Make ff_fill_linesize() use the information stored in
[ffmpeg.git] / libavcodec / imgconvert.c
1 /*
2  * Misc image conversion routines
3  * Copyright (c) 2001, 2002, 2003 Fabrice Bellard
4  *
5  * This file is part of FFmpeg.
6  *
7  * FFmpeg is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU Lesser General Public
9  * License as published by the Free Software Foundation; either
10  * version 2.1 of the License, or (at your option) any later version.
11  *
12  * FFmpeg is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15  * Lesser General Public License for more details.
16  *
17  * You should have received a copy of the GNU Lesser General Public
18  * License along with FFmpeg; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20  */
21
22 /**
23  * @file libavcodec/imgconvert.c
24  * misc image conversion routines
25  */
26
27 /* TODO:
28  * - write 'ffimg' program to test all the image related stuff
29  * - move all api to slice based system
30  * - integrate deinterlacing, postprocessing and scaling in the conversion process
31  */
32
33 #include "avcodec.h"
34 #include "dsputil.h"
35 #include "colorspace.h"
36 #include "internal.h"
37 #include "imgconvert.h"
38 #include "libavutil/pixdesc.h"
39
40 #if HAVE_MMX
41 #include "x86/mmx.h"
42 #include "x86/dsputil_mmx.h"
43 #endif
44
45 #define xglue(x, y) x ## y
46 #define glue(x, y) xglue(x, y)
47
48 #define FF_COLOR_RGB      0 /**< RGB color space */
49 #define FF_COLOR_GRAY     1 /**< gray color space */
50 #define FF_COLOR_YUV      2 /**< YUV color space. 16 <= Y <= 235, 16 <= U, V <= 240 */
51 #define FF_COLOR_YUV_JPEG 3 /**< YUV color space. 0 <= Y <= 255, 0 <= U, V <= 255 */
52
53 #define FF_PIXEL_PLANAR   0 /**< each channel has one component in AVPicture */
54 #define FF_PIXEL_PACKED   1 /**< only one components containing all the channels */
55 #define FF_PIXEL_PALETTE  2  /**< one components containing indexes for a palette */
56
57 typedef struct PixFmtInfo {
58     uint8_t nb_channels;     /**< number of channels (including alpha) */
59     uint8_t color_type;      /**< color type (see FF_COLOR_xxx constants) */
60     uint8_t pixel_type;      /**< pixel storage type (see FF_PIXEL_xxx constants) */
61     uint8_t is_alpha : 1;    /**< true if alpha can be specified */
62     uint8_t depth;           /**< bit depth of the color components */
63 } PixFmtInfo;
64
65 /* this table gives more information about formats */
66 static const PixFmtInfo pix_fmt_info[PIX_FMT_NB] = {
67     /* YUV formats */
68     [PIX_FMT_YUV420P] = {
69         .nb_channels = 3,
70         .color_type = FF_COLOR_YUV,
71         .pixel_type = FF_PIXEL_PLANAR,
72         .depth = 8,
73     },
74     [PIX_FMT_YUV422P] = {
75         .nb_channels = 3,
76         .color_type = FF_COLOR_YUV,
77         .pixel_type = FF_PIXEL_PLANAR,
78         .depth = 8,
79     },
80     [PIX_FMT_YUV444P] = {
81         .nb_channels = 3,
82         .color_type = FF_COLOR_YUV,
83         .pixel_type = FF_PIXEL_PLANAR,
84         .depth = 8,
85     },
86     [PIX_FMT_YUYV422] = {
87         .nb_channels = 1,
88         .color_type = FF_COLOR_YUV,
89         .pixel_type = FF_PIXEL_PACKED,
90         .depth = 8,
91     },
92     [PIX_FMT_UYVY422] = {
93         .nb_channels = 1,
94         .color_type = FF_COLOR_YUV,
95         .pixel_type = FF_PIXEL_PACKED,
96         .depth = 8,
97     },
98     [PIX_FMT_YUV410P] = {
99         .nb_channels = 3,
100         .color_type = FF_COLOR_YUV,
101         .pixel_type = FF_PIXEL_PLANAR,
102         .depth = 8,
103     },
104     [PIX_FMT_YUV411P] = {
105         .nb_channels = 3,
106         .color_type = FF_COLOR_YUV,
107         .pixel_type = FF_PIXEL_PLANAR,
108         .depth = 8,
109     },
110     [PIX_FMT_YUV440P] = {
111         .nb_channels = 3,
112         .color_type = FF_COLOR_YUV,
113         .pixel_type = FF_PIXEL_PLANAR,
114         .depth = 8,
115     },
116     [PIX_FMT_YUV420P16LE] = {
117         .nb_channels = 3,
118         .color_type = FF_COLOR_YUV,
119         .pixel_type = FF_PIXEL_PLANAR,
120         .depth = 16,
121     },
122     [PIX_FMT_YUV422P16LE] = {
123         .nb_channels = 3,
124         .color_type = FF_COLOR_YUV,
125         .pixel_type = FF_PIXEL_PLANAR,
126         .depth = 16,
127     },
128     [PIX_FMT_YUV444P16LE] = {
129         .nb_channels = 3,
130         .color_type = FF_COLOR_YUV,
131         .pixel_type = FF_PIXEL_PLANAR,
132         .depth = 16,
133     },
134     [PIX_FMT_YUV420P16BE] = {
135         .nb_channels = 3,
136         .color_type = FF_COLOR_YUV,
137         .pixel_type = FF_PIXEL_PLANAR,
138         .depth = 16,
139     },
140     [PIX_FMT_YUV422P16BE] = {
141         .nb_channels = 3,
142         .color_type = FF_COLOR_YUV,
143         .pixel_type = FF_PIXEL_PLANAR,
144         .depth = 16,
145     },
146     [PIX_FMT_YUV444P16BE] = {
147         .nb_channels = 3,
148         .color_type = FF_COLOR_YUV,
149         .pixel_type = FF_PIXEL_PLANAR,
150         .depth = 16,
151     },
152
153
154     /* YUV formats with alpha plane */
155     [PIX_FMT_YUVA420P] = {
156         .nb_channels = 4,
157         .color_type = FF_COLOR_YUV,
158         .pixel_type = FF_PIXEL_PLANAR,
159         .depth = 8,
160     },
161
162     /* JPEG YUV */
163     [PIX_FMT_YUVJ420P] = {
164         .nb_channels = 3,
165         .color_type = FF_COLOR_YUV_JPEG,
166         .pixel_type = FF_PIXEL_PLANAR,
167         .depth = 8,
168     },
169     [PIX_FMT_YUVJ422P] = {
170         .nb_channels = 3,
171         .color_type = FF_COLOR_YUV_JPEG,
172         .pixel_type = FF_PIXEL_PLANAR,
173         .depth = 8,
174     },
175     [PIX_FMT_YUVJ444P] = {
176         .nb_channels = 3,
177         .color_type = FF_COLOR_YUV_JPEG,
178         .pixel_type = FF_PIXEL_PLANAR,
179         .depth = 8,
180     },
181     [PIX_FMT_YUVJ440P] = {
182         .nb_channels = 3,
183         .color_type = FF_COLOR_YUV_JPEG,
184         .pixel_type = FF_PIXEL_PLANAR,
185         .depth = 8,
186     },
187
188     /* RGB formats */
189     [PIX_FMT_RGB24] = {
190         .nb_channels = 3,
191         .color_type = FF_COLOR_RGB,
192         .pixel_type = FF_PIXEL_PACKED,
193         .depth = 8,
194     },
195     [PIX_FMT_BGR24] = {
196         .nb_channels = 3,
197         .color_type = FF_COLOR_RGB,
198         .pixel_type = FF_PIXEL_PACKED,
199         .depth = 8,
200     },
201     [PIX_FMT_ARGB] = {
202         .nb_channels = 4, .is_alpha = 1,
203         .color_type = FF_COLOR_RGB,
204         .pixel_type = FF_PIXEL_PACKED,
205         .depth = 8,
206     },
207     [PIX_FMT_RGB48BE] = {
208         .nb_channels = 3,
209         .color_type = FF_COLOR_RGB,
210         .pixel_type = FF_PIXEL_PACKED,
211         .depth = 16,
212     },
213     [PIX_FMT_RGB48LE] = {
214         .nb_channels = 3,
215         .color_type = FF_COLOR_RGB,
216         .pixel_type = FF_PIXEL_PACKED,
217         .depth = 16,
218     },
219     [PIX_FMT_RGB565BE] = {
220         .nb_channels = 3,
221         .color_type = FF_COLOR_RGB,
222         .pixel_type = FF_PIXEL_PACKED,
223         .depth = 5,
224     },
225     [PIX_FMT_RGB565LE] = {
226         .nb_channels = 3,
227         .color_type = FF_COLOR_RGB,
228         .pixel_type = FF_PIXEL_PACKED,
229         .depth = 5,
230     },
231     [PIX_FMT_RGB555BE] = {
232         .nb_channels = 3,
233         .color_type = FF_COLOR_RGB,
234         .pixel_type = FF_PIXEL_PACKED,
235         .depth = 5,
236     },
237     [PIX_FMT_RGB555LE] = {
238         .nb_channels = 3,
239         .color_type = FF_COLOR_RGB,
240         .pixel_type = FF_PIXEL_PACKED,
241         .depth = 5,
242     },
243     [PIX_FMT_RGB444BE] = {
244         .nb_channels = 3,
245         .color_type = FF_COLOR_RGB,
246         .pixel_type = FF_PIXEL_PACKED,
247         .depth = 4,
248     },
249     [PIX_FMT_RGB444LE] = {
250         .nb_channels = 3,
251         .color_type = FF_COLOR_RGB,
252         .pixel_type = FF_PIXEL_PACKED,
253         .depth = 4,
254     },
255
256     /* gray / mono formats */
257     [PIX_FMT_GRAY16BE] = {
258         .nb_channels = 1,
259         .color_type = FF_COLOR_GRAY,
260         .pixel_type = FF_PIXEL_PLANAR,
261         .depth = 16,
262     },
263     [PIX_FMT_GRAY16LE] = {
264         .nb_channels = 1,
265         .color_type = FF_COLOR_GRAY,
266         .pixel_type = FF_PIXEL_PLANAR,
267         .depth = 16,
268     },
269     [PIX_FMT_GRAY8] = {
270         .nb_channels = 1,
271         .color_type = FF_COLOR_GRAY,
272         .pixel_type = FF_PIXEL_PLANAR,
273         .depth = 8,
274     },
275     [PIX_FMT_MONOWHITE] = {
276         .nb_channels = 1,
277         .color_type = FF_COLOR_GRAY,
278         .pixel_type = FF_PIXEL_PLANAR,
279         .depth = 1,
280     },
281     [PIX_FMT_MONOBLACK] = {
282         .nb_channels = 1,
283         .color_type = FF_COLOR_GRAY,
284         .pixel_type = FF_PIXEL_PLANAR,
285         .depth = 1,
286     },
287
288     /* paletted formats */
289     [PIX_FMT_PAL8] = {
290         .nb_channels = 4, .is_alpha = 1,
291         .color_type = FF_COLOR_RGB,
292         .pixel_type = FF_PIXEL_PALETTE,
293         .depth = 8,
294     },
295     [PIX_FMT_UYYVYY411] = {
296         .nb_channels = 1,
297         .color_type = FF_COLOR_YUV,
298         .pixel_type = FF_PIXEL_PACKED,
299         .depth = 8,
300     },
301     [PIX_FMT_ABGR] = {
302         .nb_channels = 4, .is_alpha = 1,
303         .color_type = FF_COLOR_RGB,
304         .pixel_type = FF_PIXEL_PACKED,
305         .depth = 8,
306     },
307     [PIX_FMT_BGR565BE] = {
308         .nb_channels = 3,
309         .color_type = FF_COLOR_RGB,
310         .pixel_type = FF_PIXEL_PACKED,
311         .depth = 5,
312     },
313     [PIX_FMT_BGR565LE] = {
314         .nb_channels = 3,
315         .color_type = FF_COLOR_RGB,
316         .pixel_type = FF_PIXEL_PACKED,
317         .depth = 5,
318     },
319     [PIX_FMT_BGR555BE] = {
320         .nb_channels = 3,
321         .color_type = FF_COLOR_RGB,
322         .pixel_type = FF_PIXEL_PACKED,
323         .depth = 5,
324     },
325     [PIX_FMT_BGR555LE] = {
326         .nb_channels = 3,
327         .color_type = FF_COLOR_RGB,
328         .pixel_type = FF_PIXEL_PACKED,
329         .depth = 5,
330     },
331     [PIX_FMT_BGR444BE] = {
332         .nb_channels = 3,
333         .color_type = FF_COLOR_RGB,
334         .pixel_type = FF_PIXEL_PACKED,
335         .depth = 4,
336     },
337     [PIX_FMT_BGR444LE] = {
338         .nb_channels = 3,
339         .color_type = FF_COLOR_RGB,
340         .pixel_type = FF_PIXEL_PACKED,
341         .depth = 4,
342     },
343     [PIX_FMT_RGB8] = {
344         .nb_channels = 1,
345         .color_type = FF_COLOR_RGB,
346         .pixel_type = FF_PIXEL_PACKED,
347         .depth = 8,
348     },
349     [PIX_FMT_RGB4] = {
350         .nb_channels = 1,
351         .color_type = FF_COLOR_RGB,
352         .pixel_type = FF_PIXEL_PACKED,
353         .depth = 4,
354     },
355     [PIX_FMT_RGB4_BYTE] = {
356         .nb_channels = 1,
357         .color_type = FF_COLOR_RGB,
358         .pixel_type = FF_PIXEL_PACKED,
359         .depth = 8,
360     },
361     [PIX_FMT_BGR8] = {
362         .nb_channels = 1,
363         .color_type = FF_COLOR_RGB,
364         .pixel_type = FF_PIXEL_PACKED,
365         .depth = 8,
366     },
367     [PIX_FMT_BGR4] = {
368         .nb_channels = 1,
369         .color_type = FF_COLOR_RGB,
370         .pixel_type = FF_PIXEL_PACKED,
371         .depth = 4,
372     },
373     [PIX_FMT_BGR4_BYTE] = {
374         .nb_channels = 1,
375         .color_type = FF_COLOR_RGB,
376         .pixel_type = FF_PIXEL_PACKED,
377         .depth = 8,
378     },
379     [PIX_FMT_NV12] = {
380         .nb_channels = 2,
381         .color_type = FF_COLOR_YUV,
382         .pixel_type = FF_PIXEL_PLANAR,
383         .depth = 8,
384     },
385     [PIX_FMT_NV21] = {
386         .nb_channels = 2,
387         .color_type = FF_COLOR_YUV,
388         .pixel_type = FF_PIXEL_PLANAR,
389         .depth = 8,
390     },
391
392     [PIX_FMT_BGRA] = {
393         .nb_channels = 4, .is_alpha = 1,
394         .color_type = FF_COLOR_RGB,
395         .pixel_type = FF_PIXEL_PACKED,
396         .depth = 8,
397     },
398     [PIX_FMT_RGBA] = {
399         .nb_channels = 4, .is_alpha = 1,
400         .color_type = FF_COLOR_RGB,
401         .pixel_type = FF_PIXEL_PACKED,
402         .depth = 8,
403     },
404 };
405
406 void avcodec_get_chroma_sub_sample(enum PixelFormat pix_fmt, int *h_shift, int *v_shift)
407 {
408     *h_shift = av_pix_fmt_descriptors[pix_fmt].log2_chroma_w;
409     *v_shift = av_pix_fmt_descriptors[pix_fmt].log2_chroma_h;
410 }
411
412 const char *avcodec_get_pix_fmt_name(enum PixelFormat pix_fmt)
413 {
414     if (pix_fmt < 0 || pix_fmt >= PIX_FMT_NB)
415         return NULL;
416     else
417         return av_pix_fmt_descriptors[pix_fmt].name;
418 }
419
420 #if LIBAVCODEC_VERSION_MAJOR < 53
421 enum PixelFormat avcodec_get_pix_fmt(const char *name)
422 {
423     return av_get_pix_fmt(name);
424 }
425 #endif
426
427 void avcodec_pix_fmt_string (char *buf, int buf_size, enum PixelFormat pix_fmt)
428 {
429     /* print header */
430     if (pix_fmt < 0)
431         snprintf (buf, buf_size,
432                   "name      " " nb_channels" " depth" " is_alpha"
433             );
434     else{
435         PixFmtInfo info= pix_fmt_info[pix_fmt];
436
437         char is_alpha_char= info.is_alpha ? 'y' : 'n';
438
439         snprintf (buf, buf_size,
440                   "%-11s %5d %9d %6c",
441                   av_pix_fmt_descriptors[pix_fmt].name,
442                   info.nb_channels,
443                   info.depth,
444                   is_alpha_char
445             );
446     }
447 }
448
449 int ff_is_hwaccel_pix_fmt(enum PixelFormat pix_fmt)
450 {
451     return av_pix_fmt_descriptors[pix_fmt].flags & PIX_FMT_HWACCEL;
452 }
453
454 int ff_set_systematic_pal(uint32_t pal[256], enum PixelFormat pix_fmt){
455     int i;
456
457     for(i=0; i<256; i++){
458         int r,g,b;
459
460         switch(pix_fmt) {
461         case PIX_FMT_RGB8:
462             r= (i>>5    )*36;
463             g= ((i>>2)&7)*36;
464             b= (i&3     )*85;
465             break;
466         case PIX_FMT_BGR8:
467             b= (i>>6    )*85;
468             g= ((i>>3)&7)*36;
469             r= (i&7     )*36;
470             break;
471         case PIX_FMT_RGB4_BYTE:
472             r= (i>>3    )*255;
473             g= ((i>>1)&3)*85;
474             b= (i&1     )*255;
475             break;
476         case PIX_FMT_BGR4_BYTE:
477             b= (i>>3    )*255;
478             g= ((i>>1)&3)*85;
479             r= (i&1     )*255;
480             break;
481         case PIX_FMT_GRAY8:
482             r=b=g= i;
483             break;
484         default:
485             return -1;
486         }
487         pal[i] =  b + (g<<8) + (r<<16);
488     }
489
490     return 0;
491 }
492
493 int ff_fill_linesize(AVPicture *picture, enum PixelFormat pix_fmt, int width)
494 {
495     int i;
496     const AVPixFmtDescriptor *desc = &av_pix_fmt_descriptors[pix_fmt];
497     int max_plane_step     [4];
498     int max_plane_step_comp[4];
499
500     memset(picture->linesize, 0, sizeof(picture->linesize));
501
502     if (desc->flags & PIX_FMT_HWACCEL)
503         return -1;
504
505     if (desc->flags & PIX_FMT_BITSTREAM) {
506         picture->linesize[0] = (width * (desc->comp[0].step_minus1+1) + 7) >> 3;
507         return 0;
508     }
509
510     memset(max_plane_step     , 0, sizeof(max_plane_step     ));
511     memset(max_plane_step_comp, 0, sizeof(max_plane_step_comp));
512     for (i = 0; i < 4; i++) {
513         const AVComponentDescriptor *comp = &(desc->comp[i]);
514         if ((comp->step_minus1+1) > max_plane_step[comp->plane]) {
515             max_plane_step     [comp->plane] = comp->step_minus1+1;
516             max_plane_step_comp[comp->plane] = i;
517         }
518     }
519
520     for (i = 0; i < 4; i++) {
521         int s = (max_plane_step_comp[i] == 1 || max_plane_step_comp[i] == 2) ? desc->log2_chroma_w : 0;
522         picture->linesize[i] = max_plane_step[i] * (((width + (1 << s) - 1)) >> s);
523     }
524
525     return 0;
526 }
527
528 int ff_fill_pointer(AVPicture *picture, uint8_t *ptr, enum PixelFormat pix_fmt,
529                     int height)
530 {
531     int size, h2, size2;
532     const AVPixFmtDescriptor *desc = &av_pix_fmt_descriptors[pix_fmt];
533
534     size = picture->linesize[0] * height;
535     switch(pix_fmt) {
536     case PIX_FMT_YUV420P:
537     case PIX_FMT_YUV422P:
538     case PIX_FMT_YUV444P:
539     case PIX_FMT_YUV410P:
540     case PIX_FMT_YUV411P:
541     case PIX_FMT_YUV440P:
542     case PIX_FMT_YUVJ420P:
543     case PIX_FMT_YUVJ422P:
544     case PIX_FMT_YUVJ444P:
545     case PIX_FMT_YUVJ440P:
546     case PIX_FMT_YUV420P16LE:
547     case PIX_FMT_YUV422P16LE:
548     case PIX_FMT_YUV444P16LE:
549     case PIX_FMT_YUV420P16BE:
550     case PIX_FMT_YUV422P16BE:
551     case PIX_FMT_YUV444P16BE:
552         h2 = (height + (1 << desc->log2_chroma_h) - 1) >> desc->log2_chroma_h;
553         size2 = picture->linesize[1] * h2;
554         picture->data[0] = ptr;
555         picture->data[1] = picture->data[0] + size;
556         picture->data[2] = picture->data[1] + size2;
557         picture->data[3] = NULL;
558         return size + 2 * size2;
559     case PIX_FMT_YUVA420P:
560         h2 = (height + (1 << desc->log2_chroma_h) - 1) >> desc->log2_chroma_h;
561         size2 = picture->linesize[1] * h2;
562         picture->data[0] = ptr;
563         picture->data[1] = picture->data[0] + size;
564         picture->data[2] = picture->data[1] + size2;
565         picture->data[3] = picture->data[1] + size2 + size2;
566         return 2 * size + 2 * size2;
567     case PIX_FMT_NV12:
568     case PIX_FMT_NV21:
569         h2 = (height + (1 << desc->log2_chroma_h) - 1) >> desc->log2_chroma_h;
570         size2 = picture->linesize[1] * h2;
571         picture->data[0] = ptr;
572         picture->data[1] = picture->data[0] + size;
573         picture->data[2] = NULL;
574         picture->data[3] = NULL;
575         return size + size2;
576     case PIX_FMT_RGB24:
577     case PIX_FMT_BGR24:
578     case PIX_FMT_ARGB:
579     case PIX_FMT_ABGR:
580     case PIX_FMT_RGBA:
581     case PIX_FMT_BGRA:
582     case PIX_FMT_RGB48BE:
583     case PIX_FMT_RGB48LE:
584     case PIX_FMT_GRAY16BE:
585     case PIX_FMT_GRAY16LE:
586     case PIX_FMT_BGR444BE:
587     case PIX_FMT_BGR444LE:
588     case PIX_FMT_BGR555BE:
589     case PIX_FMT_BGR555LE:
590     case PIX_FMT_BGR565BE:
591     case PIX_FMT_BGR565LE:
592     case PIX_FMT_RGB444BE:
593     case PIX_FMT_RGB444LE:
594     case PIX_FMT_RGB555BE:
595     case PIX_FMT_RGB555LE:
596     case PIX_FMT_RGB565BE:
597     case PIX_FMT_RGB565LE:
598     case PIX_FMT_YUYV422:
599     case PIX_FMT_UYVY422:
600     case PIX_FMT_UYYVYY411:
601     case PIX_FMT_RGB4:
602     case PIX_FMT_BGR4:
603     case PIX_FMT_MONOWHITE:
604     case PIX_FMT_MONOBLACK:
605         picture->data[0] = ptr;
606         picture->data[1] = NULL;
607         picture->data[2] = NULL;
608         picture->data[3] = NULL;
609         return size;
610     case PIX_FMT_PAL8:
611     case PIX_FMT_RGB8:
612     case PIX_FMT_BGR8:
613     case PIX_FMT_RGB4_BYTE:
614     case PIX_FMT_BGR4_BYTE:
615     case PIX_FMT_GRAY8:
616         size2 = (size + 3) & ~3;
617         picture->data[0] = ptr;
618         picture->data[1] = ptr + size2; /* palette is stored here as 256 32 bit words */
619         picture->data[2] = NULL;
620         picture->data[3] = NULL;
621         return size2 + 256 * 4;
622     default:
623         picture->data[0] = NULL;
624         picture->data[1] = NULL;
625         picture->data[2] = NULL;
626         picture->data[3] = NULL;
627         return -1;
628     }
629 }
630
631 int avpicture_fill(AVPicture *picture, uint8_t *ptr,
632                    enum PixelFormat pix_fmt, int width, int height)
633 {
634
635     if(avcodec_check_dimensions(NULL, width, height))
636         return -1;
637
638     if (ff_fill_linesize(picture, pix_fmt, width))
639         return -1;
640
641     return ff_fill_pointer(picture, ptr, pix_fmt, height);
642 }
643
644 int avpicture_layout(const AVPicture* src, enum PixelFormat pix_fmt, int width, int height,
645                      unsigned char *dest, int dest_size)
646 {
647     const PixFmtInfo* pf = &pix_fmt_info[pix_fmt];
648     const AVPixFmtDescriptor *desc = &av_pix_fmt_descriptors[pix_fmt];
649     int i, j, w, ow, h, oh, data_planes;
650     const unsigned char* s;
651     int size = avpicture_get_size(pix_fmt, width, height);
652
653     if (size > dest_size || size < 0)
654         return -1;
655
656     if (pf->pixel_type == FF_PIXEL_PACKED || pf->pixel_type == FF_PIXEL_PALETTE) {
657         if (pix_fmt == PIX_FMT_YUYV422 ||
658             pix_fmt == PIX_FMT_UYVY422 ||
659             pix_fmt == PIX_FMT_BGR565BE ||
660             pix_fmt == PIX_FMT_BGR565LE ||
661             pix_fmt == PIX_FMT_BGR555BE ||
662             pix_fmt == PIX_FMT_BGR555LE ||
663             pix_fmt == PIX_FMT_BGR444BE ||
664             pix_fmt == PIX_FMT_BGR444LE ||
665             pix_fmt == PIX_FMT_RGB565BE ||
666             pix_fmt == PIX_FMT_RGB565LE ||
667             pix_fmt == PIX_FMT_RGB555BE ||
668             pix_fmt == PIX_FMT_RGB555LE ||
669             pix_fmt == PIX_FMT_RGB444BE ||
670             pix_fmt == PIX_FMT_RGB444LE)
671             w = width * 2;
672         else if (pix_fmt == PIX_FMT_UYYVYY411)
673             w = width + width/2;
674         else if (pix_fmt == PIX_FMT_PAL8)
675             w = width;
676         else
677             w = width * (pf->depth * pf->nb_channels / 8);
678
679         data_planes = 1;
680         h = height;
681     } else {
682         data_planes = pf->nb_channels;
683         w = (width*pf->depth + 7)/8;
684         h = height;
685     }
686
687     ow = w;
688     oh = h;
689
690     for (i=0; i<data_planes; i++) {
691         if (i == 1) {
692             w = (- ((-width) >> desc->log2_chroma_w) * pf->depth + 7) / 8;
693             h = -((-height) >> desc->log2_chroma_h);
694             if (pix_fmt == PIX_FMT_NV12 || pix_fmt == PIX_FMT_NV21)
695                 w <<= 1;
696         } else if (i == 3) {
697             w = ow;
698             h = oh;
699         }
700         s = src->data[i];
701         for(j=0; j<h; j++) {
702             memcpy(dest, s, w);
703             dest += w;
704             s += src->linesize[i];
705         }
706     }
707
708     if (pf->pixel_type == FF_PIXEL_PALETTE)
709         memcpy((unsigned char *)(((size_t)dest + 3) & ~3), src->data[1], 256 * 4);
710
711     return size;
712 }
713
714 int avpicture_get_size(enum PixelFormat pix_fmt, int width, int height)
715 {
716     AVPicture dummy_pict;
717     if(avcodec_check_dimensions(NULL, width, height))
718         return -1;
719     switch (pix_fmt) {
720     case PIX_FMT_RGB8:
721     case PIX_FMT_BGR8:
722     case PIX_FMT_RGB4_BYTE:
723     case PIX_FMT_BGR4_BYTE:
724     case PIX_FMT_GRAY8:
725         // do not include palette for these pseudo-paletted formats
726         return width * height;
727     }
728     return avpicture_fill(&dummy_pict, NULL, pix_fmt, width, height);
729 }
730
731 int avcodec_get_pix_fmt_loss(enum PixelFormat dst_pix_fmt, enum PixelFormat src_pix_fmt,
732                              int has_alpha)
733 {
734     const PixFmtInfo *pf, *ps;
735     const AVPixFmtDescriptor *src_desc = &av_pix_fmt_descriptors[src_pix_fmt];
736     const AVPixFmtDescriptor *dst_desc = &av_pix_fmt_descriptors[dst_pix_fmt];
737     int loss;
738
739     ps = &pix_fmt_info[src_pix_fmt];
740
741     /* compute loss */
742     loss = 0;
743     pf = &pix_fmt_info[dst_pix_fmt];
744     if (pf->depth < ps->depth ||
745         ((dst_pix_fmt == PIX_FMT_RGB555BE || dst_pix_fmt == PIX_FMT_RGB555LE ||
746           dst_pix_fmt == PIX_FMT_BGR555BE || dst_pix_fmt == PIX_FMT_BGR555LE) &&
747          (src_pix_fmt == PIX_FMT_RGB565BE || src_pix_fmt == PIX_FMT_RGB565LE ||
748           src_pix_fmt == PIX_FMT_BGR565BE || src_pix_fmt == PIX_FMT_BGR565LE)))
749         loss |= FF_LOSS_DEPTH;
750     if (dst_desc->log2_chroma_w > src_desc->log2_chroma_w ||
751         dst_desc->log2_chroma_h > src_desc->log2_chroma_h)
752         loss |= FF_LOSS_RESOLUTION;
753     switch(pf->color_type) {
754     case FF_COLOR_RGB:
755         if (ps->color_type != FF_COLOR_RGB &&
756             ps->color_type != FF_COLOR_GRAY)
757             loss |= FF_LOSS_COLORSPACE;
758         break;
759     case FF_COLOR_GRAY:
760         if (ps->color_type != FF_COLOR_GRAY)
761             loss |= FF_LOSS_COLORSPACE;
762         break;
763     case FF_COLOR_YUV:
764         if (ps->color_type != FF_COLOR_YUV)
765             loss |= FF_LOSS_COLORSPACE;
766         break;
767     case FF_COLOR_YUV_JPEG:
768         if (ps->color_type != FF_COLOR_YUV_JPEG &&
769             ps->color_type != FF_COLOR_YUV &&
770             ps->color_type != FF_COLOR_GRAY)
771             loss |= FF_LOSS_COLORSPACE;
772         break;
773     default:
774         /* fail safe test */
775         if (ps->color_type != pf->color_type)
776             loss |= FF_LOSS_COLORSPACE;
777         break;
778     }
779     if (pf->color_type == FF_COLOR_GRAY &&
780         ps->color_type != FF_COLOR_GRAY)
781         loss |= FF_LOSS_CHROMA;
782     if (!pf->is_alpha && (ps->is_alpha && has_alpha))
783         loss |= FF_LOSS_ALPHA;
784     if (pf->pixel_type == FF_PIXEL_PALETTE &&
785         (ps->pixel_type != FF_PIXEL_PALETTE && ps->color_type != FF_COLOR_GRAY))
786         loss |= FF_LOSS_COLORQUANT;
787     return loss;
788 }
789
790 static int avg_bits_per_pixel(enum PixelFormat pix_fmt)
791 {
792     int bits;
793     const PixFmtInfo *pf;
794     const AVPixFmtDescriptor *desc = &av_pix_fmt_descriptors[pix_fmt];
795
796     pf = &pix_fmt_info[pix_fmt];
797     switch(pf->pixel_type) {
798     case FF_PIXEL_PACKED:
799         switch(pix_fmt) {
800         case PIX_FMT_YUYV422:
801         case PIX_FMT_UYVY422:
802         case PIX_FMT_RGB565BE:
803         case PIX_FMT_RGB565LE:
804         case PIX_FMT_RGB555BE:
805         case PIX_FMT_RGB555LE:
806         case PIX_FMT_RGB444BE:
807         case PIX_FMT_RGB444LE:
808         case PIX_FMT_BGR565BE:
809         case PIX_FMT_BGR565LE:
810         case PIX_FMT_BGR555BE:
811         case PIX_FMT_BGR555LE:
812         case PIX_FMT_BGR444BE:
813         case PIX_FMT_BGR444LE:
814             bits = 16;
815             break;
816         case PIX_FMT_UYYVYY411:
817             bits = 12;
818             break;
819         default:
820             bits = pf->depth * pf->nb_channels;
821             break;
822         }
823         break;
824     case FF_PIXEL_PLANAR:
825         if (desc->log2_chroma_w == 0 && desc->log2_chroma_h == 0) {
826             bits = pf->depth * pf->nb_channels;
827         } else {
828             bits = pf->depth + ((2 * pf->depth) >>
829                                 (desc->log2_chroma_w + desc->log2_chroma_h));
830         }
831         break;
832     case FF_PIXEL_PALETTE:
833         bits = 8;
834         break;
835     default:
836         bits = -1;
837         break;
838     }
839     return bits;
840 }
841
842 static enum PixelFormat avcodec_find_best_pix_fmt1(int64_t pix_fmt_mask,
843                                       enum PixelFormat src_pix_fmt,
844                                       int has_alpha,
845                                       int loss_mask)
846 {
847     int dist, i, loss, min_dist;
848     enum PixelFormat dst_pix_fmt;
849
850     /* find exact color match with smallest size */
851     dst_pix_fmt = PIX_FMT_NONE;
852     min_dist = 0x7fffffff;
853     for(i = 0;i < PIX_FMT_NB; i++) {
854         if (pix_fmt_mask & (1ULL << i)) {
855             loss = avcodec_get_pix_fmt_loss(i, src_pix_fmt, has_alpha) & loss_mask;
856             if (loss == 0) {
857                 dist = avg_bits_per_pixel(i);
858                 if (dist < min_dist) {
859                     min_dist = dist;
860                     dst_pix_fmt = i;
861                 }
862             }
863         }
864     }
865     return dst_pix_fmt;
866 }
867
868 enum PixelFormat avcodec_find_best_pix_fmt(int64_t pix_fmt_mask, enum PixelFormat src_pix_fmt,
869                               int has_alpha, int *loss_ptr)
870 {
871     enum PixelFormat dst_pix_fmt;
872     int loss_mask, i;
873     static const int loss_mask_order[] = {
874         ~0, /* no loss first */
875         ~FF_LOSS_ALPHA,
876         ~FF_LOSS_RESOLUTION,
877         ~(FF_LOSS_COLORSPACE | FF_LOSS_RESOLUTION),
878         ~FF_LOSS_COLORQUANT,
879         ~FF_LOSS_DEPTH,
880         0,
881     };
882
883     /* try with successive loss */
884     i = 0;
885     for(;;) {
886         loss_mask = loss_mask_order[i++];
887         dst_pix_fmt = avcodec_find_best_pix_fmt1(pix_fmt_mask, src_pix_fmt,
888                                                  has_alpha, loss_mask);
889         if (dst_pix_fmt >= 0)
890             goto found;
891         if (loss_mask == 0)
892             break;
893     }
894     return PIX_FMT_NONE;
895  found:
896     if (loss_ptr)
897         *loss_ptr = avcodec_get_pix_fmt_loss(dst_pix_fmt, src_pix_fmt, has_alpha);
898     return dst_pix_fmt;
899 }
900
901 void ff_img_copy_plane(uint8_t *dst, int dst_wrap,
902                            const uint8_t *src, int src_wrap,
903                            int width, int height)
904 {
905     if((!dst) || (!src))
906         return;
907     for(;height > 0; height--) {
908         memcpy(dst, src, width);
909         dst += dst_wrap;
910         src += src_wrap;
911     }
912 }
913
914 int ff_get_plane_bytewidth(enum PixelFormat pix_fmt, int width, int plane)
915 {
916     int bits;
917     const PixFmtInfo *pf = &pix_fmt_info[pix_fmt];
918     const AVPixFmtDescriptor *desc = &av_pix_fmt_descriptors[pix_fmt];
919
920     pf = &pix_fmt_info[pix_fmt];
921     switch(pf->pixel_type) {
922     case FF_PIXEL_PACKED:
923         switch(pix_fmt) {
924         case PIX_FMT_YUYV422:
925         case PIX_FMT_UYVY422:
926         case PIX_FMT_RGB565BE:
927         case PIX_FMT_RGB565LE:
928         case PIX_FMT_RGB555BE:
929         case PIX_FMT_RGB555LE:
930         case PIX_FMT_RGB444BE:
931         case PIX_FMT_RGB444LE:
932         case PIX_FMT_BGR565BE:
933         case PIX_FMT_BGR565LE:
934         case PIX_FMT_BGR555BE:
935         case PIX_FMT_BGR555LE:
936         case PIX_FMT_BGR444BE:
937         case PIX_FMT_BGR444LE:
938             bits = 16;
939             break;
940         case PIX_FMT_UYYVYY411:
941             bits = 12;
942             break;
943         default:
944             bits = pf->depth * pf->nb_channels;
945             break;
946         }
947         return (width * bits + 7) >> 3;
948         break;
949     case FF_PIXEL_PLANAR:
950             if (plane == 1 || plane == 2)
951                 width= -((-width)>>desc->log2_chroma_w);
952
953             return (width * pf->depth + 7) >> 3;
954         break;
955     case FF_PIXEL_PALETTE:
956         if (plane == 0)
957             return width;
958         break;
959     }
960
961     return -1;
962 }
963
964 void av_picture_copy(AVPicture *dst, const AVPicture *src,
965                      enum PixelFormat pix_fmt, int width, int height)
966 {
967     int i;
968     const PixFmtInfo *pf = &pix_fmt_info[pix_fmt];
969     const AVPixFmtDescriptor *desc = &av_pix_fmt_descriptors[pix_fmt];
970
971     switch(pf->pixel_type) {
972     case FF_PIXEL_PACKED:
973     case FF_PIXEL_PLANAR:
974         for(i = 0; i < pf->nb_channels; i++) {
975             int h;
976             int bwidth = ff_get_plane_bytewidth(pix_fmt, width, i);
977             h = height;
978             if (i == 1 || i == 2) {
979                 h= -((-height)>>desc->log2_chroma_h);
980             }
981             ff_img_copy_plane(dst->data[i], dst->linesize[i],
982                            src->data[i], src->linesize[i],
983                            bwidth, h);
984         }
985         break;
986     case FF_PIXEL_PALETTE:
987         ff_img_copy_plane(dst->data[0], dst->linesize[0],
988                        src->data[0], src->linesize[0],
989                        width, height);
990         /* copy the palette */
991         memcpy(dst->data[1], src->data[1], 4*256);
992         break;
993     }
994 }
995
996 /* 2x2 -> 1x1 */
997 void ff_shrink22(uint8_t *dst, int dst_wrap,
998                      const uint8_t *src, int src_wrap,
999                      int width, int height)
1000 {
1001     int w;
1002     const uint8_t *s1, *s2;
1003     uint8_t *d;
1004
1005     for(;height > 0; height--) {
1006         s1 = src;
1007         s2 = s1 + src_wrap;
1008         d = dst;
1009         for(w = width;w >= 4; w-=4) {
1010             d[0] = (s1[0] + s1[1] + s2[0] + s2[1] + 2) >> 2;
1011             d[1] = (s1[2] + s1[3] + s2[2] + s2[3] + 2) >> 2;
1012             d[2] = (s1[4] + s1[5] + s2[4] + s2[5] + 2) >> 2;
1013             d[3] = (s1[6] + s1[7] + s2[6] + s2[7] + 2) >> 2;
1014             s1 += 8;
1015             s2 += 8;
1016             d += 4;
1017         }
1018         for(;w > 0; w--) {
1019             d[0] = (s1[0] + s1[1] + s2[0] + s2[1] + 2) >> 2;
1020             s1 += 2;
1021             s2 += 2;
1022             d++;
1023         }
1024         src += 2 * src_wrap;
1025         dst += dst_wrap;
1026     }
1027 }
1028
1029 /* 4x4 -> 1x1 */
1030 void ff_shrink44(uint8_t *dst, int dst_wrap,
1031                      const uint8_t *src, int src_wrap,
1032                      int width, int height)
1033 {
1034     int w;
1035     const uint8_t *s1, *s2, *s3, *s4;
1036     uint8_t *d;
1037
1038     for(;height > 0; height--) {
1039         s1 = src;
1040         s2 = s1 + src_wrap;
1041         s3 = s2 + src_wrap;
1042         s4 = s3 + src_wrap;
1043         d = dst;
1044         for(w = width;w > 0; w--) {
1045             d[0] = (s1[0] + s1[1] + s1[2] + s1[3] +
1046                     s2[0] + s2[1] + s2[2] + s2[3] +
1047                     s3[0] + s3[1] + s3[2] + s3[3] +
1048                     s4[0] + s4[1] + s4[2] + s4[3] + 8) >> 4;
1049             s1 += 4;
1050             s2 += 4;
1051             s3 += 4;
1052             s4 += 4;
1053             d++;
1054         }
1055         src += 4 * src_wrap;
1056         dst += dst_wrap;
1057     }
1058 }
1059
1060 /* 8x8 -> 1x1 */
1061 void ff_shrink88(uint8_t *dst, int dst_wrap,
1062                      const uint8_t *src, int src_wrap,
1063                      int width, int height)
1064 {
1065     int w, i;
1066
1067     for(;height > 0; height--) {
1068         for(w = width;w > 0; w--) {
1069             int tmp=0;
1070             for(i=0; i<8; i++){
1071                 tmp += src[0] + src[1] + src[2] + src[3] + src[4] + src[5] + src[6] + src[7];
1072                 src += src_wrap;
1073             }
1074             *(dst++) = (tmp + 32)>>6;
1075             src += 8 - 8*src_wrap;
1076         }
1077         src += 8*src_wrap - 8*width;
1078         dst += dst_wrap - width;
1079     }
1080 }
1081
1082
1083 int avpicture_alloc(AVPicture *picture,
1084                     enum PixelFormat pix_fmt, int width, int height)
1085 {
1086     int size;
1087     void *ptr;
1088
1089     size = avpicture_fill(picture, NULL, pix_fmt, width, height);
1090     if(size<0)
1091         goto fail;
1092     ptr = av_malloc(size);
1093     if (!ptr)
1094         goto fail;
1095     avpicture_fill(picture, ptr, pix_fmt, width, height);
1096     if(picture->data[1] && !picture->data[2])
1097         ff_set_systematic_pal((uint32_t*)picture->data[1], pix_fmt);
1098
1099     return 0;
1100  fail:
1101     memset(picture, 0, sizeof(AVPicture));
1102     return -1;
1103 }
1104
1105 void avpicture_free(AVPicture *picture)
1106 {
1107     av_free(picture->data[0]);
1108 }
1109
1110 /* return true if yuv planar */
1111 static inline int is_yuv_planar(const PixFmtInfo *ps)
1112 {
1113     return (ps->color_type == FF_COLOR_YUV ||
1114             ps->color_type == FF_COLOR_YUV_JPEG) &&
1115         ps->pixel_type == FF_PIXEL_PLANAR;
1116 }
1117
1118 int av_picture_crop(AVPicture *dst, const AVPicture *src,
1119                     enum PixelFormat pix_fmt, int top_band, int left_band)
1120 {
1121     int y_shift;
1122     int x_shift;
1123
1124     if (pix_fmt < 0 || pix_fmt >= PIX_FMT_NB || !is_yuv_planar(&pix_fmt_info[pix_fmt]))
1125         return -1;
1126
1127     y_shift = av_pix_fmt_descriptors[pix_fmt].log2_chroma_h;
1128     x_shift = av_pix_fmt_descriptors[pix_fmt].log2_chroma_w;
1129
1130     dst->data[0] = src->data[0] + (top_band * src->linesize[0]) + left_band;
1131     dst->data[1] = src->data[1] + ((top_band >> y_shift) * src->linesize[1]) + (left_band >> x_shift);
1132     dst->data[2] = src->data[2] + ((top_band >> y_shift) * src->linesize[2]) + (left_band >> x_shift);
1133
1134     dst->linesize[0] = src->linesize[0];
1135     dst->linesize[1] = src->linesize[1];
1136     dst->linesize[2] = src->linesize[2];
1137     return 0;
1138 }
1139
1140 int av_picture_pad(AVPicture *dst, const AVPicture *src, int height, int width,
1141                    enum PixelFormat pix_fmt, int padtop, int padbottom, int padleft, int padright,
1142             int *color)
1143 {
1144     uint8_t *optr;
1145     int y_shift;
1146     int x_shift;
1147     int yheight;
1148     int i, y;
1149
1150     if (pix_fmt < 0 || pix_fmt >= PIX_FMT_NB ||
1151         !is_yuv_planar(&pix_fmt_info[pix_fmt])) return -1;
1152
1153     for (i = 0; i < 3; i++) {
1154         x_shift = i ? av_pix_fmt_descriptors[pix_fmt].log2_chroma_w : 0;
1155         y_shift = i ? av_pix_fmt_descriptors[pix_fmt].log2_chroma_h : 0;
1156
1157         if (padtop || padleft) {
1158             memset(dst->data[i], color[i],
1159                 dst->linesize[i] * (padtop >> y_shift) + (padleft >> x_shift));
1160         }
1161
1162         if (padleft || padright) {
1163             optr = dst->data[i] + dst->linesize[i] * (padtop >> y_shift) +
1164                 (dst->linesize[i] - (padright >> x_shift));
1165             yheight = (height - 1 - (padtop + padbottom)) >> y_shift;
1166             for (y = 0; y < yheight; y++) {
1167                 memset(optr, color[i], (padleft + padright) >> x_shift);
1168                 optr += dst->linesize[i];
1169             }
1170         }
1171
1172         if (src) { /* first line */
1173             uint8_t *iptr = src->data[i];
1174             optr = dst->data[i] + dst->linesize[i] * (padtop >> y_shift) +
1175                     (padleft >> x_shift);
1176             memcpy(optr, iptr, (width - padleft - padright) >> x_shift);
1177             iptr += src->linesize[i];
1178             optr = dst->data[i] + dst->linesize[i] * (padtop >> y_shift) +
1179                 (dst->linesize[i] - (padright >> x_shift));
1180             yheight = (height - 1 - (padtop + padbottom)) >> y_shift;
1181             for (y = 0; y < yheight; y++) {
1182                 memset(optr, color[i], (padleft + padright) >> x_shift);
1183                 memcpy(optr + ((padleft + padright) >> x_shift), iptr,
1184                        (width - padleft - padright) >> x_shift);
1185                 iptr += src->linesize[i];
1186                 optr += dst->linesize[i];
1187             }
1188         }
1189
1190         if (padbottom || padright) {
1191             optr = dst->data[i] + dst->linesize[i] *
1192                 ((height - padbottom) >> y_shift) - (padright >> x_shift);
1193             memset(optr, color[i],dst->linesize[i] *
1194                 (padbottom >> y_shift) + (padright >> x_shift));
1195         }
1196     }
1197     return 0;
1198 }
1199
1200 /* NOTE: we scan all the pixels to have an exact information */
1201 static int get_alpha_info_pal8(const AVPicture *src, int width, int height)
1202 {
1203     const unsigned char *p;
1204     int src_wrap, ret, x, y;
1205     unsigned int a;
1206     uint32_t *palette = (uint32_t *)src->data[1];
1207
1208     p = src->data[0];
1209     src_wrap = src->linesize[0] - width;
1210     ret = 0;
1211     for(y=0;y<height;y++) {
1212         for(x=0;x<width;x++) {
1213             a = palette[p[0]] >> 24;
1214             if (a == 0x00) {
1215                 ret |= FF_ALPHA_TRANSP;
1216             } else if (a != 0xff) {
1217                 ret |= FF_ALPHA_SEMI_TRANSP;
1218             }
1219             p++;
1220         }
1221         p += src_wrap;
1222     }
1223     return ret;
1224 }
1225
1226 int img_get_alpha_info(const AVPicture *src,
1227                        enum PixelFormat pix_fmt, int width, int height)
1228 {
1229     const PixFmtInfo *pf = &pix_fmt_info[pix_fmt];
1230     int ret;
1231
1232     /* no alpha can be represented in format */
1233     if (!pf->is_alpha)
1234         return 0;
1235     switch(pix_fmt) {
1236     case PIX_FMT_PAL8:
1237         ret = get_alpha_info_pal8(src, width, height);
1238         break;
1239     default:
1240         /* we do not know, so everything is indicated */
1241         ret = FF_ALPHA_TRANSP | FF_ALPHA_SEMI_TRANSP;
1242         break;
1243     }
1244     return ret;
1245 }
1246
1247 #if HAVE_MMX
1248 #define DEINT_INPLACE_LINE_LUM \
1249                     movd_m2r(lum_m4[0],mm0);\
1250                     movd_m2r(lum_m3[0],mm1);\
1251                     movd_m2r(lum_m2[0],mm2);\
1252                     movd_m2r(lum_m1[0],mm3);\
1253                     movd_m2r(lum[0],mm4);\
1254                     punpcklbw_r2r(mm7,mm0);\
1255                     movd_r2m(mm2,lum_m4[0]);\
1256                     punpcklbw_r2r(mm7,mm1);\
1257                     punpcklbw_r2r(mm7,mm2);\
1258                     punpcklbw_r2r(mm7,mm3);\
1259                     punpcklbw_r2r(mm7,mm4);\
1260                     paddw_r2r(mm3,mm1);\
1261                     psllw_i2r(1,mm2);\
1262                     paddw_r2r(mm4,mm0);\
1263                     psllw_i2r(2,mm1);\
1264                     paddw_r2r(mm6,mm2);\
1265                     paddw_r2r(mm2,mm1);\
1266                     psubusw_r2r(mm0,mm1);\
1267                     psrlw_i2r(3,mm1);\
1268                     packuswb_r2r(mm7,mm1);\
1269                     movd_r2m(mm1,lum_m2[0]);
1270
1271 #define DEINT_LINE_LUM \
1272                     movd_m2r(lum_m4[0],mm0);\
1273                     movd_m2r(lum_m3[0],mm1);\
1274                     movd_m2r(lum_m2[0],mm2);\
1275                     movd_m2r(lum_m1[0],mm3);\
1276                     movd_m2r(lum[0],mm4);\
1277                     punpcklbw_r2r(mm7,mm0);\
1278                     punpcklbw_r2r(mm7,mm1);\
1279                     punpcklbw_r2r(mm7,mm2);\
1280                     punpcklbw_r2r(mm7,mm3);\
1281                     punpcklbw_r2r(mm7,mm4);\
1282                     paddw_r2r(mm3,mm1);\
1283                     psllw_i2r(1,mm2);\
1284                     paddw_r2r(mm4,mm0);\
1285                     psllw_i2r(2,mm1);\
1286                     paddw_r2r(mm6,mm2);\
1287                     paddw_r2r(mm2,mm1);\
1288                     psubusw_r2r(mm0,mm1);\
1289                     psrlw_i2r(3,mm1);\
1290                     packuswb_r2r(mm7,mm1);\
1291                     movd_r2m(mm1,dst[0]);
1292 #endif
1293
1294 /* filter parameters: [-1 4 2 4 -1] // 8 */
1295 static void deinterlace_line(uint8_t *dst,
1296                              const uint8_t *lum_m4, const uint8_t *lum_m3,
1297                              const uint8_t *lum_m2, const uint8_t *lum_m1,
1298                              const uint8_t *lum,
1299                              int size)
1300 {
1301 #if !HAVE_MMX
1302     uint8_t *cm = ff_cropTbl + MAX_NEG_CROP;
1303     int sum;
1304
1305     for(;size > 0;size--) {
1306         sum = -lum_m4[0];
1307         sum += lum_m3[0] << 2;
1308         sum += lum_m2[0] << 1;
1309         sum += lum_m1[0] << 2;
1310         sum += -lum[0];
1311         dst[0] = cm[(sum + 4) >> 3];
1312         lum_m4++;
1313         lum_m3++;
1314         lum_m2++;
1315         lum_m1++;
1316         lum++;
1317         dst++;
1318     }
1319 #else
1320
1321     {
1322         pxor_r2r(mm7,mm7);
1323         movq_m2r(ff_pw_4,mm6);
1324     }
1325     for (;size > 3; size-=4) {
1326         DEINT_LINE_LUM
1327         lum_m4+=4;
1328         lum_m3+=4;
1329         lum_m2+=4;
1330         lum_m1+=4;
1331         lum+=4;
1332         dst+=4;
1333     }
1334 #endif
1335 }
1336 static void deinterlace_line_inplace(uint8_t *lum_m4, uint8_t *lum_m3, uint8_t *lum_m2, uint8_t *lum_m1, uint8_t *lum,
1337                              int size)
1338 {
1339 #if !HAVE_MMX
1340     uint8_t *cm = ff_cropTbl + MAX_NEG_CROP;
1341     int sum;
1342
1343     for(;size > 0;size--) {
1344         sum = -lum_m4[0];
1345         sum += lum_m3[0] << 2;
1346         sum += lum_m2[0] << 1;
1347         lum_m4[0]=lum_m2[0];
1348         sum += lum_m1[0] << 2;
1349         sum += -lum[0];
1350         lum_m2[0] = cm[(sum + 4) >> 3];
1351         lum_m4++;
1352         lum_m3++;
1353         lum_m2++;
1354         lum_m1++;
1355         lum++;
1356     }
1357 #else
1358
1359     {
1360         pxor_r2r(mm7,mm7);
1361         movq_m2r(ff_pw_4,mm6);
1362     }
1363     for (;size > 3; size-=4) {
1364         DEINT_INPLACE_LINE_LUM
1365         lum_m4+=4;
1366         lum_m3+=4;
1367         lum_m2+=4;
1368         lum_m1+=4;
1369         lum+=4;
1370     }
1371 #endif
1372 }
1373
1374 /* deinterlacing : 2 temporal taps, 3 spatial taps linear filter. The
1375    top field is copied as is, but the bottom field is deinterlaced
1376    against the top field. */
1377 static void deinterlace_bottom_field(uint8_t *dst, int dst_wrap,
1378                                     const uint8_t *src1, int src_wrap,
1379                                     int width, int height)
1380 {
1381     const uint8_t *src_m2, *src_m1, *src_0, *src_p1, *src_p2;
1382     int y;
1383
1384     src_m2 = src1;
1385     src_m1 = src1;
1386     src_0=&src_m1[src_wrap];
1387     src_p1=&src_0[src_wrap];
1388     src_p2=&src_p1[src_wrap];
1389     for(y=0;y<(height-2);y+=2) {
1390         memcpy(dst,src_m1,width);
1391         dst += dst_wrap;
1392         deinterlace_line(dst,src_m2,src_m1,src_0,src_p1,src_p2,width);
1393         src_m2 = src_0;
1394         src_m1 = src_p1;
1395         src_0 = src_p2;
1396         src_p1 += 2*src_wrap;
1397         src_p2 += 2*src_wrap;
1398         dst += dst_wrap;
1399     }
1400     memcpy(dst,src_m1,width);
1401     dst += dst_wrap;
1402     /* do last line */
1403     deinterlace_line(dst,src_m2,src_m1,src_0,src_0,src_0,width);
1404 }
1405
1406 static void deinterlace_bottom_field_inplace(uint8_t *src1, int src_wrap,
1407                                              int width, int height)
1408 {
1409     uint8_t *src_m1, *src_0, *src_p1, *src_p2;
1410     int y;
1411     uint8_t *buf;
1412     buf = (uint8_t*)av_malloc(width);
1413
1414     src_m1 = src1;
1415     memcpy(buf,src_m1,width);
1416     src_0=&src_m1[src_wrap];
1417     src_p1=&src_0[src_wrap];
1418     src_p2=&src_p1[src_wrap];
1419     for(y=0;y<(height-2);y+=2) {
1420         deinterlace_line_inplace(buf,src_m1,src_0,src_p1,src_p2,width);
1421         src_m1 = src_p1;
1422         src_0 = src_p2;
1423         src_p1 += 2*src_wrap;
1424         src_p2 += 2*src_wrap;
1425     }
1426     /* do last line */
1427     deinterlace_line_inplace(buf,src_m1,src_0,src_0,src_0,width);
1428     av_free(buf);
1429 }
1430
1431 int avpicture_deinterlace(AVPicture *dst, const AVPicture *src,
1432                           enum PixelFormat pix_fmt, int width, int height)
1433 {
1434     int i;
1435
1436     if (pix_fmt != PIX_FMT_YUV420P &&
1437         pix_fmt != PIX_FMT_YUV422P &&
1438         pix_fmt != PIX_FMT_YUV444P &&
1439         pix_fmt != PIX_FMT_YUV411P &&
1440         pix_fmt != PIX_FMT_GRAY8)
1441         return -1;
1442     if ((width & 3) != 0 || (height & 3) != 0)
1443         return -1;
1444
1445     for(i=0;i<3;i++) {
1446         if (i == 1) {
1447             switch(pix_fmt) {
1448             case PIX_FMT_YUV420P:
1449                 width >>= 1;
1450                 height >>= 1;
1451                 break;
1452             case PIX_FMT_YUV422P:
1453                 width >>= 1;
1454                 break;
1455             case PIX_FMT_YUV411P:
1456                 width >>= 2;
1457                 break;
1458             default:
1459                 break;
1460             }
1461             if (pix_fmt == PIX_FMT_GRAY8) {
1462                 break;
1463             }
1464         }
1465         if (src == dst) {
1466             deinterlace_bottom_field_inplace(dst->data[i], dst->linesize[i],
1467                                  width, height);
1468         } else {
1469             deinterlace_bottom_field(dst->data[i],dst->linesize[i],
1470                                         src->data[i], src->linesize[i],
1471                                         width, height);
1472         }
1473     }
1474     emms_c();
1475     return 0;
1476 }
1477