Remove g6Dither from libswscale.
[ffmpeg.git] / libswscale / swscale.c
1 /*
2  * Copyright (C) 2001-2003 Michael Niedermayer <michaelni@gmx.at>
3  *
4  * This file is part of FFmpeg.
5  *
6  * FFmpeg is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * FFmpeg is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with FFmpeg; if not, write to the Free Software
18  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
19  *
20  * the C code (not assembly, mmx, ...) of this file can be used
21  * under the LGPL license too
22  */
23
24 /*
25   supported Input formats: YV12, I420/IYUV, YUY2, UYVY, BGR32, BGR32_1, BGR24, BGR16, BGR15, RGB32, RGB32_1, RGB24, Y8/Y800, YVU9/IF09, PAL8
26   supported output formats: YV12, I420/IYUV, YUY2, UYVY, {BGR,RGB}{1,4,8,15,16,24,32}, Y8/Y800, YVU9/IF09
27   {BGR,RGB}{1,4,8,15,16} support dithering
28
29   unscaled special converters (YV12=I420=IYUV, Y800=Y8)
30   YV12 -> {BGR,RGB}{1,4,8,15,16,24,32}
31   x -> x
32   YUV9 -> YV12
33   YUV9/YV12 -> Y800
34   Y800 -> YUV9/YV12
35   BGR24 -> BGR32 & RGB24 -> RGB32
36   BGR32 -> BGR24 & RGB32 -> RGB24
37   BGR15 -> BGR16
38 */
39
40 /*
41 tested special converters (most are tested actually, but I did not write it down ...)
42  YV12 -> BGR16
43  YV12 -> YV12
44  BGR15 -> BGR16
45  BGR16 -> BGR16
46  YVU9 -> YV12
47
48 untested special converters
49   YV12/I420 -> BGR15/BGR24/BGR32 (it is the yuv2rgb stuff, so it should be ok)
50   YV12/I420 -> YV12/I420
51   YUY2/BGR15/BGR24/BGR32/RGB24/RGB32 -> same format
52   BGR24 -> BGR32 & RGB24 -> RGB32
53   BGR32 -> BGR24 & RGB32 -> RGB24
54   BGR24 -> YV12
55 */
56
57 #define _SVID_SOURCE //needed for MAP_ANONYMOUS
58 #include <inttypes.h>
59 #include <string.h>
60 #include <math.h>
61 #include <stdio.h>
62 #include <unistd.h>
63 #include "config.h"
64 #include <assert.h>
65 #ifdef HAVE_SYS_MMAN_H
66 #include <sys/mman.h>
67 #if defined(MAP_ANON) && !defined(MAP_ANONYMOUS)
68 #define MAP_ANONYMOUS MAP_ANON
69 #endif
70 #endif
71 #include "swscale.h"
72 #include "swscale_internal.h"
73 #include "rgb2rgb.h"
74 #include "libavutil/x86_cpu.h"
75 #include "libavutil/bswap.h"
76
77 unsigned swscale_version(void)
78 {
79     return LIBSWSCALE_VERSION_INT;
80 }
81
82 #undef MOVNTQ
83 #undef PAVGB
84
85 //#undef HAVE_MMX2
86 //#define HAVE_3DNOW
87 //#undef HAVE_MMX
88 //#undef ARCH_X86
89 //#define WORDS_BIGENDIAN
90 #define DITHER1XBPP
91
92 #define FAST_BGR2YV12 // use 7 bit coeffs instead of 15bit
93
94 #define RET 0xC3 //near return opcode for X86
95
96 #ifdef M_PI
97 #define PI M_PI
98 #else
99 #define PI 3.14159265358979323846
100 #endif
101
102 #define isSupportedIn(x)    (       \
103            (x)==PIX_FMT_YUV420P     \
104         || (x)==PIX_FMT_YUVA420P    \
105         || (x)==PIX_FMT_YUYV422     \
106         || (x)==PIX_FMT_UYVY422     \
107         || (x)==PIX_FMT_RGB32       \
108         || (x)==PIX_FMT_RGB32_1     \
109         || (x)==PIX_FMT_BGR24       \
110         || (x)==PIX_FMT_BGR565      \
111         || (x)==PIX_FMT_BGR555      \
112         || (x)==PIX_FMT_BGR32       \
113         || (x)==PIX_FMT_BGR32_1     \
114         || (x)==PIX_FMT_RGB24       \
115         || (x)==PIX_FMT_RGB565      \
116         || (x)==PIX_FMT_RGB555      \
117         || (x)==PIX_FMT_GRAY8       \
118         || (x)==PIX_FMT_YUV410P     \
119         || (x)==PIX_FMT_YUV440P     \
120         || (x)==PIX_FMT_GRAY16BE    \
121         || (x)==PIX_FMT_GRAY16LE    \
122         || (x)==PIX_FMT_YUV444P     \
123         || (x)==PIX_FMT_YUV422P     \
124         || (x)==PIX_FMT_YUV411P     \
125         || (x)==PIX_FMT_PAL8        \
126         || (x)==PIX_FMT_BGR8        \
127         || (x)==PIX_FMT_RGB8        \
128         || (x)==PIX_FMT_BGR4_BYTE   \
129         || (x)==PIX_FMT_RGB4_BYTE   \
130         || (x)==PIX_FMT_YUV440P     \
131         || (x)==PIX_FMT_MONOWHITE   \
132         || (x)==PIX_FMT_MONOBLACK   \
133     )
134 #define isSupportedOut(x)   (       \
135            (x)==PIX_FMT_YUV420P     \
136         || (x)==PIX_FMT_YUYV422     \
137         || (x)==PIX_FMT_UYVY422     \
138         || (x)==PIX_FMT_YUV444P     \
139         || (x)==PIX_FMT_YUV422P     \
140         || (x)==PIX_FMT_YUV411P     \
141         || isRGB(x)                 \
142         || isBGR(x)                 \
143         || (x)==PIX_FMT_NV12        \
144         || (x)==PIX_FMT_NV21        \
145         || (x)==PIX_FMT_GRAY16BE    \
146         || (x)==PIX_FMT_GRAY16LE    \
147         || (x)==PIX_FMT_GRAY8       \
148         || (x)==PIX_FMT_YUV410P     \
149         || (x)==PIX_FMT_YUV440P     \
150     )
151 #define isPacked(x)         (       \
152            (x)==PIX_FMT_PAL8        \
153         || (x)==PIX_FMT_YUYV422     \
154         || (x)==PIX_FMT_UYVY422     \
155         || isRGB(x)                 \
156         || isBGR(x)                 \
157     )
158
159 #define RGB2YUV_SHIFT 15
160 #define BY ( (int)(0.114*219/255*(1<<RGB2YUV_SHIFT)+0.5))
161 #define BV (-(int)(0.081*224/255*(1<<RGB2YUV_SHIFT)+0.5))
162 #define BU ( (int)(0.500*224/255*(1<<RGB2YUV_SHIFT)+0.5))
163 #define GY ( (int)(0.587*219/255*(1<<RGB2YUV_SHIFT)+0.5))
164 #define GV (-(int)(0.419*224/255*(1<<RGB2YUV_SHIFT)+0.5))
165 #define GU (-(int)(0.331*224/255*(1<<RGB2YUV_SHIFT)+0.5))
166 #define RY ( (int)(0.299*219/255*(1<<RGB2YUV_SHIFT)+0.5))
167 #define RV ( (int)(0.500*224/255*(1<<RGB2YUV_SHIFT)+0.5))
168 #define RU (-(int)(0.169*224/255*(1<<RGB2YUV_SHIFT)+0.5))
169
170 extern const int32_t Inverse_Table_6_9[8][4];
171
172 static const double rgb2yuv_table[8][9]={
173     {0.7152, 0.0722, 0.2126, -0.386, 0.5, -0.115, -0.454, -0.046, 0.5},
174     {0.7152, 0.0722, 0.2126, -0.386, 0.5, -0.115, -0.454, -0.046, 0.5},
175     {0.587 , 0.114 , 0.299 , -0.331, 0.5, -0.169, -0.419, -0.081, 0.5},
176     {0.587 , 0.114 , 0.299 , -0.331, 0.5, -0.169, -0.419, -0.081, 0.5},
177     {0.59  , 0.11  , 0.30  , -0.331, 0.5, -0.169, -0.421, -0.079, 0.5}, //FCC
178     {0.587 , 0.114 , 0.299 , -0.331, 0.5, -0.169, -0.419, -0.081, 0.5},
179     {0.587 , 0.114 , 0.299 , -0.331, 0.5, -0.169, -0.419, -0.081, 0.5}, //SMPTE 170M
180     {0.701 , 0.087 , 0.212 , -0.384, 0.5  -0.116, -0.445, -0.055, 0.5}, //SMPTE 240M
181 };
182
183 /*
184 NOTES
185 Special versions: fast Y 1:1 scaling (no interpolation in y direction)
186
187 TODO
188 more intelligent misalignment avoidance for the horizontal scaler
189 write special vertical cubic upscale version
190 Optimize C code (yv12 / minmax)
191 add support for packed pixel yuv input & output
192 add support for Y8 output
193 optimize bgr24 & bgr32
194 add BGR4 output support
195 write special BGR->BGR scaler
196 */
197
198 #if defined(ARCH_X86) && defined (CONFIG_GPL)
199 DECLARE_ASM_CONST(8, uint64_t, bF8)=       0xF8F8F8F8F8F8F8F8LL;
200 DECLARE_ASM_CONST(8, uint64_t, bFC)=       0xFCFCFCFCFCFCFCFCLL;
201 DECLARE_ASM_CONST(8, uint64_t, w10)=       0x0010001000100010LL;
202 DECLARE_ASM_CONST(8, uint64_t, w02)=       0x0002000200020002LL;
203 DECLARE_ASM_CONST(8, uint64_t, bm00001111)=0x00000000FFFFFFFFLL;
204 DECLARE_ASM_CONST(8, uint64_t, bm00000111)=0x0000000000FFFFFFLL;
205 DECLARE_ASM_CONST(8, uint64_t, bm11111000)=0xFFFFFFFFFF000000LL;
206 DECLARE_ASM_CONST(8, uint64_t, bm01010101)=0x00FF00FF00FF00FFLL;
207
208 static volatile uint64_t attribute_used __attribute__((aligned(8))) b5Dither;
209 static volatile uint64_t attribute_used __attribute__((aligned(8))) g5Dither;
210 static volatile uint64_t attribute_used __attribute__((aligned(8))) r5Dither;
211
212 const DECLARE_ALIGNED(8, uint64_t, ff_dither4[2]) = {
213         0x0103010301030103LL,
214         0x0200020002000200LL,};
215
216 const DECLARE_ALIGNED(8, uint64_t, ff_dither8[2]) = {
217         0x0602060206020602LL,
218         0x0004000400040004LL,};
219
220 DECLARE_ASM_CONST(8, uint64_t, b16Mask)=   0x001F001F001F001FLL;
221 DECLARE_ASM_CONST(8, uint64_t, g16Mask)=   0x07E007E007E007E0LL;
222 DECLARE_ASM_CONST(8, uint64_t, r16Mask)=   0xF800F800F800F800LL;
223 DECLARE_ASM_CONST(8, uint64_t, b15Mask)=   0x001F001F001F001FLL;
224 DECLARE_ASM_CONST(8, uint64_t, g15Mask)=   0x03E003E003E003E0LL;
225 DECLARE_ASM_CONST(8, uint64_t, r15Mask)=   0x7C007C007C007C00LL;
226
227 DECLARE_ALIGNED(8, const uint64_t, ff_M24A)         = 0x00FF0000FF0000FFLL;
228 DECLARE_ALIGNED(8, const uint64_t, ff_M24B)         = 0xFF0000FF0000FF00LL;
229 DECLARE_ALIGNED(8, const uint64_t, ff_M24C)         = 0x0000FF0000FF0000LL;
230
231 #ifdef FAST_BGR2YV12
232 DECLARE_ALIGNED(8, const uint64_t, ff_bgr2YCoeff)   = 0x000000210041000DULL;
233 DECLARE_ALIGNED(8, const uint64_t, ff_bgr2UCoeff)   = 0x0000FFEEFFDC0038ULL;
234 DECLARE_ALIGNED(8, const uint64_t, ff_bgr2VCoeff)   = 0x00000038FFD2FFF8ULL;
235 #else
236 DECLARE_ALIGNED(8, const uint64_t, ff_bgr2YCoeff)   = 0x000020E540830C8BULL;
237 DECLARE_ALIGNED(8, const uint64_t, ff_bgr2UCoeff)   = 0x0000ED0FDAC23831ULL;
238 DECLARE_ALIGNED(8, const uint64_t, ff_bgr2VCoeff)   = 0x00003831D0E6F6EAULL;
239 #endif /* FAST_BGR2YV12 */
240 DECLARE_ALIGNED(8, const uint64_t, ff_bgr2YOffset)  = 0x1010101010101010ULL;
241 DECLARE_ALIGNED(8, const uint64_t, ff_bgr2UVOffset) = 0x8080808080808080ULL;
242 DECLARE_ALIGNED(8, const uint64_t, ff_w1111)        = 0x0001000100010001ULL;
243
244 DECLARE_ALIGNED(8, const uint64_t, ff_bgr24toY1Coeff) = 0x0C88000040870C88ULL;
245 DECLARE_ALIGNED(8, const uint64_t, ff_bgr24toY2Coeff) = 0x20DE4087000020DEULL;
246 DECLARE_ALIGNED(8, const uint64_t, ff_rgb24toY1Coeff) = 0x20DE0000408720DEULL;
247 DECLARE_ALIGNED(8, const uint64_t, ff_rgb24toY2Coeff) = 0x0C88408700000C88ULL;
248 DECLARE_ALIGNED(8, const uint64_t, ff_bgr24toYOffset) = 0x0008400000084000ULL;
249
250 DECLARE_ALIGNED(8, const uint64_t, ff_bgr24toUV[2][4]) = {
251     {0x38380000DAC83838ULL, 0xECFFDAC80000ECFFULL, 0xF6E40000D0E3F6E4ULL, 0x3838D0E300003838ULL},
252     {0xECFF0000DAC8ECFFULL, 0x3838DAC800003838ULL, 0x38380000D0E33838ULL, 0xF6E4D0E30000F6E4ULL},
253 };
254
255 DECLARE_ALIGNED(8, const uint64_t, ff_bgr24toUVOffset)= 0x0040400000404000ULL;
256
257 #endif /* defined(ARCH_X86) */
258
259 // clipping helper table for C implementations:
260 static unsigned char clip_table[768];
261
262 static SwsVector *sws_getConvVec(SwsVector *a, SwsVector *b);
263
264 const uint8_t  __attribute__((aligned(8))) dither_2x2_4[2][8]={
265 {  1,   3,   1,   3,   1,   3,   1,   3, },
266 {  2,   0,   2,   0,   2,   0,   2,   0, },
267 };
268
269 const uint8_t  __attribute__((aligned(8))) dither_2x2_8[2][8]={
270 {  6,   2,   6,   2,   6,   2,   6,   2, },
271 {  0,   4,   0,   4,   0,   4,   0,   4, },
272 };
273
274 const uint8_t  __attribute__((aligned(8))) dither_8x8_32[8][8]={
275 { 17,   9,  23,  15,  16,   8,  22,  14, },
276 {  5,  29,   3,  27,   4,  28,   2,  26, },
277 { 21,  13,  19,  11,  20,  12,  18,  10, },
278 {  0,  24,   6,  30,   1,  25,   7,  31, },
279 { 16,   8,  22,  14,  17,   9,  23,  15, },
280 {  4,  28,   2,  26,   5,  29,   3,  27, },
281 { 20,  12,  18,  10,  21,  13,  19,  11, },
282 {  1,  25,   7,  31,   0,  24,   6,  30, },
283 };
284
285 #if 0
286 const uint8_t  __attribute__((aligned(8))) dither_8x8_64[8][8]={
287 {  0,  48,  12,  60,   3,  51,  15,  63, },
288 { 32,  16,  44,  28,  35,  19,  47,  31, },
289 {  8,  56,   4,  52,  11,  59,   7,  55, },
290 { 40,  24,  36,  20,  43,  27,  39,  23, },
291 {  2,  50,  14,  62,   1,  49,  13,  61, },
292 { 34,  18,  46,  30,  33,  17,  45,  29, },
293 { 10,  58,   6,  54,   9,  57,   5,  53, },
294 { 42,  26,  38,  22,  41,  25,  37,  21, },
295 };
296 #endif
297
298 const uint8_t  __attribute__((aligned(8))) dither_8x8_73[8][8]={
299 {  0,  55,  14,  68,   3,  58,  17,  72, },
300 { 37,  18,  50,  32,  40,  22,  54,  35, },
301 {  9,  64,   5,  59,  13,  67,   8,  63, },
302 { 46,  27,  41,  23,  49,  31,  44,  26, },
303 {  2,  57,  16,  71,   1,  56,  15,  70, },
304 { 39,  21,  52,  34,  38,  19,  51,  33, },
305 { 11,  66,   7,  62,  10,  65,   6,  60, },
306 { 48,  30,  43,  25,  47,  29,  42,  24, },
307 };
308
309 #if 0
310 const uint8_t  __attribute__((aligned(8))) dither_8x8_128[8][8]={
311 { 68,  36,  92,  60,  66,  34,  90,  58, },
312 { 20, 116,  12, 108,  18, 114,  10, 106, },
313 { 84,  52,  76,  44,  82,  50,  74,  42, },
314 {  0,  96,  24, 120,   6, 102,  30, 126, },
315 { 64,  32,  88,  56,  70,  38,  94,  62, },
316 { 16, 112,   8, 104,  22, 118,  14, 110, },
317 { 80,  48,  72,  40,  86,  54,  78,  46, },
318 {  4, 100,  28, 124,   2,  98,  26, 122, },
319 };
320 #endif
321
322 #if 1
323 const uint8_t  __attribute__((aligned(8))) dither_8x8_220[8][8]={
324 {117,  62, 158, 103, 113,  58, 155, 100, },
325 { 34, 199,  21, 186,  31, 196,  17, 182, },
326 {144,  89, 131,  76, 141,  86, 127,  72, },
327 {  0, 165,  41, 206,  10, 175,  52, 217, },
328 {110,  55, 151,  96, 120,  65, 162, 107, },
329 { 28, 193,  14, 179,  38, 203,  24, 189, },
330 {138,  83, 124,  69, 148,  93, 134,  79, },
331 {  7, 172,  48, 213,   3, 168,  45, 210, },
332 };
333 #elif 1
334 // tries to correct a gamma of 1.5
335 const uint8_t  __attribute__((aligned(8))) dither_8x8_220[8][8]={
336 {  0, 143,  18, 200,   2, 156,  25, 215, },
337 { 78,  28, 125,  64,  89,  36, 138,  74, },
338 { 10, 180,   3, 161,  16, 195,   8, 175, },
339 {109,  51,  93,  38, 121,  60, 105,  47, },
340 {  1, 152,  23, 210,   0, 147,  20, 205, },
341 { 85,  33, 134,  71,  81,  30, 130,  67, },
342 { 14, 190,   6, 171,  12, 185,   5, 166, },
343 {117,  57, 101,  44, 113,  54,  97,  41, },
344 };
345 #elif 1
346 // tries to correct a gamma of 2.0
347 const uint8_t  __attribute__((aligned(8))) dither_8x8_220[8][8]={
348 {  0, 124,   8, 193,   0, 140,  12, 213, },
349 { 55,  14, 104,  42,  66,  19, 119,  52, },
350 {  3, 168,   1, 145,   6, 187,   3, 162, },
351 { 86,  31,  70,  21,  99,  39,  82,  28, },
352 {  0, 134,  11, 206,   0, 129,   9, 200, },
353 { 62,  17, 114,  48,  58,  16, 109,  45, },
354 {  5, 181,   2, 157,   4, 175,   1, 151, },
355 { 95,  36,  78,  26,  90,  34,  74,  24, },
356 };
357 #else
358 // tries to correct a gamma of 2.5
359 const uint8_t  __attribute__((aligned(8))) dither_8x8_220[8][8]={
360 {  0, 107,   3, 187,   0, 125,   6, 212, },
361 { 39,   7,  86,  28,  49,  11, 102,  36, },
362 {  1, 158,   0, 131,   3, 180,   1, 151, },
363 { 68,  19,  52,  12,  81,  25,  64,  17, },
364 {  0, 119,   5, 203,   0, 113,   4, 195, },
365 { 45,   9,  96,  33,  42,   8,  91,  30, },
366 {  2, 172,   1, 144,   2, 165,   0, 137, },
367 { 77,  23,  60,  15,  72,  21,  56,  14, },
368 };
369 #endif
370
371 const char *sws_format_name(enum PixelFormat format)
372 {
373     switch (format) {
374         case PIX_FMT_YUV420P:
375             return "yuv420p";
376         case PIX_FMT_YUVA420P:
377             return "yuva420p";
378         case PIX_FMT_YUYV422:
379             return "yuyv422";
380         case PIX_FMT_RGB24:
381             return "rgb24";
382         case PIX_FMT_BGR24:
383             return "bgr24";
384         case PIX_FMT_YUV422P:
385             return "yuv422p";
386         case PIX_FMT_YUV444P:
387             return "yuv444p";
388         case PIX_FMT_RGB32:
389             return "rgb32";
390         case PIX_FMT_YUV410P:
391             return "yuv410p";
392         case PIX_FMT_YUV411P:
393             return "yuv411p";
394         case PIX_FMT_RGB565:
395             return "rgb565";
396         case PIX_FMT_RGB555:
397             return "rgb555";
398         case PIX_FMT_GRAY16BE:
399             return "gray16be";
400         case PIX_FMT_GRAY16LE:
401             return "gray16le";
402         case PIX_FMT_GRAY8:
403             return "gray8";
404         case PIX_FMT_MONOWHITE:
405             return "mono white";
406         case PIX_FMT_MONOBLACK:
407             return "mono black";
408         case PIX_FMT_PAL8:
409             return "Palette";
410         case PIX_FMT_YUVJ420P:
411             return "yuvj420p";
412         case PIX_FMT_YUVJ422P:
413             return "yuvj422p";
414         case PIX_FMT_YUVJ444P:
415             return "yuvj444p";
416         case PIX_FMT_XVMC_MPEG2_MC:
417             return "xvmc_mpeg2_mc";
418         case PIX_FMT_XVMC_MPEG2_IDCT:
419             return "xvmc_mpeg2_idct";
420         case PIX_FMT_UYVY422:
421             return "uyvy422";
422         case PIX_FMT_UYYVYY411:
423             return "uyyvyy411";
424         case PIX_FMT_RGB32_1:
425             return "rgb32x";
426         case PIX_FMT_BGR32_1:
427             return "bgr32x";
428         case PIX_FMT_BGR32:
429             return "bgr32";
430         case PIX_FMT_BGR565:
431             return "bgr565";
432         case PIX_FMT_BGR555:
433             return "bgr555";
434         case PIX_FMT_BGR8:
435             return "bgr8";
436         case PIX_FMT_BGR4:
437             return "bgr4";
438         case PIX_FMT_BGR4_BYTE:
439             return "bgr4 byte";
440         case PIX_FMT_RGB8:
441             return "rgb8";
442         case PIX_FMT_RGB4:
443             return "rgb4";
444         case PIX_FMT_RGB4_BYTE:
445             return "rgb4 byte";
446         case PIX_FMT_NV12:
447             return "nv12";
448         case PIX_FMT_NV21:
449             return "nv21";
450         case PIX_FMT_YUV440P:
451             return "yuv440p";
452         default:
453             return "Unknown format";
454     }
455 }
456
457 static inline void yuv2yuvXinC(int16_t *lumFilter, int16_t **lumSrc, int lumFilterSize,
458                                int16_t *chrFilter, int16_t **chrSrc, int chrFilterSize,
459                                uint8_t *dest, uint8_t *uDest, uint8_t *vDest, int dstW, int chrDstW)
460 {
461     //FIXME Optimize (just quickly writen not opti..)
462     int i;
463     for (i=0; i<dstW; i++)
464     {
465         int val=1<<18;
466         int j;
467         for (j=0; j<lumFilterSize; j++)
468             val += lumSrc[j][i] * lumFilter[j];
469
470         dest[i]= av_clip_uint8(val>>19);
471     }
472
473     if (uDest)
474         for (i=0; i<chrDstW; i++)
475         {
476             int u=1<<18;
477             int v=1<<18;
478             int j;
479             for (j=0; j<chrFilterSize; j++)
480             {
481                 u += chrSrc[j][i] * chrFilter[j];
482                 v += chrSrc[j][i + VOFW] * chrFilter[j];
483             }
484
485             uDest[i]= av_clip_uint8(u>>19);
486             vDest[i]= av_clip_uint8(v>>19);
487         }
488 }
489
490 static inline void yuv2nv12XinC(int16_t *lumFilter, int16_t **lumSrc, int lumFilterSize,
491                                 int16_t *chrFilter, int16_t **chrSrc, int chrFilterSize,
492                                 uint8_t *dest, uint8_t *uDest, int dstW, int chrDstW, int dstFormat)
493 {
494     //FIXME Optimize (just quickly writen not opti..)
495     int i;
496     for (i=0; i<dstW; i++)
497     {
498         int val=1<<18;
499         int j;
500         for (j=0; j<lumFilterSize; j++)
501             val += lumSrc[j][i] * lumFilter[j];
502
503         dest[i]= av_clip_uint8(val>>19);
504     }
505
506     if (!uDest)
507         return;
508
509     if (dstFormat == PIX_FMT_NV12)
510         for (i=0; i<chrDstW; i++)
511         {
512             int u=1<<18;
513             int v=1<<18;
514             int j;
515             for (j=0; j<chrFilterSize; j++)
516             {
517                 u += chrSrc[j][i] * chrFilter[j];
518                 v += chrSrc[j][i + VOFW] * chrFilter[j];
519             }
520
521             uDest[2*i]= av_clip_uint8(u>>19);
522             uDest[2*i+1]= av_clip_uint8(v>>19);
523         }
524     else
525         for (i=0; i<chrDstW; i++)
526         {
527             int u=1<<18;
528             int v=1<<18;
529             int j;
530             for (j=0; j<chrFilterSize; j++)
531             {
532                 u += chrSrc[j][i] * chrFilter[j];
533                 v += chrSrc[j][i + VOFW] * chrFilter[j];
534             }
535
536             uDest[2*i]= av_clip_uint8(v>>19);
537             uDest[2*i+1]= av_clip_uint8(u>>19);
538         }
539 }
540
541 #define YSCALE_YUV_2_PACKEDX_NOCLIP_C(type) \
542     for (i=0; i<(dstW>>1); i++){\
543         int j;\
544         int Y1 = 1<<18;\
545         int Y2 = 1<<18;\
546         int U  = 1<<18;\
547         int V  = 1<<18;\
548         type av_unused *r, *b, *g;\
549         const int i2= 2*i;\
550         \
551         for (j=0; j<lumFilterSize; j++)\
552         {\
553             Y1 += lumSrc[j][i2] * lumFilter[j];\
554             Y2 += lumSrc[j][i2+1] * lumFilter[j];\
555         }\
556         for (j=0; j<chrFilterSize; j++)\
557         {\
558             U += chrSrc[j][i] * chrFilter[j];\
559             V += chrSrc[j][i+VOFW] * chrFilter[j];\
560         }\
561         Y1>>=19;\
562         Y2>>=19;\
563         U >>=19;\
564         V >>=19;\
565
566 #define YSCALE_YUV_2_PACKEDX_C(type) \
567         YSCALE_YUV_2_PACKEDX_NOCLIP_C(type)\
568         if ((Y1|Y2|U|V)&256)\
569         {\
570             if (Y1>255)   Y1=255; \
571             else if (Y1<0)Y1=0;   \
572             if (Y2>255)   Y2=255; \
573             else if (Y2<0)Y2=0;   \
574             if (U>255)    U=255;  \
575             else if (U<0) U=0;    \
576             if (V>255)    V=255;  \
577             else if (V<0) V=0;    \
578         }
579
580 #define YSCALE_YUV_2_PACKEDX_FULL_C \
581     for (i=0; i<dstW; i++){\
582         int j;\
583         int Y = 0;\
584         int U = -128<<19;\
585         int V = -128<<19;\
586         int R,G,B;\
587         \
588         for (j=0; j<lumFilterSize; j++){\
589             Y += lumSrc[j][i     ] * lumFilter[j];\
590         }\
591         for (j=0; j<chrFilterSize; j++){\
592             U += chrSrc[j][i     ] * chrFilter[j];\
593             V += chrSrc[j][i+VOFW] * chrFilter[j];\
594         }\
595         Y >>=10;\
596         U >>=10;\
597         V >>=10;\
598
599 #define YSCALE_YUV_2_RGBX_FULL_C(rnd) \
600     YSCALE_YUV_2_PACKEDX_FULL_C\
601         Y-= c->yuv2rgb_y_offset;\
602         Y*= c->yuv2rgb_y_coeff;\
603         Y+= rnd;\
604         R= Y + V*c->yuv2rgb_v2r_coeff;\
605         G= Y + V*c->yuv2rgb_v2g_coeff + U*c->yuv2rgb_u2g_coeff;\
606         B= Y +                          U*c->yuv2rgb_u2b_coeff;\
607         if ((R|G|B)&(0xC0000000)){\
608             if (R>=(256<<22))   R=(256<<22)-1; \
609             else if (R<0)R=0;   \
610             if (G>=(256<<22))   G=(256<<22)-1; \
611             else if (G<0)G=0;   \
612             if (B>=(256<<22))   B=(256<<22)-1; \
613             else if (B<0)B=0;   \
614         }\
615
616
617 #define YSCALE_YUV_2_GRAY16_C \
618     for (i=0; i<(dstW>>1); i++){\
619         int j;\
620         int Y1 = 1<<18;\
621         int Y2 = 1<<18;\
622         int U  = 1<<18;\
623         int V  = 1<<18;\
624         \
625         const int i2= 2*i;\
626         \
627         for (j=0; j<lumFilterSize; j++)\
628         {\
629             Y1 += lumSrc[j][i2] * lumFilter[j];\
630             Y2 += lumSrc[j][i2+1] * lumFilter[j];\
631         }\
632         Y1>>=11;\
633         Y2>>=11;\
634         if ((Y1|Y2|U|V)&65536)\
635         {\
636             if (Y1>65535)   Y1=65535; \
637             else if (Y1<0)Y1=0;   \
638             if (Y2>65535)   Y2=65535; \
639             else if (Y2<0)Y2=0;   \
640         }
641
642 #define YSCALE_YUV_2_RGBX_C(type) \
643     YSCALE_YUV_2_PACKEDX_C(type)  /* FIXME fix tables so that cliping is not needed and then use _NOCLIP*/\
644     r = (type *)c->table_rV[V];   \
645     g = (type *)(c->table_gU[U] + c->table_gV[V]); \
646     b = (type *)c->table_bU[U];   \
647
648 #define YSCALE_YUV_2_PACKED2_C   \
649     for (i=0; i<(dstW>>1); i++){ \
650         const int i2= 2*i;       \
651         int Y1= (buf0[i2  ]*yalpha1+buf1[i2  ]*yalpha)>>19;           \
652         int Y2= (buf0[i2+1]*yalpha1+buf1[i2+1]*yalpha)>>19;           \
653         int U= (uvbuf0[i     ]*uvalpha1+uvbuf1[i     ]*uvalpha)>>19;  \
654         int V= (uvbuf0[i+VOFW]*uvalpha1+uvbuf1[i+VOFW]*uvalpha)>>19;  \
655
656 #define YSCALE_YUV_2_GRAY16_2_C   \
657     for (i=0; i<(dstW>>1); i++){ \
658         const int i2= 2*i;       \
659         int Y1= (buf0[i2  ]*yalpha1+buf1[i2  ]*yalpha)>>11;           \
660         int Y2= (buf0[i2+1]*yalpha1+buf1[i2+1]*yalpha)>>11;           \
661
662 #define YSCALE_YUV_2_RGB2_C(type) \
663     YSCALE_YUV_2_PACKED2_C\
664     type *r, *b, *g;\
665     r = (type *)c->table_rV[V];\
666     g = (type *)(c->table_gU[U] + c->table_gV[V]);\
667     b = (type *)c->table_bU[U];\
668
669 #define YSCALE_YUV_2_PACKED1_C \
670     for (i=0; i<(dstW>>1); i++){\
671         const int i2= 2*i;\
672         int Y1= buf0[i2  ]>>7;\
673         int Y2= buf0[i2+1]>>7;\
674         int U= (uvbuf1[i     ])>>7;\
675         int V= (uvbuf1[i+VOFW])>>7;\
676
677 #define YSCALE_YUV_2_GRAY16_1_C \
678     for (i=0; i<(dstW>>1); i++){\
679         const int i2= 2*i;\
680         int Y1= buf0[i2  ]<<1;\
681         int Y2= buf0[i2+1]<<1;\
682
683 #define YSCALE_YUV_2_RGB1_C(type) \
684     YSCALE_YUV_2_PACKED1_C\
685     type *r, *b, *g;\
686     r = (type *)c->table_rV[V];\
687     g = (type *)(c->table_gU[U] + c->table_gV[V]);\
688     b = (type *)c->table_bU[U];\
689
690 #define YSCALE_YUV_2_PACKED1B_C \
691     for (i=0; i<(dstW>>1); i++){\
692         const int i2= 2*i;\
693         int Y1= buf0[i2  ]>>7;\
694         int Y2= buf0[i2+1]>>7;\
695         int U= (uvbuf0[i     ] + uvbuf1[i     ])>>8;\
696         int V= (uvbuf0[i+VOFW] + uvbuf1[i+VOFW])>>8;\
697
698 #define YSCALE_YUV_2_RGB1B_C(type) \
699     YSCALE_YUV_2_PACKED1B_C\
700     type *r, *b, *g;\
701     r = (type *)c->table_rV[V];\
702     g = (type *)(c->table_gU[U] + c->table_gV[V]);\
703     b = (type *)c->table_bU[U];\
704
705 #define YSCALE_YUV_2_MONO2_C \
706     const uint8_t * const d128=dither_8x8_220[y&7];\
707     uint8_t *g= c->table_gU[128] + c->table_gV[128];\
708     for (i=0; i<dstW-7; i+=8){\
709         int acc;\
710         acc =       g[((buf0[i  ]*yalpha1+buf1[i  ]*yalpha)>>19) + d128[0]];\
711         acc+= acc + g[((buf0[i+1]*yalpha1+buf1[i+1]*yalpha)>>19) + d128[1]];\
712         acc+= acc + g[((buf0[i+2]*yalpha1+buf1[i+2]*yalpha)>>19) + d128[2]];\
713         acc+= acc + g[((buf0[i+3]*yalpha1+buf1[i+3]*yalpha)>>19) + d128[3]];\
714         acc+= acc + g[((buf0[i+4]*yalpha1+buf1[i+4]*yalpha)>>19) + d128[4]];\
715         acc+= acc + g[((buf0[i+5]*yalpha1+buf1[i+5]*yalpha)>>19) + d128[5]];\
716         acc+= acc + g[((buf0[i+6]*yalpha1+buf1[i+6]*yalpha)>>19) + d128[6]];\
717         acc+= acc + g[((buf0[i+7]*yalpha1+buf1[i+7]*yalpha)>>19) + d128[7]];\
718         ((uint8_t*)dest)[0]= c->dstFormat == PIX_FMT_MONOBLACK ? acc : ~acc;\
719         dest++;\
720     }\
721
722
723 #define YSCALE_YUV_2_MONOX_C \
724     const uint8_t * const d128=dither_8x8_220[y&7];\
725     uint8_t *g= c->table_gU[128] + c->table_gV[128];\
726     int acc=0;\
727     for (i=0; i<dstW-1; i+=2){\
728         int j;\
729         int Y1=1<<18;\
730         int Y2=1<<18;\
731 \
732         for (j=0; j<lumFilterSize; j++)\
733         {\
734             Y1 += lumSrc[j][i] * lumFilter[j];\
735             Y2 += lumSrc[j][i+1] * lumFilter[j];\
736         }\
737         Y1>>=19;\
738         Y2>>=19;\
739         if ((Y1|Y2)&256)\
740         {\
741             if (Y1>255)   Y1=255;\
742             else if (Y1<0)Y1=0;\
743             if (Y2>255)   Y2=255;\
744             else if (Y2<0)Y2=0;\
745         }\
746         acc+= acc + g[Y1+d128[(i+0)&7]];\
747         acc+= acc + g[Y2+d128[(i+1)&7]];\
748         if ((i&7)==6){\
749             ((uint8_t*)dest)[0]= c->dstFormat == PIX_FMT_MONOBLACK ? acc : ~acc;\
750             dest++;\
751         }\
752     }
753
754
755 #define YSCALE_YUV_2_ANYRGB_C(func, func2, func_g16, func_monoblack)\
756     switch(c->dstFormat)\
757     {\
758     case PIX_FMT_RGB32:\
759     case PIX_FMT_BGR32:\
760     case PIX_FMT_RGB32_1:\
761     case PIX_FMT_BGR32_1:\
762         func(uint32_t)\
763             ((uint32_t*)dest)[i2+0]= r[Y1] + g[Y1] + b[Y1];\
764             ((uint32_t*)dest)[i2+1]= r[Y2] + g[Y2] + b[Y2];\
765         }                \
766         break;\
767     case PIX_FMT_RGB24:\
768         func(uint8_t)\
769             ((uint8_t*)dest)[0]= r[Y1];\
770             ((uint8_t*)dest)[1]= g[Y1];\
771             ((uint8_t*)dest)[2]= b[Y1];\
772             ((uint8_t*)dest)[3]= r[Y2];\
773             ((uint8_t*)dest)[4]= g[Y2];\
774             ((uint8_t*)dest)[5]= b[Y2];\
775             dest+=6;\
776         }\
777         break;\
778     case PIX_FMT_BGR24:\
779         func(uint8_t)\
780             ((uint8_t*)dest)[0]= b[Y1];\
781             ((uint8_t*)dest)[1]= g[Y1];\
782             ((uint8_t*)dest)[2]= r[Y1];\
783             ((uint8_t*)dest)[3]= b[Y2];\
784             ((uint8_t*)dest)[4]= g[Y2];\
785             ((uint8_t*)dest)[5]= r[Y2];\
786             dest+=6;\
787         }\
788         break;\
789     case PIX_FMT_RGB565:\
790     case PIX_FMT_BGR565:\
791         {\
792             const int dr1= dither_2x2_8[y&1    ][0];\
793             const int dg1= dither_2x2_4[y&1    ][0];\
794             const int db1= dither_2x2_8[(y&1)^1][0];\
795             const int dr2= dither_2x2_8[y&1    ][1];\
796             const int dg2= dither_2x2_4[y&1    ][1];\
797             const int db2= dither_2x2_8[(y&1)^1][1];\
798             func(uint16_t)\
799                 ((uint16_t*)dest)[i2+0]= r[Y1+dr1] + g[Y1+dg1] + b[Y1+db1];\
800                 ((uint16_t*)dest)[i2+1]= r[Y2+dr2] + g[Y2+dg2] + b[Y2+db2];\
801             }\
802         }\
803         break;\
804     case PIX_FMT_RGB555:\
805     case PIX_FMT_BGR555:\
806         {\
807             const int dr1= dither_2x2_8[y&1    ][0];\
808             const int dg1= dither_2x2_8[y&1    ][1];\
809             const int db1= dither_2x2_8[(y&1)^1][0];\
810             const int dr2= dither_2x2_8[y&1    ][1];\
811             const int dg2= dither_2x2_8[y&1    ][0];\
812             const int db2= dither_2x2_8[(y&1)^1][1];\
813             func(uint16_t)\
814                 ((uint16_t*)dest)[i2+0]= r[Y1+dr1] + g[Y1+dg1] + b[Y1+db1];\
815                 ((uint16_t*)dest)[i2+1]= r[Y2+dr2] + g[Y2+dg2] + b[Y2+db2];\
816             }\
817         }\
818         break;\
819     case PIX_FMT_RGB8:\
820     case PIX_FMT_BGR8:\
821         {\
822             const uint8_t * const d64= dither_8x8_73[y&7];\
823             const uint8_t * const d32= dither_8x8_32[y&7];\
824             func(uint8_t)\
825                 ((uint8_t*)dest)[i2+0]= r[Y1+d32[(i2+0)&7]] + g[Y1+d32[(i2+0)&7]] + b[Y1+d64[(i2+0)&7]];\
826                 ((uint8_t*)dest)[i2+1]= r[Y2+d32[(i2+1)&7]] + g[Y2+d32[(i2+1)&7]] + b[Y2+d64[(i2+1)&7]];\
827             }\
828         }\
829         break;\
830     case PIX_FMT_RGB4:\
831     case PIX_FMT_BGR4:\
832         {\
833             const uint8_t * const d64= dither_8x8_73 [y&7];\
834             const uint8_t * const d128=dither_8x8_220[y&7];\
835             func(uint8_t)\
836                 ((uint8_t*)dest)[i]= r[Y1+d128[(i2+0)&7]] + g[Y1+d64[(i2+0)&7]] + b[Y1+d128[(i2+0)&7]]\
837                                  + ((r[Y2+d128[(i2+1)&7]] + g[Y2+d64[(i2+1)&7]] + b[Y2+d128[(i2+1)&7]])<<4);\
838             }\
839         }\
840         break;\
841     case PIX_FMT_RGB4_BYTE:\
842     case PIX_FMT_BGR4_BYTE:\
843         {\
844             const uint8_t * const d64= dither_8x8_73 [y&7];\
845             const uint8_t * const d128=dither_8x8_220[y&7];\
846             func(uint8_t)\
847                 ((uint8_t*)dest)[i2+0]= r[Y1+d128[(i2+0)&7]] + g[Y1+d64[(i2+0)&7]] + b[Y1+d128[(i2+0)&7]];\
848                 ((uint8_t*)dest)[i2+1]= r[Y2+d128[(i2+1)&7]] + g[Y2+d64[(i2+1)&7]] + b[Y2+d128[(i2+1)&7]];\
849             }\
850         }\
851         break;\
852     case PIX_FMT_MONOBLACK:\
853     case PIX_FMT_MONOWHITE:\
854         {\
855             func_monoblack\
856         }\
857         break;\
858     case PIX_FMT_YUYV422:\
859         func2\
860             ((uint8_t*)dest)[2*i2+0]= Y1;\
861             ((uint8_t*)dest)[2*i2+1]= U;\
862             ((uint8_t*)dest)[2*i2+2]= Y2;\
863             ((uint8_t*)dest)[2*i2+3]= V;\
864         }                \
865         break;\
866     case PIX_FMT_UYVY422:\
867         func2\
868             ((uint8_t*)dest)[2*i2+0]= U;\
869             ((uint8_t*)dest)[2*i2+1]= Y1;\
870             ((uint8_t*)dest)[2*i2+2]= V;\
871             ((uint8_t*)dest)[2*i2+3]= Y2;\
872         }                \
873         break;\
874     case PIX_FMT_GRAY16BE:\
875         func_g16\
876             ((uint8_t*)dest)[2*i2+0]= Y1>>8;\
877             ((uint8_t*)dest)[2*i2+1]= Y1;\
878             ((uint8_t*)dest)[2*i2+2]= Y2>>8;\
879             ((uint8_t*)dest)[2*i2+3]= Y2;\
880         }                \
881         break;\
882     case PIX_FMT_GRAY16LE:\
883         func_g16\
884             ((uint8_t*)dest)[2*i2+0]= Y1;\
885             ((uint8_t*)dest)[2*i2+1]= Y1>>8;\
886             ((uint8_t*)dest)[2*i2+2]= Y2;\
887             ((uint8_t*)dest)[2*i2+3]= Y2>>8;\
888         }                \
889         break;\
890     }\
891
892
893 static inline void yuv2packedXinC(SwsContext *c, int16_t *lumFilter, int16_t **lumSrc, int lumFilterSize,
894                                   int16_t *chrFilter, int16_t **chrSrc, int chrFilterSize,
895                                   uint8_t *dest, int dstW, int y)
896 {
897     int i;
898     YSCALE_YUV_2_ANYRGB_C(YSCALE_YUV_2_RGBX_C, YSCALE_YUV_2_PACKEDX_C(void), YSCALE_YUV_2_GRAY16_C, YSCALE_YUV_2_MONOX_C)
899 }
900
901 static inline void yuv2rgbXinC_full(SwsContext *c, int16_t *lumFilter, int16_t **lumSrc, int lumFilterSize,
902                                     int16_t *chrFilter, int16_t **chrSrc, int chrFilterSize,
903                                     uint8_t *dest, int dstW, int y)
904 {
905     int i;
906     int step= fmt_depth(c->dstFormat)/8;
907     int aidx= 3;
908
909     switch(c->dstFormat){
910     case PIX_FMT_ARGB:
911         dest++;
912         aidx= 0;
913     case PIX_FMT_RGB24:
914         aidx--;
915     case PIX_FMT_RGBA:
916         YSCALE_YUV_2_RGBX_FULL_C(1<<21)
917             dest[aidx]= 0;
918             dest[0]= R>>22;
919             dest[1]= G>>22;
920             dest[2]= B>>22;
921             dest+= step;
922         }
923         break;
924     case PIX_FMT_ABGR:
925         dest++;
926         aidx= 0;
927     case PIX_FMT_BGR24:
928         aidx--;
929     case PIX_FMT_BGRA:
930         YSCALE_YUV_2_RGBX_FULL_C(1<<21)
931             dest[aidx]= 0;
932             dest[0]= B>>22;
933             dest[1]= G>>22;
934             dest[2]= R>>22;
935             dest+= step;
936         }
937         break;
938     default:
939         assert(0);
940     }
941 }
942
943 //Note: we have C, X86, MMX, MMX2, 3DNOW version therse no 3DNOW+MMX2 one
944 //Plain C versions
945 #if !defined (HAVE_MMX) || defined (RUNTIME_CPUDETECT) || !defined(CONFIG_GPL)
946 #define COMPILE_C
947 #endif
948
949 #ifdef ARCH_POWERPC
950 #if (defined (HAVE_ALTIVEC) || defined (RUNTIME_CPUDETECT)) && defined (CONFIG_GPL)
951 #define COMPILE_ALTIVEC
952 #endif //HAVE_ALTIVEC
953 #endif //ARCH_POWERPC
954
955 #if defined(ARCH_X86)
956
957 #if ((defined (HAVE_MMX) && !defined (HAVE_3DNOW) && !defined (HAVE_MMX2)) || defined (RUNTIME_CPUDETECT)) && defined (CONFIG_GPL)
958 #define COMPILE_MMX
959 #endif
960
961 #if (defined (HAVE_MMX2) || defined (RUNTIME_CPUDETECT)) && defined (CONFIG_GPL)
962 #define COMPILE_MMX2
963 #endif
964
965 #if ((defined (HAVE_3DNOW) && !defined (HAVE_MMX2)) || defined (RUNTIME_CPUDETECT)) && defined (CONFIG_GPL)
966 #define COMPILE_3DNOW
967 #endif
968 #endif //ARCH_X86 || ARCH_X86_64
969
970 #undef HAVE_MMX
971 #undef HAVE_MMX2
972 #undef HAVE_3DNOW
973
974 #ifdef COMPILE_C
975 #undef HAVE_MMX
976 #undef HAVE_MMX2
977 #undef HAVE_3DNOW
978 #undef HAVE_ALTIVEC
979 #define RENAME(a) a ## _C
980 #include "swscale_template.c"
981 #endif
982
983 #ifdef COMPILE_ALTIVEC
984 #undef RENAME
985 #define HAVE_ALTIVEC
986 #define RENAME(a) a ## _altivec
987 #include "swscale_template.c"
988 #endif
989
990 #if defined(ARCH_X86)
991
992 //X86 versions
993 /*
994 #undef RENAME
995 #undef HAVE_MMX
996 #undef HAVE_MMX2
997 #undef HAVE_3DNOW
998 #define ARCH_X86
999 #define RENAME(a) a ## _X86
1000 #include "swscale_template.c"
1001 */
1002 //MMX versions
1003 #ifdef COMPILE_MMX
1004 #undef RENAME
1005 #define HAVE_MMX
1006 #undef HAVE_MMX2
1007 #undef HAVE_3DNOW
1008 #define RENAME(a) a ## _MMX
1009 #include "swscale_template.c"
1010 #endif
1011
1012 //MMX2 versions
1013 #ifdef COMPILE_MMX2
1014 #undef RENAME
1015 #define HAVE_MMX
1016 #define HAVE_MMX2
1017 #undef HAVE_3DNOW
1018 #define RENAME(a) a ## _MMX2
1019 #include "swscale_template.c"
1020 #endif
1021
1022 //3DNOW versions
1023 #ifdef COMPILE_3DNOW
1024 #undef RENAME
1025 #define HAVE_MMX
1026 #undef HAVE_MMX2
1027 #define HAVE_3DNOW
1028 #define RENAME(a) a ## _3DNow
1029 #include "swscale_template.c"
1030 #endif
1031
1032 #endif //ARCH_X86 || ARCH_X86_64
1033
1034 // minor note: the HAVE_xyz is messed up after that line so don't use it
1035
1036 static double getSplineCoeff(double a, double b, double c, double d, double dist)
1037 {
1038 //    printf("%f %f %f %f %f\n", a,b,c,d,dist);
1039     if (dist<=1.0)      return ((d*dist + c)*dist + b)*dist +a;
1040     else                return getSplineCoeff(        0.0,
1041                                              b+ 2.0*c + 3.0*d,
1042                                                     c + 3.0*d,
1043                                             -b- 3.0*c - 6.0*d,
1044                                             dist-1.0);
1045 }
1046
1047 static inline int initFilter(int16_t **outFilter, int16_t **filterPos, int *outFilterSize, int xInc,
1048                              int srcW, int dstW, int filterAlign, int one, int flags,
1049                              SwsVector *srcFilter, SwsVector *dstFilter, double param[2])
1050 {
1051     int i;
1052     int filterSize;
1053     int filter2Size;
1054     int minFilterSize;
1055     int64_t *filter=NULL;
1056     int64_t *filter2=NULL;
1057     const int64_t fone= 1LL<<54;
1058     int ret= -1;
1059 #if defined(ARCH_X86)
1060     if (flags & SWS_CPU_CAPS_MMX)
1061         asm volatile("emms\n\t"::: "memory"); //FIXME this should not be required but it IS (even for non-MMX versions)
1062 #endif
1063
1064     // Note the +1 is for the MMXscaler which reads over the end
1065     *filterPos = av_malloc((dstW+1)*sizeof(int16_t));
1066
1067     if (FFABS(xInc - 0x10000) <10) // unscaled
1068     {
1069         int i;
1070         filterSize= 1;
1071         filter= av_mallocz(dstW*sizeof(*filter)*filterSize);
1072
1073         for (i=0; i<dstW; i++)
1074         {
1075             filter[i*filterSize]= fone;
1076             (*filterPos)[i]=i;
1077         }
1078
1079     }
1080     else if (flags&SWS_POINT) // lame looking point sampling mode
1081     {
1082         int i;
1083         int xDstInSrc;
1084         filterSize= 1;
1085         filter= av_malloc(dstW*sizeof(*filter)*filterSize);
1086
1087         xDstInSrc= xInc/2 - 0x8000;
1088         for (i=0; i<dstW; i++)
1089         {
1090             int xx= (xDstInSrc - ((filterSize-1)<<15) + (1<<15))>>16;
1091
1092             (*filterPos)[i]= xx;
1093             filter[i]= fone;
1094             xDstInSrc+= xInc;
1095         }
1096     }
1097     else if ((xInc <= (1<<16) && (flags&SWS_AREA)) || (flags&SWS_FAST_BILINEAR)) // bilinear upscale
1098     {
1099         int i;
1100         int xDstInSrc;
1101         if      (flags&SWS_BICUBIC) filterSize= 4;
1102         else if (flags&SWS_X      ) filterSize= 4;
1103         else                        filterSize= 2; // SWS_BILINEAR / SWS_AREA
1104         filter= av_malloc(dstW*sizeof(*filter)*filterSize);
1105
1106         xDstInSrc= xInc/2 - 0x8000;
1107         for (i=0; i<dstW; i++)
1108         {
1109             int xx= (xDstInSrc - ((filterSize-1)<<15) + (1<<15))>>16;
1110             int j;
1111
1112             (*filterPos)[i]= xx;
1113                 //Bilinear upscale / linear interpolate / Area averaging
1114                 for (j=0; j<filterSize; j++)
1115                 {
1116                     int64_t coeff= fone - FFABS((xx<<16) - xDstInSrc)*(fone>>16);
1117                     if (coeff<0) coeff=0;
1118                     filter[i*filterSize + j]= coeff;
1119                     xx++;
1120                 }
1121             xDstInSrc+= xInc;
1122         }
1123     }
1124     else
1125     {
1126         int xDstInSrc;
1127         int sizeFactor;
1128
1129         if      (flags&SWS_BICUBIC)      sizeFactor=  4;
1130         else if (flags&SWS_X)            sizeFactor=  8;
1131         else if (flags&SWS_AREA)         sizeFactor=  1; //downscale only, for upscale it is bilinear
1132         else if (flags&SWS_GAUSS)        sizeFactor=  8;   // infinite ;)
1133         else if (flags&SWS_LANCZOS)      sizeFactor= param[0] != SWS_PARAM_DEFAULT ? ceil(2*param[0]) : 6;
1134         else if (flags&SWS_SINC)         sizeFactor= 20; // infinite ;)
1135         else if (flags&SWS_SPLINE)       sizeFactor= 20;  // infinite ;)
1136         else if (flags&SWS_BILINEAR)     sizeFactor=  2;
1137         else {
1138             sizeFactor= 0; //GCC warning killer
1139             assert(0);
1140         }
1141
1142         if (xInc <= 1<<16)      filterSize= 1 + sizeFactor; // upscale
1143         else                    filterSize= 1 + (sizeFactor*srcW + dstW - 1)/ dstW;
1144
1145         if (filterSize > srcW-2) filterSize=srcW-2;
1146
1147         filter= av_malloc(dstW*sizeof(*filter)*filterSize);
1148
1149         xDstInSrc= xInc - 0x10000;
1150         for (i=0; i<dstW; i++)
1151         {
1152             int xx= (xDstInSrc - ((filterSize-2)<<16)) / (1<<17);
1153             int j;
1154             (*filterPos)[i]= xx;
1155             for (j=0; j<filterSize; j++)
1156             {
1157                 int64_t d= ((int64_t)FFABS((xx<<17) - xDstInSrc))<<13;
1158                 double floatd;
1159                 int64_t coeff;
1160
1161                 if (xInc > 1<<16)
1162                     d= d*dstW/srcW;
1163                 floatd= d * (1.0/(1<<30));
1164
1165                 if (flags & SWS_BICUBIC)
1166                 {
1167                     int64_t B= (param[0] != SWS_PARAM_DEFAULT ? param[0] :   0) * (1<<24);
1168                     int64_t C= (param[1] != SWS_PARAM_DEFAULT ? param[1] : 0.6) * (1<<24);
1169                     int64_t dd = ( d*d)>>30;
1170                     int64_t ddd= (dd*d)>>30;
1171
1172                     if      (d < 1LL<<30)
1173                         coeff = (12*(1<<24)-9*B-6*C)*ddd + (-18*(1<<24)+12*B+6*C)*dd + (6*(1<<24)-2*B)*(1<<30);
1174                     else if (d < 1LL<<31)
1175                         coeff = (-B-6*C)*ddd + (6*B+30*C)*dd + (-12*B-48*C)*d + (8*B+24*C)*(1<<30);
1176                     else
1177                         coeff=0.0;
1178                     coeff *= fone>>(30+24);
1179                 }
1180 /*                else if (flags & SWS_X)
1181                 {
1182                     double p= param ? param*0.01 : 0.3;
1183                     coeff = d ? sin(d*PI)/(d*PI) : 1.0;
1184                     coeff*= pow(2.0, - p*d*d);
1185                 }*/
1186                 else if (flags & SWS_X)
1187                 {
1188                     double A= param[0] != SWS_PARAM_DEFAULT ? param[0] : 1.0;
1189                     double c;
1190
1191                     if (floatd<1.0)
1192                         c = cos(floatd*PI);
1193                     else
1194                         c=-1.0;
1195                     if (c<0.0)      c= -pow(-c, A);
1196                     else            c=  pow( c, A);
1197                     coeff= (c*0.5 + 0.5)*fone;
1198                 }
1199                 else if (flags & SWS_AREA)
1200                 {
1201                     int64_t d2= d - (1<<29);
1202                     if      (d2*xInc < -(1LL<<(29+16))) coeff= 1.0 * (1LL<<(30+16));
1203                     else if (d2*xInc <  (1LL<<(29+16))) coeff= -d2*xInc + (1LL<<(29+16));
1204                     else coeff=0.0;
1205                     coeff *= fone>>(30+16);
1206                 }
1207                 else if (flags & SWS_GAUSS)
1208                 {
1209                     double p= param[0] != SWS_PARAM_DEFAULT ? param[0] : 3.0;
1210                     coeff = (pow(2.0, - p*floatd*floatd))*fone;
1211                 }
1212                 else if (flags & SWS_SINC)
1213                 {
1214                     coeff = (d ? sin(floatd*PI)/(floatd*PI) : 1.0)*fone;
1215                 }
1216                 else if (flags & SWS_LANCZOS)
1217                 {
1218                     double p= param[0] != SWS_PARAM_DEFAULT ? param[0] : 3.0;
1219                     coeff = (d ? sin(floatd*PI)*sin(floatd*PI/p)/(floatd*floatd*PI*PI/p) : 1.0)*fone;
1220                     if (floatd>p) coeff=0;
1221                 }
1222                 else if (flags & SWS_BILINEAR)
1223                 {
1224                     coeff= (1<<30) - d;
1225                     if (coeff<0) coeff=0;
1226                     coeff *= fone >> 30;
1227                 }
1228                 else if (flags & SWS_SPLINE)
1229                 {
1230                     double p=-2.196152422706632;
1231                     coeff = getSplineCoeff(1.0, 0.0, p, -p-1.0, floatd) * fone;
1232                 }
1233                 else {
1234                     coeff= 0.0; //GCC warning killer
1235                     assert(0);
1236                 }
1237
1238                 filter[i*filterSize + j]= coeff;
1239                 xx++;
1240             }
1241             xDstInSrc+= 2*xInc;
1242         }
1243     }
1244
1245     /* apply src & dst Filter to filter -> filter2
1246        av_free(filter);
1247     */
1248     assert(filterSize>0);
1249     filter2Size= filterSize;
1250     if (srcFilter) filter2Size+= srcFilter->length - 1;
1251     if (dstFilter) filter2Size+= dstFilter->length - 1;
1252     assert(filter2Size>0);
1253     filter2= av_mallocz(filter2Size*dstW*sizeof(*filter2));
1254
1255     for (i=0; i<dstW; i++)
1256     {
1257         int j, k;
1258
1259         if(srcFilter){
1260             for (k=0; k<srcFilter->length; k++){
1261                 for (j=0; j<filterSize; j++)
1262                     filter2[i*filter2Size + k + j] += srcFilter->coeff[k]*filter[i*filterSize + j];
1263             }
1264         }else{
1265             for (j=0; j<filterSize; j++)
1266                 filter2[i*filter2Size + j]= filter[i*filterSize + j];
1267         }
1268         //FIXME dstFilter
1269
1270         (*filterPos)[i]+= (filterSize-1)/2 - (filter2Size-1)/2;
1271     }
1272     av_freep(&filter);
1273
1274     /* try to reduce the filter-size (step1 find size and shift left) */
1275     // Assume it is near normalized (*0.5 or *2.0 is OK but * 0.001 is not).
1276     minFilterSize= 0;
1277     for (i=dstW-1; i>=0; i--)
1278     {
1279         int min= filter2Size;
1280         int j;
1281         int64_t cutOff=0.0;
1282
1283         /* get rid off near zero elements on the left by shifting left */
1284         for (j=0; j<filter2Size; j++)
1285         {
1286             int k;
1287             cutOff += FFABS(filter2[i*filter2Size]);
1288
1289             if (cutOff > SWS_MAX_REDUCE_CUTOFF*fone) break;
1290
1291             /* preserve monotonicity because the core can't handle the filter otherwise */
1292             if (i<dstW-1 && (*filterPos)[i] >= (*filterPos)[i+1]) break;
1293
1294             // Move filter coeffs left
1295             for (k=1; k<filter2Size; k++)
1296                 filter2[i*filter2Size + k - 1]= filter2[i*filter2Size + k];
1297             filter2[i*filter2Size + k - 1]= 0;
1298             (*filterPos)[i]++;
1299         }
1300
1301         cutOff=0;
1302         /* count near zeros on the right */
1303         for (j=filter2Size-1; j>0; j--)
1304         {
1305             cutOff += FFABS(filter2[i*filter2Size + j]);
1306
1307             if (cutOff > SWS_MAX_REDUCE_CUTOFF*fone) break;
1308             min--;
1309         }
1310
1311         if (min>minFilterSize) minFilterSize= min;
1312     }
1313
1314     if (flags & SWS_CPU_CAPS_ALTIVEC) {
1315         // we can handle the special case 4,
1316         // so we don't want to go to the full 8
1317         if (minFilterSize < 5)
1318             filterAlign = 4;
1319
1320         // we really don't want to waste our time
1321         // doing useless computation, so fall-back on
1322         // the scalar C code for very small filter.
1323         // vectorizing is worth it only if you have
1324         // decent-sized vector.
1325         if (minFilterSize < 3)
1326             filterAlign = 1;
1327     }
1328
1329     if (flags & SWS_CPU_CAPS_MMX) {
1330         // special case for unscaled vertical filtering
1331         if (minFilterSize == 1 && filterAlign == 2)
1332             filterAlign= 1;
1333     }
1334
1335     assert(minFilterSize > 0);
1336     filterSize= (minFilterSize +(filterAlign-1)) & (~(filterAlign-1));
1337     assert(filterSize > 0);
1338     filter= av_malloc(filterSize*dstW*sizeof(*filter));
1339     if (filterSize >= MAX_FILTER_SIZE*16/((flags&SWS_ACCURATE_RND) ? APCK_SIZE : 16) || !filter)
1340         goto error;
1341     *outFilterSize= filterSize;
1342
1343     if (flags&SWS_PRINT_INFO)
1344         av_log(NULL, AV_LOG_VERBOSE, "SwScaler: reducing / aligning filtersize %d -> %d\n", filter2Size, filterSize);
1345     /* try to reduce the filter-size (step2 reduce it) */
1346     for (i=0; i<dstW; i++)
1347     {
1348         int j;
1349
1350         for (j=0; j<filterSize; j++)
1351         {
1352             if (j>=filter2Size) filter[i*filterSize + j]= 0;
1353             else               filter[i*filterSize + j]= filter2[i*filter2Size + j];
1354             if((flags & SWS_BITEXACT) && j>=minFilterSize)
1355                 filter[i*filterSize + j]= 0;
1356         }
1357     }
1358
1359
1360     //FIXME try to align filterpos if possible
1361
1362     //fix borders
1363     for (i=0; i<dstW; i++)
1364     {
1365         int j;
1366         if ((*filterPos)[i] < 0)
1367         {
1368             // Move filter coeffs left to compensate for filterPos
1369             for (j=1; j<filterSize; j++)
1370             {
1371                 int left= FFMAX(j + (*filterPos)[i], 0);
1372                 filter[i*filterSize + left] += filter[i*filterSize + j];
1373                 filter[i*filterSize + j]=0;
1374             }
1375             (*filterPos)[i]= 0;
1376         }
1377
1378         if ((*filterPos)[i] + filterSize > srcW)
1379         {
1380             int shift= (*filterPos)[i] + filterSize - srcW;
1381             // Move filter coeffs right to compensate for filterPos
1382             for (j=filterSize-2; j>=0; j--)
1383             {
1384                 int right= FFMIN(j + shift, filterSize-1);
1385                 filter[i*filterSize +right] += filter[i*filterSize +j];
1386                 filter[i*filterSize +j]=0;
1387             }
1388             (*filterPos)[i]= srcW - filterSize;
1389         }
1390     }
1391
1392     // Note the +1 is for the MMXscaler which reads over the end
1393     /* align at 16 for AltiVec (needed by hScale_altivec_real) */
1394     *outFilter= av_mallocz(*outFilterSize*(dstW+1)*sizeof(int16_t));
1395
1396     /* Normalize & Store in outFilter */
1397     for (i=0; i<dstW; i++)
1398     {
1399         int j;
1400         int64_t error=0;
1401         int64_t sum=0;
1402
1403         for (j=0; j<filterSize; j++)
1404         {
1405             sum+= filter[i*filterSize + j];
1406         }
1407         sum= (sum + one/2)/ one;
1408         for (j=0; j<*outFilterSize; j++)
1409         {
1410             int64_t v= filter[i*filterSize + j] + error;
1411             int intV= ROUNDED_DIV(v, sum);
1412             (*outFilter)[i*(*outFilterSize) + j]= intV;
1413             error= v - intV*sum;
1414         }
1415     }
1416
1417     (*filterPos)[dstW]= (*filterPos)[dstW-1]; // the MMX scaler will read over the end
1418     for (i=0; i<*outFilterSize; i++)
1419     {
1420         int j= dstW*(*outFilterSize);
1421         (*outFilter)[j + i]= (*outFilter)[j + i - (*outFilterSize)];
1422     }
1423
1424     ret=0;
1425 error:
1426     av_free(filter);
1427     av_free(filter2);
1428     return ret;
1429 }
1430
1431 #ifdef COMPILE_MMX2
1432 static void initMMX2HScaler(int dstW, int xInc, uint8_t *funnyCode, int16_t *filter, int32_t *filterPos, int numSplits)
1433 {
1434     uint8_t *fragmentA;
1435     long imm8OfPShufW1A;
1436     long imm8OfPShufW2A;
1437     long fragmentLengthA;
1438     uint8_t *fragmentB;
1439     long imm8OfPShufW1B;
1440     long imm8OfPShufW2B;
1441     long fragmentLengthB;
1442     int fragmentPos;
1443
1444     int xpos, i;
1445
1446     // create an optimized horizontal scaling routine
1447
1448     //code fragment
1449
1450     asm volatile(
1451         "jmp                         9f                 \n\t"
1452     // Begin
1453         "0:                                             \n\t"
1454         "movq    (%%"REG_d", %%"REG_a"), %%mm3          \n\t"
1455         "movd    (%%"REG_c", %%"REG_S"), %%mm0          \n\t"
1456         "movd   1(%%"REG_c", %%"REG_S"), %%mm1          \n\t"
1457         "punpcklbw                %%mm7, %%mm1          \n\t"
1458         "punpcklbw                %%mm7, %%mm0          \n\t"
1459         "pshufw                   $0xFF, %%mm1, %%mm1   \n\t"
1460         "1:                                             \n\t"
1461         "pshufw                   $0xFF, %%mm0, %%mm0   \n\t"
1462         "2:                                             \n\t"
1463         "psubw                    %%mm1, %%mm0          \n\t"
1464         "movl   8(%%"REG_b", %%"REG_a"), %%esi          \n\t"
1465         "pmullw                   %%mm3, %%mm0          \n\t"
1466         "psllw                       $7, %%mm1          \n\t"
1467         "paddw                    %%mm1, %%mm0          \n\t"
1468
1469         "movq                     %%mm0, (%%"REG_D", %%"REG_a") \n\t"
1470
1471         "add                         $8, %%"REG_a"      \n\t"
1472     // End
1473         "9:                                             \n\t"
1474 //        "int $3                                         \n\t"
1475         "lea                 " LOCAL_MANGLE(0b) ", %0   \n\t"
1476         "lea                 " LOCAL_MANGLE(1b) ", %1   \n\t"
1477         "lea                 " LOCAL_MANGLE(2b) ", %2   \n\t"
1478         "dec                         %1                 \n\t"
1479         "dec                         %2                 \n\t"
1480         "sub                         %0, %1             \n\t"
1481         "sub                         %0, %2             \n\t"
1482         "lea                 " LOCAL_MANGLE(9b) ", %3   \n\t"
1483         "sub                         %0, %3             \n\t"
1484
1485
1486         :"=r" (fragmentA), "=r" (imm8OfPShufW1A), "=r" (imm8OfPShufW2A),
1487         "=r" (fragmentLengthA)
1488     );
1489
1490     asm volatile(
1491         "jmp                         9f                 \n\t"
1492     // Begin
1493         "0:                                             \n\t"
1494         "movq    (%%"REG_d", %%"REG_a"), %%mm3          \n\t"
1495         "movd    (%%"REG_c", %%"REG_S"), %%mm0          \n\t"
1496         "punpcklbw                %%mm7, %%mm0          \n\t"
1497         "pshufw                   $0xFF, %%mm0, %%mm1   \n\t"
1498         "1:                                             \n\t"
1499         "pshufw                   $0xFF, %%mm0, %%mm0   \n\t"
1500         "2:                                             \n\t"
1501         "psubw                    %%mm1, %%mm0          \n\t"
1502         "movl   8(%%"REG_b", %%"REG_a"), %%esi          \n\t"
1503         "pmullw                   %%mm3, %%mm0          \n\t"
1504         "psllw                       $7, %%mm1          \n\t"
1505         "paddw                    %%mm1, %%mm0          \n\t"
1506
1507         "movq                     %%mm0, (%%"REG_D", %%"REG_a") \n\t"
1508
1509         "add                         $8, %%"REG_a"      \n\t"
1510     // End
1511         "9:                                             \n\t"
1512 //        "int                       $3                   \n\t"
1513         "lea                 " LOCAL_MANGLE(0b) ", %0   \n\t"
1514         "lea                 " LOCAL_MANGLE(1b) ", %1   \n\t"
1515         "lea                 " LOCAL_MANGLE(2b) ", %2   \n\t"
1516         "dec                         %1                 \n\t"
1517         "dec                         %2                 \n\t"
1518         "sub                         %0, %1             \n\t"
1519         "sub                         %0, %2             \n\t"
1520         "lea                 " LOCAL_MANGLE(9b) ", %3   \n\t"
1521         "sub                         %0, %3             \n\t"
1522
1523
1524         :"=r" (fragmentB), "=r" (imm8OfPShufW1B), "=r" (imm8OfPShufW2B),
1525         "=r" (fragmentLengthB)
1526     );
1527
1528     xpos= 0; //lumXInc/2 - 0x8000; // difference between pixel centers
1529     fragmentPos=0;
1530
1531     for (i=0; i<dstW/numSplits; i++)
1532     {
1533         int xx=xpos>>16;
1534
1535         if ((i&3) == 0)
1536         {
1537             int a=0;
1538             int b=((xpos+xInc)>>16) - xx;
1539             int c=((xpos+xInc*2)>>16) - xx;
1540             int d=((xpos+xInc*3)>>16) - xx;
1541
1542             filter[i  ] = (( xpos         & 0xFFFF) ^ 0xFFFF)>>9;
1543             filter[i+1] = (((xpos+xInc  ) & 0xFFFF) ^ 0xFFFF)>>9;
1544             filter[i+2] = (((xpos+xInc*2) & 0xFFFF) ^ 0xFFFF)>>9;
1545             filter[i+3] = (((xpos+xInc*3) & 0xFFFF) ^ 0xFFFF)>>9;
1546             filterPos[i/2]= xx;
1547
1548             if (d+1<4)
1549             {
1550                 int maxShift= 3-(d+1);
1551                 int shift=0;
1552
1553                 memcpy(funnyCode + fragmentPos, fragmentB, fragmentLengthB);
1554
1555                 funnyCode[fragmentPos + imm8OfPShufW1B]=
1556                     (a+1) | ((b+1)<<2) | ((c+1)<<4) | ((d+1)<<6);
1557                 funnyCode[fragmentPos + imm8OfPShufW2B]=
1558                     a | (b<<2) | (c<<4) | (d<<6);
1559
1560                 if (i+3>=dstW) shift=maxShift; //avoid overread
1561                 else if ((filterPos[i/2]&3) <= maxShift) shift=filterPos[i/2]&3; //Align
1562
1563                 if (shift && i>=shift)
1564                 {
1565                     funnyCode[fragmentPos + imm8OfPShufW1B]+= 0x55*shift;
1566                     funnyCode[fragmentPos + imm8OfPShufW2B]+= 0x55*shift;
1567                     filterPos[i/2]-=shift;
1568                 }
1569
1570                 fragmentPos+= fragmentLengthB;
1571             }
1572             else
1573             {
1574                 int maxShift= 3-d;
1575                 int shift=0;
1576
1577                 memcpy(funnyCode + fragmentPos, fragmentA, fragmentLengthA);
1578
1579                 funnyCode[fragmentPos + imm8OfPShufW1A]=
1580                 funnyCode[fragmentPos + imm8OfPShufW2A]=
1581                     a | (b<<2) | (c<<4) | (d<<6);
1582
1583                 if (i+4>=dstW) shift=maxShift; //avoid overread
1584                 else if ((filterPos[i/2]&3) <= maxShift) shift=filterPos[i/2]&3; //partial align
1585
1586                 if (shift && i>=shift)
1587                 {
1588                     funnyCode[fragmentPos + imm8OfPShufW1A]+= 0x55*shift;
1589                     funnyCode[fragmentPos + imm8OfPShufW2A]+= 0x55*shift;
1590                     filterPos[i/2]-=shift;
1591                 }
1592
1593                 fragmentPos+= fragmentLengthA;
1594             }
1595
1596             funnyCode[fragmentPos]= RET;
1597         }
1598         xpos+=xInc;
1599     }
1600     filterPos[i/2]= xpos>>16; // needed to jump to the next part
1601 }
1602 #endif /* COMPILE_MMX2 */
1603
1604 static void globalInit(void){
1605     // generating tables:
1606     int i;
1607     for (i=0; i<768; i++){
1608         int c= av_clip_uint8(i-256);
1609         clip_table[i]=c;
1610     }
1611 }
1612
1613 static SwsFunc getSwsFunc(int flags){
1614
1615 #if defined(RUNTIME_CPUDETECT) && defined (CONFIG_GPL)
1616 #if defined(ARCH_X86)
1617     // ordered per speed fastest first
1618     if (flags & SWS_CPU_CAPS_MMX2)
1619         return swScale_MMX2;
1620     else if (flags & SWS_CPU_CAPS_3DNOW)
1621         return swScale_3DNow;
1622     else if (flags & SWS_CPU_CAPS_MMX)
1623         return swScale_MMX;
1624     else
1625         return swScale_C;
1626
1627 #else
1628 #ifdef ARCH_POWERPC
1629     if (flags & SWS_CPU_CAPS_ALTIVEC)
1630         return swScale_altivec;
1631     else
1632         return swScale_C;
1633 #endif
1634     return swScale_C;
1635 #endif /* defined(ARCH_X86) */
1636 #else //RUNTIME_CPUDETECT
1637 #ifdef HAVE_MMX2
1638     return swScale_MMX2;
1639 #elif defined (HAVE_3DNOW)
1640     return swScale_3DNow;
1641 #elif defined (HAVE_MMX)
1642     return swScale_MMX;
1643 #elif defined (HAVE_ALTIVEC)
1644     return swScale_altivec;
1645 #else
1646     return swScale_C;
1647 #endif
1648 #endif //!RUNTIME_CPUDETECT
1649 }
1650
1651 static int PlanarToNV12Wrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1652                                int srcSliceH, uint8_t* dstParam[], int dstStride[]){
1653     uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
1654     /* Copy Y plane */
1655     if (dstStride[0]==srcStride[0] && srcStride[0] > 0)
1656         memcpy(dst, src[0], srcSliceH*dstStride[0]);
1657     else
1658     {
1659         int i;
1660         uint8_t *srcPtr= src[0];
1661         uint8_t *dstPtr= dst;
1662         for (i=0; i<srcSliceH; i++)
1663         {
1664             memcpy(dstPtr, srcPtr, c->srcW);
1665             srcPtr+= srcStride[0];
1666             dstPtr+= dstStride[0];
1667         }
1668     }
1669     dst = dstParam[1] + dstStride[1]*srcSliceY/2;
1670     if (c->dstFormat == PIX_FMT_NV12)
1671         interleaveBytes(src[1], src[2], dst, c->srcW/2, srcSliceH/2, srcStride[1], srcStride[2], dstStride[0]);
1672     else
1673         interleaveBytes(src[2], src[1], dst, c->srcW/2, srcSliceH/2, srcStride[2], srcStride[1], dstStride[0]);
1674
1675     return srcSliceH;
1676 }
1677
1678 static int PlanarToYuy2Wrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1679                                int srcSliceH, uint8_t* dstParam[], int dstStride[]){
1680     uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
1681
1682     yv12toyuy2(src[0], src[1], src[2], dst, c->srcW, srcSliceH, srcStride[0], srcStride[1], dstStride[0]);
1683
1684     return srcSliceH;
1685 }
1686
1687 static int PlanarToUyvyWrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1688                                int srcSliceH, uint8_t* dstParam[], int dstStride[]){
1689     uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
1690
1691     yv12touyvy(src[0], src[1], src[2], dst, c->srcW, srcSliceH, srcStride[0], srcStride[1], dstStride[0]);
1692
1693     return srcSliceH;
1694 }
1695
1696 static int YUV422PToYuy2Wrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1697                                 int srcSliceH, uint8_t* dstParam[], int dstStride[]){
1698     uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
1699
1700     yuv422ptoyuy2(src[0],src[1],src[2],dst,c->srcW,srcSliceH,srcStride[0],srcStride[1],dstStride[0]);
1701
1702     return srcSliceH;
1703 }
1704
1705 static int YUV422PToUyvyWrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1706                                 int srcSliceH, uint8_t* dstParam[], int dstStride[]){
1707     uint8_t *dst=dstParam[0] + dstStride[0]*srcSliceY;
1708
1709     yuv422ptouyvy(src[0],src[1],src[2],dst,c->srcW,srcSliceH,srcStride[0],srcStride[1],dstStride[0]);
1710
1711     return srcSliceH;
1712 }
1713
1714 /* {RGB,BGR}{15,16,24,32,32_1} -> {RGB,BGR}{15,16,24,32} */
1715 static int rgb2rgbWrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1716                           int srcSliceH, uint8_t* dst[], int dstStride[]){
1717     const int srcFormat= c->srcFormat;
1718     const int dstFormat= c->dstFormat;
1719     const int srcBpp= (fmt_depth(srcFormat) + 7) >> 3;
1720     const int dstBpp= (fmt_depth(dstFormat) + 7) >> 3;
1721     const int srcId= fmt_depth(srcFormat) >> 2; /* 1:0, 4:1, 8:2, 15:3, 16:4, 24:6, 32:8 */
1722     const int dstId= fmt_depth(dstFormat) >> 2;
1723     void (*conv)(const uint8_t *src, uint8_t *dst, long src_size)=NULL;
1724
1725     /* BGR -> BGR */
1726     if (  (isBGR(srcFormat) && isBGR(dstFormat))
1727        || (isRGB(srcFormat) && isRGB(dstFormat))){
1728         switch(srcId | (dstId<<4)){
1729         case 0x34: conv= rgb16to15; break;
1730         case 0x36: conv= rgb24to15; break;
1731         case 0x38: conv= rgb32to15; break;
1732         case 0x43: conv= rgb15to16; break;
1733         case 0x46: conv= rgb24to16; break;
1734         case 0x48: conv= rgb32to16; break;
1735         case 0x63: conv= rgb15to24; break;
1736         case 0x64: conv= rgb16to24; break;
1737         case 0x68: conv= rgb32to24; break;
1738         case 0x83: conv= rgb15to32; break;
1739         case 0x84: conv= rgb16to32; break;
1740         case 0x86: conv= rgb24to32; break;
1741         default: av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
1742                         sws_format_name(srcFormat), sws_format_name(dstFormat)); break;
1743         }
1744     }else if (  (isBGR(srcFormat) && isRGB(dstFormat))
1745              || (isRGB(srcFormat) && isBGR(dstFormat))){
1746         switch(srcId | (dstId<<4)){
1747         case 0x33: conv= rgb15tobgr15; break;
1748         case 0x34: conv= rgb16tobgr15; break;
1749         case 0x36: conv= rgb24tobgr15; break;
1750         case 0x38: conv= rgb32tobgr15; break;
1751         case 0x43: conv= rgb15tobgr16; break;
1752         case 0x44: conv= rgb16tobgr16; break;
1753         case 0x46: conv= rgb24tobgr16; break;
1754         case 0x48: conv= rgb32tobgr16; break;
1755         case 0x63: conv= rgb15tobgr24; break;
1756         case 0x64: conv= rgb16tobgr24; break;
1757         case 0x66: conv= rgb24tobgr24; break;
1758         case 0x68: conv= rgb32tobgr24; break;
1759         case 0x83: conv= rgb15tobgr32; break;
1760         case 0x84: conv= rgb16tobgr32; break;
1761         case 0x86: conv= rgb24tobgr32; break;
1762         case 0x88: conv= rgb32tobgr32; break;
1763         default: av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
1764                         sws_format_name(srcFormat), sws_format_name(dstFormat)); break;
1765         }
1766     }else{
1767         av_log(c, AV_LOG_ERROR, "internal error %s -> %s converter\n",
1768                sws_format_name(srcFormat), sws_format_name(dstFormat));
1769     }
1770
1771     if(conv)
1772     {
1773         uint8_t *srcPtr= src[0];
1774         if(srcFormat == PIX_FMT_RGB32_1 || srcFormat == PIX_FMT_BGR32_1)
1775             srcPtr += ALT32_CORR;
1776
1777         if (dstStride[0]*srcBpp == srcStride[0]*dstBpp && srcStride[0] > 0)
1778             conv(srcPtr, dst[0] + dstStride[0]*srcSliceY, srcSliceH*srcStride[0]);
1779         else
1780         {
1781             int i;
1782             uint8_t *dstPtr= dst[0] + dstStride[0]*srcSliceY;
1783
1784             for (i=0; i<srcSliceH; i++)
1785             {
1786                 conv(srcPtr, dstPtr, c->srcW*srcBpp);
1787                 srcPtr+= srcStride[0];
1788                 dstPtr+= dstStride[0];
1789             }
1790         }
1791     }
1792     return srcSliceH;
1793 }
1794
1795 static int bgr24toyv12Wrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1796                               int srcSliceH, uint8_t* dst[], int dstStride[]){
1797
1798     rgb24toyv12(
1799         src[0],
1800         dst[0]+ srcSliceY    *dstStride[0],
1801         dst[1]+(srcSliceY>>1)*dstStride[1],
1802         dst[2]+(srcSliceY>>1)*dstStride[2],
1803         c->srcW, srcSliceH,
1804         dstStride[0], dstStride[1], srcStride[0]);
1805     return srcSliceH;
1806 }
1807
1808 static int yvu9toyv12Wrapper(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1809                              int srcSliceH, uint8_t* dst[], int dstStride[]){
1810     int i;
1811
1812     /* copy Y */
1813     if (srcStride[0]==dstStride[0] && srcStride[0] > 0)
1814         memcpy(dst[0]+ srcSliceY*dstStride[0], src[0], srcStride[0]*srcSliceH);
1815     else{
1816         uint8_t *srcPtr= src[0];
1817         uint8_t *dstPtr= dst[0] + dstStride[0]*srcSliceY;
1818
1819         for (i=0; i<srcSliceH; i++)
1820         {
1821             memcpy(dstPtr, srcPtr, c->srcW);
1822             srcPtr+= srcStride[0];
1823             dstPtr+= dstStride[0];
1824         }
1825     }
1826
1827     if (c->dstFormat==PIX_FMT_YUV420P){
1828         planar2x(src[1], dst[1], c->chrSrcW, c->chrSrcH, srcStride[1], dstStride[1]);
1829         planar2x(src[2], dst[2], c->chrSrcW, c->chrSrcH, srcStride[2], dstStride[2]);
1830     }else{
1831         planar2x(src[1], dst[2], c->chrSrcW, c->chrSrcH, srcStride[1], dstStride[2]);
1832         planar2x(src[2], dst[1], c->chrSrcW, c->chrSrcH, srcStride[2], dstStride[1]);
1833     }
1834     return srcSliceH;
1835 }
1836
1837 /* unscaled copy like stuff (assumes nearly identical formats) */
1838 static int packedCopy(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1839                       int srcSliceH, uint8_t* dst[], int dstStride[])
1840 {
1841     if (dstStride[0]==srcStride[0] && srcStride[0] > 0)
1842         memcpy(dst[0] + dstStride[0]*srcSliceY, src[0], srcSliceH*dstStride[0]);
1843     else
1844     {
1845         int i;
1846         uint8_t *srcPtr= src[0];
1847         uint8_t *dstPtr= dst[0] + dstStride[0]*srcSliceY;
1848         int length=0;
1849
1850         /* universal length finder */
1851         while(length+c->srcW <= FFABS(dstStride[0])
1852            && length+c->srcW <= FFABS(srcStride[0])) length+= c->srcW;
1853         assert(length!=0);
1854
1855         for (i=0; i<srcSliceH; i++)
1856         {
1857             memcpy(dstPtr, srcPtr, length);
1858             srcPtr+= srcStride[0];
1859             dstPtr+= dstStride[0];
1860         }
1861     }
1862     return srcSliceH;
1863 }
1864
1865 static int planarCopy(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1866                       int srcSliceH, uint8_t* dst[], int dstStride[])
1867 {
1868     int plane;
1869     for (plane=0; plane<3; plane++)
1870     {
1871         int length= plane==0 ? c->srcW  : -((-c->srcW  )>>c->chrDstHSubSample);
1872         int y=      plane==0 ? srcSliceY: -((-srcSliceY)>>c->chrDstVSubSample);
1873         int height= plane==0 ? srcSliceH: -((-srcSliceH)>>c->chrDstVSubSample);
1874
1875         if ((isGray(c->srcFormat) || isGray(c->dstFormat)) && plane>0)
1876         {
1877             if (!isGray(c->dstFormat))
1878                 memset(dst[plane], 128, dstStride[plane]*height);
1879         }
1880         else
1881         {
1882             if (dstStride[plane]==srcStride[plane] && srcStride[plane] > 0)
1883                 memcpy(dst[plane] + dstStride[plane]*y, src[plane], height*dstStride[plane]);
1884             else
1885             {
1886                 int i;
1887                 uint8_t *srcPtr= src[plane];
1888                 uint8_t *dstPtr= dst[plane] + dstStride[plane]*y;
1889                 for (i=0; i<height; i++)
1890                 {
1891                     memcpy(dstPtr, srcPtr, length);
1892                     srcPtr+= srcStride[plane];
1893                     dstPtr+= dstStride[plane];
1894                 }
1895             }
1896         }
1897     }
1898     return srcSliceH;
1899 }
1900
1901 static int gray16togray(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1902                         int srcSliceH, uint8_t* dst[], int dstStride[]){
1903
1904     int length= c->srcW;
1905     int y=      srcSliceY;
1906     int height= srcSliceH;
1907     int i, j;
1908     uint8_t *srcPtr= src[0];
1909     uint8_t *dstPtr= dst[0] + dstStride[0]*y;
1910
1911     if (!isGray(c->dstFormat)){
1912         int height= -((-srcSliceH)>>c->chrDstVSubSample);
1913         memset(dst[1], 128, dstStride[1]*height);
1914         memset(dst[2], 128, dstStride[2]*height);
1915     }
1916     if (c->srcFormat == PIX_FMT_GRAY16LE) srcPtr++;
1917     for (i=0; i<height; i++)
1918     {
1919         for (j=0; j<length; j++) dstPtr[j] = srcPtr[j<<1];
1920         srcPtr+= srcStride[0];
1921         dstPtr+= dstStride[0];
1922     }
1923     return srcSliceH;
1924 }
1925
1926 static int graytogray16(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1927                         int srcSliceH, uint8_t* dst[], int dstStride[]){
1928
1929     int length= c->srcW;
1930     int y=      srcSliceY;
1931     int height= srcSliceH;
1932     int i, j;
1933     uint8_t *srcPtr= src[0];
1934     uint8_t *dstPtr= dst[0] + dstStride[0]*y;
1935     for (i=0; i<height; i++)
1936     {
1937         for (j=0; j<length; j++)
1938         {
1939             dstPtr[j<<1] = srcPtr[j];
1940             dstPtr[(j<<1)+1] = srcPtr[j];
1941         }
1942         srcPtr+= srcStride[0];
1943         dstPtr+= dstStride[0];
1944     }
1945     return srcSliceH;
1946 }
1947
1948 static int gray16swap(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
1949                       int srcSliceH, uint8_t* dst[], int dstStride[]){
1950
1951     int length= c->srcW;
1952     int y=      srcSliceY;
1953     int height= srcSliceH;
1954     int i, j;
1955     uint16_t *srcPtr= (uint16_t*)src[0];
1956     uint16_t *dstPtr= (uint16_t*)(dst[0] + dstStride[0]*y/2);
1957     for (i=0; i<height; i++)
1958     {
1959         for (j=0; j<length; j++) dstPtr[j] = bswap_16(srcPtr[j]);
1960         srcPtr+= srcStride[0]/2;
1961         dstPtr+= dstStride[0]/2;
1962     }
1963     return srcSliceH;
1964 }
1965
1966
1967 static void getSubSampleFactors(int *h, int *v, int format){
1968     switch(format){
1969     case PIX_FMT_UYVY422:
1970     case PIX_FMT_YUYV422:
1971         *h=1;
1972         *v=0;
1973         break;
1974     case PIX_FMT_YUV420P:
1975     case PIX_FMT_YUVA420P:
1976     case PIX_FMT_GRAY16BE:
1977     case PIX_FMT_GRAY16LE:
1978     case PIX_FMT_GRAY8: //FIXME remove after different subsamplings are fully implemented
1979     case PIX_FMT_NV12:
1980     case PIX_FMT_NV21:
1981         *h=1;
1982         *v=1;
1983         break;
1984     case PIX_FMT_YUV440P:
1985         *h=0;
1986         *v=1;
1987         break;
1988     case PIX_FMT_YUV410P:
1989         *h=2;
1990         *v=2;
1991         break;
1992     case PIX_FMT_YUV444P:
1993         *h=0;
1994         *v=0;
1995         break;
1996     case PIX_FMT_YUV422P:
1997         *h=1;
1998         *v=0;
1999         break;
2000     case PIX_FMT_YUV411P:
2001         *h=2;
2002         *v=0;
2003         break;
2004     default:
2005         *h=0;
2006         *v=0;
2007         break;
2008     }
2009 }
2010
2011 static uint16_t roundToInt16(int64_t f){
2012     int r= (f + (1<<15))>>16;
2013          if (r<-0x7FFF) return 0x8000;
2014     else if (r> 0x7FFF) return 0x7FFF;
2015     else                return r;
2016 }
2017
2018 /**
2019  * @param inv_table the yuv2rgb coeffs, normally Inverse_Table_6_9[x]
2020  * @param fullRange if 1 then the luma range is 0..255 if 0 it is 16..235
2021  * @return -1 if not supported
2022  */
2023 int sws_setColorspaceDetails(SwsContext *c, const int inv_table[4], int srcRange, const int table[4], int dstRange, int brightness, int contrast, int saturation){
2024     int64_t crv =  inv_table[0];
2025     int64_t cbu =  inv_table[1];
2026     int64_t cgu = -inv_table[2];
2027     int64_t cgv = -inv_table[3];
2028     int64_t cy  = 1<<16;
2029     int64_t oy  = 0;
2030
2031     memcpy(c->srcColorspaceTable, inv_table, sizeof(int)*4);
2032     memcpy(c->dstColorspaceTable,     table, sizeof(int)*4);
2033
2034     c->brightness= brightness;
2035     c->contrast  = contrast;
2036     c->saturation= saturation;
2037     c->srcRange  = srcRange;
2038     c->dstRange  = dstRange;
2039     if (isYUV(c->dstFormat) || isGray(c->dstFormat)) return 0;
2040
2041     c->uOffset=   0x0400040004000400LL;
2042     c->vOffset=   0x0400040004000400LL;
2043
2044     if (!srcRange){
2045         cy= (cy*255) / 219;
2046         oy= 16<<16;
2047     }else{
2048         crv= (crv*224) / 255;
2049         cbu= (cbu*224) / 255;
2050         cgu= (cgu*224) / 255;
2051         cgv= (cgv*224) / 255;
2052     }
2053
2054     cy = (cy *contrast             )>>16;
2055     crv= (crv*contrast * saturation)>>32;
2056     cbu= (cbu*contrast * saturation)>>32;
2057     cgu= (cgu*contrast * saturation)>>32;
2058     cgv= (cgv*contrast * saturation)>>32;
2059
2060     oy -= 256*brightness;
2061
2062     c->yCoeff=    roundToInt16(cy *8192) * 0x0001000100010001ULL;
2063     c->vrCoeff=   roundToInt16(crv*8192) * 0x0001000100010001ULL;
2064     c->ubCoeff=   roundToInt16(cbu*8192) * 0x0001000100010001ULL;
2065     c->vgCoeff=   roundToInt16(cgv*8192) * 0x0001000100010001ULL;
2066     c->ugCoeff=   roundToInt16(cgu*8192) * 0x0001000100010001ULL;
2067     c->yOffset=   roundToInt16(oy *   8) * 0x0001000100010001ULL;
2068
2069     c->yuv2rgb_y_coeff  = (int16_t)roundToInt16(cy <<13);
2070     c->yuv2rgb_y_offset = (int16_t)roundToInt16(oy << 9);
2071     c->yuv2rgb_v2r_coeff= (int16_t)roundToInt16(crv<<13);
2072     c->yuv2rgb_v2g_coeff= (int16_t)roundToInt16(cgv<<13);
2073     c->yuv2rgb_u2g_coeff= (int16_t)roundToInt16(cgu<<13);
2074     c->yuv2rgb_u2b_coeff= (int16_t)roundToInt16(cbu<<13);
2075
2076     yuv2rgb_c_init_tables(c, inv_table, srcRange, brightness, contrast, saturation);
2077     //FIXME factorize
2078
2079 #ifdef COMPILE_ALTIVEC
2080     if (c->flags & SWS_CPU_CAPS_ALTIVEC)
2081         yuv2rgb_altivec_init_tables (c, inv_table, brightness, contrast, saturation);
2082 #endif
2083     return 0;
2084 }
2085
2086 /**
2087  * @return -1 if not supported
2088  */
2089 int sws_getColorspaceDetails(SwsContext *c, int **inv_table, int *srcRange, int **table, int *dstRange, int *brightness, int *contrast, int *saturation){
2090     if (isYUV(c->dstFormat) || isGray(c->dstFormat)) return -1;
2091
2092     *inv_table = c->srcColorspaceTable;
2093     *table     = c->dstColorspaceTable;
2094     *srcRange  = c->srcRange;
2095     *dstRange  = c->dstRange;
2096     *brightness= c->brightness;
2097     *contrast  = c->contrast;
2098     *saturation= c->saturation;
2099
2100     return 0;
2101 }
2102
2103 static int handle_jpeg(int *format)
2104 {
2105     switch (*format) {
2106         case PIX_FMT_YUVJ420P:
2107             *format = PIX_FMT_YUV420P;
2108             return 1;
2109         case PIX_FMT_YUVJ422P:
2110             *format = PIX_FMT_YUV422P;
2111             return 1;
2112         case PIX_FMT_YUVJ444P:
2113             *format = PIX_FMT_YUV444P;
2114             return 1;
2115         case PIX_FMT_YUVJ440P:
2116             *format = PIX_FMT_YUV440P;
2117             return 1;
2118         default:
2119             return 0;
2120     }
2121 }
2122
2123 SwsContext *sws_getContext(int srcW, int srcH, int srcFormat, int dstW, int dstH, int dstFormat, int flags,
2124                            SwsFilter *srcFilter, SwsFilter *dstFilter, double *param){
2125
2126     SwsContext *c;
2127     int i;
2128     int usesVFilter, usesHFilter;
2129     int unscaled, needsDither;
2130     int srcRange, dstRange;
2131     SwsFilter dummyFilter= {NULL, NULL, NULL, NULL};
2132 #if defined(ARCH_X86)
2133     if (flags & SWS_CPU_CAPS_MMX)
2134         asm volatile("emms\n\t"::: "memory");
2135 #endif
2136
2137 #if !defined(RUNTIME_CPUDETECT) || !defined (CONFIG_GPL) //ensure that the flags match the compiled variant if cpudetect is off
2138     flags &= ~(SWS_CPU_CAPS_MMX|SWS_CPU_CAPS_MMX2|SWS_CPU_CAPS_3DNOW|SWS_CPU_CAPS_ALTIVEC|SWS_CPU_CAPS_BFIN);
2139 #ifdef HAVE_MMX2
2140     flags |= SWS_CPU_CAPS_MMX|SWS_CPU_CAPS_MMX2;
2141 #elif defined (HAVE_3DNOW)
2142     flags |= SWS_CPU_CAPS_MMX|SWS_CPU_CAPS_3DNOW;
2143 #elif defined (HAVE_MMX)
2144     flags |= SWS_CPU_CAPS_MMX;
2145 #elif defined (HAVE_ALTIVEC)
2146     flags |= SWS_CPU_CAPS_ALTIVEC;
2147 #elif defined (ARCH_BFIN)
2148     flags |= SWS_CPU_CAPS_BFIN;
2149 #endif
2150 #endif /* RUNTIME_CPUDETECT */
2151     if (clip_table[512] != 255) globalInit();
2152     if (!rgb15to16) sws_rgb2rgb_init(flags);
2153
2154     unscaled = (srcW == dstW && srcH == dstH);
2155     needsDither= (isBGR(dstFormat) || isRGB(dstFormat))
2156         && (fmt_depth(dstFormat))<24
2157         && ((fmt_depth(dstFormat))<(fmt_depth(srcFormat)) || (!(isRGB(srcFormat) || isBGR(srcFormat))));
2158
2159     srcRange = handle_jpeg(&srcFormat);
2160     dstRange = handle_jpeg(&dstFormat);
2161
2162     if (!isSupportedIn(srcFormat))
2163     {
2164         av_log(NULL, AV_LOG_ERROR, "swScaler: %s is not supported as input pixel format\n", sws_format_name(srcFormat));
2165         return NULL;
2166     }
2167     if (!isSupportedOut(dstFormat))
2168     {
2169         av_log(NULL, AV_LOG_ERROR, "swScaler: %s is not supported as output pixel format\n", sws_format_name(dstFormat));
2170         return NULL;
2171     }
2172
2173     i= flags & ( SWS_POINT
2174                 |SWS_AREA
2175                 |SWS_BILINEAR
2176                 |SWS_FAST_BILINEAR
2177                 |SWS_BICUBIC
2178                 |SWS_X
2179                 |SWS_GAUSS
2180                 |SWS_LANCZOS
2181                 |SWS_SINC
2182                 |SWS_SPLINE
2183                 |SWS_BICUBLIN);
2184     if(!i || (i & (i-1)))
2185     {
2186         av_log(NULL, AV_LOG_ERROR, "swScaler: Exactly one scaler algorithm must be choosen\n");
2187         return NULL;
2188     }
2189
2190     /* sanity check */
2191     if (srcW<4 || srcH<1 || dstW<8 || dstH<1) //FIXME check if these are enough and try to lowwer them after fixing the relevant parts of the code
2192     {
2193         av_log(NULL, AV_LOG_ERROR, "swScaler: %dx%d -> %dx%d is invalid scaling dimension\n",
2194                srcW, srcH, dstW, dstH);
2195         return NULL;
2196     }
2197     if(srcW > VOFW || dstW > VOFW){
2198         av_log(NULL, AV_LOG_ERROR, "swScaler: Compile time max width is "AV_STRINGIFY(VOFW)" change VOF/VOFW and recompile\n");
2199         return NULL;
2200     }
2201
2202     if (!dstFilter) dstFilter= &dummyFilter;
2203     if (!srcFilter) srcFilter= &dummyFilter;
2204
2205     c= av_mallocz(sizeof(SwsContext));
2206
2207     c->av_class = &sws_context_class;
2208     c->srcW= srcW;
2209     c->srcH= srcH;
2210     c->dstW= dstW;
2211     c->dstH= dstH;
2212     c->lumXInc= ((srcW<<16) + (dstW>>1))/dstW;
2213     c->lumYInc= ((srcH<<16) + (dstH>>1))/dstH;
2214     c->flags= flags;
2215     c->dstFormat= dstFormat;
2216     c->srcFormat= srcFormat;
2217     c->vRounder= 4* 0x0001000100010001ULL;
2218
2219     usesHFilter= usesVFilter= 0;
2220     if (dstFilter->lumV && dstFilter->lumV->length>1) usesVFilter=1;
2221     if (dstFilter->lumH && dstFilter->lumH->length>1) usesHFilter=1;
2222     if (dstFilter->chrV && dstFilter->chrV->length>1) usesVFilter=1;
2223     if (dstFilter->chrH && dstFilter->chrH->length>1) usesHFilter=1;
2224     if (srcFilter->lumV && srcFilter->lumV->length>1) usesVFilter=1;
2225     if (srcFilter->lumH && srcFilter->lumH->length>1) usesHFilter=1;
2226     if (srcFilter->chrV && srcFilter->chrV->length>1) usesVFilter=1;
2227     if (srcFilter->chrH && srcFilter->chrH->length>1) usesHFilter=1;
2228
2229     getSubSampleFactors(&c->chrSrcHSubSample, &c->chrSrcVSubSample, srcFormat);
2230     getSubSampleFactors(&c->chrDstHSubSample, &c->chrDstVSubSample, dstFormat);
2231
2232     // reuse chroma for 2 pixles rgb/bgr unless user wants full chroma interpolation
2233     if ((isBGR(dstFormat) || isRGB(dstFormat)) && !(flags&SWS_FULL_CHR_H_INT)) c->chrDstHSubSample=1;
2234
2235     // drop some chroma lines if the user wants it
2236     c->vChrDrop= (flags&SWS_SRC_V_CHR_DROP_MASK)>>SWS_SRC_V_CHR_DROP_SHIFT;
2237     c->chrSrcVSubSample+= c->vChrDrop;
2238
2239     // drop every 2. pixel for chroma calculation unless user wants full chroma
2240     if ((isBGR(srcFormat) || isRGB(srcFormat)) && !(flags&SWS_FULL_CHR_H_INP)
2241       && srcFormat!=PIX_FMT_RGB8      && srcFormat!=PIX_FMT_BGR8
2242       && srcFormat!=PIX_FMT_RGB4      && srcFormat!=PIX_FMT_BGR4
2243       && srcFormat!=PIX_FMT_RGB4_BYTE && srcFormat!=PIX_FMT_BGR4_BYTE
2244       && ((dstW>>c->chrDstHSubSample) <= (srcW>>1) || (flags&(SWS_FAST_BILINEAR|SWS_POINT))))
2245         c->chrSrcHSubSample=1;
2246
2247     if (param){
2248         c->param[0] = param[0];
2249         c->param[1] = param[1];
2250     }else{
2251         c->param[0] =
2252         c->param[1] = SWS_PARAM_DEFAULT;
2253     }
2254
2255     c->chrIntHSubSample= c->chrDstHSubSample;
2256     c->chrIntVSubSample= c->chrSrcVSubSample;
2257
2258     // Note the -((-x)>>y) is so that we always round toward +inf.
2259     c->chrSrcW= -((-srcW) >> c->chrSrcHSubSample);
2260     c->chrSrcH= -((-srcH) >> c->chrSrcVSubSample);
2261     c->chrDstW= -((-dstW) >> c->chrDstHSubSample);
2262     c->chrDstH= -((-dstH) >> c->chrDstVSubSample);
2263
2264     sws_setColorspaceDetails(c, Inverse_Table_6_9[SWS_CS_DEFAULT], srcRange, Inverse_Table_6_9[SWS_CS_DEFAULT] /* FIXME*/, dstRange, 0, 1<<16, 1<<16);
2265
2266     /* unscaled special Cases */
2267     if (unscaled && !usesHFilter && !usesVFilter && (srcRange == dstRange || isBGR(dstFormat) || isRGB(dstFormat)))
2268     {
2269         /* yv12_to_nv12 */
2270         if (srcFormat == PIX_FMT_YUV420P && (dstFormat == PIX_FMT_NV12 || dstFormat == PIX_FMT_NV21))
2271         {
2272             c->swScale= PlanarToNV12Wrapper;
2273         }
2274 #ifdef CONFIG_GPL
2275         /* yuv2bgr */
2276         if ((srcFormat==PIX_FMT_YUV420P || srcFormat==PIX_FMT_YUV422P) && (isBGR(dstFormat) || isRGB(dstFormat))
2277             && !(flags & SWS_ACCURATE_RND))
2278         {
2279             c->swScale= yuv2rgb_get_func_ptr(c);
2280         }
2281 #endif
2282
2283         if (srcFormat==PIX_FMT_YUV410P && dstFormat==PIX_FMT_YUV420P && !(flags & SWS_BITEXACT))
2284         {
2285             c->swScale= yvu9toyv12Wrapper;
2286         }
2287
2288         /* bgr24toYV12 */
2289         if (srcFormat==PIX_FMT_BGR24 && dstFormat==PIX_FMT_YUV420P && !(flags & SWS_ACCURATE_RND))
2290             c->swScale= bgr24toyv12Wrapper;
2291
2292         /* rgb/bgr -> rgb/bgr (no dither needed forms) */
2293         if (  (isBGR(srcFormat) || isRGB(srcFormat))
2294            && (isBGR(dstFormat) || isRGB(dstFormat))
2295            && srcFormat != PIX_FMT_BGR8      && dstFormat != PIX_FMT_BGR8
2296            && srcFormat != PIX_FMT_RGB8      && dstFormat != PIX_FMT_RGB8
2297            && srcFormat != PIX_FMT_BGR4      && dstFormat != PIX_FMT_BGR4
2298            && srcFormat != PIX_FMT_RGB4      && dstFormat != PIX_FMT_RGB4
2299            && srcFormat != PIX_FMT_BGR4_BYTE && dstFormat != PIX_FMT_BGR4_BYTE
2300            && srcFormat != PIX_FMT_RGB4_BYTE && dstFormat != PIX_FMT_RGB4_BYTE
2301            && srcFormat != PIX_FMT_MONOBLACK && dstFormat != PIX_FMT_MONOBLACK
2302            && srcFormat != PIX_FMT_MONOWHITE && dstFormat != PIX_FMT_MONOWHITE
2303                                              && dstFormat != PIX_FMT_RGB32_1
2304                                              && dstFormat != PIX_FMT_BGR32_1
2305            && (!needsDither || (c->flags&(SWS_FAST_BILINEAR|SWS_POINT))))
2306              c->swScale= rgb2rgbWrapper;
2307
2308         if (srcFormat == PIX_FMT_YUV422P)
2309         {
2310             if (dstFormat == PIX_FMT_YUYV422)
2311                 c->swScale= YUV422PToYuy2Wrapper;
2312             else if (dstFormat == PIX_FMT_UYVY422)
2313                 c->swScale= YUV422PToUyvyWrapper;
2314         }
2315
2316         /* LQ converters if -sws 0 or -sws 4*/
2317         if (c->flags&(SWS_FAST_BILINEAR|SWS_POINT)){
2318             /* yv12_to_yuy2 */
2319             if (srcFormat == PIX_FMT_YUV420P)
2320             {
2321                 if (dstFormat == PIX_FMT_YUYV422)
2322                     c->swScale= PlanarToYuy2Wrapper;
2323                 else if (dstFormat == PIX_FMT_UYVY422)
2324                     c->swScale= PlanarToUyvyWrapper;
2325             }
2326         }
2327
2328 #ifdef COMPILE_ALTIVEC
2329         if ((c->flags & SWS_CPU_CAPS_ALTIVEC) &&
2330             srcFormat == PIX_FMT_YUV420P) {
2331           // unscaled YV12 -> packed YUV, we want speed
2332           if (dstFormat == PIX_FMT_YUYV422)
2333               c->swScale= yv12toyuy2_unscaled_altivec;
2334           else if (dstFormat == PIX_FMT_UYVY422)
2335               c->swScale= yv12touyvy_unscaled_altivec;
2336         }
2337 #endif
2338
2339         /* simple copy */
2340         if (  srcFormat == dstFormat
2341             || (isPlanarYUV(srcFormat) && isGray(dstFormat))
2342             || (isPlanarYUV(dstFormat) && isGray(srcFormat)))
2343         {
2344             if (isPacked(c->srcFormat))
2345                 c->swScale= packedCopy;
2346             else /* Planar YUV or gray */
2347                 c->swScale= planarCopy;
2348         }
2349
2350         /* gray16{le,be} conversions */
2351         if (isGray16(srcFormat) && (isPlanarYUV(dstFormat) || (dstFormat == PIX_FMT_GRAY8)))
2352         {
2353             c->swScale= gray16togray;
2354         }
2355         if ((isPlanarYUV(srcFormat) || (srcFormat == PIX_FMT_GRAY8)) && isGray16(dstFormat))
2356         {
2357             c->swScale= graytogray16;
2358         }
2359         if (srcFormat != dstFormat && isGray16(srcFormat) && isGray16(dstFormat))
2360         {
2361             c->swScale= gray16swap;
2362         }
2363
2364 #ifdef ARCH_BFIN
2365         if (flags & SWS_CPU_CAPS_BFIN)
2366             ff_bfin_get_unscaled_swscale (c);
2367 #endif
2368
2369         if (c->swScale){
2370             if (flags&SWS_PRINT_INFO)
2371                 av_log(c, AV_LOG_INFO, "using unscaled %s -> %s special converter\n",
2372                                 sws_format_name(srcFormat), sws_format_name(dstFormat));
2373             return c;
2374         }
2375     }
2376
2377     if (flags & SWS_CPU_CAPS_MMX2)
2378     {
2379         c->canMMX2BeUsed= (dstW >=srcW && (dstW&31)==0 && (srcW&15)==0) ? 1 : 0;
2380         if (!c->canMMX2BeUsed && dstW >=srcW && (srcW&15)==0 && (flags&SWS_FAST_BILINEAR))
2381         {
2382             if (flags&SWS_PRINT_INFO)
2383                 av_log(c, AV_LOG_INFO, "output Width is not a multiple of 32 -> no MMX2 scaler\n");
2384         }
2385         if (usesHFilter) c->canMMX2BeUsed=0;
2386     }
2387     else
2388         c->canMMX2BeUsed=0;
2389
2390     c->chrXInc= ((c->chrSrcW<<16) + (c->chrDstW>>1))/c->chrDstW;
2391     c->chrYInc= ((c->chrSrcH<<16) + (c->chrDstH>>1))/c->chrDstH;
2392
2393     // match pixel 0 of the src to pixel 0 of dst and match pixel n-2 of src to pixel n-2 of dst
2394     // but only for the FAST_BILINEAR mode otherwise do correct scaling
2395     // n-2 is the last chrominance sample available
2396     // this is not perfect, but no one should notice the difference, the more correct variant
2397     // would be like the vertical one, but that would require some special code for the
2398     // first and last pixel
2399     if (flags&SWS_FAST_BILINEAR)
2400     {
2401         if (c->canMMX2BeUsed)
2402         {
2403             c->lumXInc+= 20;
2404             c->chrXInc+= 20;
2405         }
2406         //we don't use the x86asm scaler if mmx is available
2407         else if (flags & SWS_CPU_CAPS_MMX)
2408         {
2409             c->lumXInc = ((srcW-2)<<16)/(dstW-2) - 20;
2410             c->chrXInc = ((c->chrSrcW-2)<<16)/(c->chrDstW-2) - 20;
2411         }
2412     }
2413
2414     /* precalculate horizontal scaler filter coefficients */
2415     {
2416         const int filterAlign=
2417             (flags & SWS_CPU_CAPS_MMX) ? 4 :
2418             (flags & SWS_CPU_CAPS_ALTIVEC) ? 8 :
2419             1;
2420
2421         initFilter(&c->hLumFilter, &c->hLumFilterPos, &c->hLumFilterSize, c->lumXInc,
2422                    srcW      ,       dstW, filterAlign, 1<<14,
2423                    (flags&SWS_BICUBLIN) ? (flags|SWS_BICUBIC)  : flags,
2424                    srcFilter->lumH, dstFilter->lumH, c->param);
2425         initFilter(&c->hChrFilter, &c->hChrFilterPos, &c->hChrFilterSize, c->chrXInc,
2426                    c->chrSrcW, c->chrDstW, filterAlign, 1<<14,
2427                    (flags&SWS_BICUBLIN) ? (flags|SWS_BILINEAR) : flags,
2428                    srcFilter->chrH, dstFilter->chrH, c->param);
2429
2430 #define MAX_FUNNY_CODE_SIZE 10000
2431 #if defined(COMPILE_MMX2)
2432 // can't downscale !!!
2433         if (c->canMMX2BeUsed && (flags & SWS_FAST_BILINEAR))
2434         {
2435 #ifdef MAP_ANONYMOUS
2436             c->funnyYCode = (uint8_t*)mmap(NULL, MAX_FUNNY_CODE_SIZE, PROT_EXEC | PROT_READ | PROT_WRITE, MAP_PRIVATE | MAP_ANONYMOUS, 0, 0);
2437             c->funnyUVCode = (uint8_t*)mmap(NULL, MAX_FUNNY_CODE_SIZE, PROT_EXEC | PROT_READ | PROT_WRITE, MAP_PRIVATE | MAP_ANONYMOUS, 0, 0);
2438 #else
2439             c->funnyYCode = av_malloc(MAX_FUNNY_CODE_SIZE);
2440             c->funnyUVCode = av_malloc(MAX_FUNNY_CODE_SIZE);
2441 #endif
2442
2443             c->lumMmx2Filter   = av_malloc((dstW        /8+8)*sizeof(int16_t));
2444             c->chrMmx2Filter   = av_malloc((c->chrDstW  /4+8)*sizeof(int16_t));
2445             c->lumMmx2FilterPos= av_malloc((dstW      /2/8+8)*sizeof(int32_t));
2446             c->chrMmx2FilterPos= av_malloc((c->chrDstW/2/4+8)*sizeof(int32_t));
2447
2448             initMMX2HScaler(      dstW, c->lumXInc, c->funnyYCode , c->lumMmx2Filter, c->lumMmx2FilterPos, 8);
2449             initMMX2HScaler(c->chrDstW, c->chrXInc, c->funnyUVCode, c->chrMmx2Filter, c->chrMmx2FilterPos, 4);
2450         }
2451 #endif /* defined(COMPILE_MMX2) */
2452     } // Init Horizontal stuff
2453
2454
2455
2456     /* precalculate vertical scaler filter coefficients */
2457     {
2458         const int filterAlign=
2459             (flags & SWS_CPU_CAPS_MMX) && (flags & SWS_ACCURATE_RND) ? 2 :
2460             (flags & SWS_CPU_CAPS_ALTIVEC) ? 8 :
2461             1;
2462
2463         initFilter(&c->vLumFilter, &c->vLumFilterPos, &c->vLumFilterSize, c->lumYInc,
2464                    srcH      ,        dstH, filterAlign, (1<<12),
2465                    (flags&SWS_BICUBLIN) ? (flags|SWS_BICUBIC)  : flags,
2466                    srcFilter->lumV, dstFilter->lumV, c->param);
2467         initFilter(&c->vChrFilter, &c->vChrFilterPos, &c->vChrFilterSize, c->chrYInc,
2468                    c->chrSrcH, c->chrDstH, filterAlign, (1<<12),
2469                    (flags&SWS_BICUBLIN) ? (flags|SWS_BILINEAR) : flags,
2470                    srcFilter->chrV, dstFilter->chrV, c->param);
2471
2472 #ifdef HAVE_ALTIVEC
2473         c->vYCoeffsBank = av_malloc(sizeof (vector signed short)*c->vLumFilterSize*c->dstH);
2474         c->vCCoeffsBank = av_malloc(sizeof (vector signed short)*c->vChrFilterSize*c->chrDstH);
2475
2476         for (i=0;i<c->vLumFilterSize*c->dstH;i++) {
2477             int j;
2478             short *p = (short *)&c->vYCoeffsBank[i];
2479             for (j=0;j<8;j++)
2480                 p[j] = c->vLumFilter[i];
2481         }
2482
2483         for (i=0;i<c->vChrFilterSize*c->chrDstH;i++) {
2484             int j;
2485             short *p = (short *)&c->vCCoeffsBank[i];
2486             for (j=0;j<8;j++)
2487                 p[j] = c->vChrFilter[i];
2488         }
2489 #endif
2490     }
2491
2492     // Calculate Buffer Sizes so that they won't run out while handling these damn slices
2493     c->vLumBufSize= c->vLumFilterSize;
2494     c->vChrBufSize= c->vChrFilterSize;
2495     for (i=0; i<dstH; i++)
2496     {
2497         int chrI= i*c->chrDstH / dstH;
2498         int nextSlice= FFMAX(c->vLumFilterPos[i   ] + c->vLumFilterSize - 1,
2499                            ((c->vChrFilterPos[chrI] + c->vChrFilterSize - 1)<<c->chrSrcVSubSample));
2500
2501         nextSlice>>= c->chrSrcVSubSample;
2502         nextSlice<<= c->chrSrcVSubSample;
2503         if (c->vLumFilterPos[i   ] + c->vLumBufSize < nextSlice)
2504             c->vLumBufSize= nextSlice - c->vLumFilterPos[i];
2505         if (c->vChrFilterPos[chrI] + c->vChrBufSize < (nextSlice>>c->chrSrcVSubSample))
2506             c->vChrBufSize= (nextSlice>>c->chrSrcVSubSample) - c->vChrFilterPos[chrI];
2507     }
2508
2509     // allocate pixbufs (we use dynamic allocation because otherwise we would need to
2510     c->lumPixBuf= av_malloc(c->vLumBufSize*2*sizeof(int16_t*));
2511     c->chrPixBuf= av_malloc(c->vChrBufSize*2*sizeof(int16_t*));
2512     //Note we need at least one pixel more at the end because of the mmx code (just in case someone wanna replace the 4000/8000)
2513     /* align at 16 bytes for AltiVec */
2514     for (i=0; i<c->vLumBufSize; i++)
2515         c->lumPixBuf[i]= c->lumPixBuf[i+c->vLumBufSize]= av_mallocz(VOF+1);
2516     for (i=0; i<c->vChrBufSize; i++)
2517         c->chrPixBuf[i]= c->chrPixBuf[i+c->vChrBufSize]= av_malloc((VOF+1)*2);
2518
2519     //try to avoid drawing green stuff between the right end and the stride end
2520     for (i=0; i<c->vChrBufSize; i++) memset(c->chrPixBuf[i], 64, (VOF+1)*2);
2521
2522     assert(2*VOFW == VOF);
2523
2524     assert(c->chrDstH <= dstH);
2525
2526     if (flags&SWS_PRINT_INFO)
2527     {
2528 #ifdef DITHER1XBPP
2529         const char *dither= " dithered";
2530 #else
2531         const char *dither= "";
2532 #endif
2533         if (flags&SWS_FAST_BILINEAR)
2534             av_log(c, AV_LOG_INFO, "FAST_BILINEAR scaler, ");
2535         else if (flags&SWS_BILINEAR)
2536             av_log(c, AV_LOG_INFO, "BILINEAR scaler, ");
2537         else if (flags&SWS_BICUBIC)
2538             av_log(c, AV_LOG_INFO, "BICUBIC scaler, ");
2539         else if (flags&SWS_X)
2540             av_log(c, AV_LOG_INFO, "Experimental scaler, ");
2541         else if (flags&SWS_POINT)
2542             av_log(c, AV_LOG_INFO, "Nearest Neighbor / POINT scaler, ");
2543         else if (flags&SWS_AREA)
2544             av_log(c, AV_LOG_INFO, "Area Averageing scaler, ");
2545         else if (flags&SWS_BICUBLIN)
2546             av_log(c, AV_LOG_INFO, "luma BICUBIC / chroma BILINEAR scaler, ");
2547         else if (flags&SWS_GAUSS)
2548             av_log(c, AV_LOG_INFO, "Gaussian scaler, ");
2549         else if (flags&SWS_SINC)
2550             av_log(c, AV_LOG_INFO, "Sinc scaler, ");
2551         else if (flags&SWS_LANCZOS)
2552             av_log(c, AV_LOG_INFO, "Lanczos scaler, ");
2553         else if (flags&SWS_SPLINE)
2554             av_log(c, AV_LOG_INFO, "Bicubic spline scaler, ");
2555         else
2556             av_log(c, AV_LOG_INFO, "ehh flags invalid?! ");
2557
2558         if (dstFormat==PIX_FMT_BGR555 || dstFormat==PIX_FMT_BGR565)
2559             av_log(c, AV_LOG_INFO, "from %s to%s %s ",
2560                    sws_format_name(srcFormat), dither, sws_format_name(dstFormat));
2561         else
2562             av_log(c, AV_LOG_INFO, "from %s to %s ",
2563                    sws_format_name(srcFormat), sws_format_name(dstFormat));
2564
2565         if (flags & SWS_CPU_CAPS_MMX2)
2566             av_log(c, AV_LOG_INFO, "using MMX2\n");
2567         else if (flags & SWS_CPU_CAPS_3DNOW)
2568             av_log(c, AV_LOG_INFO, "using 3DNOW\n");
2569         else if (flags & SWS_CPU_CAPS_MMX)
2570             av_log(c, AV_LOG_INFO, "using MMX\n");
2571         else if (flags & SWS_CPU_CAPS_ALTIVEC)
2572             av_log(c, AV_LOG_INFO, "using AltiVec\n");
2573         else
2574             av_log(c, AV_LOG_INFO, "using C\n");
2575     }
2576
2577     if (flags & SWS_PRINT_INFO)
2578     {
2579         if (flags & SWS_CPU_CAPS_MMX)
2580         {
2581             if (c->canMMX2BeUsed && (flags&SWS_FAST_BILINEAR))
2582                 av_log(c, AV_LOG_VERBOSE, "using FAST_BILINEAR MMX2 scaler for horizontal scaling\n");
2583             else
2584             {
2585                 if (c->hLumFilterSize==4)
2586                     av_log(c, AV_LOG_VERBOSE, "using 4-tap MMX scaler for horizontal luminance scaling\n");
2587                 else if (c->hLumFilterSize==8)
2588                     av_log(c, AV_LOG_VERBOSE, "using 8-tap MMX scaler for horizontal luminance scaling\n");
2589                 else
2590                     av_log(c, AV_LOG_VERBOSE, "using n-tap MMX scaler for horizontal luminance scaling\n");
2591
2592                 if (c->hChrFilterSize==4)
2593                     av_log(c, AV_LOG_VERBOSE, "using 4-tap MMX scaler for horizontal chrominance scaling\n");
2594                 else if (c->hChrFilterSize==8)
2595                     av_log(c, AV_LOG_VERBOSE, "using 8-tap MMX scaler for horizontal chrominance scaling\n");
2596                 else
2597                     av_log(c, AV_LOG_VERBOSE, "using n-tap MMX scaler for horizontal chrominance scaling\n");
2598             }
2599         }
2600         else
2601         {
2602 #if defined(ARCH_X86)
2603             av_log(c, AV_LOG_VERBOSE, "using X86-Asm scaler for horizontal scaling\n");
2604 #else
2605             if (flags & SWS_FAST_BILINEAR)
2606                 av_log(c, AV_LOG_VERBOSE, "using FAST_BILINEAR C scaler for horizontal scaling\n");
2607             else
2608                 av_log(c, AV_LOG_VERBOSE, "using C scaler for horizontal scaling\n");
2609 #endif
2610         }
2611         if (isPlanarYUV(dstFormat))
2612         {
2613             if (c->vLumFilterSize==1)
2614                 av_log(c, AV_LOG_VERBOSE, "using 1-tap %s \"scaler\" for vertical scaling (YV12 like)\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
2615             else
2616                 av_log(c, AV_LOG_VERBOSE, "using n-tap %s scaler for vertical scaling (YV12 like)\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
2617         }
2618         else
2619         {
2620             if (c->vLumFilterSize==1 && c->vChrFilterSize==2)
2621                 av_log(c, AV_LOG_VERBOSE, "using 1-tap %s \"scaler\" for vertical luminance scaling (BGR)\n"
2622                        "      2-tap scaler for vertical chrominance scaling (BGR)\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
2623             else if (c->vLumFilterSize==2 && c->vChrFilterSize==2)
2624                 av_log(c, AV_LOG_VERBOSE, "using 2-tap linear %s scaler for vertical scaling (BGR)\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
2625             else
2626                 av_log(c, AV_LOG_VERBOSE, "using n-tap %s scaler for vertical scaling (BGR)\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
2627         }
2628
2629         if (dstFormat==PIX_FMT_BGR24)
2630             av_log(c, AV_LOG_VERBOSE, "using %s YV12->BGR24 Converter\n",
2631                    (flags & SWS_CPU_CAPS_MMX2) ? "MMX2" : ((flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C"));
2632         else if (dstFormat==PIX_FMT_RGB32)
2633             av_log(c, AV_LOG_VERBOSE, "using %s YV12->BGR32 Converter\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
2634         else if (dstFormat==PIX_FMT_BGR565)
2635             av_log(c, AV_LOG_VERBOSE, "using %s YV12->BGR16 Converter\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
2636         else if (dstFormat==PIX_FMT_BGR555)
2637             av_log(c, AV_LOG_VERBOSE, "using %s YV12->BGR15 Converter\n", (flags & SWS_CPU_CAPS_MMX) ? "MMX" : "C");
2638
2639         av_log(c, AV_LOG_VERBOSE, "%dx%d -> %dx%d\n", srcW, srcH, dstW, dstH);
2640     }
2641     if (flags & SWS_PRINT_INFO)
2642     {
2643         av_log(c, AV_LOG_DEBUG, "Lum srcW=%d srcH=%d dstW=%d dstH=%d xInc=%d yInc=%d\n",
2644                c->srcW, c->srcH, c->dstW, c->dstH, c->lumXInc, c->lumYInc);
2645         av_log(c, AV_LOG_DEBUG, "Chr srcW=%d srcH=%d dstW=%d dstH=%d xInc=%d yInc=%d\n",
2646                c->chrSrcW, c->chrSrcH, c->chrDstW, c->chrDstH, c->chrXInc, c->chrYInc);
2647     }
2648
2649     c->swScale= getSwsFunc(flags);
2650     return c;
2651 }
2652
2653 /**
2654  * swscale wrapper, so we don't need to export the SwsContext.
2655  * assumes planar YUV to be in YUV order instead of YVU
2656  */
2657 int sws_scale(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
2658               int srcSliceH, uint8_t* dst[], int dstStride[]){
2659     int i;
2660     uint8_t* src2[4]= {src[0], src[1], src[2]};
2661     uint32_t pal[256];
2662     int use_pal=   c->srcFormat == PIX_FMT_PAL8
2663                 || c->srcFormat == PIX_FMT_BGR4_BYTE
2664                 || c->srcFormat == PIX_FMT_RGB4_BYTE
2665                 || c->srcFormat == PIX_FMT_BGR8
2666                 || c->srcFormat == PIX_FMT_RGB8;
2667
2668     if (c->sliceDir == 0 && srcSliceY != 0 && srcSliceY + srcSliceH != c->srcH) {
2669         av_log(c, AV_LOG_ERROR, "Slices start in the middle!\n");
2670         return 0;
2671     }
2672     if (c->sliceDir == 0) {
2673         if (srcSliceY == 0) c->sliceDir = 1; else c->sliceDir = -1;
2674     }
2675
2676     if (use_pal){
2677         for (i=0; i<256; i++){
2678             int p, r, g, b,y,u,v;
2679             if(c->srcFormat == PIX_FMT_PAL8){
2680                 p=((uint32_t*)(src[1]))[i];
2681                 r= (p>>16)&0xFF;
2682                 g= (p>> 8)&0xFF;
2683                 b=  p     &0xFF;
2684             }else if(c->srcFormat == PIX_FMT_RGB8){
2685                 r= (i>>5    )*36;
2686                 g= ((i>>2)&7)*36;
2687                 b= (i&3     )*85;
2688             }else if(c->srcFormat == PIX_FMT_BGR8){
2689                 b= (i>>6    )*85;
2690                 g= ((i>>3)&7)*36;
2691                 r= (i&7     )*36;
2692             }else if(c->srcFormat == PIX_FMT_RGB4_BYTE){
2693                 r= (i>>3    )*255;
2694                 g= ((i>>1)&3)*85;
2695                 b= (i&1     )*255;
2696             }else if(c->srcFormat == PIX_FMT_BGR4_BYTE){
2697                 b= (i>>3    )*255;
2698                 g= ((i>>1)&3)*85;
2699                 r= (i&1     )*255;
2700             }
2701             y= av_clip_uint8((RY*r + GY*g + BY*b + ( 33<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT);
2702             u= av_clip_uint8((RU*r + GU*g + BU*b + (257<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT);
2703             v= av_clip_uint8((RV*r + GV*g + BV*b + (257<<(RGB2YUV_SHIFT-1)))>>RGB2YUV_SHIFT);
2704             pal[i]= y + (u<<8) + (v<<16);
2705         }
2706         src2[1]= (uint8_t*)pal;
2707     }
2708
2709     // copy strides, so they can safely be modified
2710     if (c->sliceDir == 1) {
2711         // slices go from top to bottom
2712         int srcStride2[4]= {srcStride[0], srcStride[1], srcStride[2]};
2713         int dstStride2[4]= {dstStride[0], dstStride[1], dstStride[2]};
2714         return c->swScale(c, src2, srcStride2, srcSliceY, srcSliceH, dst, dstStride2);
2715     } else {
2716         // slices go from bottom to top => we flip the image internally
2717         uint8_t* dst2[4]= {dst[0] + (c->dstH-1)*dstStride[0],
2718                            dst[1] + ((c->dstH>>c->chrDstVSubSample)-1)*dstStride[1],
2719                            dst[2] + ((c->dstH>>c->chrDstVSubSample)-1)*dstStride[2]};
2720         int srcStride2[4]= {-srcStride[0], -srcStride[1], -srcStride[2]};
2721         int dstStride2[4]= {-dstStride[0], -dstStride[1], -dstStride[2]};
2722
2723         src2[0] += (srcSliceH-1)*srcStride[0];
2724         if (!use_pal)
2725             src2[1] += ((srcSliceH>>c->chrSrcVSubSample)-1)*srcStride[1];
2726         src2[2] += ((srcSliceH>>c->chrSrcVSubSample)-1)*srcStride[2];
2727
2728         return c->swScale(c, src2, srcStride2, c->srcH-srcSliceY-srcSliceH, srcSliceH, dst2, dstStride2);
2729     }
2730 }
2731
2732 /**
2733  * swscale wrapper, so we don't need to export the SwsContext
2734  */
2735 int sws_scale_ordered(SwsContext *c, uint8_t* src[], int srcStride[], int srcSliceY,
2736                       int srcSliceH, uint8_t* dst[], int dstStride[]){
2737     return sws_scale(c, src, srcStride, srcSliceY, srcSliceH, dst, dstStride);
2738 }
2739
2740 SwsFilter *sws_getDefaultFilter(float lumaGBlur, float chromaGBlur,
2741                                 float lumaSharpen, float chromaSharpen,
2742                                 float chromaHShift, float chromaVShift,
2743                                 int verbose)
2744 {
2745     SwsFilter *filter= av_malloc(sizeof(SwsFilter));
2746
2747     if (lumaGBlur!=0.0){
2748         filter->lumH= sws_getGaussianVec(lumaGBlur, 3.0);
2749         filter->lumV= sws_getGaussianVec(lumaGBlur, 3.0);
2750     }else{
2751         filter->lumH= sws_getIdentityVec();
2752         filter->lumV= sws_getIdentityVec();
2753     }
2754
2755     if (chromaGBlur!=0.0){
2756         filter->chrH= sws_getGaussianVec(chromaGBlur, 3.0);
2757         filter->chrV= sws_getGaussianVec(chromaGBlur, 3.0);
2758     }else{
2759         filter->chrH= sws_getIdentityVec();
2760         filter->chrV= sws_getIdentityVec();
2761     }
2762
2763     if (chromaSharpen!=0.0){
2764         SwsVector *id= sws_getIdentityVec();
2765         sws_scaleVec(filter->chrH, -chromaSharpen);
2766         sws_scaleVec(filter->chrV, -chromaSharpen);
2767         sws_addVec(filter->chrH, id);
2768         sws_addVec(filter->chrV, id);
2769         sws_freeVec(id);
2770     }
2771
2772     if (lumaSharpen!=0.0){
2773         SwsVector *id= sws_getIdentityVec();
2774         sws_scaleVec(filter->lumH, -lumaSharpen);
2775         sws_scaleVec(filter->lumV, -lumaSharpen);
2776         sws_addVec(filter->lumH, id);
2777         sws_addVec(filter->lumV, id);
2778         sws_freeVec(id);
2779     }
2780
2781     if (chromaHShift != 0.0)
2782         sws_shiftVec(filter->chrH, (int)(chromaHShift+0.5));
2783
2784     if (chromaVShift != 0.0)
2785         sws_shiftVec(filter->chrV, (int)(chromaVShift+0.5));
2786
2787     sws_normalizeVec(filter->chrH, 1.0);
2788     sws_normalizeVec(filter->chrV, 1.0);
2789     sws_normalizeVec(filter->lumH, 1.0);
2790     sws_normalizeVec(filter->lumV, 1.0);
2791
2792     if (verbose) sws_printVec(filter->chrH);
2793     if (verbose) sws_printVec(filter->lumH);
2794
2795     return filter;
2796 }
2797
2798 /**
2799  * returns a normalized gaussian curve used to filter stuff
2800  * quality=3 is high quality, lowwer is lowwer quality
2801  */
2802 SwsVector *sws_getGaussianVec(double variance, double quality){
2803     const int length= (int)(variance*quality + 0.5) | 1;
2804     int i;
2805     double *coeff= av_malloc(length*sizeof(double));
2806     double middle= (length-1)*0.5;
2807     SwsVector *vec= av_malloc(sizeof(SwsVector));
2808
2809     vec->coeff= coeff;
2810     vec->length= length;
2811
2812     for (i=0; i<length; i++)
2813     {
2814         double dist= i-middle;
2815         coeff[i]= exp(-dist*dist/(2*variance*variance)) / sqrt(2*variance*PI);
2816     }
2817
2818     sws_normalizeVec(vec, 1.0);
2819
2820     return vec;
2821 }
2822
2823 SwsVector *sws_getConstVec(double c, int length){
2824     int i;
2825     double *coeff= av_malloc(length*sizeof(double));
2826     SwsVector *vec= av_malloc(sizeof(SwsVector));
2827
2828     vec->coeff= coeff;
2829     vec->length= length;
2830
2831     for (i=0; i<length; i++)
2832         coeff[i]= c;
2833
2834     return vec;
2835 }
2836
2837
2838 SwsVector *sws_getIdentityVec(void){
2839     return sws_getConstVec(1.0, 1);
2840 }
2841
2842 double sws_dcVec(SwsVector *a){
2843     int i;
2844     double sum=0;
2845
2846     for (i=0; i<a->length; i++)
2847         sum+= a->coeff[i];
2848
2849     return sum;
2850 }
2851
2852 void sws_scaleVec(SwsVector *a, double scalar){
2853     int i;
2854
2855     for (i=0; i<a->length; i++)
2856         a->coeff[i]*= scalar;
2857 }
2858
2859 void sws_normalizeVec(SwsVector *a, double height){
2860     sws_scaleVec(a, height/sws_dcVec(a));
2861 }
2862
2863 static SwsVector *sws_getConvVec(SwsVector *a, SwsVector *b){
2864     int length= a->length + b->length - 1;
2865     double *coeff= av_malloc(length*sizeof(double));
2866     int i, j;
2867     SwsVector *vec= av_malloc(sizeof(SwsVector));
2868
2869     vec->coeff= coeff;
2870     vec->length= length;
2871
2872     for (i=0; i<length; i++) coeff[i]= 0.0;
2873
2874     for (i=0; i<a->length; i++)
2875     {
2876         for (j=0; j<b->length; j++)
2877         {
2878             coeff[i+j]+= a->coeff[i]*b->coeff[j];
2879         }
2880     }
2881
2882     return vec;
2883 }
2884
2885 static SwsVector *sws_sumVec(SwsVector *a, SwsVector *b){
2886     int length= FFMAX(a->length, b->length);
2887     double *coeff= av_malloc(length*sizeof(double));
2888     int i;
2889     SwsVector *vec= av_malloc(sizeof(SwsVector));
2890
2891     vec->coeff= coeff;
2892     vec->length= length;
2893
2894     for (i=0; i<length; i++) coeff[i]= 0.0;
2895
2896     for (i=0; i<a->length; i++) coeff[i + (length-1)/2 - (a->length-1)/2]+= a->coeff[i];
2897     for (i=0; i<b->length; i++) coeff[i + (length-1)/2 - (b->length-1)/2]+= b->coeff[i];
2898
2899     return vec;
2900 }
2901
2902 static SwsVector *sws_diffVec(SwsVector *a, SwsVector *b){
2903     int length= FFMAX(a->length, b->length);
2904     double *coeff= av_malloc(length*sizeof(double));
2905     int i;
2906     SwsVector *vec= av_malloc(sizeof(SwsVector));
2907
2908     vec->coeff= coeff;
2909     vec->length= length;
2910
2911     for (i=0; i<length; i++) coeff[i]= 0.0;
2912
2913     for (i=0; i<a->length; i++) coeff[i + (length-1)/2 - (a->length-1)/2]+= a->coeff[i];
2914     for (i=0; i<b->length; i++) coeff[i + (length-1)/2 - (b->length-1)/2]-= b->coeff[i];
2915
2916     return vec;
2917 }
2918
2919 /* shift left / or right if "shift" is negative */
2920 static SwsVector *sws_getShiftedVec(SwsVector *a, int shift){
2921     int length= a->length + FFABS(shift)*2;
2922     double *coeff= av_malloc(length*sizeof(double));
2923     int i;
2924     SwsVector *vec= av_malloc(sizeof(SwsVector));
2925
2926     vec->coeff= coeff;
2927     vec->length= length;
2928
2929     for (i=0; i<length; i++) coeff[i]= 0.0;
2930
2931     for (i=0; i<a->length; i++)
2932     {
2933         coeff[i + (length-1)/2 - (a->length-1)/2 - shift]= a->coeff[i];
2934     }
2935
2936     return vec;
2937 }
2938
2939 void sws_shiftVec(SwsVector *a, int shift){
2940     SwsVector *shifted= sws_getShiftedVec(a, shift);
2941     av_free(a->coeff);
2942     a->coeff= shifted->coeff;
2943     a->length= shifted->length;
2944     av_free(shifted);
2945 }
2946
2947 void sws_addVec(SwsVector *a, SwsVector *b){
2948     SwsVector *sum= sws_sumVec(a, b);
2949     av_free(a->coeff);
2950     a->coeff= sum->coeff;
2951     a->length= sum->length;
2952     av_free(sum);
2953 }
2954
2955 void sws_subVec(SwsVector *a, SwsVector *b){
2956     SwsVector *diff= sws_diffVec(a, b);
2957     av_free(a->coeff);
2958     a->coeff= diff->coeff;
2959     a->length= diff->length;
2960     av_free(diff);
2961 }
2962
2963 void sws_convVec(SwsVector *a, SwsVector *b){
2964     SwsVector *conv= sws_getConvVec(a, b);
2965     av_free(a->coeff);
2966     a->coeff= conv->coeff;
2967     a->length= conv->length;
2968     av_free(conv);
2969 }
2970
2971 SwsVector *sws_cloneVec(SwsVector *a){
2972     double *coeff= av_malloc(a->length*sizeof(double));
2973     int i;
2974     SwsVector *vec= av_malloc(sizeof(SwsVector));
2975
2976     vec->coeff= coeff;
2977     vec->length= a->length;
2978
2979     for (i=0; i<a->length; i++) coeff[i]= a->coeff[i];
2980
2981     return vec;
2982 }
2983
2984 void sws_printVec(SwsVector *a){
2985     int i;
2986     double max=0;
2987     double min=0;
2988     double range;
2989
2990     for (i=0; i<a->length; i++)
2991         if (a->coeff[i]>max) max= a->coeff[i];
2992
2993     for (i=0; i<a->length; i++)
2994         if (a->coeff[i]<min) min= a->coeff[i];
2995
2996     range= max - min;
2997
2998     for (i=0; i<a->length; i++)
2999     {
3000         int x= (int)((a->coeff[i]-min)*60.0/range +0.5);
3001         av_log(NULL, AV_LOG_DEBUG, "%1.3f ", a->coeff[i]);
3002         for (;x>0; x--) av_log(NULL, AV_LOG_DEBUG, " ");
3003         av_log(NULL, AV_LOG_DEBUG, "|\n");
3004     }
3005 }
3006
3007 void sws_freeVec(SwsVector *a){
3008     if (!a) return;
3009     av_freep(&a->coeff);
3010     a->length=0;
3011     av_free(a);
3012 }
3013
3014 void sws_freeFilter(SwsFilter *filter){
3015     if (!filter) return;
3016
3017     if (filter->lumH) sws_freeVec(filter->lumH);
3018     if (filter->lumV) sws_freeVec(filter->lumV);
3019     if (filter->chrH) sws_freeVec(filter->chrH);
3020     if (filter->chrV) sws_freeVec(filter->chrV);
3021     av_free(filter);
3022 }
3023
3024
3025 void sws_freeContext(SwsContext *c){
3026     int i;
3027     if (!c) return;
3028
3029     if (c->lumPixBuf)
3030     {
3031         for (i=0; i<c->vLumBufSize; i++)
3032             av_freep(&c->lumPixBuf[i]);
3033         av_freep(&c->lumPixBuf);
3034     }
3035
3036     if (c->chrPixBuf)
3037     {
3038         for (i=0; i<c->vChrBufSize; i++)
3039             av_freep(&c->chrPixBuf[i]);
3040         av_freep(&c->chrPixBuf);
3041     }
3042
3043     av_freep(&c->vLumFilter);
3044     av_freep(&c->vChrFilter);
3045     av_freep(&c->hLumFilter);
3046     av_freep(&c->hChrFilter);
3047 #ifdef HAVE_ALTIVEC
3048     av_freep(&c->vYCoeffsBank);
3049     av_freep(&c->vCCoeffsBank);
3050 #endif
3051
3052     av_freep(&c->vLumFilterPos);
3053     av_freep(&c->vChrFilterPos);
3054     av_freep(&c->hLumFilterPos);
3055     av_freep(&c->hChrFilterPos);
3056
3057 #if defined(ARCH_X86) && defined(CONFIG_GPL)
3058 #ifdef MAP_ANONYMOUS
3059     if (c->funnyYCode) munmap(c->funnyYCode, MAX_FUNNY_CODE_SIZE);
3060     if (c->funnyUVCode) munmap(c->funnyUVCode, MAX_FUNNY_CODE_SIZE);
3061 #else
3062     av_free(c->funnyYCode);
3063     av_free(c->funnyUVCode);
3064 #endif
3065     c->funnyYCode=NULL;
3066     c->funnyUVCode=NULL;
3067 #endif /* defined(ARCH_X86) */
3068
3069     av_freep(&c->lumMmx2Filter);
3070     av_freep(&c->chrMmx2Filter);
3071     av_freep(&c->lumMmx2FilterPos);
3072     av_freep(&c->chrMmx2FilterPos);
3073     av_freep(&c->yuvTable);
3074
3075     av_free(c);
3076 }
3077
3078 /**
3079  * Checks if context is valid or reallocs a new one instead.
3080  * If context is NULL, just calls sws_getContext() to get a new one.
3081  * Otherwise, checks if the parameters are the same already saved in context.
3082  * If that is the case, returns the current context.
3083  * Otherwise, frees context and gets a new one.
3084  *
3085  * Be warned that srcFilter, dstFilter are not checked, they are
3086  * asumed to remain valid.
3087  */
3088 struct SwsContext *sws_getCachedContext(struct SwsContext *context,
3089                                         int srcW, int srcH, int srcFormat,
3090                                         int dstW, int dstH, int dstFormat, int flags,
3091                                         SwsFilter *srcFilter, SwsFilter *dstFilter, double *param)
3092 {
3093     static const double default_param[2] = {SWS_PARAM_DEFAULT, SWS_PARAM_DEFAULT};
3094
3095     if (!param)
3096         param = default_param;
3097
3098     if (context) {
3099         if (context->srcW != srcW || context->srcH != srcH ||
3100             context->srcFormat != srcFormat ||
3101             context->dstW != dstW || context->dstH != dstH ||
3102             context->dstFormat != dstFormat || context->flags != flags ||
3103             context->param[0] != param[0] || context->param[1] != param[1])
3104         {
3105             sws_freeContext(context);
3106             context = NULL;
3107         }
3108     }
3109     if (!context) {
3110         return sws_getContext(srcW, srcH, srcFormat,
3111                               dstW, dstH, dstFormat, flags,
3112                               srcFilter, dstFilter, param);
3113     }
3114     return context;
3115 }
3116