1 /*
2 * Copyright (C) 2004-2010 Michael Niedermayer <michaelni@gmx.at>
3 * Copyright (C) 2008 David Conrad
4 *
5 * This file is part of FFmpeg.
6 *
7 * FFmpeg is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
10 * version 2.1 of the License, or (at your option) any later version.
11 *
12 * FFmpeg is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * Lesser General Public License for more details.
16 *
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with FFmpeg; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20 */
21
22 #include "libavutil/attributes.h"
23 #include "libavutil/avassert.h"
24 #include "libavutil/common.h"
25 #include "me_cmp.h"
26 #include "snow_dwt.h"
27
ff_slice_buffer_init(slice_buffer * buf,int line_count,int max_allocated_lines,int line_width,IDWTELEM * base_buffer)28 int ff_slice_buffer_init(slice_buffer *buf, int line_count,
29 int max_allocated_lines, int line_width,
30 IDWTELEM *base_buffer)
31 {
32 int i;
33
34 buf->base_buffer = base_buffer;
35 buf->line_count = line_count;
36 buf->line_width = line_width;
37 buf->data_count = max_allocated_lines;
38 buf->line = av_mallocz_array(line_count, sizeof(IDWTELEM *));
39 if (!buf->line)
40 return AVERROR(ENOMEM);
41 buf->data_stack = av_malloc_array(max_allocated_lines, sizeof(IDWTELEM *));
42 if (!buf->data_stack) {
43 av_freep(&buf->line);
44 return AVERROR(ENOMEM);
45 }
46
47 for (i = 0; i < max_allocated_lines; i++) {
48 buf->data_stack[i] = av_malloc_array(line_width, sizeof(IDWTELEM));
49 if (!buf->data_stack[i]) {
50 for (i--; i >=0; i--)
51 av_freep(&buf->data_stack[i]);
52 av_freep(&buf->data_stack);
53 av_freep(&buf->line);
54 return AVERROR(ENOMEM);
55 }
56 }
57
58 buf->data_stack_top = max_allocated_lines - 1;
59 return 0;
60 }
61
ff_slice_buffer_load_line(slice_buffer * buf,int line)62 IDWTELEM *ff_slice_buffer_load_line(slice_buffer *buf, int line)
63 {
64 IDWTELEM *buffer;
65
66 av_assert0(buf->data_stack_top >= 0);
67 // av_assert1(!buf->line[line]);
68 if (buf->line[line])
69 return buf->line[line];
70
71 buffer = buf->data_stack[buf->data_stack_top];
72 buf->data_stack_top--;
73 buf->line[line] = buffer;
74
75 return buffer;
76 }
77
ff_slice_buffer_release(slice_buffer * buf,int line)78 void ff_slice_buffer_release(slice_buffer *buf, int line)
79 {
80 IDWTELEM *buffer;
81
82 av_assert1(line >= 0 && line < buf->line_count);
83 av_assert1(buf->line[line]);
84
85 buffer = buf->line[line];
86 buf->data_stack_top++;
87 buf->data_stack[buf->data_stack_top] = buffer;
88 buf->line[line] = NULL;
89 }
90
ff_slice_buffer_flush(slice_buffer * buf)91 void ff_slice_buffer_flush(slice_buffer *buf)
92 {
93 int i;
94
95 if (!buf->line)
96 return;
97
98 for (i = 0; i < buf->line_count; i++)
99 if (buf->line[i])
100 ff_slice_buffer_release(buf, i);
101 }
102
ff_slice_buffer_destroy(slice_buffer * buf)103 void ff_slice_buffer_destroy(slice_buffer *buf)
104 {
105 int i;
106 ff_slice_buffer_flush(buf);
107
108 if (buf->data_stack)
109 for (i = buf->data_count - 1; i >= 0; i--)
110 av_freep(&buf->data_stack[i]);
111 av_freep(&buf->data_stack);
112 av_freep(&buf->line);
113 }
114
lift(DWTELEM * dst,DWTELEM * src,DWTELEM * ref,int dst_step,int src_step,int ref_step,int width,int mul,int add,int shift,int highpass,int inverse)115 static av_always_inline void lift(DWTELEM *dst, DWTELEM *src, DWTELEM *ref,
116 int dst_step, int src_step, int ref_step,
117 int width, int mul, int add, int shift,
118 int highpass, int inverse)
119 {
120 const int mirror_left = !highpass;
121 const int mirror_right = (width & 1) ^ highpass;
122 const int w = (width >> 1) - 1 + (highpass & width);
123 int i;
124
125 #define LIFT(src, ref, inv) ((src) + ((inv) ? -(ref) : +(ref)))
126 if (mirror_left) {
127 dst[0] = LIFT(src[0], ((mul * 2 * ref[0] + add) >> shift), inverse);
128 dst += dst_step;
129 src += src_step;
130 }
131
132 for (i = 0; i < w; i++)
133 dst[i * dst_step] = LIFT(src[i * src_step],
134 ((mul * (ref[i * ref_step] +
135 ref[(i + 1) * ref_step]) +
136 add) >> shift),
137 inverse);
138
139 if (mirror_right)
140 dst[w * dst_step] = LIFT(src[w * src_step],
141 ((mul * 2 * ref[w * ref_step] + add) >> shift),
142 inverse);
143 }
144
liftS(DWTELEM * dst,DWTELEM * src,DWTELEM * ref,int dst_step,int src_step,int ref_step,int width,int mul,int add,int shift,int highpass,int inverse)145 static av_always_inline void liftS(DWTELEM *dst, DWTELEM *src, DWTELEM *ref,
146 int dst_step, int src_step, int ref_step,
147 int width, int mul, int add, int shift,
148 int highpass, int inverse)
149 {
150 const int mirror_left = !highpass;
151 const int mirror_right = (width & 1) ^ highpass;
152 const int w = (width >> 1) - 1 + (highpass & width);
153 int i;
154
155 av_assert1(shift == 4);
156 #define LIFTS(src, ref, inv) \
157 ((inv) ? (src) + (((ref) + 4 * (src)) >> shift) \
158 : -((-16 * (src) + (ref) + add / \
159 4 + 1 + (5 << 25)) / (5 * 4) - (1 << 23)))
160 if (mirror_left) {
161 dst[0] = LIFTS(src[0], mul * 2 * ref[0] + add, inverse);
162 dst += dst_step;
163 src += src_step;
164 }
165
166 for (i = 0; i < w; i++)
167 dst[i * dst_step] = LIFTS(src[i * src_step],
168 mul * (ref[i * ref_step] +
169 ref[(i + 1) * ref_step]) + add,
170 inverse);
171
172 if (mirror_right)
173 dst[w * dst_step] = LIFTS(src[w * src_step],
174 mul * 2 * ref[w * ref_step] + add,
175 inverse);
176 }
177
horizontal_decompose53i(DWTELEM * b,DWTELEM * temp,int width)178 static void horizontal_decompose53i(DWTELEM *b, DWTELEM *temp, int width)
179 {
180 const int width2 = width >> 1;
181 int x;
182 const int w2 = (width + 1) >> 1;
183
184 for (x = 0; x < width2; x++) {
185 temp[x] = b[2 * x];
186 temp[x + w2] = b[2 * x + 1];
187 }
188 if (width & 1)
189 temp[x] = b[2 * x];
190 lift(b + w2, temp + w2, temp, 1, 1, 1, width, -1, 0, 1, 1, 0);
191 lift(b, temp, b + w2, 1, 1, 1, width, 1, 2, 2, 0, 0);
192 }
193
vertical_decompose53iH0(DWTELEM * b0,DWTELEM * b1,DWTELEM * b2,int width)194 static void vertical_decompose53iH0(DWTELEM *b0, DWTELEM *b1, DWTELEM *b2,
195 int width)
196 {
197 int i;
198
199 for (i = 0; i < width; i++)
200 b1[i] -= (b0[i] + b2[i]) >> 1;
201 }
202
vertical_decompose53iL0(DWTELEM * b0,DWTELEM * b1,DWTELEM * b2,int width)203 static void vertical_decompose53iL0(DWTELEM *b0, DWTELEM *b1, DWTELEM *b2,
204 int width)
205 {
206 int i;
207
208 for (i = 0; i < width; i++)
209 b1[i] += (b0[i] + b2[i] + 2) >> 2;
210 }
211
spatial_decompose53i(DWTELEM * buffer,DWTELEM * temp,int width,int height,int stride)212 static void spatial_decompose53i(DWTELEM *buffer, DWTELEM *temp,
213 int width, int height, int stride)
214 {
215 int y;
216 DWTELEM *b0 = buffer + avpriv_mirror(-2 - 1, height - 1) * stride;
217 DWTELEM *b1 = buffer + avpriv_mirror(-2, height - 1) * stride;
218
219 for (y = -2; y < height; y += 2) {
220 DWTELEM *b2 = buffer + avpriv_mirror(y + 1, height - 1) * stride;
221 DWTELEM *b3 = buffer + avpriv_mirror(y + 2, height - 1) * stride;
222
223 if (y + 1 < (unsigned)height)
224 horizontal_decompose53i(b2, temp, width);
225 if (y + 2 < (unsigned)height)
226 horizontal_decompose53i(b3, temp, width);
227
228 if (y + 1 < (unsigned)height)
229 vertical_decompose53iH0(b1, b2, b3, width);
230 if (y + 0 < (unsigned)height)
231 vertical_decompose53iL0(b0, b1, b2, width);
232
233 b0 = b2;
234 b1 = b3;
235 }
236 }
237
horizontal_decompose97i(DWTELEM * b,DWTELEM * temp,int width)238 static void horizontal_decompose97i(DWTELEM *b, DWTELEM *temp, int width)
239 {
240 const int w2 = (width + 1) >> 1;
241
242 lift(temp + w2, b + 1, b, 1, 2, 2, width, W_AM, W_AO, W_AS, 1, 1);
243 liftS(temp, b, temp + w2, 1, 2, 1, width, W_BM, W_BO, W_BS, 0, 0);
244 lift(b + w2, temp + w2, temp, 1, 1, 1, width, W_CM, W_CO, W_CS, 1, 0);
245 lift(b, temp, b + w2, 1, 1, 1, width, W_DM, W_DO, W_DS, 0, 0);
246 }
247
vertical_decompose97iH0(DWTELEM * b0,DWTELEM * b1,DWTELEM * b2,int width)248 static void vertical_decompose97iH0(DWTELEM *b0, DWTELEM *b1, DWTELEM *b2,
249 int width)
250 {
251 int i;
252
253 for (i = 0; i < width; i++)
254 b1[i] -= (W_AM * (b0[i] + b2[i]) + W_AO) >> W_AS;
255 }
256
vertical_decompose97iH1(DWTELEM * b0,DWTELEM * b1,DWTELEM * b2,int width)257 static void vertical_decompose97iH1(DWTELEM *b0, DWTELEM *b1, DWTELEM *b2,
258 int width)
259 {
260 int i;
261
262 for (i = 0; i < width; i++)
263 b1[i] += (W_CM * (b0[i] + b2[i]) + W_CO) >> W_CS;
264 }
265
vertical_decompose97iL0(DWTELEM * b0,DWTELEM * b1,DWTELEM * b2,int width)266 static void vertical_decompose97iL0(DWTELEM *b0, DWTELEM *b1, DWTELEM *b2,
267 int width)
268 {
269 int i;
270
271 for (i = 0; i < width; i++)
272 b1[i] = (16 * 4 * b1[i] - 4 * (b0[i] + b2[i]) + W_BO * 5 + (5 << 27)) /
273 (5 * 16) - (1 << 23);
274 }
275
vertical_decompose97iL1(DWTELEM * b0,DWTELEM * b1,DWTELEM * b2,int width)276 static void vertical_decompose97iL1(DWTELEM *b0, DWTELEM *b1, DWTELEM *b2,
277 int width)
278 {
279 int i;
280
281 for (i = 0; i < width; i++)
282 b1[i] += (W_DM * (b0[i] + b2[i]) + W_DO) >> W_DS;
283 }
284
spatial_decompose97i(DWTELEM * buffer,DWTELEM * temp,int width,int height,int stride)285 static void spatial_decompose97i(DWTELEM *buffer, DWTELEM *temp,
286 int width, int height, int stride)
287 {
288 int y;
289 DWTELEM *b0 = buffer + avpriv_mirror(-4 - 1, height - 1) * stride;
290 DWTELEM *b1 = buffer + avpriv_mirror(-4, height - 1) * stride;
291 DWTELEM *b2 = buffer + avpriv_mirror(-4 + 1, height - 1) * stride;
292 DWTELEM *b3 = buffer + avpriv_mirror(-4 + 2, height - 1) * stride;
293
294 for (y = -4; y < height; y += 2) {
295 DWTELEM *b4 = buffer + avpriv_mirror(y + 3, height - 1) * stride;
296 DWTELEM *b5 = buffer + avpriv_mirror(y + 4, height - 1) * stride;
297
298 if (y + 3 < (unsigned)height)
299 horizontal_decompose97i(b4, temp, width);
300 if (y + 4 < (unsigned)height)
301 horizontal_decompose97i(b5, temp, width);
302
303 if (y + 3 < (unsigned)height)
304 vertical_decompose97iH0(b3, b4, b5, width);
305 if (y + 2 < (unsigned)height)
306 vertical_decompose97iL0(b2, b3, b4, width);
307 if (y + 1 < (unsigned)height)
308 vertical_decompose97iH1(b1, b2, b3, width);
309 if (y + 0 < (unsigned)height)
310 vertical_decompose97iL1(b0, b1, b2, width);
311
312 b0 = b2;
313 b1 = b3;
314 b2 = b4;
315 b3 = b5;
316 }
317 }
318
ff_spatial_dwt(DWTELEM * buffer,DWTELEM * temp,int width,int height,int stride,int type,int decomposition_count)319 void ff_spatial_dwt(DWTELEM *buffer, DWTELEM *temp, int width, int height,
320 int stride, int type, int decomposition_count)
321 {
322 int level;
323
324 for (level = 0; level < decomposition_count; level++) {
325 switch (type) {
326 case DWT_97:
327 spatial_decompose97i(buffer, temp,
328 width >> level, height >> level,
329 stride << level);
330 break;
331 case DWT_53:
332 spatial_decompose53i(buffer, temp,
333 width >> level, height >> level,
334 stride << level);
335 break;
336 }
337 }
338 }
339
horizontal_compose53i(IDWTELEM * b,IDWTELEM * temp,int width)340 static void horizontal_compose53i(IDWTELEM *b, IDWTELEM *temp, int width)
341 {
342 const int width2 = width >> 1;
343 const int w2 = (width + 1) >> 1;
344 int x;
345
346 for (x = 0; x < width2; x++) {
347 temp[2 * x] = b[x];
348 temp[2 * x + 1] = b[x + w2];
349 }
350 if (width & 1)
351 temp[2 * x] = b[x];
352
353 b[0] = temp[0] - ((temp[1] + 1) >> 1);
354 for (x = 2; x < width - 1; x += 2) {
355 b[x] = temp[x] - ((temp[x - 1] + temp[x + 1] + 2) >> 2);
356 b[x - 1] = temp[x - 1] + ((b[x - 2] + b[x] + 1) >> 1);
357 }
358 if (width & 1) {
359 b[x] = temp[x] - ((temp[x - 1] + 1) >> 1);
360 b[x - 1] = temp[x - 1] + ((b[x - 2] + b[x] + 1) >> 1);
361 } else
362 b[x - 1] = temp[x - 1] + b[x - 2];
363 }
364
vertical_compose53iH0(IDWTELEM * b0,IDWTELEM * b1,IDWTELEM * b2,int width)365 static void vertical_compose53iH0(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2,
366 int width)
367 {
368 int i;
369
370 for (i = 0; i < width; i++)
371 b1[i] += (b0[i] + b2[i]) >> 1;
372 }
373
vertical_compose53iL0(IDWTELEM * b0,IDWTELEM * b1,IDWTELEM * b2,int width)374 static void vertical_compose53iL0(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2,
375 int width)
376 {
377 int i;
378
379 for (i = 0; i < width; i++)
380 b1[i] -= (b0[i] + b2[i] + 2) >> 2;
381 }
382
spatial_compose53i_buffered_init(DWTCompose * cs,slice_buffer * sb,int height,int stride_line)383 static void spatial_compose53i_buffered_init(DWTCompose *cs, slice_buffer *sb,
384 int height, int stride_line)
385 {
386 cs->b0 = slice_buffer_get_line(sb,
387 avpriv_mirror(-1 - 1, height - 1) * stride_line);
388 cs->b1 = slice_buffer_get_line(sb, avpriv_mirror(-1, height - 1) * stride_line);
389 cs->y = -1;
390 }
391
spatial_compose53i_init(DWTCompose * cs,IDWTELEM * buffer,int height,int stride)392 static void spatial_compose53i_init(DWTCompose *cs, IDWTELEM *buffer,
393 int height, int stride)
394 {
395 cs->b0 = buffer + avpriv_mirror(-1 - 1, height - 1) * stride;
396 cs->b1 = buffer + avpriv_mirror(-1, height - 1) * stride;
397 cs->y = -1;
398 }
399
spatial_compose53i_dy_buffered(DWTCompose * cs,slice_buffer * sb,IDWTELEM * temp,int width,int height,int stride_line)400 static void spatial_compose53i_dy_buffered(DWTCompose *cs, slice_buffer *sb,
401 IDWTELEM *temp,
402 int width, int height,
403 int stride_line)
404 {
405 int y = cs->y;
406
407 IDWTELEM *b0 = cs->b0;
408 IDWTELEM *b1 = cs->b1;
409 IDWTELEM *b2 = slice_buffer_get_line(sb,
410 avpriv_mirror(y + 1, height - 1) *
411 stride_line);
412 IDWTELEM *b3 = slice_buffer_get_line(sb,
413 avpriv_mirror(y + 2, height - 1) *
414 stride_line);
415
416 if (y + 1 < (unsigned)height && y < (unsigned)height) {
417 int x;
418
419 for (x = 0; x < width; x++) {
420 b2[x] -= (b1[x] + b3[x] + 2) >> 2;
421 b1[x] += (b0[x] + b2[x]) >> 1;
422 }
423 } else {
424 if (y + 1 < (unsigned)height)
425 vertical_compose53iL0(b1, b2, b3, width);
426 if (y + 0 < (unsigned)height)
427 vertical_compose53iH0(b0, b1, b2, width);
428 }
429
430 if (y - 1 < (unsigned)height)
431 horizontal_compose53i(b0, temp, width);
432 if (y + 0 < (unsigned)height)
433 horizontal_compose53i(b1, temp, width);
434
435 cs->b0 = b2;
436 cs->b1 = b3;
437 cs->y += 2;
438 }
439
spatial_compose53i_dy(DWTCompose * cs,IDWTELEM * buffer,IDWTELEM * temp,int width,int height,int stride)440 static void spatial_compose53i_dy(DWTCompose *cs, IDWTELEM *buffer,
441 IDWTELEM *temp, int width, int height,
442 int stride)
443 {
444 int y = cs->y;
445 IDWTELEM *b0 = cs->b0;
446 IDWTELEM *b1 = cs->b1;
447 IDWTELEM *b2 = buffer + avpriv_mirror(y + 1, height - 1) * stride;
448 IDWTELEM *b3 = buffer + avpriv_mirror(y + 2, height - 1) * stride;
449
450 if (y + 1 < (unsigned)height)
451 vertical_compose53iL0(b1, b2, b3, width);
452 if (y + 0 < (unsigned)height)
453 vertical_compose53iH0(b0, b1, b2, width);
454
455 if (y - 1 < (unsigned)height)
456 horizontal_compose53i(b0, temp, width);
457 if (y + 0 < (unsigned)height)
458 horizontal_compose53i(b1, temp, width);
459
460 cs->b0 = b2;
461 cs->b1 = b3;
462 cs->y += 2;
463 }
464
ff_snow_horizontal_compose97i(IDWTELEM * b,IDWTELEM * temp,int width)465 void ff_snow_horizontal_compose97i(IDWTELEM *b, IDWTELEM *temp, int width)
466 {
467 const int w2 = (width + 1) >> 1;
468 int x;
469
470 temp[0] = b[0] - ((3 * b[w2] + 2) >> 2);
471 for (x = 1; x < (width >> 1); x++) {
472 temp[2 * x] = b[x] - ((3 * (b[x + w2 - 1] + b[x + w2]) + 4) >> 3);
473 temp[2 * x - 1] = b[x + w2 - 1] - temp[2 * x - 2] - temp[2 * x];
474 }
475 if (width & 1) {
476 temp[2 * x] = b[x] - ((3 * b[x + w2 - 1] + 2) >> 2);
477 temp[2 * x - 1] = b[x + w2 - 1] - temp[2 * x - 2] - temp[2 * x];
478 } else
479 temp[2 * x - 1] = b[x + w2 - 1] - 2 * temp[2 * x - 2];
480
481 b[0] = temp[0] + ((2 * temp[0] + temp[1] + 4) >> 3);
482 for (x = 2; x < width - 1; x += 2) {
483 b[x] = temp[x] + ((4 * temp[x] + temp[x - 1] + temp[x + 1] + 8) >> 4);
484 b[x - 1] = temp[x - 1] + ((3 * (b[x - 2] + b[x])) >> 1);
485 }
486 if (width & 1) {
487 b[x] = temp[x] + ((2 * temp[x] + temp[x - 1] + 4) >> 3);
488 b[x - 1] = temp[x - 1] + ((3 * (b[x - 2] + b[x])) >> 1);
489 } else
490 b[x - 1] = temp[x - 1] + 3 * b[x - 2];
491 }
492
vertical_compose97iH0(IDWTELEM * b0,IDWTELEM * b1,IDWTELEM * b2,int width)493 static void vertical_compose97iH0(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2,
494 int width)
495 {
496 int i;
497
498 for (i = 0; i < width; i++)
499 b1[i] += (W_AM * (b0[i] + b2[i]) + W_AO) >> W_AS;
500 }
501
vertical_compose97iH1(IDWTELEM * b0,IDWTELEM * b1,IDWTELEM * b2,int width)502 static void vertical_compose97iH1(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2,
503 int width)
504 {
505 int i;
506
507 for (i = 0; i < width; i++)
508 b1[i] -= (W_CM * (b0[i] + b2[i]) + W_CO) >> W_CS;
509 }
510
vertical_compose97iL0(IDWTELEM * b0,IDWTELEM * b1,IDWTELEM * b2,int width)511 static void vertical_compose97iL0(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2,
512 int width)
513 {
514 int i;
515
516 for (i = 0; i < width; i++)
517 b1[i] += (W_BM * (b0[i] + b2[i]) + 4 * b1[i] + W_BO) >> W_BS;
518 }
519
vertical_compose97iL1(IDWTELEM * b0,IDWTELEM * b1,IDWTELEM * b2,int width)520 static void vertical_compose97iL1(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2,
521 int width)
522 {
523 int i;
524
525 for (i = 0; i < width; i++)
526 b1[i] -= (W_DM * (b0[i] + b2[i]) + W_DO) >> W_DS;
527 }
528
ff_snow_vertical_compose97i(IDWTELEM * b0,IDWTELEM * b1,IDWTELEM * b2,IDWTELEM * b3,IDWTELEM * b4,IDWTELEM * b5,int width)529 void ff_snow_vertical_compose97i(IDWTELEM *b0, IDWTELEM *b1, IDWTELEM *b2,
530 IDWTELEM *b3, IDWTELEM *b4, IDWTELEM *b5,
531 int width)
532 {
533 int i;
534
535 for (i = 0; i < width; i++) {
536 b4[i] -= (W_DM * (b3[i] + b5[i]) + W_DO) >> W_DS;
537 b3[i] -= (W_CM * (b2[i] + b4[i]) + W_CO) >> W_CS;
538 b2[i] += (W_BM * (b1[i] + b3[i]) + 4 * b2[i] + W_BO) >> W_BS;
539 b1[i] += (W_AM * (b0[i] + b2[i]) + W_AO) >> W_AS;
540 }
541 }
542
spatial_compose97i_buffered_init(DWTCompose * cs,slice_buffer * sb,int height,int stride_line)543 static void spatial_compose97i_buffered_init(DWTCompose *cs, slice_buffer *sb,
544 int height, int stride_line)
545 {
546 cs->b0 = slice_buffer_get_line(sb, avpriv_mirror(-3 - 1, height - 1) * stride_line);
547 cs->b1 = slice_buffer_get_line(sb, avpriv_mirror(-3, height - 1) * stride_line);
548 cs->b2 = slice_buffer_get_line(sb, avpriv_mirror(-3 + 1, height - 1) * stride_line);
549 cs->b3 = slice_buffer_get_line(sb, avpriv_mirror(-3 + 2, height - 1) * stride_line);
550 cs->y = -3;
551 }
552
spatial_compose97i_init(DWTCompose * cs,IDWTELEM * buffer,int height,int stride)553 static void spatial_compose97i_init(DWTCompose *cs, IDWTELEM *buffer, int height,
554 int stride)
555 {
556 cs->b0 = buffer + avpriv_mirror(-3 - 1, height - 1) * stride;
557 cs->b1 = buffer + avpriv_mirror(-3, height - 1) * stride;
558 cs->b2 = buffer + avpriv_mirror(-3 + 1, height - 1) * stride;
559 cs->b3 = buffer + avpriv_mirror(-3 + 2, height - 1) * stride;
560 cs->y = -3;
561 }
562
spatial_compose97i_dy_buffered(SnowDWTContext * dsp,DWTCompose * cs,slice_buffer * sb,IDWTELEM * temp,int width,int height,int stride_line)563 static void spatial_compose97i_dy_buffered(SnowDWTContext *dsp, DWTCompose *cs,
564 slice_buffer * sb, IDWTELEM *temp,
565 int width, int height,
566 int stride_line)
567 {
568 int y = cs->y;
569
570 IDWTELEM *b0 = cs->b0;
571 IDWTELEM *b1 = cs->b1;
572 IDWTELEM *b2 = cs->b2;
573 IDWTELEM *b3 = cs->b3;
574 IDWTELEM *b4 = slice_buffer_get_line(sb,
575 avpriv_mirror(y + 3, height - 1) *
576 stride_line);
577 IDWTELEM *b5 = slice_buffer_get_line(sb,
578 avpriv_mirror(y + 4, height - 1) *
579 stride_line);
580
581 if (y > 0 && y + 4 < height) {
582 dsp->vertical_compose97i(b0, b1, b2, b3, b4, b5, width);
583 } else {
584 if (y + 3 < (unsigned)height)
585 vertical_compose97iL1(b3, b4, b5, width);
586 if (y + 2 < (unsigned)height)
587 vertical_compose97iH1(b2, b3, b4, width);
588 if (y + 1 < (unsigned)height)
589 vertical_compose97iL0(b1, b2, b3, width);
590 if (y + 0 < (unsigned)height)
591 vertical_compose97iH0(b0, b1, b2, width);
592 }
593
594 if (y - 1 < (unsigned)height)
595 dsp->horizontal_compose97i(b0, temp, width);
596 if (y + 0 < (unsigned)height)
597 dsp->horizontal_compose97i(b1, temp, width);
598
599 cs->b0 = b2;
600 cs->b1 = b3;
601 cs->b2 = b4;
602 cs->b3 = b5;
603 cs->y += 2;
604 }
605
spatial_compose97i_dy(DWTCompose * cs,IDWTELEM * buffer,IDWTELEM * temp,int width,int height,int stride)606 static void spatial_compose97i_dy(DWTCompose *cs, IDWTELEM *buffer,
607 IDWTELEM *temp, int width, int height,
608 int stride)
609 {
610 int y = cs->y;
611 IDWTELEM *b0 = cs->b0;
612 IDWTELEM *b1 = cs->b1;
613 IDWTELEM *b2 = cs->b2;
614 IDWTELEM *b3 = cs->b3;
615 IDWTELEM *b4 = buffer + avpriv_mirror(y + 3, height - 1) * stride;
616 IDWTELEM *b5 = buffer + avpriv_mirror(y + 4, height - 1) * stride;
617
618 if (y + 3 < (unsigned)height)
619 vertical_compose97iL1(b3, b4, b5, width);
620 if (y + 2 < (unsigned)height)
621 vertical_compose97iH1(b2, b3, b4, width);
622 if (y + 1 < (unsigned)height)
623 vertical_compose97iL0(b1, b2, b3, width);
624 if (y + 0 < (unsigned)height)
625 vertical_compose97iH0(b0, b1, b2, width);
626
627 if (y - 1 < (unsigned)height)
628 ff_snow_horizontal_compose97i(b0, temp, width);
629 if (y + 0 < (unsigned)height)
630 ff_snow_horizontal_compose97i(b1, temp, width);
631
632 cs->b0 = b2;
633 cs->b1 = b3;
634 cs->b2 = b4;
635 cs->b3 = b5;
636 cs->y += 2;
637 }
638
ff_spatial_idwt_buffered_init(DWTCompose * cs,slice_buffer * sb,int width,int height,int stride_line,int type,int decomposition_count)639 void ff_spatial_idwt_buffered_init(DWTCompose *cs, slice_buffer *sb, int width,
640 int height, int stride_line, int type,
641 int decomposition_count)
642 {
643 int level;
644 for (level = decomposition_count - 1; level >= 0; level--) {
645 switch (type) {
646 case DWT_97:
647 spatial_compose97i_buffered_init(cs + level, sb, height >> level,
648 stride_line << level);
649 break;
650 case DWT_53:
651 spatial_compose53i_buffered_init(cs + level, sb, height >> level,
652 stride_line << level);
653 break;
654 }
655 }
656 }
657
ff_spatial_idwt_buffered_slice(SnowDWTContext * dsp,DWTCompose * cs,slice_buffer * slice_buf,IDWTELEM * temp,int width,int height,int stride_line,int type,int decomposition_count,int y)658 void ff_spatial_idwt_buffered_slice(SnowDWTContext *dsp, DWTCompose *cs,
659 slice_buffer *slice_buf, IDWTELEM *temp,
660 int width, int height, int stride_line,
661 int type, int decomposition_count, int y)
662 {
663 const int support = type == 1 ? 3 : 5;
664 int level;
665 if (type == 2)
666 return;
667
668 for (level = decomposition_count - 1; level >= 0; level--)
669 while (cs[level].y <= FFMIN((y >> level) + support, height >> level)) {
670 switch (type) {
671 case DWT_97:
672 spatial_compose97i_dy_buffered(dsp, cs + level, slice_buf, temp,
673 width >> level,
674 height >> level,
675 stride_line << level);
676 break;
677 case DWT_53:
678 spatial_compose53i_dy_buffered(cs + level, slice_buf, temp,
679 width >> level,
680 height >> level,
681 stride_line << level);
682 break;
683 }
684 }
685 }
686
spatial_idwt_init(DWTCompose * cs,IDWTELEM * buffer,int width,int height,int stride,int type,int decomposition_count)687 static void spatial_idwt_init(DWTCompose *cs, IDWTELEM *buffer, int width,
688 int height, int stride, int type,
689 int decomposition_count)
690 {
691 int level;
692 for (level = decomposition_count - 1; level >= 0; level--) {
693 switch (type) {
694 case DWT_97:
695 spatial_compose97i_init(cs + level, buffer, height >> level,
696 stride << level);
697 break;
698 case DWT_53:
699 spatial_compose53i_init(cs + level, buffer, height >> level,
700 stride << level);
701 break;
702 }
703 }
704 }
705
spatial_idwt_slice(DWTCompose * cs,IDWTELEM * buffer,IDWTELEM * temp,int width,int height,int stride,int type,int decomposition_count,int y)706 static void spatial_idwt_slice(DWTCompose *cs, IDWTELEM *buffer,
707 IDWTELEM *temp, int width, int height,
708 int stride, int type,
709 int decomposition_count, int y)
710 {
711 const int support = type == 1 ? 3 : 5;
712 int level;
713 if (type == 2)
714 return;
715
716 for (level = decomposition_count - 1; level >= 0; level--)
717 while (cs[level].y <= FFMIN((y >> level) + support, height >> level)) {
718 switch (type) {
719 case DWT_97:
720 spatial_compose97i_dy(cs + level, buffer, temp, width >> level,
721 height >> level, stride << level);
722 break;
723 case DWT_53:
724 spatial_compose53i_dy(cs + level, buffer, temp, width >> level,
725 height >> level, stride << level);
726 break;
727 }
728 }
729 }
730
ff_spatial_idwt(IDWTELEM * buffer,IDWTELEM * temp,int width,int height,int stride,int type,int decomposition_count)731 void ff_spatial_idwt(IDWTELEM *buffer, IDWTELEM *temp, int width, int height,
732 int stride, int type, int decomposition_count)
733 {
734 DWTCompose cs[MAX_DECOMPOSITIONS];
735 int y;
736 spatial_idwt_init(cs, buffer, width, height, stride, type,
737 decomposition_count);
738 for (y = 0; y < height; y += 4)
739 spatial_idwt_slice(cs, buffer, temp, width, height, stride, type,
740 decomposition_count, y);
741 }
742
w_c(struct MpegEncContext * v,uint8_t * pix1,uint8_t * pix2,ptrdiff_t line_size,int w,int h,int type)743 static inline int w_c(struct MpegEncContext *v, uint8_t *pix1, uint8_t *pix2, ptrdiff_t line_size,
744 int w, int h, int type)
745 {
746 int s, i, j;
747 const int dec_count = w == 8 ? 3 : 4;
748 int tmp[32 * 32], tmp2[32];
749 int level, ori;
750 static const int scale[2][2][4][4] = {
751 {
752 { // 9/7 8x8 dec=3
753 { 268, 239, 239, 213 },
754 { 0, 224, 224, 152 },
755 { 0, 135, 135, 110 },
756 },
757 { // 9/7 16x16 or 32x32 dec=4
758 { 344, 310, 310, 280 },
759 { 0, 320, 320, 228 },
760 { 0, 175, 175, 136 },
761 { 0, 129, 129, 102 },
762 }
763 },
764 {
765 { // 5/3 8x8 dec=3
766 { 275, 245, 245, 218 },
767 { 0, 230, 230, 156 },
768 { 0, 138, 138, 113 },
769 },
770 { // 5/3 16x16 or 32x32 dec=4
771 { 352, 317, 317, 286 },
772 { 0, 328, 328, 233 },
773 { 0, 180, 180, 140 },
774 { 0, 132, 132, 105 },
775 }
776 }
777 };
778
779 for (i = 0; i < h; i++) {
780 for (j = 0; j < w; j += 4) {
781 tmp[32 * i + j + 0] = (pix1[j + 0] - pix2[j + 0]) << 4;
782 tmp[32 * i + j + 1] = (pix1[j + 1] - pix2[j + 1]) << 4;
783 tmp[32 * i + j + 2] = (pix1[j + 2] - pix2[j + 2]) << 4;
784 tmp[32 * i + j + 3] = (pix1[j + 3] - pix2[j + 3]) << 4;
785 }
786 pix1 += line_size;
787 pix2 += line_size;
788 }
789
790 ff_spatial_dwt(tmp, tmp2, w, h, 32, type, dec_count);
791
792 s = 0;
793 av_assert1(w == h);
794 for (level = 0; level < dec_count; level++)
795 for (ori = level ? 1 : 0; ori < 4; ori++) {
796 int size = w >> (dec_count - level);
797 int sx = (ori & 1) ? size : 0;
798 int stride = 32 << (dec_count - level);
799 int sy = (ori & 2) ? stride >> 1 : 0;
800
801 for (i = 0; i < size; i++)
802 for (j = 0; j < size; j++) {
803 int v = tmp[sx + sy + i * stride + j] *
804 scale[type][dec_count - 3][level][ori];
805 s += FFABS(v);
806 }
807 }
808 av_assert1(s >= 0);
809 return s >> 9;
810 }
811
w53_8_c(struct MpegEncContext * v,uint8_t * pix1,uint8_t * pix2,ptrdiff_t line_size,int h)812 static int w53_8_c(struct MpegEncContext *v, uint8_t *pix1, uint8_t *pix2, ptrdiff_t line_size, int h)
813 {
814 return w_c(v, pix1, pix2, line_size, 8, h, 1);
815 }
816
w97_8_c(struct MpegEncContext * v,uint8_t * pix1,uint8_t * pix2,ptrdiff_t line_size,int h)817 static int w97_8_c(struct MpegEncContext *v, uint8_t *pix1, uint8_t *pix2, ptrdiff_t line_size, int h)
818 {
819 return w_c(v, pix1, pix2, line_size, 8, h, 0);
820 }
821
w53_16_c(struct MpegEncContext * v,uint8_t * pix1,uint8_t * pix2,ptrdiff_t line_size,int h)822 static int w53_16_c(struct MpegEncContext *v, uint8_t *pix1, uint8_t *pix2, ptrdiff_t line_size, int h)
823 {
824 return w_c(v, pix1, pix2, line_size, 16, h, 1);
825 }
826
w97_16_c(struct MpegEncContext * v,uint8_t * pix1,uint8_t * pix2,ptrdiff_t line_size,int h)827 static int w97_16_c(struct MpegEncContext *v, uint8_t *pix1, uint8_t *pix2, ptrdiff_t line_size, int h)
828 {
829 return w_c(v, pix1, pix2, line_size, 16, h, 0);
830 }
831
ff_w53_32_c(struct MpegEncContext * v,uint8_t * pix1,uint8_t * pix2,ptrdiff_t line_size,int h)832 int ff_w53_32_c(struct MpegEncContext *v, uint8_t *pix1, uint8_t *pix2, ptrdiff_t line_size, int h)
833 {
834 return w_c(v, pix1, pix2, line_size, 32, h, 1);
835 }
836
ff_w97_32_c(struct MpegEncContext * v,uint8_t * pix1,uint8_t * pix2,ptrdiff_t line_size,int h)837 int ff_w97_32_c(struct MpegEncContext *v, uint8_t *pix1, uint8_t *pix2, ptrdiff_t line_size, int h)
838 {
839 return w_c(v, pix1, pix2, line_size, 32, h, 0);
840 }
841
ff_dsputil_init_dwt(MECmpContext * c)842 av_cold void ff_dsputil_init_dwt(MECmpContext *c)
843 {
844 c->w53[0] = w53_16_c;
845 c->w53[1] = w53_8_c;
846 c->w97[0] = w97_16_c;
847 c->w97[1] = w97_8_c;
848 }
849
ff_dwt_init(SnowDWTContext * c)850 av_cold void ff_dwt_init(SnowDWTContext *c)
851 {
852 c->vertical_compose97i = ff_snow_vertical_compose97i;
853 c->horizontal_compose97i = ff_snow_horizontal_compose97i;
854 c->inner_add_yblock = ff_snow_inner_add_yblock;
855
856 if (HAVE_MMX)
857 ff_dwt_init_x86(c);
858 }
859
860
861