yuvPlanartouyvy_c: fix sign extension
[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     const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(c->srcFormat);
70     int i;
71     int32_t *dst        = (int32_t *) _dst;
72     const uint16_t *src = (const uint16_t *) _src;
73     int bits            = desc->comp[0].depth_minus1;
74     int sh              = bits - 4;
75
76     if((isAnyRGB(c->srcFormat) || c->srcFormat==AV_PIX_FMT_PAL8) && desc->comp[0].depth_minus1<15)
77         sh= 9;
78
79     for (i = 0; i < dstW; i++) {
80         int j;
81         int srcPos = filterPos[i];
82         int val    = 0;
83
84         for (j = 0; j < filterSize; j++) {
85             val += src[srcPos + j] * filter[filterSize * i + j];
86         }
87         // filter=14 bit, input=16 bit, output=30 bit, >> 11 makes 19 bit
88         dst[i] = FFMIN(val >> sh, (1 << 19) - 1);
89     }
90 }
91
92 static void hScale16To15_c(SwsContext *c, int16_t *dst, int dstW,
93                            const uint8_t *_src, const int16_t *filter,
94                            const int32_t *filterPos, int filterSize)
95 {
96     const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(c->srcFormat);
97     int i;
98     const uint16_t *src = (const uint16_t *) _src;
99     int sh              = desc->comp[0].depth_minus1;
100
101     if(sh<15)
102         sh= isAnyRGB(c->srcFormat) || c->srcFormat==AV_PIX_FMT_PAL8 ? 13 : desc->comp[0].depth_minus1;
103
104     for (i = 0; i < dstW; i++) {
105         int j;
106         int srcPos = filterPos[i];
107         int val    = 0;
108
109         for (j = 0; j < filterSize; j++) {
110             val += src[srcPos + j] * filter[filterSize * i + j];
111         }
112         // filter=14 bit, input=16 bit, output=30 bit, >> 15 makes 15 bit
113         dst[i] = FFMIN(val >> sh, (1 << 15) - 1);
114     }
115 }
116
117 // bilinear / bicubic scaling
118 static void hScale8To15_c(SwsContext *c, int16_t *dst, int dstW,
119                           const uint8_t *src, const int16_t *filter,
120                           const int32_t *filterPos, int filterSize)
121 {
122     int i;
123     for (i = 0; i < dstW; i++) {
124         int j;
125         int srcPos = filterPos[i];
126         int val    = 0;
127         for (j = 0; j < filterSize; j++) {
128             val += ((int)src[srcPos + j]) * filter[filterSize * i + j];
129         }
130         dst[i] = FFMIN(val >> 7, (1 << 15) - 1); // the cubic equation does overflow ...
131     }
132 }
133
134 static void hScale8To19_c(SwsContext *c, int16_t *_dst, int dstW,
135                           const uint8_t *src, const int16_t *filter,
136                           const int32_t *filterPos, int filterSize)
137 {
138     int i;
139     int32_t *dst = (int32_t *) _dst;
140     for (i = 0; i < dstW; i++) {
141         int j;
142         int srcPos = filterPos[i];
143         int val    = 0;
144         for (j = 0; j < filterSize; j++) {
145             val += ((int)src[srcPos + j]) * filter[filterSize * i + j];
146         }
147         dst[i] = FFMIN(val >> 3, (1 << 19) - 1); // the cubic equation does overflow ...
148     }
149 }
150
151 // FIXME all pal and rgb srcFormats could do this convertion as well
152 // FIXME all scalers more complex than bilinear could do half of this transform
153 static void chrRangeToJpeg_c(int16_t *dstU, int16_t *dstV, int width)
154 {
155     int i;
156     for (i = 0; i < width; i++) {
157         dstU[i] = (FFMIN(dstU[i], 30775) * 4663 - 9289992) >> 12; // -264
158         dstV[i] = (FFMIN(dstV[i], 30775) * 4663 - 9289992) >> 12; // -264
159     }
160 }
161
162 static void chrRangeFromJpeg_c(int16_t *dstU, int16_t *dstV, int width)
163 {
164     int i;
165     for (i = 0; i < width; i++) {
166         dstU[i] = (dstU[i] * 1799 + 4081085) >> 11; // 1469
167         dstV[i] = (dstV[i] * 1799 + 4081085) >> 11; // 1469
168     }
169 }
170
171 static void lumRangeToJpeg_c(int16_t *dst, int width)
172 {
173     int i;
174     for (i = 0; i < width; i++)
175         dst[i] = (FFMIN(dst[i], 30189) * 19077 - 39057361) >> 14;
176 }
177
178 static void lumRangeFromJpeg_c(int16_t *dst, int width)
179 {
180     int i;
181     for (i = 0; i < width; i++)
182         dst[i] = (dst[i] * 14071 + 33561947) >> 14;
183 }
184
185 static void chrRangeToJpeg16_c(int16_t *_dstU, int16_t *_dstV, int width)
186 {
187     int i;
188     int32_t *dstU = (int32_t *) _dstU;
189     int32_t *dstV = (int32_t *) _dstV;
190     for (i = 0; i < width; i++) {
191         dstU[i] = (FFMIN(dstU[i], 30775 << 4) * 4663 - (9289992 << 4)) >> 12; // -264
192         dstV[i] = (FFMIN(dstV[i], 30775 << 4) * 4663 - (9289992 << 4)) >> 12; // -264
193     }
194 }
195
196 static void chrRangeFromJpeg16_c(int16_t *_dstU, int16_t *_dstV, int width)
197 {
198     int i;
199     int32_t *dstU = (int32_t *) _dstU;
200     int32_t *dstV = (int32_t *) _dstV;
201     for (i = 0; i < width; i++) {
202         dstU[i] = (dstU[i] * 1799 + (4081085 << 4)) >> 11; // 1469
203         dstV[i] = (dstV[i] * 1799 + (4081085 << 4)) >> 11; // 1469
204     }
205 }
206
207 static void lumRangeToJpeg16_c(int16_t *_dst, int width)
208 {
209     int i;
210     int32_t *dst = (int32_t *) _dst;
211     for (i = 0; i < width; i++)
212         dst[i] = (FFMIN(dst[i], 30189 << 4) * 4769 - (39057361 << 2)) >> 12;
213 }
214
215 static void lumRangeFromJpeg16_c(int16_t *_dst, int width)
216 {
217     int i;
218     int32_t *dst = (int32_t *) _dst;
219     for (i = 0; i < width; i++)
220         dst[i] = (dst[i]*(14071/4) + (33561947<<4)/4)>>12;
221 }
222
223 static void hyscale_fast_c(SwsContext *c, int16_t *dst, int dstWidth,
224                            const uint8_t *src, int srcW, int xInc)
225 {
226     int i;
227     unsigned int xpos = 0;
228     for (i = 0; i < dstWidth; i++) {
229         register unsigned int xx     = xpos >> 16;
230         register unsigned int xalpha = (xpos & 0xFFFF) >> 9;
231         dst[i] = (src[xx] << 7) + (src[xx + 1] - src[xx]) * xalpha;
232         xpos  += xInc;
233     }
234     for (i=dstWidth-1; (i*xInc)>>16 >=srcW-1; i--)
235         dst[i] = src[srcW-1]*128;
236 }
237
238 // *** horizontal scale Y line to temp buffer
239 static av_always_inline void hyscale(SwsContext *c, int16_t *dst, int dstWidth,
240                                      const uint8_t *src_in[4],
241                                      int srcW, int xInc,
242                                      const int16_t *hLumFilter,
243                                      const int32_t *hLumFilterPos,
244                                      int hLumFilterSize,
245                                      uint8_t *formatConvBuffer,
246                                      uint32_t *pal, int isAlpha)
247 {
248     void (*toYV12)(uint8_t *, const uint8_t *, const uint8_t *, const uint8_t *, int, uint32_t *) =
249         isAlpha ? c->alpToYV12 : c->lumToYV12;
250     void (*convertRange)(int16_t *, int) = isAlpha ? NULL : c->lumConvertRange;
251     const uint8_t *src = src_in[isAlpha ? 3 : 0];
252
253     if (toYV12) {
254         toYV12(formatConvBuffer, src, src_in[1], src_in[2], srcW, pal);
255         src = formatConvBuffer;
256     } else if (c->readLumPlanar && !isAlpha) {
257         c->readLumPlanar(formatConvBuffer, src_in, srcW);
258         src = formatConvBuffer;
259     }
260
261     if (!c->hyscale_fast) {
262         c->hyScale(c, dst, dstWidth, src, hLumFilter,
263                    hLumFilterPos, hLumFilterSize);
264     } else { // fast bilinear upscale / crap downscale
265         c->hyscale_fast(c, dst, dstWidth, src, srcW, xInc);
266     }
267
268     if (convertRange)
269         convertRange(dst, dstWidth);
270 }
271
272 static void hcscale_fast_c(SwsContext *c, int16_t *dst1, int16_t *dst2,
273                            int dstWidth, const uint8_t *src1,
274                            const uint8_t *src2, int srcW, int xInc)
275 {
276     int i;
277     unsigned int xpos = 0;
278     for (i = 0; i < dstWidth; i++) {
279         register unsigned int xx     = xpos >> 16;
280         register unsigned int xalpha = (xpos & 0xFFFF) >> 9;
281         dst1[i] = (src1[xx] * (xalpha ^ 127) + src1[xx + 1] * xalpha);
282         dst2[i] = (src2[xx] * (xalpha ^ 127) + src2[xx + 1] * xalpha);
283         xpos   += xInc;
284     }
285     for (i=dstWidth-1; (i*xInc)>>16 >=srcW-1; i--) {
286         dst1[i] = src1[srcW-1]*128;
287         dst2[i] = src2[srcW-1]*128;
288     }
289 }
290
291 static av_always_inline void hcscale(SwsContext *c, int16_t *dst1,
292                                      int16_t *dst2, int dstWidth,
293                                      const uint8_t *src_in[4],
294                                      int srcW, int xInc,
295                                      const int16_t *hChrFilter,
296                                      const int32_t *hChrFilterPos,
297                                      int hChrFilterSize,
298                                      uint8_t *formatConvBuffer, uint32_t *pal)
299 {
300     const uint8_t *src1 = src_in[1], *src2 = src_in[2];
301     if (c->chrToYV12) {
302         uint8_t *buf2 = formatConvBuffer +
303                         FFALIGN(srcW*2+78, 16);
304         c->chrToYV12(formatConvBuffer, buf2, src_in[0], src1, src2, srcW, pal);
305         src1= formatConvBuffer;
306         src2= buf2;
307     } else if (c->readChrPlanar) {
308         uint8_t *buf2 = formatConvBuffer +
309                         FFALIGN(srcW*2+78, 16);
310         c->readChrPlanar(formatConvBuffer, buf2, src_in, srcW);
311         src1 = formatConvBuffer;
312         src2 = buf2;
313     }
314
315     if (!c->hcscale_fast) {
316         c->hcScale(c, dst1, dstWidth, src1, hChrFilter, hChrFilterPos, hChrFilterSize);
317         c->hcScale(c, dst2, dstWidth, src2, hChrFilter, hChrFilterPos, hChrFilterSize);
318     } else { // fast bilinear upscale / crap downscale
319         c->hcscale_fast(c, dst1, dst2, dstWidth, src1, src2, srcW, xInc);
320     }
321
322     if (c->chrConvertRange)
323         c->chrConvertRange(dst1, dst2, dstWidth);
324 }
325
326 #define DEBUG_SWSCALE_BUFFERS 0
327 #define DEBUG_BUFFERS(...)                      \
328     if (DEBUG_SWSCALE_BUFFERS)                  \
329         av_log(c, AV_LOG_DEBUG, __VA_ARGS__)
330
331 static int swScale(SwsContext *c, const uint8_t *src[],
332                    int srcStride[], int srcSliceY,
333                    int srcSliceH, uint8_t *dst[], int dstStride[])
334 {
335     /* load a few things into local vars to make the code more readable?
336      * and faster */
337     const int srcW                   = c->srcW;
338     const int dstW                   = c->dstW;
339     const int dstH                   = c->dstH;
340     const int chrDstW                = c->chrDstW;
341     const int chrSrcW                = c->chrSrcW;
342     const int lumXInc                = c->lumXInc;
343     const int chrXInc                = c->chrXInc;
344     const enum AVPixelFormat dstFormat = c->dstFormat;
345     const int flags                  = c->flags;
346     int32_t *vLumFilterPos           = c->vLumFilterPos;
347     int32_t *vChrFilterPos           = c->vChrFilterPos;
348     int32_t *hLumFilterPos           = c->hLumFilterPos;
349     int32_t *hChrFilterPos           = c->hChrFilterPos;
350     int16_t *hLumFilter              = c->hLumFilter;
351     int16_t *hChrFilter              = c->hChrFilter;
352     int32_t *lumMmxFilter            = c->lumMmxFilter;
353     int32_t *chrMmxFilter            = c->chrMmxFilter;
354     const int vLumFilterSize         = c->vLumFilterSize;
355     const int vChrFilterSize         = c->vChrFilterSize;
356     const int hLumFilterSize         = c->hLumFilterSize;
357     const int hChrFilterSize         = c->hChrFilterSize;
358     int16_t **lumPixBuf              = c->lumPixBuf;
359     int16_t **chrUPixBuf             = c->chrUPixBuf;
360     int16_t **chrVPixBuf             = c->chrVPixBuf;
361     int16_t **alpPixBuf              = c->alpPixBuf;
362     const int vLumBufSize            = c->vLumBufSize;
363     const int vChrBufSize            = c->vChrBufSize;
364     uint8_t *formatConvBuffer        = c->formatConvBuffer;
365     uint32_t *pal                    = c->pal_yuv;
366     yuv2planar1_fn yuv2plane1        = c->yuv2plane1;
367     yuv2planarX_fn yuv2planeX        = c->yuv2planeX;
368     yuv2interleavedX_fn yuv2nv12cX   = c->yuv2nv12cX;
369     yuv2packed1_fn yuv2packed1       = c->yuv2packed1;
370     yuv2packed2_fn yuv2packed2       = c->yuv2packed2;
371     yuv2packedX_fn yuv2packedX       = c->yuv2packedX;
372     const int chrSrcSliceY           =     srcSliceY  >> c->chrSrcVSubSample;
373     const int chrSrcSliceH           = -((-srcSliceH) >> c->chrSrcVSubSample);
374     int should_dither                = is9_OR_10BPS(c->srcFormat) ||
375                                        is16BPS(c->srcFormat);
376     int lastDstY;
377
378     /* vars which will change and which we need to store back in the context */
379     int dstY         = c->dstY;
380     int lumBufIndex  = c->lumBufIndex;
381     int chrBufIndex  = c->chrBufIndex;
382     int lastInLumBuf = c->lastInLumBuf;
383     int lastInChrBuf = c->lastInChrBuf;
384
385     if (isPacked(c->srcFormat)) {
386         src[0] =
387         src[1] =
388         src[2] =
389         src[3] = src[0];
390         srcStride[0] =
391         srcStride[1] =
392         srcStride[2] =
393         srcStride[3] = srcStride[0];
394     }
395     srcStride[1] <<= c->vChrDrop;
396     srcStride[2] <<= c->vChrDrop;
397
398     DEBUG_BUFFERS("swScale() %p[%d] %p[%d] %p[%d] %p[%d] -> %p[%d] %p[%d] %p[%d] %p[%d]\n",
399                   src[0], srcStride[0], src[1], srcStride[1],
400                   src[2], srcStride[2], src[3], srcStride[3],
401                   dst[0], dstStride[0], dst[1], dstStride[1],
402                   dst[2], dstStride[2], dst[3], dstStride[3]);
403     DEBUG_BUFFERS("srcSliceY: %d srcSliceH: %d dstY: %d dstH: %d\n",
404                   srcSliceY, srcSliceH, dstY, dstH);
405     DEBUG_BUFFERS("vLumFilterSize: %d vLumBufSize: %d vChrFilterSize: %d vChrBufSize: %d\n",
406                   vLumFilterSize, vLumBufSize, vChrFilterSize, vChrBufSize);
407
408     if (dstStride[0]%16 !=0 || dstStride[1]%16 !=0 ||
409         dstStride[2]%16 !=0 || dstStride[3]%16 != 0) {
410         static int warnedAlready = 0; // FIXME maybe move this into the context
411         if (flags & SWS_PRINT_INFO && !warnedAlready) {
412             av_log(c, AV_LOG_WARNING,
413                    "Warning: dstStride is not aligned!\n"
414                    "         ->cannot do aligned memory accesses anymore\n");
415             warnedAlready = 1;
416         }
417     }
418
419     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
420         || dstStride[0]%16 || dstStride[1]%16 || dstStride[2]%16 || dstStride[3]%16
421         || srcStride[0]%16 || srcStride[1]%16 || srcStride[2]%16 || srcStride[3]%16
422     ) {
423         static int warnedAlready=0;
424         int cpu_flags = av_get_cpu_flags();
425         if (HAVE_MMXEXT && (cpu_flags & AV_CPU_FLAG_SSE2) && !warnedAlready){
426             av_log(c, AV_LOG_WARNING, "Warning: data is not aligned! This can lead to a speedloss\n");
427             warnedAlready=1;
428         }
429     }
430
431     /* Note the user might start scaling the picture in the middle so this
432      * will not get executed. This is not really intended but works
433      * currently, so people might do it. */
434     if (srcSliceY == 0) {
435         lumBufIndex  = -1;
436         chrBufIndex  = -1;
437         dstY         = 0;
438         lastInLumBuf = -1;
439         lastInChrBuf = -1;
440     }
441
442     if (!should_dither) {
443         c->chrDither8 = c->lumDither8 = ff_sws_pb_64;
444     }
445     lastDstY = dstY;
446
447     for (; dstY < dstH; dstY++) {
448         const int chrDstY = dstY >> c->chrDstVSubSample;
449         uint8_t *dest[4]  = {
450             dst[0] + dstStride[0] * dstY,
451             dst[1] + dstStride[1] * chrDstY,
452             dst[2] + dstStride[2] * chrDstY,
453             (CONFIG_SWSCALE_ALPHA && alpPixBuf) ? dst[3] + dstStride[3] * dstY : NULL,
454         };
455         int use_mmx_vfilter= c->use_mmx_vfilter;
456
457         // First line needed as input
458         const int firstLumSrcY  = FFMAX(1 - vLumFilterSize, vLumFilterPos[dstY]);
459         const int firstLumSrcY2 = FFMAX(1 - vLumFilterSize, vLumFilterPos[FFMIN(dstY | ((1 << c->chrDstVSubSample) - 1), dstH - 1)]);
460         // First line needed as input
461         const int firstChrSrcY  = FFMAX(1 - vChrFilterSize, vChrFilterPos[chrDstY]);
462
463         // Last line needed as input
464         int lastLumSrcY  = FFMIN(c->srcH,    firstLumSrcY  + vLumFilterSize) - 1;
465         int lastLumSrcY2 = FFMIN(c->srcH,    firstLumSrcY2 + vLumFilterSize) - 1;
466         int lastChrSrcY  = FFMIN(c->chrSrcH, firstChrSrcY  + vChrFilterSize) - 1;
467         int enough_lines;
468
469         // handle holes (FAST_BILINEAR & weird filters)
470         if (firstLumSrcY > lastInLumBuf)
471             lastInLumBuf = firstLumSrcY - 1;
472         if (firstChrSrcY > lastInChrBuf)
473             lastInChrBuf = firstChrSrcY - 1;
474         av_assert0(firstLumSrcY >= lastInLumBuf - vLumBufSize + 1);
475         av_assert0(firstChrSrcY >= lastInChrBuf - vChrBufSize + 1);
476
477         DEBUG_BUFFERS("dstY: %d\n", dstY);
478         DEBUG_BUFFERS("\tfirstLumSrcY: %d lastLumSrcY: %d lastInLumBuf: %d\n",
479                       firstLumSrcY, lastLumSrcY, lastInLumBuf);
480         DEBUG_BUFFERS("\tfirstChrSrcY: %d lastChrSrcY: %d lastInChrBuf: %d\n",
481                       firstChrSrcY, lastChrSrcY, lastInChrBuf);
482
483         // Do we have enough lines in this slice to output the dstY line
484         enough_lines = lastLumSrcY2 < srcSliceY + srcSliceH &&
485                        lastChrSrcY < -((-srcSliceY - srcSliceH) >> c->chrSrcVSubSample);
486
487         if (!enough_lines) {
488             lastLumSrcY = srcSliceY + srcSliceH - 1;
489             lastChrSrcY = chrSrcSliceY + chrSrcSliceH - 1;
490             DEBUG_BUFFERS("buffering slice: lastLumSrcY %d lastChrSrcY %d\n",
491                           lastLumSrcY, lastChrSrcY);
492         }
493
494         // Do horizontal scaling
495         while (lastInLumBuf < lastLumSrcY) {
496             const uint8_t *src1[4] = {
497                 src[0] + (lastInLumBuf + 1 - srcSliceY) * srcStride[0],
498                 src[1] + (lastInLumBuf + 1 - srcSliceY) * srcStride[1],
499                 src[2] + (lastInLumBuf + 1 - srcSliceY) * srcStride[2],
500                 src[3] + (lastInLumBuf + 1 - srcSliceY) * srcStride[3],
501             };
502             lumBufIndex++;
503             av_assert0(lumBufIndex < 2 * vLumBufSize);
504             av_assert0(lastInLumBuf + 1 - srcSliceY < srcSliceH);
505             av_assert0(lastInLumBuf + 1 - srcSliceY >= 0);
506             hyscale(c, lumPixBuf[lumBufIndex], dstW, src1, srcW, lumXInc,
507                     hLumFilter, hLumFilterPos, hLumFilterSize,
508                     formatConvBuffer, pal, 0);
509             if (CONFIG_SWSCALE_ALPHA && alpPixBuf)
510                 hyscale(c, alpPixBuf[lumBufIndex], dstW, src1, srcW,
511                         lumXInc, hLumFilter, hLumFilterPos, hLumFilterSize,
512                         formatConvBuffer, pal, 1);
513             lastInLumBuf++;
514             DEBUG_BUFFERS("\t\tlumBufIndex %d: lastInLumBuf: %d\n",
515                           lumBufIndex, lastInLumBuf);
516         }
517         while (lastInChrBuf < lastChrSrcY) {
518             const uint8_t *src1[4] = {
519                 src[0] + (lastInChrBuf + 1 - chrSrcSliceY) * srcStride[0],
520                 src[1] + (lastInChrBuf + 1 - chrSrcSliceY) * srcStride[1],
521                 src[2] + (lastInChrBuf + 1 - chrSrcSliceY) * srcStride[2],
522                 src[3] + (lastInChrBuf + 1 - chrSrcSliceY) * srcStride[3],
523             };
524             chrBufIndex++;
525             av_assert0(chrBufIndex < 2 * vChrBufSize);
526             av_assert0(lastInChrBuf + 1 - chrSrcSliceY < (chrSrcSliceH));
527             av_assert0(lastInChrBuf + 1 - chrSrcSliceY >= 0);
528             // FIXME replace parameters through context struct (some at least)
529
530             if (c->needs_hcscale)
531                 hcscale(c, chrUPixBuf[chrBufIndex], chrVPixBuf[chrBufIndex],
532                         chrDstW, src1, chrSrcW, chrXInc,
533                         hChrFilter, hChrFilterPos, hChrFilterSize,
534                         formatConvBuffer, pal);
535             lastInChrBuf++;
536             DEBUG_BUFFERS("\t\tchrBufIndex %d: lastInChrBuf: %d\n",
537                           chrBufIndex, lastInChrBuf);
538         }
539         // wrap buf index around to stay inside the ring buffer
540         if (lumBufIndex >= vLumBufSize)
541             lumBufIndex -= vLumBufSize;
542         if (chrBufIndex >= vChrBufSize)
543             chrBufIndex -= vChrBufSize;
544         if (!enough_lines)
545             break;  // we can't output a dstY line so let's try with the next slice
546
547 #if HAVE_MMX_INLINE
548         updateMMXDitherTables(c, dstY, lumBufIndex, chrBufIndex,
549                               lastInLumBuf, lastInChrBuf);
550 #endif
551         if (should_dither) {
552             c->chrDither8 = dither_8x8_128[chrDstY & 7];
553             c->lumDither8 = dither_8x8_128[dstY    & 7];
554         }
555         if (dstY >= dstH - 2) {
556             /* hmm looks like we can't use MMX here without overwriting
557              * this array's tail */
558             ff_sws_init_output_funcs(c, &yuv2plane1, &yuv2planeX, &yuv2nv12cX,
559                                      &yuv2packed1, &yuv2packed2, &yuv2packedX);
560             use_mmx_vfilter= 0;
561         }
562
563         {
564             const int16_t **lumSrcPtr  = (const int16_t **)(void*) lumPixBuf  + lumBufIndex + firstLumSrcY - lastInLumBuf + vLumBufSize;
565             const int16_t **chrUSrcPtr = (const int16_t **)(void*) chrUPixBuf + chrBufIndex + firstChrSrcY - lastInChrBuf + vChrBufSize;
566             const int16_t **chrVSrcPtr = (const int16_t **)(void*) chrVPixBuf + chrBufIndex + firstChrSrcY - lastInChrBuf + vChrBufSize;
567             const int16_t **alpSrcPtr  = (CONFIG_SWSCALE_ALPHA && alpPixBuf) ?
568                                          (const int16_t **)(void*) alpPixBuf + lumBufIndex + firstLumSrcY - lastInLumBuf + vLumBufSize : NULL;
569             int16_t *vLumFilter = c->vLumFilter;
570             int16_t *vChrFilter = c->vChrFilter;
571
572             if (isPlanarYUV(dstFormat) ||
573                 (isGray(dstFormat) && !isALPHA(dstFormat))) { // YV12 like
574                 const int chrSkipMask = (1 << c->chrDstVSubSample) - 1;
575
576                 vLumFilter +=    dstY * vLumFilterSize;
577                 vChrFilter += chrDstY * vChrFilterSize;
578
579 //                 av_assert0(use_mmx_vfilter != (
580 //                                yuv2planeX == yuv2planeX_10BE_c
581 //                             || yuv2planeX == yuv2planeX_10LE_c
582 //                             || yuv2planeX == yuv2planeX_9BE_c
583 //                             || yuv2planeX == yuv2planeX_9LE_c
584 //                             || yuv2planeX == yuv2planeX_16BE_c
585 //                             || yuv2planeX == yuv2planeX_16LE_c
586 //                             || yuv2planeX == yuv2planeX_8_c) || !ARCH_X86);
587
588                 if(use_mmx_vfilter){
589                     vLumFilter= c->lumMmxFilter;
590                     vChrFilter= c->chrMmxFilter;
591                 }
592
593                 if (vLumFilterSize == 1) {
594                     yuv2plane1(lumSrcPtr[0], dest[0], dstW, c->lumDither8, 0);
595                 } else {
596                     yuv2planeX(vLumFilter, vLumFilterSize,
597                                lumSrcPtr, dest[0],
598                                dstW, c->lumDither8, 0);
599                 }
600
601                 if (!((dstY & chrSkipMask) || isGray(dstFormat))) {
602                     if (yuv2nv12cX) {
603                         yuv2nv12cX(c, vChrFilter,
604                                    vChrFilterSize, chrUSrcPtr, chrVSrcPtr,
605                                    dest[1], chrDstW);
606                     } else if (vChrFilterSize == 1) {
607                         yuv2plane1(chrUSrcPtr[0], dest[1], chrDstW, c->chrDither8, 0);
608                         yuv2plane1(chrVSrcPtr[0], dest[2], chrDstW, c->chrDither8, 3);
609                     } else {
610                         yuv2planeX(vChrFilter,
611                                    vChrFilterSize, chrUSrcPtr, dest[1],
612                                    chrDstW, c->chrDither8, 0);
613                         yuv2planeX(vChrFilter,
614                                    vChrFilterSize, chrVSrcPtr, dest[2],
615                                    chrDstW, c->chrDither8, use_mmx_vfilter ? (c->uv_offx2 >> 1) : 3);
616                     }
617                 }
618
619                 if (CONFIG_SWSCALE_ALPHA && alpPixBuf) {
620                     if(use_mmx_vfilter){
621                         vLumFilter= c->alpMmxFilter;
622                     }
623                     if (vLumFilterSize == 1) {
624                         yuv2plane1(alpSrcPtr[0], dest[3], dstW,
625                                    c->lumDither8, 0);
626                     } else {
627                         yuv2planeX(vLumFilter,
628                                    vLumFilterSize, alpSrcPtr, dest[3],
629                                    dstW, c->lumDither8, 0);
630                     }
631                 }
632             } else {
633                 av_assert1(lumSrcPtr  + vLumFilterSize - 1 < lumPixBuf  + vLumBufSize * 2);
634                 av_assert1(chrUSrcPtr + vChrFilterSize - 1 < chrUPixBuf + vChrBufSize * 2);
635                 if (c->yuv2packed1 && vLumFilterSize == 1 &&
636                     vChrFilterSize <= 2) { // unscaled RGB
637                     int chrAlpha = vChrFilterSize == 1 ? 0 : vChrFilter[2 * dstY + 1];
638                     yuv2packed1(c, *lumSrcPtr, chrUSrcPtr, chrVSrcPtr,
639                                 alpPixBuf ? *alpSrcPtr : NULL,
640                                 dest[0], dstW, chrAlpha, dstY);
641                 } else if (c->yuv2packed2 && vLumFilterSize == 2 &&
642                            vChrFilterSize == 2) { // bilinear upscale RGB
643                     int lumAlpha = vLumFilter[2 * dstY + 1];
644                     int chrAlpha = vChrFilter[2 * dstY + 1];
645                     lumMmxFilter[2] =
646                     lumMmxFilter[3] = vLumFilter[2 * dstY]    * 0x10001;
647                     chrMmxFilter[2] =
648                     chrMmxFilter[3] = vChrFilter[2 * chrDstY] * 0x10001;
649                     yuv2packed2(c, lumSrcPtr, chrUSrcPtr, chrVSrcPtr,
650                                 alpPixBuf ? alpSrcPtr : NULL,
651                                 dest[0], dstW, lumAlpha, chrAlpha, dstY);
652                 } else { // general RGB
653                     yuv2packedX(c, vLumFilter + dstY * vLumFilterSize,
654                                 lumSrcPtr, vLumFilterSize,
655                                 vChrFilter + dstY * vChrFilterSize,
656                                 chrUSrcPtr, chrVSrcPtr, vChrFilterSize,
657                                 alpSrcPtr, dest[0], dstW, dstY);
658                 }
659             }
660         }
661     }
662
663     if (isPlanar(dstFormat) && isALPHA(dstFormat) && !alpPixBuf)
664         fillPlane(dst[3], dstStride[3], dstW, dstY - lastDstY, lastDstY, 255);
665
666 #if HAVE_MMXEXT_INLINE
667     if (av_get_cpu_flags() & AV_CPU_FLAG_MMXEXT)
668         __asm__ volatile ("sfence" ::: "memory");
669 #endif
670     emms_c();
671
672     /* store changed local vars back in the context */
673     c->dstY         = dstY;
674     c->lumBufIndex  = lumBufIndex;
675     c->chrBufIndex  = chrBufIndex;
676     c->lastInLumBuf = lastInLumBuf;
677     c->lastInChrBuf = lastInChrBuf;
678
679     return dstY - lastDstY;
680 }
681
682 static av_cold void sws_init_swScale_c(SwsContext *c)
683 {
684     enum AVPixelFormat srcFormat = c->srcFormat;
685
686     ff_sws_init_output_funcs(c, &c->yuv2plane1, &c->yuv2planeX,
687                              &c->yuv2nv12cX, &c->yuv2packed1,
688                              &c->yuv2packed2, &c->yuv2packedX);
689
690     ff_sws_init_input_funcs(c);
691
692
693     if (c->srcBpc == 8) {
694         if (c->dstBpc <= 14) {
695             c->hyScale = c->hcScale = hScale8To15_c;
696             if (c->flags & SWS_FAST_BILINEAR) {
697                 c->hyscale_fast = hyscale_fast_c;
698                 c->hcscale_fast = hcscale_fast_c;
699             }
700         } else {
701             c->hyScale = c->hcScale = hScale8To19_c;
702         }
703     } else {
704         c->hyScale = c->hcScale = c->dstBpc > 14 ? hScale16To19_c
705                                                  : hScale16To15_c;
706     }
707
708     if (c->srcRange != c->dstRange && !isAnyRGB(c->dstFormat)) {
709         if (c->dstBpc <= 14) {
710             if (c->srcRange) {
711                 c->lumConvertRange = lumRangeFromJpeg_c;
712                 c->chrConvertRange = chrRangeFromJpeg_c;
713             } else {
714                 c->lumConvertRange = lumRangeToJpeg_c;
715                 c->chrConvertRange = chrRangeToJpeg_c;
716             }
717         } else {
718             if (c->srcRange) {
719                 c->lumConvertRange = lumRangeFromJpeg16_c;
720                 c->chrConvertRange = chrRangeFromJpeg16_c;
721             } else {
722                 c->lumConvertRange = lumRangeToJpeg16_c;
723                 c->chrConvertRange = chrRangeToJpeg16_c;
724             }
725         }
726     }
727
728     if (!(isGray(srcFormat) || isGray(c->dstFormat) ||
729           srcFormat == AV_PIX_FMT_MONOBLACK || srcFormat == AV_PIX_FMT_MONOWHITE))
730         c->needs_hcscale = 1;
731 }
732
733 SwsFunc ff_getSwsFunc(SwsContext *c)
734 {
735     sws_init_swScale_c(c);
736
737     if (HAVE_MMX)
738         ff_sws_init_swScale_mmx(c);
739     if (HAVE_ALTIVEC)
740         ff_sws_init_swScale_altivec(c);
741
742     return swScale;
743 }
744
745 static void reset_ptr(const uint8_t *src[], int format)
746 {
747     if (!isALPHA(format))
748         src[3] = NULL;
749     if (!isPlanar(format)) {
750         src[3] = src[2] = NULL;
751
752         if (!usePal(format))
753             src[1] = NULL;
754     }
755 }
756
757 static int check_image_pointers(const uint8_t * const data[4], enum AVPixelFormat pix_fmt,
758                                 const int linesizes[4])
759 {
760     const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(pix_fmt);
761     int i;
762
763     for (i = 0; i < 4; i++) {
764         int plane = desc->comp[i].plane;
765         if (!data[plane] || !linesizes[plane])
766             return 0;
767     }
768
769     return 1;
770 }
771
772 /**
773  * swscale wrapper, so we don't need to export the SwsContext.
774  * Assumes planar YUV to be in YUV order instead of YVU.
775  */
776 int attribute_align_arg sws_scale(struct SwsContext *c,
777                                   const uint8_t * const srcSlice[],
778                                   const int srcStride[], int srcSliceY,
779                                   int srcSliceH, uint8_t *const dst[],
780                                   const int dstStride[])
781 {
782     int i, ret;
783     const uint8_t *src2[4] = { srcSlice[0], srcSlice[1], srcSlice[2], srcSlice[3] };
784     uint8_t *dst2[4] = { dst[0], dst[1], dst[2], dst[3] };
785     uint8_t *rgb0_tmp = NULL;
786
787     // do not mess up sliceDir if we have a "trailing" 0-size slice
788     if (srcSliceH == 0)
789         return 0;
790
791     if (!check_image_pointers(srcSlice, c->srcFormat, srcStride)) {
792         av_log(c, AV_LOG_ERROR, "bad src image pointers\n");
793         return 0;
794     }
795     if (!check_image_pointers((const uint8_t* const*)dst, c->dstFormat, dstStride)) {
796         av_log(c, AV_LOG_ERROR, "bad dst image pointers\n");
797         return 0;
798     }
799
800     if (c->sliceDir == 0 && srcSliceY != 0 && srcSliceY + srcSliceH != c->srcH) {
801         av_log(c, AV_LOG_ERROR, "Slices start in the middle!\n");
802         return 0;
803     }
804     if (c->sliceDir == 0) {
805         if (srcSliceY == 0) c->sliceDir = 1; else c->sliceDir = -1;
806     }
807
808     if (usePal(c->srcFormat)) {
809         for (i = 0; i < 256; i++) {
810             int p, r, g, b, y, u, v, a = 0xff;
811             if (c->srcFormat == AV_PIX_FMT_PAL8) {
812                 p = ((const uint32_t *)(srcSlice[1]))[i];
813                 a = (p >> 24) & 0xFF;
814                 r = (p >> 16) & 0xFF;
815                 g = (p >>  8) & 0xFF;
816                 b =  p        & 0xFF;
817             } else if (c->srcFormat == AV_PIX_FMT_RGB8) {
818                 r = ( i >> 5     ) * 36;
819                 g = ((i >> 2) & 7) * 36;
820                 b = ( i       & 3) * 85;
821             } else if (c->srcFormat == AV_PIX_FMT_BGR8) {
822                 b = ( i >> 6     ) * 85;
823                 g = ((i >> 3) & 7) * 36;
824                 r = ( i       & 7) * 36;
825             } else if (c->srcFormat == AV_PIX_FMT_RGB4_BYTE) {
826                 r = ( i >> 3     ) * 255;
827                 g = ((i >> 1) & 3) * 85;
828                 b = ( i       & 1) * 255;
829             } else if (c->srcFormat == AV_PIX_FMT_GRAY8 || c->srcFormat == AV_PIX_FMT_GRAY8A) {
830                 r = g = b = i;
831             } else {
832                 av_assert1(c->srcFormat == AV_PIX_FMT_BGR4_BYTE);
833                 b = ( i >> 3     ) * 255;
834                 g = ((i >> 1) & 3) * 85;
835                 r = ( i       & 1) * 255;
836             }
837 #define RGB2YUV_SHIFT 15
838 #define BY ( (int) (0.114 * 219 / 255 * (1 << RGB2YUV_SHIFT) + 0.5))
839 #define BV (-(int) (0.081 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5))
840 #define BU ( (int) (0.500 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5))
841 #define GY ( (int) (0.587 * 219 / 255 * (1 << RGB2YUV_SHIFT) + 0.5))
842 #define GV (-(int) (0.419 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5))
843 #define GU (-(int) (0.331 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5))
844 #define RY ( (int) (0.299 * 219 / 255 * (1 << RGB2YUV_SHIFT) + 0.5))
845 #define RV ( (int) (0.500 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5))
846 #define RU (-(int) (0.169 * 224 / 255 * (1 << RGB2YUV_SHIFT) + 0.5))
847
848             y = av_clip_uint8((RY * r + GY * g + BY * b + ( 33 << (RGB2YUV_SHIFT - 1))) >> RGB2YUV_SHIFT);
849             u = av_clip_uint8((RU * r + GU * g + BU * b + (257 << (RGB2YUV_SHIFT - 1))) >> RGB2YUV_SHIFT);
850             v = av_clip_uint8((RV * r + GV * g + BV * b + (257 << (RGB2YUV_SHIFT - 1))) >> RGB2YUV_SHIFT);
851             c->pal_yuv[i]= y + (u<<8) + (v<<16) + ((unsigned)a<<24);
852
853             switch (c->dstFormat) {
854             case AV_PIX_FMT_BGR32:
855 #if !HAVE_BIGENDIAN
856             case AV_PIX_FMT_RGB24:
857 #endif
858                 c->pal_rgb[i]=  r + (g<<8) + (b<<16) + ((unsigned)a<<24);
859                 break;
860             case AV_PIX_FMT_BGR32_1:
861 #if HAVE_BIGENDIAN
862             case AV_PIX_FMT_BGR24:
863 #endif
864                 c->pal_rgb[i]= a + (r<<8) + (g<<16) + ((unsigned)b<<24);
865                 break;
866             case AV_PIX_FMT_RGB32_1:
867 #if HAVE_BIGENDIAN
868             case AV_PIX_FMT_RGB24:
869 #endif
870                 c->pal_rgb[i]= a + (b<<8) + (g<<16) + ((unsigned)r<<24);
871                 break;
872             case AV_PIX_FMT_RGB32:
873 #if !HAVE_BIGENDIAN
874             case AV_PIX_FMT_BGR24:
875 #endif
876             default:
877                 c->pal_rgb[i]=  b + (g<<8) + (r<<16) + ((unsigned)a<<24);
878             }
879         }
880     }
881
882     if (c->src0Alpha && !c->dst0Alpha && isALPHA(c->dstFormat)) {
883         uint8_t *base;
884         int x,y;
885         rgb0_tmp = av_malloc(FFABS(srcStride[0]) * srcSliceH + 32);
886         base = srcStride[0] < 0 ? rgb0_tmp - srcStride[0] * (srcSliceH-1) : rgb0_tmp;
887         for (y=0; y<srcSliceH; y++){
888             memcpy(base + srcStride[0]*y, src2[0] + srcStride[0]*y, 4*c->srcW);
889             for (x=c->src0Alpha-1; x<4*c->srcW; x+=4) {
890                 base[ srcStride[0]*y + x] = 0xFF;
891             }
892         }
893         src2[0] = base;
894     }
895
896     // copy strides, so they can safely be modified
897     if (c->sliceDir == 1) {
898         // slices go from top to bottom
899         int srcStride2[4] = { srcStride[0], srcStride[1], srcStride[2],
900                               srcStride[3] };
901         int dstStride2[4] = { dstStride[0], dstStride[1], dstStride[2],
902                               dstStride[3] };
903
904         reset_ptr(src2, c->srcFormat);
905         reset_ptr((void*)dst2, c->dstFormat);
906
907         /* reset slice direction at end of frame */
908         if (srcSliceY + srcSliceH == c->srcH)
909             c->sliceDir = 0;
910
911         ret = c->swScale(c, src2, srcStride2, srcSliceY, srcSliceH, dst2,
912                           dstStride2);
913     } else {
914         // slices go from bottom to top => we flip the image internally
915         int srcStride2[4] = { -srcStride[0], -srcStride[1], -srcStride[2],
916                               -srcStride[3] };
917         int dstStride2[4] = { -dstStride[0], -dstStride[1], -dstStride[2],
918                               -dstStride[3] };
919
920         src2[0] += (srcSliceH - 1) * srcStride[0];
921         if (!usePal(c->srcFormat))
922             src2[1] += ((srcSliceH >> c->chrSrcVSubSample) - 1) * srcStride[1];
923         src2[2] += ((srcSliceH >> c->chrSrcVSubSample) - 1) * srcStride[2];
924         src2[3] += (srcSliceH - 1) * srcStride[3];
925         dst2[0] += ( c->dstH                         - 1) * dstStride[0];
926         dst2[1] += ((c->dstH >> c->chrDstVSubSample) - 1) * dstStride[1];
927         dst2[2] += ((c->dstH >> c->chrDstVSubSample) - 1) * dstStride[2];
928         dst2[3] += ( c->dstH                         - 1) * dstStride[3];
929
930         reset_ptr(src2, c->srcFormat);
931         reset_ptr((void*)dst2, c->dstFormat);
932
933         /* reset slice direction at end of frame */
934         if (!srcSliceY)
935             c->sliceDir = 0;
936
937         ret = c->swScale(c, src2, srcStride2, c->srcH-srcSliceY-srcSliceH,
938                           srcSliceH, dst2, dstStride2);
939     }
940
941     av_free(rgb0_tmp);
942     return ret;
943 }
944