Merge commit 'b7f1010c8fce09096057528f7cd29589ea1ae7df'
[ffmpeg.git] / libswscale / utils.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
7  * modify it under the terms of the GNU Lesser General Public
8  * License as published by the Free Software Foundation; either
9  * version 2.1 of the License, or (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 GNU
14  * Lesser General Public License for more details.
15  *
16  * You should have received a copy of the GNU Lesser General Public
17  * License 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
21 #include "config.h"
22
23 #define _SVID_SOURCE // needed for MAP_ANONYMOUS
24 #define _DARWIN_C_SOURCE // needed for MAP_ANON
25 #include <inttypes.h>
26 #include <math.h>
27 #include <stdio.h>
28 #include <string.h>
29 #if HAVE_SYS_MMAN_H
30 #include <sys/mman.h>
31 #if defined(MAP_ANON) && !defined(MAP_ANONYMOUS)
32 #define MAP_ANONYMOUS MAP_ANON
33 #endif
34 #endif
35 #if HAVE_VIRTUALALLOC
36 #define WIN32_LEAN_AND_MEAN
37 #include <windows.h>
38 #endif
39
40 #include "libavutil/attributes.h"
41 #include "libavutil/avassert.h"
42 #include "libavutil/avutil.h"
43 #include "libavutil/bswap.h"
44 #include "libavutil/cpu.h"
45 #include "libavutil/intreadwrite.h"
46 #include "libavutil/mathematics.h"
47 #include "libavutil/opt.h"
48 #include "libavutil/pixdesc.h"
49 #include "libavutil/x86/asm.h"
50 #include "libavutil/x86/cpu.h"
51 #include "rgb2rgb.h"
52 #include "swscale.h"
53 #include "swscale_internal.h"
54
55 unsigned swscale_version(void)
56 {
57     av_assert0(LIBSWSCALE_VERSION_MICRO >= 100);
58     return LIBSWSCALE_VERSION_INT;
59 }
60
61 const char *swscale_configuration(void)
62 {
63     return FFMPEG_CONFIGURATION;
64 }
65
66 const char *swscale_license(void)
67 {
68 #define LICENSE_PREFIX "libswscale license: "
69     return LICENSE_PREFIX FFMPEG_LICENSE + sizeof(LICENSE_PREFIX) - 1;
70 }
71
72 #define RET 0xC3 // near return opcode for x86
73
74 typedef struct FormatEntry {
75     int is_supported_in, is_supported_out;
76 } FormatEntry;
77
78 static const FormatEntry format_entries[AV_PIX_FMT_NB] = {
79     [AV_PIX_FMT_YUV420P]     = { 1, 1 },
80     [AV_PIX_FMT_YUYV422]     = { 1, 1 },
81     [AV_PIX_FMT_RGB24]       = { 1, 1 },
82     [AV_PIX_FMT_BGR24]       = { 1, 1 },
83     [AV_PIX_FMT_YUV422P]     = { 1, 1 },
84     [AV_PIX_FMT_YUV444P]     = { 1, 1 },
85     [AV_PIX_FMT_YUV410P]     = { 1, 1 },
86     [AV_PIX_FMT_YUV411P]     = { 1, 1 },
87     [AV_PIX_FMT_GRAY8]       = { 1, 1 },
88     [AV_PIX_FMT_MONOWHITE]   = { 1, 1 },
89     [AV_PIX_FMT_MONOBLACK]   = { 1, 1 },
90     [AV_PIX_FMT_PAL8]        = { 1, 0 },
91     [AV_PIX_FMT_YUVJ420P]    = { 1, 1 },
92     [AV_PIX_FMT_YUVJ422P]    = { 1, 1 },
93     [AV_PIX_FMT_YUVJ444P]    = { 1, 1 },
94     [AV_PIX_FMT_UYVY422]     = { 1, 1 },
95     [AV_PIX_FMT_UYYVYY411]   = { 0, 0 },
96     [AV_PIX_FMT_BGR8]        = { 1, 1 },
97     [AV_PIX_FMT_BGR4]        = { 0, 1 },
98     [AV_PIX_FMT_BGR4_BYTE]   = { 1, 1 },
99     [AV_PIX_FMT_RGB8]        = { 1, 1 },
100     [AV_PIX_FMT_RGB4]        = { 0, 1 },
101     [AV_PIX_FMT_RGB4_BYTE]   = { 1, 1 },
102     [AV_PIX_FMT_NV12]        = { 1, 1 },
103     [AV_PIX_FMT_NV21]        = { 1, 1 },
104     [AV_PIX_FMT_ARGB]        = { 1, 1 },
105     [AV_PIX_FMT_RGBA]        = { 1, 1 },
106     [AV_PIX_FMT_ABGR]        = { 1, 1 },
107     [AV_PIX_FMT_BGRA]        = { 1, 1 },
108     [AV_PIX_FMT_0RGB]        = { 1, 1 },
109     [AV_PIX_FMT_RGB0]        = { 1, 1 },
110     [AV_PIX_FMT_0BGR]        = { 1, 1 },
111     [AV_PIX_FMT_BGR0]        = { 1, 1 },
112     [AV_PIX_FMT_GRAY16BE]    = { 1, 1 },
113     [AV_PIX_FMT_GRAY16LE]    = { 1, 1 },
114     [AV_PIX_FMT_YUV440P]     = { 1, 1 },
115     [AV_PIX_FMT_YUVJ440P]    = { 1, 1 },
116     [AV_PIX_FMT_YUVA420P]    = { 1, 1 },
117     [AV_PIX_FMT_YUVA422P]    = { 1, 1 },
118     [AV_PIX_FMT_YUVA444P]    = { 1, 1 },
119     [AV_PIX_FMT_RGB48BE]     = { 1, 1 },
120     [AV_PIX_FMT_RGB48LE]     = { 1, 1 },
121     [AV_PIX_FMT_RGBA64BE]    = { 1, 0 },
122     [AV_PIX_FMT_RGBA64LE]    = { 1, 0 },
123     [AV_PIX_FMT_RGB565BE]    = { 1, 1 },
124     [AV_PIX_FMT_RGB565LE]    = { 1, 1 },
125     [AV_PIX_FMT_RGB555BE]    = { 1, 1 },
126     [AV_PIX_FMT_RGB555LE]    = { 1, 1 },
127     [AV_PIX_FMT_BGR565BE]    = { 1, 1 },
128     [AV_PIX_FMT_BGR565LE]    = { 1, 1 },
129     [AV_PIX_FMT_BGR555BE]    = { 1, 1 },
130     [AV_PIX_FMT_BGR555LE]    = { 1, 1 },
131     [AV_PIX_FMT_YUV420P16LE] = { 1, 1 },
132     [AV_PIX_FMT_YUV420P16BE] = { 1, 1 },
133     [AV_PIX_FMT_YUV422P16LE] = { 1, 1 },
134     [AV_PIX_FMT_YUV422P16BE] = { 1, 1 },
135     [AV_PIX_FMT_YUV444P16LE] = { 1, 1 },
136     [AV_PIX_FMT_YUV444P16BE] = { 1, 1 },
137     [AV_PIX_FMT_RGB444LE]    = { 1, 1 },
138     [AV_PIX_FMT_RGB444BE]    = { 1, 1 },
139     [AV_PIX_FMT_BGR444LE]    = { 1, 1 },
140     [AV_PIX_FMT_BGR444BE]    = { 1, 1 },
141     [AV_PIX_FMT_Y400A]       = { 1, 0 },
142     [AV_PIX_FMT_BGR48BE]     = { 1, 1 },
143     [AV_PIX_FMT_BGR48LE]     = { 1, 1 },
144     [AV_PIX_FMT_BGRA64BE]    = { 0, 0 },
145     [AV_PIX_FMT_BGRA64LE]    = { 0, 0 },
146     [AV_PIX_FMT_YUV420P9BE]  = { 1, 1 },
147     [AV_PIX_FMT_YUV420P9LE]  = { 1, 1 },
148     [AV_PIX_FMT_YUV420P10BE] = { 1, 1 },
149     [AV_PIX_FMT_YUV420P10LE] = { 1, 1 },
150     [AV_PIX_FMT_YUV420P12BE] = { 1, 1 },
151     [AV_PIX_FMT_YUV420P12LE] = { 1, 1 },
152     [AV_PIX_FMT_YUV420P14BE] = { 1, 1 },
153     [AV_PIX_FMT_YUV420P14LE] = { 1, 1 },
154     [AV_PIX_FMT_YUV422P9BE]  = { 1, 1 },
155     [AV_PIX_FMT_YUV422P9LE]  = { 1, 1 },
156     [AV_PIX_FMT_YUV422P10BE] = { 1, 1 },
157     [AV_PIX_FMT_YUV422P10LE] = { 1, 1 },
158     [AV_PIX_FMT_YUV422P12BE] = { 1, 1 },
159     [AV_PIX_FMT_YUV422P12LE] = { 1, 1 },
160     [AV_PIX_FMT_YUV422P14BE] = { 1, 1 },
161     [AV_PIX_FMT_YUV422P14LE] = { 1, 1 },
162     [AV_PIX_FMT_YUV444P9BE]  = { 1, 1 },
163     [AV_PIX_FMT_YUV444P9LE]  = { 1, 1 },
164     [AV_PIX_FMT_YUV444P10BE] = { 1, 1 },
165     [AV_PIX_FMT_YUV444P10LE] = { 1, 1 },
166     [AV_PIX_FMT_YUV444P12BE] = { 1, 1 },
167     [AV_PIX_FMT_YUV444P12LE] = { 1, 1 },
168     [AV_PIX_FMT_YUV444P14BE] = { 1, 1 },
169     [AV_PIX_FMT_YUV444P14LE] = { 1, 1 },
170     [AV_PIX_FMT_GBRP]        = { 1, 0 },
171     [AV_PIX_FMT_GBRP9LE]     = { 1, 0 },
172     [AV_PIX_FMT_GBRP9BE]     = { 1, 0 },
173     [AV_PIX_FMT_GBRP10LE]    = { 1, 0 },
174     [AV_PIX_FMT_GBRP10BE]    = { 1, 0 },
175     [AV_PIX_FMT_GBRP12LE]    = { 1, 0 },
176     [AV_PIX_FMT_GBRP12BE]    = { 1, 0 },
177     [AV_PIX_FMT_GBRP14LE]    = { 1, 0 },
178     [AV_PIX_FMT_GBRP14BE]    = { 1, 0 },
179     [AV_PIX_FMT_GBRP16LE]    = { 1, 0 },
180     [AV_PIX_FMT_GBRP16BE]    = { 1, 0 },
181 };
182
183 int sws_isSupportedInput(enum AVPixelFormat pix_fmt)
184 {
185     return (unsigned)pix_fmt < AV_PIX_FMT_NB ?
186            format_entries[pix_fmt].is_supported_in : 0;
187 }
188
189 int sws_isSupportedOutput(enum AVPixelFormat pix_fmt)
190 {
191     return (unsigned)pix_fmt < AV_PIX_FMT_NB ?
192            format_entries[pix_fmt].is_supported_out : 0;
193 }
194
195 extern const int32_t ff_yuv2rgb_coeffs[8][4];
196
197 #if FF_API_SWS_FORMAT_NAME
198 const char *sws_format_name(enum AVPixelFormat format)
199 {
200     return av_get_pix_fmt_name(format);
201 }
202 #endif
203
204 static double getSplineCoeff(double a, double b, double c, double d,
205                              double dist)
206 {
207     if (dist <= 1.0)
208         return ((d * dist + c) * dist + b) * dist + a;
209     else
210         return getSplineCoeff(0.0,
211                                b + 2.0 * c + 3.0 * d,
212                                c + 3.0 * d,
213                               -b - 3.0 * c - 6.0 * d,
214                               dist - 1.0);
215 }
216
217 static int initFilter(int16_t **outFilter, int32_t **filterPos,
218                       int *outFilterSize, int xInc, int srcW, int dstW,
219                       int filterAlign, int one, int flags, int cpu_flags,
220                       SwsVector *srcFilter, SwsVector *dstFilter,
221                       double param[2])
222 {
223     int i;
224     int filterSize;
225     int filter2Size;
226     int minFilterSize;
227     int64_t *filter    = NULL;
228     int64_t *filter2   = NULL;
229     const int64_t fone = 1LL << 54;
230     int ret            = -1;
231
232     emms_c(); // FIXME should not be required but IS (even for non-MMX versions)
233
234     // NOTE: the +3 is for the MMX(+1) / SSE(+3) scaler which reads over the end
235     FF_ALLOC_OR_GOTO(NULL, *filterPos, (dstW + 3) * sizeof(**filterPos), fail);
236
237     if (FFABS(xInc - 0x10000) < 10) { // unscaled
238         int i;
239         filterSize = 1;
240         FF_ALLOCZ_OR_GOTO(NULL, filter,
241                           dstW * sizeof(*filter) * filterSize, fail);
242
243         for (i = 0; i < dstW; i++) {
244             filter[i * filterSize] = fone;
245             (*filterPos)[i]        = i;
246         }
247     } else if (flags & SWS_POINT) { // lame looking point sampling mode
248         int i;
249         int64_t xDstInSrc;
250         filterSize = 1;
251         FF_ALLOC_OR_GOTO(NULL, filter,
252                          dstW * sizeof(*filter) * filterSize, fail);
253
254         xDstInSrc = xInc / 2 - 0x8000;
255         for (i = 0; i < dstW; i++) {
256             int xx = (xDstInSrc - ((filterSize - 1) << 15) + (1 << 15)) >> 16;
257
258             (*filterPos)[i] = xx;
259             filter[i]       = fone;
260             xDstInSrc      += xInc;
261         }
262     } else if ((xInc <= (1 << 16) && (flags & SWS_AREA)) ||
263                (flags & SWS_FAST_BILINEAR)) { // bilinear upscale
264         int i;
265         int64_t xDstInSrc;
266         filterSize = 2;
267         FF_ALLOC_OR_GOTO(NULL, filter,
268                          dstW * sizeof(*filter) * filterSize, fail);
269
270         xDstInSrc = xInc / 2 - 0x8000;
271         for (i = 0; i < dstW; i++) {
272             int xx = (xDstInSrc - ((filterSize - 1) << 15) + (1 << 15)) >> 16;
273             int j;
274
275             (*filterPos)[i] = xx;
276             // bilinear upscale / linear interpolate / area averaging
277             for (j = 0; j < filterSize; j++) {
278                 int64_t coeff= fone - FFABS(((int64_t)xx<<16) - xDstInSrc)*(fone>>16);
279                 if (coeff < 0)
280                     coeff = 0;
281                 filter[i * filterSize + j] = coeff;
282                 xx++;
283             }
284             xDstInSrc += xInc;
285         }
286     } else {
287         int64_t xDstInSrc;
288         int sizeFactor;
289
290         if (flags & SWS_BICUBIC)
291             sizeFactor = 4;
292         else if (flags & SWS_X)
293             sizeFactor = 8;
294         else if (flags & SWS_AREA)
295             sizeFactor = 1;     // downscale only, for upscale it is bilinear
296         else if (flags & SWS_GAUSS)
297             sizeFactor = 8;     // infinite ;)
298         else if (flags & SWS_LANCZOS)
299             sizeFactor = param[0] != SWS_PARAM_DEFAULT ? ceil(2 * param[0]) : 6;
300         else if (flags & SWS_SINC)
301             sizeFactor = 20;    // infinite ;)
302         else if (flags & SWS_SPLINE)
303             sizeFactor = 20;    // infinite ;)
304         else if (flags & SWS_BILINEAR)
305             sizeFactor = 2;
306         else {
307             av_assert0(0);
308         }
309
310         if (xInc <= 1 << 16)
311             filterSize = 1 + sizeFactor;    // upscale
312         else
313             filterSize = 1 + (sizeFactor * srcW + dstW - 1) / dstW;
314
315         filterSize = FFMIN(filterSize, srcW - 2);
316         filterSize = FFMAX(filterSize, 1);
317
318         FF_ALLOC_OR_GOTO(NULL, filter,
319                          dstW * sizeof(*filter) * filterSize, fail);
320
321         xDstInSrc = xInc - 0x10000;
322         for (i = 0; i < dstW; i++) {
323             int xx = (xDstInSrc - ((filterSize - 2) << 16)) / (1 << 17);
324             int j;
325             (*filterPos)[i] = xx;
326             for (j = 0; j < filterSize; j++) {
327                 int64_t d = (FFABS(((int64_t)xx << 17) - xDstInSrc)) << 13;
328                 double floatd;
329                 int64_t coeff;
330
331                 if (xInc > 1 << 16)
332                     d = d * dstW / srcW;
333                 floatd = d * (1.0 / (1 << 30));
334
335                 if (flags & SWS_BICUBIC) {
336                     int64_t B = (param[0] != SWS_PARAM_DEFAULT ? param[0] :   0) * (1 << 24);
337                     int64_t C = (param[1] != SWS_PARAM_DEFAULT ? param[1] : 0.6) * (1 << 24);
338
339                     if (d >= 1LL << 31) {
340                         coeff = 0.0;
341                     } else {
342                         int64_t dd  = (d  * d) >> 30;
343                         int64_t ddd = (dd * d) >> 30;
344
345                         if (d < 1LL << 30)
346                             coeff =  (12 * (1 << 24) -  9 * B - 6 * C) * ddd +
347                                     (-18 * (1 << 24) + 12 * B + 6 * C) *  dd +
348                                       (6 * (1 << 24) -  2 * B)         * (1 << 30);
349                         else
350                             coeff =      (-B -  6 * C) * ddd +
351                                       (6 * B + 30 * C) * dd  +
352                                     (-12 * B - 48 * C) * d   +
353                                       (8 * B + 24 * C) * (1 << 30);
354                     }
355                     coeff *= fone >> (30 + 24);
356                 }
357 #if 0
358                 else if (flags & SWS_X) {
359                     double p  = param ? param * 0.01 : 0.3;
360                     coeff     = d ? sin(d * M_PI) / (d * M_PI) : 1.0;
361                     coeff    *= pow(2.0, -p * d * d);
362                 }
363 #endif
364                 else if (flags & SWS_X) {
365                     double A = param[0] != SWS_PARAM_DEFAULT ? param[0] : 1.0;
366                     double c;
367
368                     if (floatd < 1.0)
369                         c = cos(floatd * M_PI);
370                     else
371                         c = -1.0;
372                     if (c < 0.0)
373                         c = -pow(-c, A);
374                     else
375                         c = pow(c, A);
376                     coeff = (c * 0.5 + 0.5) * fone;
377                 } else if (flags & SWS_AREA) {
378                     int64_t d2 = d - (1 << 29);
379                     if (d2 * xInc < -(1LL << (29 + 16)))
380                         coeff = 1.0 * (1LL << (30 + 16));
381                     else if (d2 * xInc < (1LL << (29 + 16)))
382                         coeff = -d2 * xInc + (1LL << (29 + 16));
383                     else
384                         coeff = 0.0;
385                     coeff *= fone >> (30 + 16);
386                 } else if (flags & SWS_GAUSS) {
387                     double p = param[0] != SWS_PARAM_DEFAULT ? param[0] : 3.0;
388                     coeff = (pow(2.0, -p * floatd * floatd)) * fone;
389                 } else if (flags & SWS_SINC) {
390                     coeff = (d ? sin(floatd * M_PI) / (floatd * M_PI) : 1.0) * fone;
391                 } else if (flags & SWS_LANCZOS) {
392                     double p = param[0] != SWS_PARAM_DEFAULT ? param[0] : 3.0;
393                     coeff = (d ? sin(floatd * M_PI) * sin(floatd * M_PI / p) /
394                              (floatd * floatd * M_PI * M_PI / p) : 1.0) * fone;
395                     if (floatd > p)
396                         coeff = 0;
397                 } else if (flags & SWS_BILINEAR) {
398                     coeff = (1 << 30) - d;
399                     if (coeff < 0)
400                         coeff = 0;
401                     coeff *= fone >> 30;
402                 } else if (flags & SWS_SPLINE) {
403                     double p = -2.196152422706632;
404                     coeff = getSplineCoeff(1.0, 0.0, p, -p - 1.0, floatd) * fone;
405                 } else {
406                     av_assert0(0);
407                 }
408
409                 filter[i * filterSize + j] = coeff;
410                 xx++;
411             }
412             xDstInSrc += 2 * xInc;
413         }
414     }
415
416     /* apply src & dst Filter to filter -> filter2
417      * av_free(filter);
418      */
419     av_assert0(filterSize > 0);
420     filter2Size = filterSize;
421     if (srcFilter)
422         filter2Size += srcFilter->length - 1;
423     if (dstFilter)
424         filter2Size += dstFilter->length - 1;
425     av_assert0(filter2Size > 0);
426     FF_ALLOCZ_OR_GOTO(NULL, filter2, filter2Size * dstW * sizeof(*filter2), fail);
427
428     for (i = 0; i < dstW; i++) {
429         int j, k;
430
431         if (srcFilter) {
432             for (k = 0; k < srcFilter->length; k++) {
433                 for (j = 0; j < filterSize; j++)
434                     filter2[i * filter2Size + k + j] +=
435                         srcFilter->coeff[k] * filter[i * filterSize + j];
436             }
437         } else {
438             for (j = 0; j < filterSize; j++)
439                 filter2[i * filter2Size + j] = filter[i * filterSize + j];
440         }
441         // FIXME dstFilter
442
443         (*filterPos)[i] += (filterSize - 1) / 2 - (filter2Size - 1) / 2;
444     }
445     av_freep(&filter);
446
447     /* try to reduce the filter-size (step1 find size and shift left) */
448     // Assume it is near normalized (*0.5 or *2.0 is OK but * 0.001 is not).
449     minFilterSize = 0;
450     for (i = dstW - 1; i >= 0; i--) {
451         int min = filter2Size;
452         int j;
453         int64_t cutOff = 0.0;
454
455         /* get rid of near zero elements on the left by shifting left */
456         for (j = 0; j < filter2Size; j++) {
457             int k;
458             cutOff += FFABS(filter2[i * filter2Size]);
459
460             if (cutOff > SWS_MAX_REDUCE_CUTOFF * fone)
461                 break;
462
463             /* preserve monotonicity because the core can't handle the
464              * filter otherwise */
465             if (i < dstW - 1 && (*filterPos)[i] >= (*filterPos)[i + 1])
466                 break;
467
468             // move filter coefficients left
469             for (k = 1; k < filter2Size; k++)
470                 filter2[i * filter2Size + k - 1] = filter2[i * filter2Size + k];
471             filter2[i * filter2Size + k - 1] = 0;
472             (*filterPos)[i]++;
473         }
474
475         cutOff = 0;
476         /* count near zeros on the right */
477         for (j = filter2Size - 1; j > 0; j--) {
478             cutOff += FFABS(filter2[i * filter2Size + j]);
479
480             if (cutOff > SWS_MAX_REDUCE_CUTOFF * fone)
481                 break;
482             min--;
483         }
484
485         if (min > minFilterSize)
486             minFilterSize = min;
487     }
488
489     if (HAVE_ALTIVEC && cpu_flags & AV_CPU_FLAG_ALTIVEC) {
490         // we can handle the special case 4, so we don't want to go the full 8
491         if (minFilterSize < 5)
492             filterAlign = 4;
493
494         /* We really don't want to waste our time doing useless computation, so
495          * fall back on the scalar C code for very small filters.
496          * Vectorizing is worth it only if you have a decent-sized vector. */
497         if (minFilterSize < 3)
498             filterAlign = 1;
499     }
500
501     if (INLINE_MMX(cpu_flags)) {
502         // special case for unscaled vertical filtering
503         if (minFilterSize == 1 && filterAlign == 2)
504             filterAlign = 1;
505     }
506
507     av_assert0(minFilterSize > 0);
508     filterSize = (minFilterSize + (filterAlign - 1)) & (~(filterAlign - 1));
509     av_assert0(filterSize > 0);
510     filter = av_malloc(filterSize * dstW * sizeof(*filter));
511     if (filterSize >= MAX_FILTER_SIZE * 16 /
512                       ((flags & SWS_ACCURATE_RND) ? APCK_SIZE : 16) || !filter)
513         goto fail;
514     *outFilterSize = filterSize;
515
516     if (flags & SWS_PRINT_INFO)
517         av_log(NULL, AV_LOG_VERBOSE,
518                "SwScaler: reducing / aligning filtersize %d -> %d\n",
519                filter2Size, filterSize);
520     /* try to reduce the filter-size (step2 reduce it) */
521     for (i = 0; i < dstW; i++) {
522         int j;
523
524         for (j = 0; j < filterSize; j++) {
525             if (j >= filter2Size)
526                 filter[i * filterSize + j] = 0;
527             else
528                 filter[i * filterSize + j] = filter2[i * filter2Size + j];
529             if ((flags & SWS_BITEXACT) && j >= minFilterSize)
530                 filter[i * filterSize + j] = 0;
531         }
532     }
533
534     // FIXME try to align filterPos if possible
535
536     // fix borders
537     for (i = 0; i < dstW; i++) {
538         int j;
539         if ((*filterPos)[i] < 0) {
540             // move filter coefficients left to compensate for filterPos
541             for (j = 1; j < filterSize; j++) {
542                 int left = FFMAX(j + (*filterPos)[i], 0);
543                 filter[i * filterSize + left] += filter[i * filterSize + j];
544                 filter[i * filterSize + j]     = 0;
545             }
546             (*filterPos)[i]= 0;
547         }
548
549         if ((*filterPos)[i] + filterSize > srcW) {
550             int shift = (*filterPos)[i] + filterSize - srcW;
551             // move filter coefficients right to compensate for filterPos
552             for (j = filterSize - 2; j >= 0; j--) {
553                 int right = FFMIN(j + shift, filterSize - 1);
554                 filter[i * filterSize + right] += filter[i * filterSize + j];
555                 filter[i * filterSize + j]      = 0;
556             }
557             (*filterPos)[i]= srcW - filterSize;
558         }
559     }
560
561     // Note the +1 is for the MMX scaler which reads over the end
562     /* align at 16 for AltiVec (needed by hScale_altivec_real) */
563     FF_ALLOCZ_OR_GOTO(NULL, *outFilter,
564                       *outFilterSize * (dstW + 3) * sizeof(int16_t), fail);
565
566     /* normalize & store in outFilter */
567     for (i = 0; i < dstW; i++) {
568         int j;
569         int64_t error = 0;
570         int64_t sum   = 0;
571
572         for (j = 0; j < filterSize; j++) {
573             sum += filter[i * filterSize + j];
574         }
575         sum = (sum + one / 2) / one;
576         for (j = 0; j < *outFilterSize; j++) {
577             int64_t v = filter[i * filterSize + j] + error;
578             int intV  = ROUNDED_DIV(v, sum);
579             (*outFilter)[i * (*outFilterSize) + j] = intV;
580             error                                  = v - intV * sum;
581         }
582     }
583
584     (*filterPos)[dstW + 0] =
585     (*filterPos)[dstW + 1] =
586     (*filterPos)[dstW + 2] = (*filterPos)[dstW - 1]; /* the MMX/SSE scaler will
587                                                       * read over the end */
588     for (i = 0; i < *outFilterSize; i++) {
589         int k = (dstW - 1) * (*outFilterSize) + i;
590         (*outFilter)[k + 1 * (*outFilterSize)] =
591         (*outFilter)[k + 2 * (*outFilterSize)] =
592         (*outFilter)[k + 3 * (*outFilterSize)] = (*outFilter)[k];
593     }
594
595     ret = 0;
596
597 fail:
598     av_free(filter);
599     av_free(filter2);
600     return ret;
601 }
602
603 #if HAVE_MMXEXT_INLINE
604 static int initMMX2HScaler(int dstW, int xInc, uint8_t *filterCode,
605                            int16_t *filter, int32_t *filterPos, int numSplits)
606 {
607     uint8_t *fragmentA;
608     x86_reg imm8OfPShufW1A;
609     x86_reg imm8OfPShufW2A;
610     x86_reg fragmentLengthA;
611     uint8_t *fragmentB;
612     x86_reg imm8OfPShufW1B;
613     x86_reg imm8OfPShufW2B;
614     x86_reg fragmentLengthB;
615     int fragmentPos;
616
617     int xpos, i;
618
619     // create an optimized horizontal scaling routine
620     /* This scaler is made of runtime-generated MMX2 code using specially tuned
621      * pshufw instructions. For every four output pixels, if four input pixels
622      * are enough for the fast bilinear scaling, then a chunk of fragmentB is
623      * used. If five input pixels are needed, then a chunk of fragmentA is used.
624      */
625
626     // code fragment
627
628     __asm__ volatile (
629         "jmp                         9f                 \n\t"
630         // Begin
631         "0:                                             \n\t"
632         "movq    (%%"REG_d", %%"REG_a"), %%mm3          \n\t"
633         "movd    (%%"REG_c", %%"REG_S"), %%mm0          \n\t"
634         "movd   1(%%"REG_c", %%"REG_S"), %%mm1          \n\t"
635         "punpcklbw                %%mm7, %%mm1          \n\t"
636         "punpcklbw                %%mm7, %%mm0          \n\t"
637         "pshufw                   $0xFF, %%mm1, %%mm1   \n\t"
638         "1:                                             \n\t"
639         "pshufw                   $0xFF, %%mm0, %%mm0   \n\t"
640         "2:                                             \n\t"
641         "psubw                    %%mm1, %%mm0          \n\t"
642         "movl   8(%%"REG_b", %%"REG_a"), %%esi          \n\t"
643         "pmullw                   %%mm3, %%mm0          \n\t"
644         "psllw                       $7, %%mm1          \n\t"
645         "paddw                    %%mm1, %%mm0          \n\t"
646
647         "movq                     %%mm0, (%%"REG_D", %%"REG_a") \n\t"
648
649         "add                         $8, %%"REG_a"      \n\t"
650         // End
651         "9:                                             \n\t"
652         // "int $3                                         \n\t"
653         "lea       " LOCAL_MANGLE(0b) ", %0             \n\t"
654         "lea       " LOCAL_MANGLE(1b) ", %1             \n\t"
655         "lea       " LOCAL_MANGLE(2b) ", %2             \n\t"
656         "dec                         %1                 \n\t"
657         "dec                         %2                 \n\t"
658         "sub                         %0, %1             \n\t"
659         "sub                         %0, %2             \n\t"
660         "lea       " LOCAL_MANGLE(9b) ", %3             \n\t"
661         "sub                         %0, %3             \n\t"
662
663
664         : "=r" (fragmentA), "=r" (imm8OfPShufW1A), "=r" (imm8OfPShufW2A),
665           "=r" (fragmentLengthA)
666         );
667
668     __asm__ volatile (
669         "jmp                         9f                 \n\t"
670         // Begin
671         "0:                                             \n\t"
672         "movq    (%%"REG_d", %%"REG_a"), %%mm3          \n\t"
673         "movd    (%%"REG_c", %%"REG_S"), %%mm0          \n\t"
674         "punpcklbw                %%mm7, %%mm0          \n\t"
675         "pshufw                   $0xFF, %%mm0, %%mm1   \n\t"
676         "1:                                             \n\t"
677         "pshufw                   $0xFF, %%mm0, %%mm0   \n\t"
678         "2:                                             \n\t"
679         "psubw                    %%mm1, %%mm0          \n\t"
680         "movl   8(%%"REG_b", %%"REG_a"), %%esi          \n\t"
681         "pmullw                   %%mm3, %%mm0          \n\t"
682         "psllw                       $7, %%mm1          \n\t"
683         "paddw                    %%mm1, %%mm0          \n\t"
684
685         "movq                     %%mm0, (%%"REG_D", %%"REG_a") \n\t"
686
687         "add                         $8, %%"REG_a"      \n\t"
688         // End
689         "9:                                             \n\t"
690         // "int                       $3                   \n\t"
691         "lea       " LOCAL_MANGLE(0b) ", %0             \n\t"
692         "lea       " LOCAL_MANGLE(1b) ", %1             \n\t"
693         "lea       " LOCAL_MANGLE(2b) ", %2             \n\t"
694         "dec                         %1                 \n\t"
695         "dec                         %2                 \n\t"
696         "sub                         %0, %1             \n\t"
697         "sub                         %0, %2             \n\t"
698         "lea       " LOCAL_MANGLE(9b) ", %3             \n\t"
699         "sub                         %0, %3             \n\t"
700
701
702         : "=r" (fragmentB), "=r" (imm8OfPShufW1B), "=r" (imm8OfPShufW2B),
703           "=r" (fragmentLengthB)
704         );
705
706     xpos        = 0; // lumXInc/2 - 0x8000; // difference between pixel centers
707     fragmentPos = 0;
708
709     for (i = 0; i < dstW / numSplits; i++) {
710         int xx = xpos >> 16;
711
712         if ((i & 3) == 0) {
713             int a                  = 0;
714             int b                  = ((xpos + xInc) >> 16) - xx;
715             int c                  = ((xpos + xInc * 2) >> 16) - xx;
716             int d                  = ((xpos + xInc * 3) >> 16) - xx;
717             int inc                = (d + 1 < 4);
718             uint8_t *fragment      = (d + 1 < 4) ? fragmentB : fragmentA;
719             x86_reg imm8OfPShufW1  = (d + 1 < 4) ? imm8OfPShufW1B : imm8OfPShufW1A;
720             x86_reg imm8OfPShufW2  = (d + 1 < 4) ? imm8OfPShufW2B : imm8OfPShufW2A;
721             x86_reg fragmentLength = (d + 1 < 4) ? fragmentLengthB : fragmentLengthA;
722             int maxShift           = 3 - (d + inc);
723             int shift              = 0;
724
725             if (filterCode) {
726                 filter[i]        = ((xpos              & 0xFFFF) ^ 0xFFFF) >> 9;
727                 filter[i + 1]    = (((xpos + xInc)     & 0xFFFF) ^ 0xFFFF) >> 9;
728                 filter[i + 2]    = (((xpos + xInc * 2) & 0xFFFF) ^ 0xFFFF) >> 9;
729                 filter[i + 3]    = (((xpos + xInc * 3) & 0xFFFF) ^ 0xFFFF) >> 9;
730                 filterPos[i / 2] = xx;
731
732                 memcpy(filterCode + fragmentPos, fragment, fragmentLength);
733
734                 filterCode[fragmentPos + imm8OfPShufW1] =  (a + inc)       |
735                                                           ((b + inc) << 2) |
736                                                           ((c + inc) << 4) |
737                                                           ((d + inc) << 6);
738                 filterCode[fragmentPos + imm8OfPShufW2] =  a | (b << 2) |
739                                                                (c << 4) |
740                                                                (d << 6);
741
742                 if (i + 4 - inc >= dstW)
743                     shift = maxShift;               // avoid overread
744                 else if ((filterPos[i / 2] & 3) <= maxShift)
745                     shift = filterPos[i / 2] & 3;   // align
746
747                 if (shift && i >= shift) {
748                     filterCode[fragmentPos + imm8OfPShufW1] += 0x55 * shift;
749                     filterCode[fragmentPos + imm8OfPShufW2] += 0x55 * shift;
750                     filterPos[i / 2]                        -= shift;
751                 }
752             }
753
754             fragmentPos += fragmentLength;
755
756             if (filterCode)
757                 filterCode[fragmentPos] = RET;
758         }
759         xpos += xInc;
760     }
761     if (filterCode)
762         filterPos[((i / 2) + 1) & (~1)] = xpos >> 16;  // needed to jump to the next part
763
764     return fragmentPos + 1;
765 }
766 #endif /* HAVE_MMXEXT_INLINE */
767
768 static void getSubSampleFactors(int *h, int *v, enum AVPixelFormat format)
769 {
770     *h = av_pix_fmt_descriptors[format].log2_chroma_w;
771     *v = av_pix_fmt_descriptors[format].log2_chroma_h;
772 }
773
774 int sws_setColorspaceDetails(struct SwsContext *c, const int inv_table[4],
775                              int srcRange, const int table[4], int dstRange,
776                              int brightness, int contrast, int saturation)
777 {
778     memcpy(c->srcColorspaceTable, inv_table, sizeof(int) * 4);
779     memcpy(c->dstColorspaceTable, table, sizeof(int) * 4);
780
781     c->brightness = brightness;
782     c->contrast   = contrast;
783     c->saturation = saturation;
784     c->srcRange   = srcRange;
785     c->dstRange   = dstRange;
786     if (isYUV(c->dstFormat) || isGray(c->dstFormat))
787         return -1;
788
789     c->dstFormatBpp = av_get_bits_per_pixel(&av_pix_fmt_descriptors[c->dstFormat]);
790     c->srcFormatBpp = av_get_bits_per_pixel(&av_pix_fmt_descriptors[c->srcFormat]);
791
792     ff_yuv2rgb_c_init_tables(c, inv_table, srcRange, brightness,
793                              contrast, saturation);
794     // FIXME factorize
795
796     if (HAVE_ALTIVEC && av_get_cpu_flags() & AV_CPU_FLAG_ALTIVEC)
797         ff_yuv2rgb_init_tables_altivec(c, inv_table, brightness,
798                                        contrast, saturation);
799     return 0;
800 }
801
802 int sws_getColorspaceDetails(struct SwsContext *c, int **inv_table,
803                              int *srcRange, int **table, int *dstRange,
804                              int *brightness, int *contrast, int *saturation)
805 {
806     if (!c || isYUV(c->dstFormat) || isGray(c->dstFormat))
807         return -1;
808
809     *inv_table  = c->srcColorspaceTable;
810     *table      = c->dstColorspaceTable;
811     *srcRange   = c->srcRange;
812     *dstRange   = c->dstRange;
813     *brightness = c->brightness;
814     *contrast   = c->contrast;
815     *saturation = c->saturation;
816
817     return 0;
818 }
819
820 static int handle_jpeg(enum AVPixelFormat *format)
821 {
822     switch (*format) {
823     case AV_PIX_FMT_YUVJ420P:
824         *format = AV_PIX_FMT_YUV420P;
825         return 1;
826     case AV_PIX_FMT_YUVJ422P:
827         *format = AV_PIX_FMT_YUV422P;
828         return 1;
829     case AV_PIX_FMT_YUVJ444P:
830         *format = AV_PIX_FMT_YUV444P;
831         return 1;
832     case AV_PIX_FMT_YUVJ440P:
833         *format = AV_PIX_FMT_YUV440P;
834         return 1;
835     default:
836         return 0;
837     }
838 }
839
840 static int handle_0alpha(enum AVPixelFormat *format)
841 {
842     switch (*format) {
843     case AV_PIX_FMT_0BGR    : *format = AV_PIX_FMT_ABGR   ; return 1;
844     case AV_PIX_FMT_BGR0    : *format = AV_PIX_FMT_BGRA   ; return 4;
845     case AV_PIX_FMT_0RGB    : *format = AV_PIX_FMT_ARGB   ; return 1;
846     case AV_PIX_FMT_RGB0    : *format = AV_PIX_FMT_RGBA   ; return 4;
847     default:                                          return 0;
848     }
849 }
850
851 SwsContext *sws_alloc_context(void)
852 {
853     SwsContext *c = av_mallocz(sizeof(SwsContext));
854
855     c->av_class = &sws_context_class;
856     av_opt_set_defaults(c);
857
858     return c;
859 }
860
861 av_cold int sws_init_context(SwsContext *c, SwsFilter *srcFilter,
862                              SwsFilter *dstFilter)
863 {
864     int i, j;
865     int usesVFilter, usesHFilter;
866     int unscaled;
867     SwsFilter dummyFilter = { NULL, NULL, NULL, NULL };
868     int srcW              = c->srcW;
869     int srcH              = c->srcH;
870     int dstW              = c->dstW;
871     int dstH              = c->dstH;
872     int dst_stride        = FFALIGN(dstW * sizeof(int16_t) + 66, 16);
873     int flags, cpu_flags;
874     enum AVPixelFormat srcFormat = c->srcFormat;
875     enum AVPixelFormat dstFormat = c->dstFormat;
876
877     cpu_flags = av_get_cpu_flags();
878     flags     = c->flags;
879     emms_c();
880     if (!rgb15to16)
881         sws_rgb2rgb_init();
882
883     unscaled = (srcW == dstW && srcH == dstH);
884
885     handle_jpeg(&srcFormat);
886     handle_jpeg(&dstFormat);
887     handle_0alpha(&srcFormat);
888     handle_0alpha(&dstFormat);
889
890     if(srcFormat!=c->srcFormat || dstFormat!=c->dstFormat){
891         av_log(c, AV_LOG_WARNING, "deprecated pixel format used, make sure you did set range correctly\n");
892         c->srcFormat= srcFormat;
893         c->dstFormat= dstFormat;
894     }
895
896     if (!sws_isSupportedInput(srcFormat)) {
897         av_log(c, AV_LOG_ERROR, "%s is not supported as input pixel format\n",
898                av_get_pix_fmt_name(srcFormat));
899         return AVERROR(EINVAL);
900     }
901     if (!sws_isSupportedOutput(dstFormat)) {
902         av_log(c, AV_LOG_ERROR, "%s is not supported as output pixel format\n",
903                av_get_pix_fmt_name(dstFormat));
904         return AVERROR(EINVAL);
905     }
906
907     i = flags & (SWS_POINT         |
908                  SWS_AREA          |
909                  SWS_BILINEAR      |
910                  SWS_FAST_BILINEAR |
911                  SWS_BICUBIC       |
912                  SWS_X             |
913                  SWS_GAUSS         |
914                  SWS_LANCZOS       |
915                  SWS_SINC          |
916                  SWS_SPLINE        |
917                  SWS_BICUBLIN);
918     if (!i || (i & (i - 1))) {
919         av_log(c, AV_LOG_ERROR, "Exactly one scaler algorithm must be chosen, got %X\n", i);
920         return AVERROR(EINVAL);
921     }
922     /* sanity check */
923     if (srcW < 4 || srcH < 1 || dstW < 8 || dstH < 1) {
924         /* FIXME check if these are enough and try to lower them after
925          * fixing the relevant parts of the code */
926         av_log(c, AV_LOG_ERROR, "%dx%d -> %dx%d is invalid scaling dimension\n",
927                srcW, srcH, dstW, dstH);
928         return AVERROR(EINVAL);
929     }
930
931     if (!dstFilter)
932         dstFilter = &dummyFilter;
933     if (!srcFilter)
934         srcFilter = &dummyFilter;
935
936     c->lumXInc      = (((int64_t)srcW << 16) + (dstW >> 1)) / dstW;
937     c->lumYInc      = (((int64_t)srcH << 16) + (dstH >> 1)) / dstH;
938     c->dstFormatBpp = av_get_bits_per_pixel(&av_pix_fmt_descriptors[dstFormat]);
939     c->srcFormatBpp = av_get_bits_per_pixel(&av_pix_fmt_descriptors[srcFormat]);
940     c->vRounder     = 4 * 0x0001000100010001ULL;
941
942     usesVFilter = (srcFilter->lumV && srcFilter->lumV->length > 1) ||
943                   (srcFilter->chrV && srcFilter->chrV->length > 1) ||
944                   (dstFilter->lumV && dstFilter->lumV->length > 1) ||
945                   (dstFilter->chrV && dstFilter->chrV->length > 1);
946     usesHFilter = (srcFilter->lumH && srcFilter->lumH->length > 1) ||
947                   (srcFilter->chrH && srcFilter->chrH->length > 1) ||
948                   (dstFilter->lumH && dstFilter->lumH->length > 1) ||
949                   (dstFilter->chrH && dstFilter->chrH->length > 1);
950
951     getSubSampleFactors(&c->chrSrcHSubSample, &c->chrSrcVSubSample, srcFormat);
952     getSubSampleFactors(&c->chrDstHSubSample, &c->chrDstVSubSample, dstFormat);
953
954
955     if (isAnyRGB(dstFormat) && !(flags&SWS_FULL_CHR_H_INT)) {
956         if (dstW&1) {
957             av_log(c, AV_LOG_DEBUG, "Forcing full internal H chroma due to odd output size\n");
958             flags |= SWS_FULL_CHR_H_INT;
959             c->flags = flags;
960         }
961     }
962     /* reuse chroma for 2 pixels RGB/BGR unless user wants full
963      * chroma interpolation */
964     if (flags & SWS_FULL_CHR_H_INT &&
965         isAnyRGB(dstFormat)        &&
966         dstFormat != AV_PIX_FMT_RGBA  &&
967         dstFormat != AV_PIX_FMT_ARGB  &&
968         dstFormat != AV_PIX_FMT_BGRA  &&
969         dstFormat != AV_PIX_FMT_ABGR  &&
970         dstFormat != AV_PIX_FMT_RGB24 &&
971         dstFormat != AV_PIX_FMT_BGR24) {
972         av_log(c, AV_LOG_WARNING,
973                "full chroma interpolation for destination format '%s' not yet implemented\n",
974                av_get_pix_fmt_name(dstFormat));
975         flags   &= ~SWS_FULL_CHR_H_INT;
976         c->flags = flags;
977     }
978     if (isAnyRGB(dstFormat) && !(flags & SWS_FULL_CHR_H_INT))
979         c->chrDstHSubSample = 1;
980
981     // drop some chroma lines if the user wants it
982     c->vChrDrop          = (flags & SWS_SRC_V_CHR_DROP_MASK) >>
983                            SWS_SRC_V_CHR_DROP_SHIFT;
984     c->chrSrcVSubSample += c->vChrDrop;
985
986     /* drop every other pixel for chroma calculation unless user
987      * wants full chroma */
988     if (isAnyRGB(srcFormat) && !(flags & SWS_FULL_CHR_H_INP)   &&
989         srcFormat != AV_PIX_FMT_RGB8 && srcFormat != AV_PIX_FMT_BGR8 &&
990         srcFormat != AV_PIX_FMT_RGB4 && srcFormat != AV_PIX_FMT_BGR4 &&
991         srcFormat != AV_PIX_FMT_RGB4_BYTE && srcFormat != AV_PIX_FMT_BGR4_BYTE &&
992         ((dstW >> c->chrDstHSubSample) <= (srcW >> 1) ||
993          (flags & SWS_FAST_BILINEAR)))
994         c->chrSrcHSubSample = 1;
995
996     // Note the -((-x)>>y) is so that we always round toward +inf.
997     c->chrSrcW = -((-srcW) >> c->chrSrcHSubSample);
998     c->chrSrcH = -((-srcH) >> c->chrSrcVSubSample);
999     c->chrDstW = -((-dstW) >> c->chrDstHSubSample);
1000     c->chrDstH = -((-dstH) >> c->chrDstVSubSample);
1001
1002     FF_ALLOC_OR_GOTO(c, c->formatConvBuffer, FFALIGN(srcW*2+78, 16) * 2, fail);
1003
1004     /* unscaled special cases */
1005     if (unscaled && !usesHFilter && !usesVFilter &&
1006         (c->srcRange == c->dstRange || isAnyRGB(dstFormat))) {
1007         ff_get_unscaled_swscale(c);
1008
1009         if (c->swScale) {
1010             if (flags & SWS_PRINT_INFO)
1011                 av_log(c, AV_LOG_INFO,
1012                        "using unscaled %s -> %s special converter\n",
1013                        av_get_pix_fmt_name(srcFormat), av_get_pix_fmt_name(dstFormat));
1014             return 0;
1015         }
1016     }
1017
1018     c->srcBpc = 1 + av_pix_fmt_descriptors[srcFormat].comp[0].depth_minus1;
1019     if (c->srcBpc < 8)
1020         c->srcBpc = 8;
1021     c->dstBpc = 1 + av_pix_fmt_descriptors[dstFormat].comp[0].depth_minus1;
1022     if (c->dstBpc < 8)
1023         c->dstBpc = 8;
1024     if (isAnyRGB(srcFormat) || srcFormat == AV_PIX_FMT_PAL8)
1025         c->srcBpc = 16;
1026     if (c->dstBpc == 16)
1027         dst_stride <<= 1;
1028     if (INLINE_MMXEXT(cpu_flags) && c->srcBpc == 8 && c->dstBpc <= 14) {
1029         c->canMMX2BeUsed = (dstW >= srcW && (dstW & 31) == 0 &&
1030                             (srcW & 15) == 0) ? 1 : 0;
1031         if (!c->canMMX2BeUsed && dstW >= srcW && (srcW & 15) == 0
1032             && (flags & SWS_FAST_BILINEAR)) {
1033             if (flags & SWS_PRINT_INFO)
1034                 av_log(c, AV_LOG_INFO,
1035                        "output width is not a multiple of 32 -> no MMX2 scaler\n");
1036         }
1037         if (usesHFilter || isNBPS(c->srcFormat) || is16BPS(c->srcFormat) || isAnyRGB(c->srcFormat))
1038             c->canMMX2BeUsed=0;
1039     } else
1040         c->canMMX2BeUsed = 0;
1041
1042     c->chrXInc = (((int64_t)c->chrSrcW << 16) + (c->chrDstW >> 1)) / c->chrDstW;
1043     c->chrYInc = (((int64_t)c->chrSrcH << 16) + (c->chrDstH >> 1)) / c->chrDstH;
1044
1045     /* Match pixel 0 of the src to pixel 0 of dst and match pixel n-2 of src
1046      * to pixel n-2 of dst, but only for the FAST_BILINEAR mode otherwise do
1047      * correct scaling.
1048      * n-2 is the last chrominance sample available.
1049      * This is not perfect, but no one should notice the difference, the more
1050      * correct variant would be like the vertical one, but that would require
1051      * some special code for the first and last pixel */
1052     if (flags & SWS_FAST_BILINEAR) {
1053         if (c->canMMX2BeUsed) {
1054             c->lumXInc += 20;
1055             c->chrXInc += 20;
1056         }
1057         // we don't use the x86 asm scaler if MMX is available
1058         else if (INLINE_MMX(cpu_flags) && c->dstBpc <= 14) {
1059             c->lumXInc = ((int64_t)(srcW       - 2) << 16) / (dstW       - 2) - 20;
1060             c->chrXInc = ((int64_t)(c->chrSrcW - 2) << 16) / (c->chrDstW - 2) - 20;
1061         }
1062     }
1063
1064     /* precalculate horizontal scaler filter coefficients */
1065     {
1066 #if HAVE_MMXEXT_INLINE
1067 // can't downscale !!!
1068         if (c->canMMX2BeUsed && (flags & SWS_FAST_BILINEAR)) {
1069             c->lumMmx2FilterCodeSize = initMMX2HScaler(dstW, c->lumXInc, NULL,
1070                                                        NULL, NULL, 8);
1071             c->chrMmx2FilterCodeSize = initMMX2HScaler(c->chrDstW, c->chrXInc,
1072                                                        NULL, NULL, NULL, 4);
1073
1074 #ifdef MAP_ANONYMOUS
1075             c->lumMmx2FilterCode = mmap(NULL, c->lumMmx2FilterCodeSize, PROT_READ | PROT_WRITE, MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
1076             c->chrMmx2FilterCode = mmap(NULL, c->chrMmx2FilterCodeSize, PROT_READ | PROT_WRITE, MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
1077 #elif HAVE_VIRTUALALLOC
1078             c->lumMmx2FilterCode = VirtualAlloc(NULL, c->lumMmx2FilterCodeSize, MEM_COMMIT, PAGE_EXECUTE_READWRITE);
1079             c->chrMmx2FilterCode = VirtualAlloc(NULL, c->chrMmx2FilterCodeSize, MEM_COMMIT, PAGE_EXECUTE_READWRITE);
1080 #else
1081             c->lumMmx2FilterCode = av_malloc(c->lumMmx2FilterCodeSize);
1082             c->chrMmx2FilterCode = av_malloc(c->chrMmx2FilterCodeSize);
1083 #endif
1084
1085 #ifdef MAP_ANONYMOUS
1086             if (c->lumMmx2FilterCode == MAP_FAILED || c->chrMmx2FilterCode == MAP_FAILED)
1087 #else
1088             if (!c->lumMmx2FilterCode || !c->chrMmx2FilterCode)
1089 #endif
1090             {
1091                 av_log(c, AV_LOG_ERROR, "Failed to allocate MMX2FilterCode\n");
1092                 return AVERROR(ENOMEM);
1093             }
1094
1095             FF_ALLOCZ_OR_GOTO(c, c->hLumFilter,    (dstW           / 8 + 8) * sizeof(int16_t), fail);
1096             FF_ALLOCZ_OR_GOTO(c, c->hChrFilter,    (c->chrDstW     / 4 + 8) * sizeof(int16_t), fail);
1097             FF_ALLOCZ_OR_GOTO(c, c->hLumFilterPos, (dstW       / 2 / 8 + 8) * sizeof(int32_t), fail);
1098             FF_ALLOCZ_OR_GOTO(c, c->hChrFilterPos, (c->chrDstW / 2 / 4 + 8) * sizeof(int32_t), fail);
1099
1100             initMMX2HScaler(      dstW, c->lumXInc, c->lumMmx2FilterCode,
1101                             c->hLumFilter, (uint32_t*)c->hLumFilterPos, 8);
1102             initMMX2HScaler(c->chrDstW, c->chrXInc, c->chrMmx2FilterCode,
1103                             c->hChrFilter, (uint32_t*)c->hChrFilterPos, 4);
1104
1105 #ifdef MAP_ANONYMOUS
1106             mprotect(c->lumMmx2FilterCode, c->lumMmx2FilterCodeSize, PROT_EXEC | PROT_READ);
1107             mprotect(c->chrMmx2FilterCode, c->chrMmx2FilterCodeSize, PROT_EXEC | PROT_READ);
1108 #endif
1109         } else
1110 #endif /* HAVE_MMXEXT_INLINE */
1111         {
1112             const int filterAlign =
1113                 (HAVE_MMX && cpu_flags & AV_CPU_FLAG_MMX) ? 4 :
1114                 (HAVE_ALTIVEC && cpu_flags & AV_CPU_FLAG_ALTIVEC) ? 8 :
1115                 1;
1116
1117             if (initFilter(&c->hLumFilter, &c->hLumFilterPos,
1118                            &c->hLumFilterSize, c->lumXInc,
1119                            srcW, dstW, filterAlign, 1 << 14,
1120                            (flags & SWS_BICUBLIN) ? (flags | SWS_BICUBIC) : flags,
1121                            cpu_flags, srcFilter->lumH, dstFilter->lumH,
1122                            c->param) < 0)
1123                 goto fail;
1124             if (initFilter(&c->hChrFilter, &c->hChrFilterPos,
1125                            &c->hChrFilterSize, c->chrXInc,
1126                            c->chrSrcW, c->chrDstW, filterAlign, 1 << 14,
1127                            (flags & SWS_BICUBLIN) ? (flags | SWS_BILINEAR) : flags,
1128                            cpu_flags, srcFilter->chrH, dstFilter->chrH,
1129                            c->param) < 0)
1130                 goto fail;
1131         }
1132     } // initialize horizontal stuff
1133
1134     /* precalculate vertical scaler filter coefficients */
1135     {
1136         const int filterAlign =
1137             (HAVE_MMX && cpu_flags & AV_CPU_FLAG_MMX) ? 2 :
1138             (HAVE_ALTIVEC && cpu_flags & AV_CPU_FLAG_ALTIVEC) ? 8 :
1139             1;
1140
1141         if (initFilter(&c->vLumFilter, &c->vLumFilterPos, &c->vLumFilterSize,
1142                        c->lumYInc, srcH, dstH, filterAlign, (1 << 12),
1143                        (flags & SWS_BICUBLIN) ? (flags | SWS_BICUBIC) : flags,
1144                        cpu_flags, srcFilter->lumV, dstFilter->lumV,
1145                        c->param) < 0)
1146             goto fail;
1147         if (initFilter(&c->vChrFilter, &c->vChrFilterPos, &c->vChrFilterSize,
1148                        c->chrYInc, c->chrSrcH, c->chrDstH,
1149                        filterAlign, (1 << 12),
1150                        (flags & SWS_BICUBLIN) ? (flags | SWS_BILINEAR) : flags,
1151                        cpu_flags, srcFilter->chrV, dstFilter->chrV,
1152                        c->param) < 0)
1153             goto fail;
1154
1155 #if HAVE_ALTIVEC
1156         FF_ALLOC_OR_GOTO(c, c->vYCoeffsBank, sizeof(vector signed short) * c->vLumFilterSize * c->dstH,    fail);
1157         FF_ALLOC_OR_GOTO(c, c->vCCoeffsBank, sizeof(vector signed short) * c->vChrFilterSize * c->chrDstH, fail);
1158
1159         for (i = 0; i < c->vLumFilterSize * c->dstH; i++) {
1160             int j;
1161             short *p = (short *)&c->vYCoeffsBank[i];
1162             for (j = 0; j < 8; j++)
1163                 p[j] = c->vLumFilter[i];
1164         }
1165
1166         for (i = 0; i < c->vChrFilterSize * c->chrDstH; i++) {
1167             int j;
1168             short *p = (short *)&c->vCCoeffsBank[i];
1169             for (j = 0; j < 8; j++)
1170                 p[j] = c->vChrFilter[i];
1171         }
1172 #endif
1173     }
1174
1175     // calculate buffer sizes so that they won't run out while handling these damn slices
1176     c->vLumBufSize = c->vLumFilterSize;
1177     c->vChrBufSize = c->vChrFilterSize;
1178     for (i = 0; i < dstH; i++) {
1179         int chrI      = (int64_t)i * c->chrDstH / dstH;
1180         int nextSlice = FFMAX(c->vLumFilterPos[i] + c->vLumFilterSize - 1,
1181                               ((c->vChrFilterPos[chrI] + c->vChrFilterSize - 1)
1182                                << c->chrSrcVSubSample));
1183
1184         nextSlice >>= c->chrSrcVSubSample;
1185         nextSlice <<= c->chrSrcVSubSample;
1186         if (c->vLumFilterPos[i] + c->vLumBufSize < nextSlice)
1187             c->vLumBufSize = nextSlice - c->vLumFilterPos[i];
1188         if (c->vChrFilterPos[chrI] + c->vChrBufSize <
1189             (nextSlice >> c->chrSrcVSubSample))
1190             c->vChrBufSize = (nextSlice >> c->chrSrcVSubSample) -
1191                              c->vChrFilterPos[chrI];
1192     }
1193
1194     /* Allocate pixbufs (we use dynamic allocation because otherwise we would
1195      * need to allocate several megabytes to handle all possible cases) */
1196     FF_ALLOC_OR_GOTO(c, c->lumPixBuf,  c->vLumBufSize * 3 * sizeof(int16_t *), fail);
1197     FF_ALLOC_OR_GOTO(c, c->chrUPixBuf, c->vChrBufSize * 3 * sizeof(int16_t *), fail);
1198     FF_ALLOC_OR_GOTO(c, c->chrVPixBuf, c->vChrBufSize * 3 * sizeof(int16_t *), fail);
1199     if (CONFIG_SWSCALE_ALPHA && isALPHA(c->srcFormat) && isALPHA(c->dstFormat))
1200         FF_ALLOCZ_OR_GOTO(c, c->alpPixBuf, c->vLumBufSize * 3 * sizeof(int16_t *), fail);
1201     /* Note we need at least one pixel more at the end because of the MMX code
1202      * (just in case someone wants to replace the 4000/8000). */
1203     /* align at 16 bytes for AltiVec */
1204     for (i = 0; i < c->vLumBufSize; i++) {
1205         FF_ALLOCZ_OR_GOTO(c, c->lumPixBuf[i + c->vLumBufSize],
1206                           dst_stride + 16, fail);
1207         c->lumPixBuf[i] = c->lumPixBuf[i + c->vLumBufSize];
1208     }
1209     // 64 / c->scalingBpp is the same as 16 / sizeof(scaling_intermediate)
1210     c->uv_off   = (dst_stride>>1) + 64 / (c->dstBpc &~ 7);
1211     c->uv_offx2 = dst_stride + 16;
1212     for (i = 0; i < c->vChrBufSize; i++) {
1213         FF_ALLOC_OR_GOTO(c, c->chrUPixBuf[i + c->vChrBufSize],
1214                          dst_stride * 2 + 32, fail);
1215         c->chrUPixBuf[i] = c->chrUPixBuf[i + c->vChrBufSize];
1216         c->chrVPixBuf[i] = c->chrVPixBuf[i + c->vChrBufSize]
1217                          = c->chrUPixBuf[i] + (dst_stride >> 1) + 8;
1218     }
1219     if (CONFIG_SWSCALE_ALPHA && c->alpPixBuf)
1220         for (i = 0; i < c->vLumBufSize; i++) {
1221             FF_ALLOCZ_OR_GOTO(c, c->alpPixBuf[i + c->vLumBufSize],
1222                               dst_stride + 16, fail);
1223             c->alpPixBuf[i] = c->alpPixBuf[i + c->vLumBufSize];
1224         }
1225
1226     // try to avoid drawing green stuff between the right end and the stride end
1227     for (i = 0; i < c->vChrBufSize; i++)
1228         if(av_pix_fmt_descriptors[c->dstFormat].comp[0].depth_minus1 == 15){
1229             av_assert0(c->dstBpc > 14);
1230             for(j=0; j<dst_stride/2+1; j++)
1231                 ((int32_t*)(c->chrUPixBuf[i]))[j] = 1<<18;
1232         } else
1233             for(j=0; j<dst_stride+1; j++)
1234                 ((int16_t*)(c->chrUPixBuf[i]))[j] = 1<<14;
1235
1236     av_assert0(c->chrDstH <= dstH);
1237
1238     if (flags & SWS_PRINT_INFO) {
1239         if (flags & SWS_FAST_BILINEAR)
1240             av_log(c, AV_LOG_INFO, "FAST_BILINEAR scaler, ");
1241         else if (flags & SWS_BILINEAR)
1242             av_log(c, AV_LOG_INFO, "BILINEAR scaler, ");
1243         else if (flags & SWS_BICUBIC)
1244             av_log(c, AV_LOG_INFO, "BICUBIC scaler, ");
1245         else if (flags & SWS_X)
1246             av_log(c, AV_LOG_INFO, "Experimental scaler, ");
1247         else if (flags & SWS_POINT)
1248             av_log(c, AV_LOG_INFO, "Nearest Neighbor / POINT scaler, ");
1249         else if (flags & SWS_AREA)
1250             av_log(c, AV_LOG_INFO, "Area Averaging scaler, ");
1251         else if (flags & SWS_BICUBLIN)
1252             av_log(c, AV_LOG_INFO, "luma BICUBIC / chroma BILINEAR scaler, ");
1253         else if (flags & SWS_GAUSS)
1254             av_log(c, AV_LOG_INFO, "Gaussian scaler, ");
1255         else if (flags & SWS_SINC)
1256             av_log(c, AV_LOG_INFO, "Sinc scaler, ");
1257         else if (flags & SWS_LANCZOS)
1258             av_log(c, AV_LOG_INFO, "Lanczos scaler, ");
1259         else if (flags & SWS_SPLINE)
1260             av_log(c, AV_LOG_INFO, "Bicubic spline scaler, ");
1261         else
1262             av_log(c, AV_LOG_INFO, "ehh flags invalid?! ");
1263
1264         av_log(c, AV_LOG_INFO, "from %s to %s%s ",
1265                av_get_pix_fmt_name(srcFormat),
1266 #ifdef DITHER1XBPP
1267                dstFormat == AV_PIX_FMT_BGR555   || dstFormat == AV_PIX_FMT_BGR565   ||
1268                dstFormat == AV_PIX_FMT_RGB444BE || dstFormat == AV_PIX_FMT_RGB444LE ||
1269                dstFormat == AV_PIX_FMT_BGR444BE || dstFormat == AV_PIX_FMT_BGR444LE ?
1270                                                              "dithered " : "",
1271 #else
1272                "",
1273 #endif
1274                av_get_pix_fmt_name(dstFormat));
1275
1276         if (INLINE_MMXEXT(cpu_flags))
1277             av_log(c, AV_LOG_INFO, "using MMX2\n");
1278         else if (INLINE_AMD3DNOW(cpu_flags))
1279             av_log(c, AV_LOG_INFO, "using 3DNOW\n");
1280         else if (INLINE_MMX(cpu_flags))
1281             av_log(c, AV_LOG_INFO, "using MMX\n");
1282         else if (HAVE_ALTIVEC && cpu_flags & AV_CPU_FLAG_ALTIVEC)
1283             av_log(c, AV_LOG_INFO, "using AltiVec\n");
1284         else
1285             av_log(c, AV_LOG_INFO, "using C\n");
1286
1287         av_log(c, AV_LOG_VERBOSE, "%dx%d -> %dx%d\n", srcW, srcH, dstW, dstH);
1288         av_log(c, AV_LOG_DEBUG,
1289                "lum srcW=%d srcH=%d dstW=%d dstH=%d xInc=%d yInc=%d\n",
1290                c->srcW, c->srcH, c->dstW, c->dstH, c->lumXInc, c->lumYInc);
1291         av_log(c, AV_LOG_DEBUG,
1292                "chr srcW=%d srcH=%d dstW=%d dstH=%d xInc=%d yInc=%d\n",
1293                c->chrSrcW, c->chrSrcH, c->chrDstW, c->chrDstH,
1294                c->chrXInc, c->chrYInc);
1295     }
1296
1297     c->swScale = ff_getSwsFunc(c);
1298     return 0;
1299 fail: // FIXME replace things by appropriate error codes
1300     return -1;
1301 }
1302
1303 #if FF_API_SWS_GETCONTEXT
1304 SwsContext *sws_getContext(int srcW, int srcH, enum AVPixelFormat srcFormat,
1305                            int dstW, int dstH, enum AVPixelFormat dstFormat,
1306                            int flags, SwsFilter *srcFilter,
1307                            SwsFilter *dstFilter, const double *param)
1308 {
1309     SwsContext *c;
1310
1311     if (!(c = sws_alloc_context()))
1312         return NULL;
1313
1314     c->flags     = flags;
1315     c->srcW      = srcW;
1316     c->srcH      = srcH;
1317     c->dstW      = dstW;
1318     c->dstH      = dstH;
1319     c->srcRange  = handle_jpeg(&srcFormat);
1320     c->dstRange  = handle_jpeg(&dstFormat);
1321     c->src0Alpha = handle_0alpha(&srcFormat);
1322     c->dst0Alpha = handle_0alpha(&dstFormat);
1323     c->srcFormat = srcFormat;
1324     c->dstFormat = dstFormat;
1325
1326     if (param) {
1327         c->param[0] = param[0];
1328         c->param[1] = param[1];
1329     }
1330     sws_setColorspaceDetails(c, ff_yuv2rgb_coeffs[SWS_CS_DEFAULT], c->srcRange,
1331                              ff_yuv2rgb_coeffs[SWS_CS_DEFAULT] /* FIXME*/,
1332                              c->dstRange, 0, 1 << 16, 1 << 16);
1333
1334     if (sws_init_context(c, srcFilter, dstFilter) < 0) {
1335         sws_freeContext(c);
1336         return NULL;
1337     }
1338
1339     return c;
1340 }
1341 #endif
1342
1343 SwsFilter *sws_getDefaultFilter(float lumaGBlur, float chromaGBlur,
1344                                 float lumaSharpen, float chromaSharpen,
1345                                 float chromaHShift, float chromaVShift,
1346                                 int verbose)
1347 {
1348     SwsFilter *filter = av_malloc(sizeof(SwsFilter));
1349     if (!filter)
1350         return NULL;
1351
1352     if (lumaGBlur != 0.0) {
1353         filter->lumH = sws_getGaussianVec(lumaGBlur, 3.0);
1354         filter->lumV = sws_getGaussianVec(lumaGBlur, 3.0);
1355     } else {
1356         filter->lumH = sws_getIdentityVec();
1357         filter->lumV = sws_getIdentityVec();
1358     }
1359
1360     if (chromaGBlur != 0.0) {
1361         filter->chrH = sws_getGaussianVec(chromaGBlur, 3.0);
1362         filter->chrV = sws_getGaussianVec(chromaGBlur, 3.0);
1363     } else {
1364         filter->chrH = sws_getIdentityVec();
1365         filter->chrV = sws_getIdentityVec();
1366     }
1367
1368     if (chromaSharpen != 0.0) {
1369         SwsVector *id = sws_getIdentityVec();
1370         sws_scaleVec(filter->chrH, -chromaSharpen);
1371         sws_scaleVec(filter->chrV, -chromaSharpen);
1372         sws_addVec(filter->chrH, id);
1373         sws_addVec(filter->chrV, id);
1374         sws_freeVec(id);
1375     }
1376
1377     if (lumaSharpen != 0.0) {
1378         SwsVector *id = sws_getIdentityVec();
1379         sws_scaleVec(filter->lumH, -lumaSharpen);
1380         sws_scaleVec(filter->lumV, -lumaSharpen);
1381         sws_addVec(filter->lumH, id);
1382         sws_addVec(filter->lumV, id);
1383         sws_freeVec(id);
1384     }
1385
1386     if (chromaHShift != 0.0)
1387         sws_shiftVec(filter->chrH, (int)(chromaHShift + 0.5));
1388
1389     if (chromaVShift != 0.0)
1390         sws_shiftVec(filter->chrV, (int)(chromaVShift + 0.5));
1391
1392     sws_normalizeVec(filter->chrH, 1.0);
1393     sws_normalizeVec(filter->chrV, 1.0);
1394     sws_normalizeVec(filter->lumH, 1.0);
1395     sws_normalizeVec(filter->lumV, 1.0);
1396
1397     if (verbose)
1398         sws_printVec2(filter->chrH, NULL, AV_LOG_DEBUG);
1399     if (verbose)
1400         sws_printVec2(filter->lumH, NULL, AV_LOG_DEBUG);
1401
1402     return filter;
1403 }
1404
1405 SwsVector *sws_allocVec(int length)
1406 {
1407     SwsVector *vec = av_malloc(sizeof(SwsVector));
1408     if (!vec)
1409         return NULL;
1410     vec->length = length;
1411     vec->coeff  = av_malloc(sizeof(double) * length);
1412     if (!vec->coeff)
1413         av_freep(&vec);
1414     return vec;
1415 }
1416
1417 SwsVector *sws_getGaussianVec(double variance, double quality)
1418 {
1419     const int length = (int)(variance * quality + 0.5) | 1;
1420     int i;
1421     double middle  = (length - 1) * 0.5;
1422     SwsVector *vec = sws_allocVec(length);
1423
1424     if (!vec)
1425         return NULL;
1426
1427     for (i = 0; i < length; i++) {
1428         double dist = i - middle;
1429         vec->coeff[i] = exp(-dist * dist / (2 * variance * variance)) /
1430                         sqrt(2 * variance * M_PI);
1431     }
1432
1433     sws_normalizeVec(vec, 1.0);
1434
1435     return vec;
1436 }
1437
1438 SwsVector *sws_getConstVec(double c, int length)
1439 {
1440     int i;
1441     SwsVector *vec = sws_allocVec(length);
1442
1443     if (!vec)
1444         return NULL;
1445
1446     for (i = 0; i < length; i++)
1447         vec->coeff[i] = c;
1448
1449     return vec;
1450 }
1451
1452 SwsVector *sws_getIdentityVec(void)
1453 {
1454     return sws_getConstVec(1.0, 1);
1455 }
1456
1457 static double sws_dcVec(SwsVector *a)
1458 {
1459     int i;
1460     double sum = 0;
1461
1462     for (i = 0; i < a->length; i++)
1463         sum += a->coeff[i];
1464
1465     return sum;
1466 }
1467
1468 void sws_scaleVec(SwsVector *a, double scalar)
1469 {
1470     int i;
1471
1472     for (i = 0; i < a->length; i++)
1473         a->coeff[i] *= scalar;
1474 }
1475
1476 void sws_normalizeVec(SwsVector *a, double height)
1477 {
1478     sws_scaleVec(a, height / sws_dcVec(a));
1479 }
1480
1481 static SwsVector *sws_getConvVec(SwsVector *a, SwsVector *b)
1482 {
1483     int length = a->length + b->length - 1;
1484     int i, j;
1485     SwsVector *vec = sws_getConstVec(0.0, length);
1486
1487     if (!vec)
1488         return NULL;
1489
1490     for (i = 0; i < a->length; i++) {
1491         for (j = 0; j < b->length; j++) {
1492             vec->coeff[i + j] += a->coeff[i] * b->coeff[j];
1493         }
1494     }
1495
1496     return vec;
1497 }
1498
1499 static SwsVector *sws_sumVec(SwsVector *a, SwsVector *b)
1500 {
1501     int length = FFMAX(a->length, b->length);
1502     int i;
1503     SwsVector *vec = sws_getConstVec(0.0, length);
1504
1505     if (!vec)
1506         return NULL;
1507
1508     for (i = 0; i < a->length; i++)
1509         vec->coeff[i + (length - 1) / 2 - (a->length - 1) / 2] += a->coeff[i];
1510     for (i = 0; i < b->length; i++)
1511         vec->coeff[i + (length - 1) / 2 - (b->length - 1) / 2] += b->coeff[i];
1512
1513     return vec;
1514 }
1515
1516 static SwsVector *sws_diffVec(SwsVector *a, SwsVector *b)
1517 {
1518     int length = FFMAX(a->length, b->length);
1519     int i;
1520     SwsVector *vec = sws_getConstVec(0.0, length);
1521
1522     if (!vec)
1523         return NULL;
1524
1525     for (i = 0; i < a->length; i++)
1526         vec->coeff[i + (length - 1) / 2 - (a->length - 1) / 2] += a->coeff[i];
1527     for (i = 0; i < b->length; i++)
1528         vec->coeff[i + (length - 1) / 2 - (b->length - 1) / 2] -= b->coeff[i];
1529
1530     return vec;
1531 }
1532
1533 /* shift left / or right if "shift" is negative */
1534 static SwsVector *sws_getShiftedVec(SwsVector *a, int shift)
1535 {
1536     int length = a->length + FFABS(shift) * 2;
1537     int i;
1538     SwsVector *vec = sws_getConstVec(0.0, length);
1539
1540     if (!vec)
1541         return NULL;
1542
1543     for (i = 0; i < a->length; i++) {
1544         vec->coeff[i + (length    - 1) / 2 -
1545                        (a->length - 1) / 2 - shift] = a->coeff[i];
1546     }
1547
1548     return vec;
1549 }
1550
1551 void sws_shiftVec(SwsVector *a, int shift)
1552 {
1553     SwsVector *shifted = sws_getShiftedVec(a, shift);
1554     av_free(a->coeff);
1555     a->coeff  = shifted->coeff;
1556     a->length = shifted->length;
1557     av_free(shifted);
1558 }
1559
1560 void sws_addVec(SwsVector *a, SwsVector *b)
1561 {
1562     SwsVector *sum = sws_sumVec(a, b);
1563     av_free(a->coeff);
1564     a->coeff  = sum->coeff;
1565     a->length = sum->length;
1566     av_free(sum);
1567 }
1568
1569 void sws_subVec(SwsVector *a, SwsVector *b)
1570 {
1571     SwsVector *diff = sws_diffVec(a, b);
1572     av_free(a->coeff);
1573     a->coeff  = diff->coeff;
1574     a->length = diff->length;
1575     av_free(diff);
1576 }
1577
1578 void sws_convVec(SwsVector *a, SwsVector *b)
1579 {
1580     SwsVector *conv = sws_getConvVec(a, b);
1581     av_free(a->coeff);
1582     a->coeff  = conv->coeff;
1583     a->length = conv->length;
1584     av_free(conv);
1585 }
1586
1587 SwsVector *sws_cloneVec(SwsVector *a)
1588 {
1589     int i;
1590     SwsVector *vec = sws_allocVec(a->length);
1591
1592     if (!vec)
1593         return NULL;
1594
1595     for (i = 0; i < a->length; i++)
1596         vec->coeff[i] = a->coeff[i];
1597
1598     return vec;
1599 }
1600
1601 void sws_printVec2(SwsVector *a, AVClass *log_ctx, int log_level)
1602 {
1603     int i;
1604     double max = 0;
1605     double min = 0;
1606     double range;
1607
1608     for (i = 0; i < a->length; i++)
1609         if (a->coeff[i] > max)
1610             max = a->coeff[i];
1611
1612     for (i = 0; i < a->length; i++)
1613         if (a->coeff[i] < min)
1614             min = a->coeff[i];
1615
1616     range = max - min;
1617
1618     for (i = 0; i < a->length; i++) {
1619         int x = (int)((a->coeff[i] - min) * 60.0 / range + 0.5);
1620         av_log(log_ctx, log_level, "%1.3f ", a->coeff[i]);
1621         for (; x > 0; x--)
1622             av_log(log_ctx, log_level, " ");
1623         av_log(log_ctx, log_level, "|\n");
1624     }
1625 }
1626
1627 void sws_freeVec(SwsVector *a)
1628 {
1629     if (!a)
1630         return;
1631     av_freep(&a->coeff);
1632     a->length = 0;
1633     av_free(a);
1634 }
1635
1636 void sws_freeFilter(SwsFilter *filter)
1637 {
1638     if (!filter)
1639         return;
1640
1641     if (filter->lumH)
1642         sws_freeVec(filter->lumH);
1643     if (filter->lumV)
1644         sws_freeVec(filter->lumV);
1645     if (filter->chrH)
1646         sws_freeVec(filter->chrH);
1647     if (filter->chrV)
1648         sws_freeVec(filter->chrV);
1649     av_free(filter);
1650 }
1651
1652 void sws_freeContext(SwsContext *c)
1653 {
1654     int i;
1655     if (!c)
1656         return;
1657
1658     if (c->lumPixBuf) {
1659         for (i = 0; i < c->vLumBufSize; i++)
1660             av_freep(&c->lumPixBuf[i]);
1661         av_freep(&c->lumPixBuf);
1662     }
1663
1664     if (c->chrUPixBuf) {
1665         for (i = 0; i < c->vChrBufSize; i++)
1666             av_freep(&c->chrUPixBuf[i]);
1667         av_freep(&c->chrUPixBuf);
1668         av_freep(&c->chrVPixBuf);
1669     }
1670
1671     if (CONFIG_SWSCALE_ALPHA && c->alpPixBuf) {
1672         for (i = 0; i < c->vLumBufSize; i++)
1673             av_freep(&c->alpPixBuf[i]);
1674         av_freep(&c->alpPixBuf);
1675     }
1676
1677     av_freep(&c->vLumFilter);
1678     av_freep(&c->vChrFilter);
1679     av_freep(&c->hLumFilter);
1680     av_freep(&c->hChrFilter);
1681 #if HAVE_ALTIVEC
1682     av_freep(&c->vYCoeffsBank);
1683     av_freep(&c->vCCoeffsBank);
1684 #endif
1685
1686     av_freep(&c->vLumFilterPos);
1687     av_freep(&c->vChrFilterPos);
1688     av_freep(&c->hLumFilterPos);
1689     av_freep(&c->hChrFilterPos);
1690
1691 #if HAVE_MMX_INLINE
1692 #ifdef MAP_ANONYMOUS
1693     if (c->lumMmx2FilterCode)
1694         munmap(c->lumMmx2FilterCode, c->lumMmx2FilterCodeSize);
1695     if (c->chrMmx2FilterCode)
1696         munmap(c->chrMmx2FilterCode, c->chrMmx2FilterCodeSize);
1697 #elif HAVE_VIRTUALALLOC
1698     if (c->lumMmx2FilterCode)
1699         VirtualFree(c->lumMmx2FilterCode, 0, MEM_RELEASE);
1700     if (c->chrMmx2FilterCode)
1701         VirtualFree(c->chrMmx2FilterCode, 0, MEM_RELEASE);
1702 #else
1703     av_free(c->lumMmx2FilterCode);
1704     av_free(c->chrMmx2FilterCode);
1705 #endif
1706     c->lumMmx2FilterCode = NULL;
1707     c->chrMmx2FilterCode = NULL;
1708 #endif /* HAVE_MMX_INLINE */
1709
1710     av_freep(&c->yuvTable);
1711     av_freep(&c->formatConvBuffer);
1712
1713     av_free(c);
1714 }
1715
1716 struct SwsContext *sws_getCachedContext(struct SwsContext *context, int srcW,
1717                                         int srcH, enum AVPixelFormat srcFormat,
1718                                         int dstW, int dstH,
1719                                         enum AVPixelFormat dstFormat, int flags,
1720                                         SwsFilter *srcFilter,
1721                                         SwsFilter *dstFilter,
1722                                         const double *param)
1723 {
1724     static const double default_param[2] = { SWS_PARAM_DEFAULT,
1725                                              SWS_PARAM_DEFAULT };
1726
1727     if (!param)
1728         param = default_param;
1729
1730     if (context &&
1731         (context->srcW      != srcW      ||
1732          context->srcH      != srcH      ||
1733          context->srcFormat != srcFormat ||
1734          context->dstW      != dstW      ||
1735          context->dstH      != dstH      ||
1736          context->dstFormat != dstFormat ||
1737          context->flags     != flags     ||
1738          context->param[0]  != param[0]  ||
1739          context->param[1]  != param[1])) {
1740         sws_freeContext(context);
1741         context = NULL;
1742     }
1743
1744     if (!context) {
1745         if (!(context = sws_alloc_context()))
1746             return NULL;
1747         context->srcW      = srcW;
1748         context->srcH      = srcH;
1749         context->srcRange  = handle_jpeg(&srcFormat);
1750         context->src0Alpha = handle_0alpha(&srcFormat);
1751         context->srcFormat = srcFormat;
1752         context->dstW      = dstW;
1753         context->dstH      = dstH;
1754         context->dstRange  = handle_jpeg(&dstFormat);
1755         context->dst0Alpha = handle_0alpha(&dstFormat);
1756         context->dstFormat = dstFormat;
1757         context->flags     = flags;
1758         context->param[0]  = param[0];
1759         context->param[1]  = param[1];
1760         sws_setColorspaceDetails(context, ff_yuv2rgb_coeffs[SWS_CS_DEFAULT],
1761                                  context->srcRange,
1762                                  ff_yuv2rgb_coeffs[SWS_CS_DEFAULT] /* FIXME*/,
1763                                  context->dstRange, 0, 1 << 16, 1 << 16);
1764         if (sws_init_context(context, srcFilter, dstFilter) < 0) {
1765             sws_freeContext(context);
1766             return NULL;
1767         }
1768     }
1769     return context;
1770 }