daf7e90bdc5e569aac0b00a924842318dcaf53d6
[ffmpeg.git] / libswscale / swscale.c
1 /*
2  * Copyright (C) 2001-2011 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 <assert.h>
22 #include <inttypes.h>
23 #include <math.h>
24 #include <stdio.h>
25 #include <string.h>
26
27 #include "libavutil/avassert.h"
28 #include "libavutil/avutil.h"
29 #include "libavutil/bswap.h"
30 #include "libavutil/cpu.h"
31 #include "libavutil/intreadwrite.h"
32 #include "libavutil/mathematics.h"
33 #include "libavutil/pixdesc.h"
34 #include "config.h"
35 #include "rgb2rgb.h"
36 #include "swscale_internal.h"
37 #include "swscale.h"
38
39 DECLARE_ALIGNED(8, const uint8_t, dither_8x8_128)[8][8] = {
40     {  36, 68,  60, 92,  34, 66,  58, 90, },
41     { 100,  4, 124, 28,  98,  2, 122, 26, },
42     {  52, 84,  44, 76,  50, 82,  42, 74, },
43     { 116, 20, 108, 12, 114, 18, 106, 10, },
44     {  32, 64,  56, 88,  38, 70,  62, 94, },
45     {  96,  0, 120, 24, 102,  6, 126, 30, },
46     {  48, 80,  40, 72,  54, 86,  46, 78, },
47     { 112, 16, 104,  8, 118, 22, 110, 14, },
48 };
49
50 DECLARE_ALIGNED(8, const uint8_t, ff_sws_pb_64)[8] = {
51     64, 64, 64, 64, 64, 64, 64, 64
52 };
53
54 static av_always_inline void fillPlane(uint8_t *plane, int stride, int width,
55                                        int height, int y, uint8_t val)
56 {
57     int i;
58     uint8_t *ptr = plane + stride * y;
59     for (i = 0; i < height; i++) {
60         memset(ptr, val, width);
61         ptr += stride;
62     }
63 }
64
65 static void hScale16To19_c(SwsContext *c, int16_t *_dst, int dstW,
66                            const uint8_t *_src, const int16_t *filter,
67                            const int32_t *filterPos, int filterSize)
68 {
69     int i;
70     int32_t *dst        = (int32_t *) _dst;
71     const uint16_t *src = (const uint16_t *) _src;
72     int bits            = av_pix_fmt_descriptors[c->srcFormat].comp[0].depth_minus1;
73     int sh              = bits - 4;
74
75     if((isAnyRGB(c->srcFormat) || c->srcFormat==PIX_FMT_PAL8) && av_pix_fmt_descriptors[c->srcFormat].comp[0].depth_minus1<15)
76         sh= 9;
77
78     for (i = 0; i < dstW; i++) {
79         int j;
80         int srcPos = filterPos[i];
81         int val    = 0;
82
83         for (j = 0; j < filterSize; j++) {
84             val += src[srcPos + j] * filter[filterSize * i + j];
85         }
86         // filter=14 bit, input=16 bit, output=30 bit, >> 11 makes 19 bit
87         dst[i] = FFMIN(val >> sh, (1 << 19) - 1);
88     }
89 }
90
91 static void hScale16To15_c(SwsContext *c, int16_t *dst, int dstW,
92                            const uint8_t *_src, const int16_t *filter,
93                            const int32_t *filterPos, int filterSize)
94 {
95     int i;
96     const uint16_t *src = (const uint16_t *) _src;
97     int sh              = av_pix_fmt_descriptors[c->srcFormat].comp[0].depth_minus1;
98
99     if(sh<15)
100         sh= isAnyRGB(c->srcFormat) || c->srcFormat==PIX_FMT_PAL8 ? 13 : av_pix_fmt_descriptors[c->srcFormat].comp[0].depth_minus1;
101
102     for (i = 0; i < dstW; i++) {
103         int j;
104         int srcPos = filterPos[i];
105         int val    = 0;
106
107         for (j = 0; j < filterSize; j++) {
108             val += src[srcPos + j] * filter[filterSize * i + j];
109         }
110         // filter=14 bit, input=16 bit, output=30 bit, >> 15 makes 15 bit
111         dst[i] = FFMIN(val >> sh, (1 << 15) - 1);
112     }
113 }
114
115 // bilinear / bicubic scaling
116 static void hScale8To15_c(SwsContext *c, int16_t *dst, int dstW,
117                           const uint8_t *src, const int16_t *filter,
118                           const int32_t *filterPos, int filterSize)
119 {
120     int i;
121     for (i = 0; i < dstW; i++) {
122         int j;
123         int srcPos = filterPos[i];
124         int val    = 0;
125         for (j = 0; j < filterSize; j++) {
126             val += ((int)src[srcPos + j]) * filter[filterSize * i + j];
127         }
128         dst[i] = FFMIN(val >> 7, (1 << 15) - 1); // the cubic equation does overflow ...
129     }
130 }
131
132 static void hScale8To19_c(SwsContext *c, int16_t *_dst, int dstW,
133                           const uint8_t *src, const int16_t *filter,
134                           const int32_t *filterPos, int filterSize)
135 {
136     int i;
137     int32_t *dst = (int32_t *) _dst;
138     for (i = 0; i < dstW; i++) {
139         int j;
140         int srcPos = filterPos[i];
141         int val    = 0;
142         for (j = 0; j < filterSize; j++) {
143             val += ((int)src[srcPos + j]) * filter[filterSize * i + j];
144         }
145         dst[i] = FFMIN(val >> 3, (1 << 19) - 1); // the cubic equation does overflow ...
146     }
147 }
148
149 // FIXME all pal and rgb srcFormats could do this convertion as well
150 // FIXME all scalers more complex than bilinear could do half of this transform
151 static void chrRangeToJpeg_c(int16_t *dstU, int16_t *dstV, int width)
152 {
153     int i;
154     for (i = 0; i < width; i++) {
155         dstU[i] = (FFMIN(dstU[i], 30775) * 4663 - 9289992) >> 12; // -264
156         dstV[i] = (FFMIN(dstV[i], 30775) * 4663 - 9289992) >> 12; // -264
157     }
158 }
159
160 static void chrRangeFromJpeg_c(int16_t *dstU, int16_t *dstV, int width)
161 {
162     int i;
163     for (i = 0; i < width; i++) {
164         dstU[i] = (dstU[i] * 1799 + 4081085) >> 11; // 1469
165         dstV[i] = (dstV[i] * 1799 + 4081085) >> 11; // 1469
166     }
167 }
168
169 static void lumRangeToJpeg_c(int16_t *dst, int width)
170 {
171     int i;
172     for (i = 0; i < width; i++)
173         dst[i] = (FFMIN(dst[i], 30189) * 19077 - 39057361) >> 14;
174 }
175
176 static void lumRangeFromJpeg_c(int16_t *dst, int width)
177 {
178     int i;
179     for (i = 0; i < width; i++)
180         dst[i] = (dst[i] * 14071 + 33561947) >> 14;
181 }
182
183 static void chrRangeToJpeg16_c(int16_t *_dstU, int16_t *_dstV, int width)
184 {
185     int i;
186     int32_t *dstU = (int32_t *) _dstU;
187     int32_t *dstV = (int32_t *) _dstV;
188     for (i = 0; i < width; i++) {
189         dstU[i] = (FFMIN(dstU[i], 30775 << 4) * 4663 - (9289992 << 4)) >> 12; // -264
190         dstV[i] = (FFMIN(dstV[i], 30775 << 4) * 4663 - (9289992 << 4)) >> 12; // -264
191     }
192 }
193
194 static void chrRangeFromJpeg16_c(int16_t *_dstU, int16_t *_dstV, int width)
195 {
196     int i;
197     int32_t *dstU = (int32_t *) _dstU;
198     int32_t *dstV = (int32_t *) _dstV;
199     for (i = 0; i < width; i++) {
200         dstU[i] = (dstU[i] * 1799 + (4081085 << 4)) >> 11; // 1469
201         dstV[i] = (dstV[i] * 1799 + (4081085 << 4)) >> 11; // 1469
202     }
203 }
204
205 static void lumRangeToJpeg16_c(int16_t *_dst, int width)
206 {
207     int i;
208     int32_t *dst = (int32_t *) _dst;
209     for (i = 0; i < width; i++)
210         dst[i] = (FFMIN(dst[i], 30189 << 4) * 4769 - (39057361 << 2)) >> 12;
211 }
212
213 static void lumRangeFromJpeg16_c(int16_t *_dst, int width)
214 {
215     int i;
216     int32_t *dst = (int32_t *) _dst;
217     for (i = 0; i < width; i++)
218         dst[i] = (dst[i]*(14071/4) + (33561947<<4)/4)>>12;
219 }
220
221 static void hyscale_fast_c(SwsContext *c, int16_t *dst, int dstWidth,
222                            const uint8_t *src, int srcW, int xInc)
223 {
224     int i;
225     unsigned int xpos = 0;
226     for (i = 0; i < dstWidth; i++) {
227         register unsigned int xx     = xpos >> 16;
228         register unsigned int xalpha = (xpos & 0xFFFF) >> 9;
229         dst[i] = (src[xx] << 7) + (src[xx + 1] - src[xx]) * xalpha;
230         xpos  += xInc;
231     }
232     for (i=dstWidth-1; (i*xInc)>>16 >=srcW-1; i--)
233         dst[i] = src[srcW-1]*128;
234 }
235
236 // *** horizontal scale Y line to temp buffer
237 static av_always_inline void hyscale(SwsContext *c, int16_t *dst, int dstWidth,
238                                      const uint8_t *src_in[4],
239                                      int srcW, int xInc,
240                                      const int16_t *hLumFilter,
241                                      const int32_t *hLumFilterPos,
242                                      int hLumFilterSize,
243                                      uint8_t *formatConvBuffer,
244                                      uint32_t *pal, int isAlpha)
245 {
246     void (*toYV12)(uint8_t *, const uint8_t *, const uint8_t *, const uint8_t *, int, uint32_t *) =
247         isAlpha ? c->alpToYV12 : c->lumToYV12;
248     void (*convertRange)(int16_t *, int) = isAlpha ? NULL : c->lumConvertRange;
249     const uint8_t *src = src_in[isAlpha ? 3 : 0];
250
251     if (toYV12) {
252         toYV12(formatConvBuffer, src, src_in[1], src_in[2], srcW, pal);
253         src = formatConvBuffer;
254     } else if (c->readLumPlanar && !isAlpha) {
255         c->readLumPlanar(formatConvBuffer, src_in, srcW);
256         src = formatConvBuffer;
257     }
258
259     if (!c->hyscale_fast) {
260         c->hyScale(c, dst, dstWidth, src, hLumFilter,
261                    hLumFilterPos, hLumFilterSize);
262     } else { // fast bilinear upscale / crap downscale
263         c->hyscale_fast(c, dst, dstWidth, src, srcW, xInc);
264     }
265
266     if (convertRange)
267         convertRange(dst, dstWidth);
268 }
269
270 static void hcscale_fast_c(SwsContext *c, int16_t *dst1, int16_t *dst2,
271                            int dstWidth, const uint8_t *src1,
272                            const uint8_t *src2, int srcW, int xInc)
273 {
274     int i;
275     unsigned int xpos = 0;
276     for (i = 0; i < dstWidth; i++) {
277         register unsigned int xx     = xpos >> 16;
278         register unsigned int xalpha = (xpos & 0xFFFF) >> 9;
279         dst1[i] = (src1[xx] * (xalpha ^ 127) + src1[xx + 1] * xalpha);
280         dst2[i] = (src2[xx] * (xalpha ^ 127) + src2[xx + 1] * xalpha);
281         xpos   += xInc;
282     }
283     for (i=dstWidth-1; (i*xInc)>>16 >=srcW-1; i--) {
284         dst1[i] = src1[srcW-1]*128;
285         dst2[i] = src2[srcW-1]*128;
286     }
287 }
288
289 static av_always_inline void hcscale(SwsContext *c, int16_t *dst1,
290                                      int16_t *dst2, int dstWidth,
291                                      const uint8_t *src_in[4],
292                                      int srcW, int xInc,
293                                      const int16_t *hChrFilter,
294                                      const int32_t *hChrFilterPos,
295                                      int hChrFilterSize,
296                                      uint8_t *formatConvBuffer, uint32_t *pal)
297 {
298     const uint8_t *src1 = src_in[1], *src2 = src_in[2];
299     if (c->chrToYV12) {
300         uint8_t *buf2 = formatConvBuffer +
301                         FFALIGN(srcW*2+78, 16);
302         c->chrToYV12(formatConvBuffer, buf2, src_in[0], src1, src2, srcW, pal);
303         src1= formatConvBuffer;
304         src2= buf2;
305     } else if (c->readChrPlanar) {
306         uint8_t *buf2 = formatConvBuffer +
307                         FFALIGN(srcW*2+78, 16);
308         c->readChrPlanar(formatConvBuffer, buf2, src_in, srcW);
309         src1 = formatConvBuffer;
310         src2 = buf2;
311     }
312
313     if (!c->hcscale_fast) {
314         c->hcScale(c, dst1, dstWidth, src1, hChrFilter, hChrFilterPos, hChrFilterSize);
315         c->hcScale(c, dst2, dstWidth, src2, hChrFilter, hChrFilterPos, hChrFilterSize);
316     } else { // fast bilinear upscale / crap downscale
317         c->hcscale_fast(c, dst1, dst2, dstWidth, src1, src2, srcW, xInc);
318     }
319
320     if (c->chrConvertRange)
321         c->chrConvertRange(dst1, dst2, dstWidth);
322 }
323
324 #define DEBUG_SWSCALE_BUFFERS 0
325 #define DEBUG_BUFFERS(...)                      \
326     if (DEBUG_SWSCALE_BUFFERS)                  \
327         av_log(c, AV_LOG_DEBUG, __VA_ARGS__)
328
329 static int swScale(SwsContext *c, const uint8_t *src[],
330                    int srcStride[], int srcSliceY,
331                    int srcSliceH, uint8_t *dst[], int dstStride[])
332 {
333     /* load a few things into local vars to make the code more readable?
334      * and faster */
335     const int srcW                   = c->srcW;
336     const int dstW                   = c->dstW;
337     const int dstH                   = c->dstH;
338     const int chrDstW                = c->chrDstW;
339     const int chrSrcW                = c->chrSrcW;
340     const int lumXInc                = c->lumXInc;
341     const int chrXInc                = c->chrXInc;
342     const enum PixelFormat dstFormat = c->dstFormat;
343     const int flags                  = c->flags;
344     int32_t *vLumFilterPos           = c->vLumFilterPos;
345     int32_t *vChrFilterPos           = c->vChrFilterPos;
346     int32_t *hLumFilterPos           = c->hLumFilterPos;
347     int32_t *hChrFilterPos           = c->hChrFilterPos;
348     int16_t *hLumFilter              = c->hLumFilter;
349     int16_t *hChrFilter              = c->hChrFilter;
350     int32_t *lumMmxFilter            = c->lumMmxFilter;
351     int32_t *chrMmxFilter            = c->chrMmxFilter;
352     const int vLumFilterSize         = c->vLumFilterSize;
353     const int vChrFilterSize         = c->vChrFilterSize;
354     const int hLumFilterSize         = c->hLumFilterSize;
355     const int hChrFilterSize         = c->hChrFilterSize;
356     int16_t **lumPixBuf              = c->lumPixBuf;
357     int16_t **chrUPixBuf             = c->chrUPixBuf;
358     int16_t **chrVPixBuf             = c->chrVPixBuf;
359     int16_t **alpPixBuf              = c->alpPixBuf;
360     const int vLumBufSize            = c->vLumBufSize;
361     const int vChrBufSize            = c->vChrBufSize;
362     uint8_t *formatConvBuffer        = c->formatConvBuffer;
363     uint32_t *pal                    = c->pal_yuv;
364     yuv2planar1_fn yuv2plane1        = c->yuv2plane1;
365     yuv2planarX_fn yuv2planeX        = c->yuv2planeX;
366     yuv2interleavedX_fn yuv2nv12cX   = c->yuv2nv12cX;
367     yuv2packed1_fn yuv2packed1       = c->yuv2packed1;
368     yuv2packed2_fn yuv2packed2       = c->yuv2packed2;
369     yuv2packedX_fn yuv2packedX       = c->yuv2packedX;
370     const int chrSrcSliceY           =     srcSliceY  >> c->chrSrcVSubSample;
371     const int chrSrcSliceH           = -((-srcSliceH) >> c->chrSrcVSubSample);
372     int should_dither                = is9_OR_10BPS(c->srcFormat) ||
373                                        is16BPS(c->srcFormat);
374     int lastDstY;
375
376     /* vars which will change and which we need to store back in the context */
377     int dstY         = c->dstY;
378     int lumBufIndex  = c->lumBufIndex;
379     int chrBufIndex  = c->chrBufIndex;
380     int lastInLumBuf = c->lastInLumBuf;
381     int lastInChrBuf = c->lastInChrBuf;
382
383     if (isPacked(c->srcFormat)) {
384         src[0] =
385         src[1] =
386         src[2] =
387         src[3] = src[0];
388         srcStride[0] =
389         srcStride[1] =
390         srcStride[2] =
391         srcStride[3] = srcStride[0];
392     }
393     srcStride[1] <<= c->vChrDrop;
394     srcStride[2] <<= c->vChrDrop;
395
396     DEBUG_BUFFERS("swScale() %p[%d] %p[%d] %p[%d] %p[%d] -> %p[%d] %p[%d] %p[%d] %p[%d]\n",
397                   src[0], srcStride[0], src[1], srcStride[1],
398                   src[2], srcStride[2], src[3], srcStride[3],
399                   dst[0], dstStride[0], dst[1], dstStride[1],
400                   dst[2], dstStride[2], dst[3], dstStride[3]);
401     DEBUG_BUFFERS("srcSliceY: %d srcSliceH: %d dstY: %d dstH: %d\n",
402                   srcSliceY, srcSliceH, dstY, dstH);
403     DEBUG_BUFFERS("vLumFilterSize: %d vLumBufSize: %d vChrFilterSize: %d vChrBufSize: %d\n",
404                   vLumFilterSize, vLumBufSize, vChrFilterSize, vChrBufSize);
405
406     if (dstStride[0]%16 !=0 || dstStride[1]%16 !=0 ||
407         dstStride[2]%16 !=0 || dstStride[3]%16 != 0) {
408         static int warnedAlready = 0; // FIXME maybe move this into the context
409         if (flags & SWS_PRINT_INFO && !warnedAlready) {
410             av_log(c, AV_LOG_WARNING,
411                    "Warning: dstStride is not aligned!\n"
412                    "         ->cannot do aligned memory accesses anymore\n");
413             warnedAlready = 1;
414         }
415     }
416
417     if ((int)dst[0]%16 || (int)dst[1]%16 || (int)dst[2]%16 || (int)src[0]%16 || (int)src[1]%16 || (int)src[2]%16
418         || dstStride[0]%16 || dstStride[1]%16 || dstStride[2]%16 || dstStride[3]%16
419         || srcStride[0]%16 || srcStride[1]%16 || srcStride[2]%16 || srcStride[3]%16
420     ) {
421         static int warnedAlready=0;
422         int cpu_flags = av_get_cpu_flags();
423         if (HAVE_MMXEXT && (cpu_flags & AV_CPU_FLAG_SSE2) && !warnedAlready){
424             av_log(c, AV_LOG_WARNING, "Warning: data is not aligned! This can lead to a speedloss\n");
425             warnedAlready=1;
426         }
427     }
428
429     /* Note the user might start scaling the picture in the middle so this
430      * will not get executed. This is not really intended but works
431      * currently, so people might do it. */
432     if (srcSliceY == 0) {
433         lumBufIndex  = -1;
434         chrBufIndex  = -1;
435         dstY         = 0;
436         lastInLumBuf = -1;
437         lastInChrBuf = -1;
438     }
439
440     if (!should_dither) {
441         c->chrDither8 = c->lumDither8 = ff_sws_pb_64;
442     }
443     lastDstY = dstY;
444
445     for (; dstY < dstH; dstY++) {
446         const int chrDstY = dstY >> c->chrDstVSubSample;
447         uint8_t *dest[4]  = {
448             dst[0] + dstStride[0] * dstY,
449             dst[1] + dstStride[1] * chrDstY,
450             dst[2] + dstStride[2] * chrDstY,
451             (CONFIG_SWSCALE_ALPHA && alpPixBuf) ? dst[3] + dstStride[3] * dstY : NULL,
452         };
453         int use_mmx_vfilter= c->use_mmx_vfilter;
454
455         // First line needed as input
456         const int firstLumSrcY  = FFMAX(1 - vLumFilterSize, vLumFilterPos[dstY]);
457         const int firstLumSrcY2 = FFMAX(1 - vLumFilterSize, vLumFilterPos[FFMIN(dstY | ((1 << c->chrDstVSubSample) - 1), dstH - 1)]);
458         // First line needed as input
459         const int firstChrSrcY  = FFMAX(1 - vChrFilterSize, vChrFilterPos[chrDstY]);
460
461         // Last line needed as input
462         int lastLumSrcY  = FFMIN(c->srcH,    firstLumSrcY  + vLumFilterSize) - 1;
463         int lastLumSrcY2 = FFMIN(c->srcH,    firstLumSrcY2 + vLumFilterSize) - 1;
464         int lastChrSrcY  = FFMIN(c->chrSrcH, firstChrSrcY  + vChrFilterSize) - 1;
465         int enough_lines;
466
467         // handle holes (FAST_BILINEAR & weird filters)
468         if (firstLumSrcY > lastInLumBuf)
469             lastInLumBuf = firstLumSrcY - 1;
470         if (firstChrSrcY > lastInChrBuf)
471             lastInChrBuf = firstChrSrcY - 1;
472         assert(firstLumSrcY >= lastInLumBuf - vLumBufSize + 1);
473         assert(firstChrSrcY >= lastInChrBuf - vChrBufSize + 1);
474
475         DEBUG_BUFFERS("dstY: %d\n", dstY);
476         DEBUG_BUFFERS("\tfirstLumSrcY: %d lastLumSrcY: %d lastInLumBuf: %d\n",
477                       firstLumSrcY, lastLumSrcY, lastInLumBuf);
478         DEBUG_BUFFERS("\tfirstChrSrcY: %d lastChrSrcY: %d lastInChrBuf: %d\n",
479                       firstChrSrcY, lastChrSrcY, lastInChrBuf);
480
481         // Do we have enough lines in this slice to output the dstY line
482         enough_lines = lastLumSrcY2 < srcSliceY + srcSliceH &&
483                        lastChrSrcY < -((-srcSliceY - srcSliceH) >> c->chrSrcVSubSample);
484
485         if (!enough_lines) {
486             lastLumSrcY = srcSliceY + srcSliceH - 1;
487             lastChrSrcY = chrSrcSliceY + chrSrcSliceH - 1;
488             DEBUG_BUFFERS("buffering slice: lastLumSrcY %d lastChrSrcY %d\n",
489                           lastLumSrcY, lastChrSrcY);
490         }
491
492         // Do horizontal scaling
493         while (lastInLumBuf < lastLumSrcY) {
494             const uint8_t *src1[4] = {
495                 src[0] + (lastInLumBuf + 1 - srcSliceY) * srcStride[0],
496                 src[1] + (lastInLumBuf + 1 - srcSliceY) * srcStride[1],
497                 src[2] + (lastInLumBuf + 1 - srcSliceY) * srcStride[2],
498                 src[3] + (lastInLumBuf + 1 - srcSliceY) * srcStride[3],
499             };
500             lumBufIndex++;
501             assert(lumBufIndex < 2 * vLumBufSize);
502             assert(lastInLumBuf + 1 - srcSliceY < srcSliceH);
503             assert(lastInLumBuf + 1 - srcSliceY >= 0);
504             hyscale(c, lumPixBuf[lumBufIndex], dstW, src1, srcW, lumXInc,
505                     hLumFilter, hLumFilterPos, hLumFilterSize,
506                     formatConvBuffer, pal, 0);
507             if (CONFIG_SWSCALE_ALPHA && alpPixBuf)
508                 hyscale(c, alpPixBuf[lumBufIndex], dstW, src1, srcW,
509                         lumXInc, hLumFilter, hLumFilterPos, hLumFilterSize,
510                         formatConvBuffer, pal, 1);
511             lastInLumBuf++;
512             DEBUG_BUFFERS("\t\tlumBufIndex %d: lastInLumBuf: %d\n",
513                           lumBufIndex, lastInLumBuf);
514         }
515         while (lastInChrBuf < lastChrSrcY) {
516             const uint8_t *src1[4] = {
517                 src[0] + (lastInChrBuf + 1 - chrSrcSliceY) * srcStride[0],
518                 src[1] + (lastInChrBuf + 1 - chrSrcSliceY) * srcStride[1],
519                 src[2] + (lastInChrBuf + 1 - chrSrcSliceY) * srcStride[2],
520                 src[3] + (lastInChrBuf + 1 - chrSrcSliceY) * srcStride[3],
521             };
522             chrBufIndex++;
523             assert(chrBufIndex < 2 * vChrBufSize);
524             assert(lastInChrBuf + 1 - chrSrcSliceY < (chrSrcSliceH));
525             assert(lastInChrBuf + 1 - chrSrcSliceY >= 0);
526             // FIXME replace parameters through context struct (some at least)
527
528             if (c->needs_hcscale)
529                 hcscale(c, chrUPixBuf[chrBufIndex], chrVPixBuf[chrBufIndex],
530                         chrDstW, src1, chrSrcW, chrXInc,
531                         hChrFilter, hChrFilterPos, hChrFilterSize,
532                         formatConvBuffer, pal);
533             lastInChrBuf++;
534             DEBUG_BUFFERS("\t\tchrBufIndex %d: lastInChrBuf: %d\n",
535                           chrBufIndex, lastInChrBuf);
536         }
537         // wrap buf index around to stay inside the ring buffer
538         if (lumBufIndex >= vLumBufSize)
539             lumBufIndex -= vLumBufSize;
540         if (chrBufIndex >= vChrBufSize)
541             chrBufIndex -= vChrBufSize;
542         if (!enough_lines)
543             break;  // we can't output a dstY line so let's try with the next slice
544
545 #if HAVE_MMX_INLINE
546         updateMMXDitherTables(c, dstY, lumBufIndex, chrBufIndex,
547                               lastInLumBuf, lastInChrBuf);
548 #endif
549         if (should_dither) {
550             c->chrDither8 = dither_8x8_128[chrDstY & 7];
551             c->lumDither8 = dither_8x8_128[dstY    & 7];
552         }
553         if (dstY >= dstH - 2) {
554             /* hmm looks like we can't use MMX here without overwriting
555              * this array's tail */
556             ff_sws_init_output_funcs(c, &yuv2plane1, &yuv2planeX, &yuv2nv12cX,
557                                      &yuv2packed1, &yuv2packed2, &yuv2packedX);
558             use_mmx_vfilter= 0;
559         }
560
561         {
562             const int16_t **lumSrcPtr  = (const int16_t **)(void*) lumPixBuf  + lumBufIndex + firstLumSrcY - lastInLumBuf + vLumBufSize;
563             const int16_t **chrUSrcPtr = (const int16_t **)(void*) chrUPixBuf + chrBufIndex + firstChrSrcY - lastInChrBuf + vChrBufSize;
564             const int16_t **chrVSrcPtr = (const int16_t **)(void*) chrVPixBuf + chrBufIndex + firstChrSrcY - lastInChrBuf + vChrBufSize;
565             const int16_t **alpSrcPtr  = (CONFIG_SWSCALE_ALPHA && alpPixBuf) ?
566                                          (const int16_t **)(void*) alpPixBuf + lumBufIndex + firstLumSrcY - lastInLumBuf + vLumBufSize : NULL;
567             int16_t *vLumFilter = c->vLumFilter;
568             int16_t *vChrFilter = c->vChrFilter;
569
570             if (isPlanarYUV(dstFormat) ||
571                 (isGray(dstFormat) && !isALPHA(dstFormat))) { // YV12 like
572                 const int chrSkipMask = (1 << c->chrDstVSubSample) - 1;
573
574                 vLumFilter +=    dstY * vLumFilterSize;
575                 vChrFilter += chrDstY * vChrFilterSize;
576
577 //                 av_assert0(use_mmx_vfilter != (
578 //                                yuv2planeX == yuv2planeX_10BE_c
579 //                             || yuv2planeX == yuv2planeX_10LE_c
580 //                             || yuv2planeX == yuv2planeX_9BE_c
581 //                             || yuv2planeX == yuv2planeX_9LE_c
582 //                             || yuv2planeX == yuv2planeX_16BE_c
583 //                             || yuv2planeX == yuv2planeX_16LE_c
584 //                             || yuv2planeX == yuv2planeX_8_c) || !ARCH_X86);
585
586                 if(use_mmx_vfilter){
587                     vLumFilter= c->lumMmxFilter;
588                     vChrFilter= c->chrMmxFilter;
589                 }
590
591                 if (vLumFilterSize == 1) {
592                     yuv2plane1(lumSrcPtr[0], dest[0], dstW, c->lumDither8, 0);
593                 } else {
594                     yuv2planeX(vLumFilter, vLumFilterSize,
595                                lumSrcPtr, dest[0],
596                                dstW, c->lumDither8, 0);
597                 }
598
599                 if (!((dstY & chrSkipMask) || isGray(dstFormat))) {
600                     if (yuv2nv12cX) {
601                         yuv2nv12cX(c, vChrFilter,
602                                    vChrFilterSize, chrUSrcPtr, chrVSrcPtr,
603                                    dest[1], chrDstW);
604                     } else if (vChrFilterSize == 1) {
605                         yuv2plane1(chrUSrcPtr[0], dest[1], chrDstW, c->chrDither8, 0);
606                         yuv2plane1(chrVSrcPtr[0], dest[2], chrDstW, c->chrDither8, 3);
607                     } else {
608                         yuv2planeX(vChrFilter,
609                                    vChrFilterSize, chrUSrcPtr, dest[1],
610                                    chrDstW, c->chrDither8, 0);
611                         yuv2planeX(vChrFilter,
612                                    vChrFilterSize, chrVSrcPtr, dest[2],
613                                    chrDstW, c->chrDither8, use_mmx_vfilter ? (c->uv_offx2 >> 1) : 3);
614                     }
615                 }
616
617                 if (CONFIG_SWSCALE_ALPHA && alpPixBuf) {
618                     if(use_mmx_vfilter){
619                         vLumFilter= c->alpMmxFilter;
620                     }
621                     if (vLumFilterSize == 1) {
622                         yuv2plane1(alpSrcPtr[0], dest[3], dstW,
623                                    c->lumDither8, 0);
624                     } else {
625                         yuv2planeX(vLumFilter,
626                                    vLumFilterSize, alpSrcPtr, dest[3],
627                                    dstW, c->lumDither8, 0);
628                     }
629                 }
630             } else {
631                 av_assert1(lumSrcPtr  + vLumFilterSize - 1 < lumPixBuf  + vLumBufSize * 2);
632                 av_assert1(chrUSrcPtr + vChrFilterSize - 1 < chrUPixBuf + vChrBufSize * 2);
633                 if (c->yuv2packed1 && vLumFilterSize == 1 &&
634                     vChrFilterSize <= 2) { // unscaled RGB
635                     int chrAlpha = vChrFilterSize == 1 ? 0 : vChrFilter[2 * dstY + 1];
636                     yuv2packed1(c, *lumSrcPtr, chrUSrcPtr, chrVSrcPtr,
637                                 alpPixBuf ? *alpSrcPtr : NULL,
638                                 dest[0], dstW, chrAlpha, dstY);
639                 } else if (c->yuv2packed2 && vLumFilterSize == 2 &&
640                            vChrFilterSize == 2) { // bilinear upscale RGB
641                     int lumAlpha = vLumFilter[2 * dstY + 1];
642                     int chrAlpha = vChrFilter[2 * dstY + 1];
643                     lumMmxFilter[2] =
644                     lumMmxFilter[3] = vLumFilter[2 * dstY]    * 0x10001;
645                     chrMmxFilter[2] =
646                     chrMmxFilter[3] = vChrFilter[2 * chrDstY] * 0x10001;
647                     yuv2packed2(c, lumSrcPtr, chrUSrcPtr, chrVSrcPtr,
648                                 alpPixBuf ? alpSrcPtr : NULL,
649                                 dest[0], dstW, lumAlpha, chrAlpha, dstY);
650                 } else { // general RGB
651                     yuv2packedX(c, vLumFilter + dstY * vLumFilterSize,
652                                 lumSrcPtr, vLumFilterSize,
653                                 vChrFilter + dstY * vChrFilterSize,
654                                 chrUSrcPtr, chrVSrcPtr, vChrFilterSize,
655                                 alpSrcPtr, dest[0], dstW, dstY);
656                 }
657             }
658         }
659     }
660
661     if (isPlanar(dstFormat) && isALPHA(dstFormat) && !alpPixBuf)
662         fillPlane(dst[3], dstStride[3], dstW, dstY - lastDstY, lastDstY, 255);
663
664 #if HAVE_MMXEXT_INLINE
665     if (av_get_cpu_flags() & AV_CPU_FLAG_MMXEXT)
666         __asm__ volatile ("sfence" ::: "memory");
667 #endif
668     emms_c();
669
670     /* store changed local vars back in the context */
671     c->dstY         = dstY;
672     c->lumBufIndex  = lumBufIndex;
673     c->chrBufIndex  = chrBufIndex;
674     c->lastInLumBuf = lastInLumBuf;
675     c->lastInChrBuf = lastInChrBuf;
676
677     return dstY - lastDstY;
678 }
679
680 static av_cold void sws_init_swScale_c(SwsContext *c)
681 {
682     enum PixelFormat srcFormat = c->srcFormat;
683
684     ff_sws_init_output_funcs(c, &c->yuv2plane1, &c->yuv2planeX,
685                              &c->yuv2nv12cX, &c->yuv2packed1,
686                              &c->yuv2packed2, &c->yuv2packedX);
687
688     ff_sws_init_input_funcs(c);
689
690
691     if (c->srcBpc == 8) {
692         if (c->dstBpc <= 14) {
693             c->hyScale = c->hcScale = hScale8To15_c;
694             if (c->flags & SWS_FAST_BILINEAR) {
695                 c->hyscale_fast = hyscale_fast_c;
696                 c->hcscale_fast = hcscale_fast_c;
697             }
698         } else {
699             c->hyScale = c->hcScale = hScale8To19_c;
700         }
701     } else {
702         c->hyScale = c->hcScale = c->dstBpc > 14 ? hScale16To19_c
703                                                  : hScale16To15_c;
704     }
705
706     if (c->srcRange != c->dstRange && !isAnyRGB(c->dstFormat)) {
707         if (c->dstBpc <= 14) {
708             if (c->srcRange) {
709                 c->lumConvertRange = lumRangeFromJpeg_c;
710                 c->chrConvertRange = chrRangeFromJpeg_c;
711             } else {
712                 c->lumConvertRange = lumRangeToJpeg_c;
713                 c->chrConvertRange = chrRangeToJpeg_c;
714             }
715         } else {
716             if (c->srcRange) {
717                 c->lumConvertRange = lumRangeFromJpeg16_c;
718                 c->chrConvertRange = chrRangeFromJpeg16_c;
719             } else {
720                 c->lumConvertRange = lumRangeToJpeg16_c;
721                 c->chrConvertRange = chrRangeToJpeg16_c;
722             }
723         }
724     }
725
726     if (!(isGray(srcFormat) || isGray(c->dstFormat) ||
727           srcFormat == PIX_FMT_MONOBLACK || srcFormat == PIX_FMT_MONOWHITE))
728         c->needs_hcscale = 1;
729 }
730
731 SwsFunc ff_getSwsFunc(SwsContext *c)
732 {
733     sws_init_swScale_c(c);
734
735     if (HAVE_MMX)
736         ff_sws_init_swScale_mmx(c);
737     if (HAVE_ALTIVEC)
738         ff_sws_init_swScale_altivec(c);
739
740     return swScale;
741 }