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