falkTX
/
FFmpeg
mirror of https://github.com/falkTX/FFmpeg.git
1
0
Fork 0
Code Issues 0 Releases 338 Wiki Activity
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
82 Commits
32 Branches
462MB
Tree: 3d03c0a24e
Branches Tags
${ item.name }
Create branch ${ searchTerm }
from '3d03c0a24e'
${ noResults }
FFmpeg/libavcodec/imgconvert.c

550 lines
16KB
Raw Blame History 

  1. /*

  2.  * Misc image convertion routines

  3.  * Copyright (c) 2001 Gerard Lantau.

  4.  *

  5.  * This program is free software; you can redistribute it and/or modify

  6.  * it under the terms of the GNU General Public License as published by

  7.  * the Free Software Foundation; either version 2 of the License, or

  8.  * (at your option) any later version.

  9.  *

  10.  * This program is distributed in the hope that it will be useful,

  11.  * but WITHOUT ANY WARRANTY; without even the implied warranty of

  12.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

  13.  * GNU General Public License for more details.

  14.  *

  15.  * You should have received a copy of the GNU General Public License

  16.  * along with this program; if not, write to the Free Software

  17.  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.

  18.  */

  19. #include <stdlib.h>

  20. #include <stdio.h>

  21. #include <string.h>

  22. 

  23. #include "avcodec.h"

  24. #include "dsputil.h"

  25. 

  26. #ifdef USE_FASTMEMCPY

  27. #include "fastmemcpy.h"

  28. #endif

  29. /* XXX: totally non optimized */

  30. 

  31. static void yuv422_to_yuv420p(UINT8 *lum, UINT8 *cb, UINT8 *cr,

  32.                               UINT8 *src, int width, int height)

  33. {

  34.     int x, y;

  35.     UINT8 *p = src;

  36. 

  37.     for(y=0;y<height;y+=2) {

  38.         for(x=0;x<width;x+=2) {

  39.             lum[0] = p[0];

  40.             cb[0] = p[1];

  41.             lum[1] = p[2];

  42.             cr[0] = p[3];

  43.             p += 4;

  44.             lum += 2;

  45.             cb++;

  46.             cr++;

  47.         }

  48.         for(x=0;x<width;x+=2) {

  49.             lum[0] = p[0];

  50.             lum[1] = p[2];

  51.             p += 4;

  52.             lum += 2;

  53.         }

  54.     }

  55. }

  56. 

  57. #define SCALEBITS 8

  58. #define ONE_HALF  (1 << (SCALEBITS - 1))

  59. #define FIX(x)		((int) ((x) * (1L<<SCALEBITS) + 0.5))

  60. 

  61. static void rgb24_to_yuv420p(UINT8 *lum, UINT8 *cb, UINT8 *cr,

  62.                               UINT8 *src, int width, int height)

  63. {

  64.     int wrap, wrap3, x, y;

  65.     int r, g, b, r1, g1, b1;

  66.     UINT8 *p;

  67. 

  68.     wrap = width;

  69.     wrap3 = width * 3;

  70.     p = src;

  71.     for(y=0;y<height;y+=2) {

  72.         for(x=0;x<width;x+=2) {

  73.             r = p[0];

  74.             g = p[1];

  75.             b = p[2];

  76.             r1 = r;

  77.             g1 = g;

  78.             b1 = b;

  79.             lum[0] = (FIX(0.29900) * r + FIX(0.58700) * g + 

  80.                       FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;

  81.             r = p[3];

  82.             g = p[4];

  83.             b = p[5];

  84.             r1 += r;

  85.             g1 += g;

  86.             b1 += b;

  87.             lum[1] = (FIX(0.29900) * r + FIX(0.58700) * g + 

  88.                       FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;

  89.             p += wrap3;

  90.             lum += wrap;

  91. 

  92.             r = p[0];

  93.             g = p[1];

  94.             b = p[2];

  95.             r1 += r;

  96.             g1 += g;

  97.             b1 += b;

  98.             lum[0] = (FIX(0.29900) * r + FIX(0.58700) * g + 

  99.                       FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;

  100.             r = p[3];

  101.             g = p[4];

  102.             b = p[5];

  103.             r1 += r;

  104.             g1 += g;

  105.             b1 += b;

  106.             lum[1] = (FIX(0.29900) * r + FIX(0.58700) * g + 

  107.                       FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;

  108.             

  109.             cb[0] = ((- FIX(0.16874) * r1 - FIX(0.33126) * g1 + 

  110.                       FIX(0.50000) * b1 + 4 * ONE_HALF - 1) >> (SCALEBITS + 2)) + 128;

  111.             cr[0] = ((FIX(0.50000) * r1 - FIX(0.41869) * g1 - 

  112.                      FIX(0.08131) * b1 + 4 * ONE_HALF - 1) >> (SCALEBITS + 2)) + 128;

  113. 

  114.             cb++;

  115.             cr++;

  116.             p += -wrap3 + 2 * 3;

  117.             lum += -wrap + 2;

  118.         }

  119.         p += wrap3;

  120.         lum += wrap;

  121.     }

  122. }

  123. 

  124. static void bgr24_to_yuv420p(UINT8 *lum, UINT8 *cb, UINT8 *cr,

  125.                               UINT8 *src, int width, int height)

  126. {

  127.     int wrap, wrap3, x, y;

  128.     int r, g, b, r1, g1, b1;

  129.     UINT8 *p;

  130. 

  131.     wrap = width;

  132.     wrap3 = width * 3;

  133.     p = src;

  134.     for(y=0;y<height;y+=2) {

  135.         for(x=0;x<width;x+=2) {

  136.             b = p[0];

  137.             g = p[1];

  138.             r = p[2];

  139.             r1 = r;

  140.             g1 = g;

  141.             b1 = b;

  142.             lum[0] = (FIX(0.29900) * r + FIX(0.58700) * g + 

  143.                       FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;

  144.             b = p[3];

  145.             g = p[4];

  146.             r = p[5];

  147.             r1 += r;

  148.             g1 += g;

  149.             b1 += b;

  150.             lum[1] = (FIX(0.29900) * r + FIX(0.58700) * g + 

  151.                       FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;

  152.             p += wrap3;

  153.             lum += wrap;

  154. 

  155.             b = p[0];

  156.             g = p[1];

  157.             r = p[2];

  158.             r1 += r;

  159.             g1 += g;

  160.             b1 += b;

  161.             lum[0] = (FIX(0.29900) * r + FIX(0.58700) * g + 

  162.                       FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;

  163.             b = p[3];

  164.             g = p[4];

  165.             r = p[5];

  166.             r1 += r;

  167.             g1 += g;

  168.             b1 += b;

  169.             lum[1] = (FIX(0.29900) * r + FIX(0.58700) * g + 

  170.                       FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;

  171.             

  172.             cb[0] = ((- FIX(0.16874) * r1 - FIX(0.33126) * g1 + 

  173.                       FIX(0.50000) * b1 + 4 * ONE_HALF - 1) >> (SCALEBITS + 2)) + 128;

  174.             cr[0] = ((FIX(0.50000) * r1 - FIX(0.41869) * g1 - 

  175.                      FIX(0.08131) * b1 + 4 * ONE_HALF - 1) >> (SCALEBITS + 2)) + 128;

  176. 

  177.             cb++;

  178.             cr++;

  179.             p += -wrap3 + 2 * 3;

  180.             lum += -wrap + 2;

  181.         }

  182.         p += wrap3;

  183.         lum += wrap;

  184.     }

  185. }

  186. 

  187. /* XXX: use generic filter ? */

  188. /* 1x2 -> 1x1 */

  189. static void shrink2(UINT8 *dst, int dst_wrap, 

  190.                     UINT8 *src, int src_wrap,

  191.                     int width, int height)

  192. {

  193.     int w;

  194.     UINT8 *s1, *s2, *d;

  195. 

  196.     for(;height > 0; height--) {

  197.         s1 = src;

  198.         s2 = s1 + src_wrap;

  199.         d = dst;

  200.         for(w = width;w >= 4; w-=4) {

  201.             d[0] = (s1[0] + s2[0]) >> 1;

  202.             d[1] = (s1[1] + s2[1]) >> 1;

  203.             d[2] = (s1[2] + s2[2]) >> 1;

  204.             d[3] = (s1[3] + s2[3]) >> 1;

  205.             s1 += 4;

  206.             s2 += 4;

  207.             d += 4;

  208.         }

  209.         for(;w > 0; w--) {

  210.             d[0] = (s1[0] + s2[0]) >> 1;

  211.             s1++;

  212.             s2++;

  213.             d++;

  214.         }

  215.         src += 2 * src_wrap;

  216.         dst += dst_wrap;

  217.     }

  218. }

  219. 

  220. /* 2x2 -> 1x1 */

  221. static void shrink22(UINT8 *dst, int dst_wrap, 

  222.                      UINT8 *src, int src_wrap,

  223.                      int width, int height)

  224. {

  225.     int w;

  226.     UINT8 *s1, *s2, *d;

  227. 

  228.     for(;height > 0; height--) {

  229.         s1 = src;

  230.         s2 = s1 + src_wrap;

  231.         d = dst;

  232.         for(w = width;w >= 4; w-=4) {

  233.             d[0] = (s1[0] + s1[1] + s2[0] + s2[1] + 2) >> 1;

  234.             d[1] = (s1[2] + s1[3] + s2[2] + s2[3] + 2) >> 1;

  235.             d[2] = (s1[4] + s1[5] + s2[4] + s2[5] + 2) >> 1;

  236.             d[3] = (s1[6] + s1[7] + s2[6] + s2[7] + 2) >> 1;

  237.             s1 += 8;

  238.             s2 += 8;

  239.             d += 4;

  240.         }

  241.         for(;w > 0; w--) {

  242.             d[0] = (s1[0] + s1[1] + s2[0] + s2[1] + 2) >> 1;

  243.             s1 += 2;

  244.             s2 += 2;

  245.             d++;

  246.         }

  247.         src += 2 * src_wrap;

  248.         dst += dst_wrap;

  249.     }

  250. }

  251. 

  252. static void img_copy(UINT8 *dst, int dst_wrap, 

  253.                      UINT8 *src, int src_wrap,

  254.                      int width, int height)

  255. {

  256.     for(;height > 0; height--) {

  257.         memcpy(dst, src, width);

  258.         dst += dst_wrap;

  259.         src += src_wrap;

  260.     }

  261. }

  262. 

  263. #define SCALE_BITS 10

  264. 

  265. #define C_Y  (76309 >> (16 - SCALE_BITS))

  266. #define C_RV (117504 >> (16 - SCALE_BITS))

  267. #define C_BU (138453 >> (16 - SCALE_BITS))

  268. #define C_GU (13954 >> (16 - SCALE_BITS))

  269. #define C_GV (34903 >> (16 - SCALE_BITS))

  270. 

  271. #define RGBOUT(r, g, b, y1)\

  272. {\

  273.     y = (y1 - 16) * C_Y;\

  274.     r = cm[(y + r_add) >> SCALE_BITS];\

  275.     g = cm[(y + g_add) >> SCALE_BITS];\

  276.     b = cm[(y + b_add) >> SCALE_BITS];\

  277. }

  278. 

  279. /* XXX: no chroma interpolating is done */

  280. static void yuv420p_to_rgb24(AVPicture *dst, AVPicture *src, 

  281.                              int width, int height)

  282. {

  283.     UINT8 *y1_ptr, *y2_ptr, *cb_ptr, *cr_ptr, *d, *d1, *d2;

  284.     int w, y, cb, cr, r_add, g_add, b_add, width2;

  285.     UINT8 *cm = cropTbl + MAX_NEG_CROP;

  286. 

  287.     d = dst->data[0];

  288.     y1_ptr = src->data[0];

  289.     cb_ptr = src->data[1];

  290.     cr_ptr = src->data[2];

  291.     width2 = width >> 1;

  292.     for(;height > 0; height -= 2) {

  293.         d1 = d;

  294.         d2 = d + dst->linesize[0];

  295.         y2_ptr = y1_ptr + src->linesize[0];

  296.         for(w = width2; w > 0; w --) {

  297.             cb = cb_ptr[0] - 128;

  298.             cr = cr_ptr[0] - 128;

  299.             r_add = C_RV * cr + (1 << (SCALE_BITS - 1));

  300.             g_add = - C_GU * cb - C_GV * cr + (1 << (SCALE_BITS - 1));

  301.             b_add = C_BU * cb + (1 << (SCALE_BITS - 1));

  302.             

  303.             /* output 4 pixels */

  304.             RGBOUT(d1[0], d1[1], d1[2], y1_ptr[0]);

  305.             RGBOUT(d1[3], d1[4], d1[5], y1_ptr[1]);

  306.             RGBOUT(d2[0], d2[1], d2[2], y2_ptr[0]);

  307.             RGBOUT(d2[3], d2[4], d2[5], y2_ptr[1]);

  308. 

  309.             d1 += 6;

  310.             d2 += 6;

  311.             y1_ptr += 2;

  312.             y2_ptr += 2;

  313.             cb_ptr++;

  314.             cr_ptr++;

  315.         }

  316.         d += 2 * dst->linesize[0];

  317.         y1_ptr += 2 * src->linesize[0] - width;

  318.         cb_ptr += src->linesize[1] - width2;

  319.         cr_ptr += src->linesize[2] - width2;

  320.     }

  321. }

  322. 

  323. /* XXX: no chroma interpolating is done */

  324. static void yuv422p_to_rgb24(AVPicture *dst, AVPicture *src, 

  325.                              int width, int height)

  326. {

  327.     UINT8 *y1_ptr, *cb_ptr, *cr_ptr, *d, *d1;

  328.     int w, y, cb, cr, r_add, g_add, b_add, width2;

  329.     UINT8 *cm = cropTbl + MAX_NEG_CROP;

  330. 

  331.     d = dst->data[0];

  332.     y1_ptr = src->data[0];

  333.     cb_ptr = src->data[1];

  334.     cr_ptr = src->data[2];

  335.     width2 = width >> 1;

  336.     for(;height > 0; height --) {

  337.         d1 = d;

  338.         for(w = width2; w > 0; w --) {

  339.             cb = cb_ptr[0] - 128;

  340.             cr = cr_ptr[0] - 128;

  341.             r_add = C_RV * cr + (1 << (SCALE_BITS - 1));

  342.             g_add = - C_GU * cb - C_GV * cr + (1 << (SCALE_BITS - 1));

  343.             b_add = C_BU * cb + (1 << (SCALE_BITS - 1));

  344.             

  345.             /* output 2 pixels */

  346.             RGBOUT(d1[0], d1[1], d1[2], y1_ptr[0]);

  347.             RGBOUT(d1[3], d1[4], d1[5], y1_ptr[1]);

  348. 

  349.             d1 += 6;

  350.             y1_ptr += 2;

  351.             cb_ptr++;

  352.             cr_ptr++;

  353.         }

  354.         d += dst->linesize[0];

  355.         y1_ptr += src->linesize[0] - width;

  356.         cb_ptr += src->linesize[1] - width2;

  357.         cr_ptr += src->linesize[2] - width2;

  358.     }

  359. }

  360. 

  361. /* XXX: always use linesize. Return -1 if not supported */

  362. int img_convert(AVPicture *dst, int dst_pix_fmt,

  363.                 AVPicture *src, int pix_fmt, 

  364.                 int width, int height)

  365. {

  366.     int i;

  367. 

  368.     if (dst_pix_fmt == pix_fmt) {

  369.         switch(pix_fmt) {

  370.         case PIX_FMT_YUV420P:

  371.             for(i=0;i<3;i++) {

  372.                 if (i == 1) {

  373.                     width >>= 1;

  374.                     height >>= 1;

  375.                 }

  376.                 img_copy(dst->data[i], dst->linesize[i],

  377.                          src->data[i], src->linesize[i],

  378.                          width, height);

  379.             }

  380.             break;

  381.         default:

  382.             return -1;

  383.         }

  384.     } else if (dst_pix_fmt == PIX_FMT_YUV420P) {

  385.         

  386.         switch(pix_fmt) {

  387.         case PIX_FMT_YUV420P:

  388.             for(i=0;i<3;i++) {

  389.                 img_copy(dst->data[i], dst->linesize[i],

  390.                          src->data[i], src->linesize[i],

  391.                          width, height);

  392.             }

  393.             break;

  394.         case PIX_FMT_YUV422P:

  395.             img_copy(dst->data[0], dst->linesize[0],

  396.                      src->data[0], src->linesize[0],

  397.                      width, height);

  398.             width >>= 1;

  399.             height >>= 1;

  400.             for(i=1;i<3;i++) {

  401.                 shrink2(dst->data[i], dst->linesize[i],

  402.                         src->data[i], src->linesize[i],

  403.                         width, height);

  404.             }

  405.             break;

  406.         case PIX_FMT_YUV444P:

  407.             img_copy(dst->data[0], dst->linesize[0],

  408.                      src->data[0], src->linesize[0],

  409.                      width, height);

  410.             width >>= 1;

  411.             height >>= 1;

  412.             for(i=1;i<3;i++) {

  413.                 shrink22(dst->data[i], dst->linesize[i],

  414.                          src->data[i], src->linesize[i],

  415.                          width, height);

  416.             }

  417.             break;

  418.         case PIX_FMT_YUV422:

  419.             yuv422_to_yuv420p(dst->data[0], dst->data[1], dst->data[2], 

  420.                               src->data[0], width, height);

  421.             break;

  422.         case PIX_FMT_RGB24:

  423.             rgb24_to_yuv420p(dst->data[0], dst->data[1], dst->data[2], 

  424.                              src->data[0], width, height);

  425.             break;

  426.         case PIX_FMT_BGR24:

  427.             bgr24_to_yuv420p(dst->data[0], dst->data[1], dst->data[2], 

  428.                              src->data[0], width, height);

  429.             break;

  430.         default:

  431.             return -1;

  432.         }

  433.     } else if (dst_pix_fmt == PIX_FMT_RGB24) {

  434.         switch(pix_fmt) {

  435.         case PIX_FMT_YUV420P:

  436.             yuv420p_to_rgb24(dst, src, width, height);

  437.             break;

  438.         case PIX_FMT_YUV422P:

  439.             yuv422p_to_rgb24(dst, src, width, height);

  440.             break;

  441.         default:

  442.             return -1;

  443.         }

  444.     } else {

  445.         return -1;

  446.     }

  447.     return 0;

  448. }

  449. 

  450. /* filter parameters: [-1 4 2 4 -1] // 8 */

  451. static void deinterlace_line(UINT8 *dst, UINT8 *src, int src_wrap,

  452.                              int size)

  453. {

  454.     UINT8 *cm = cropTbl + MAX_NEG_CROP;

  455.     int sum;

  456.     UINT8 *s;

  457. 

  458.     for(;size > 0;size--) {

  459.         s = src;

  460.         sum = -s[0];

  461.         s += src_wrap;

  462.         sum += s[0] << 2;

  463.         s += src_wrap;

  464.         sum += s[0] << 1;

  465.         s += src_wrap;

  466.         sum += s[0] << 2;

  467.         s += src_wrap;

  468.         sum += -s[0];

  469.         dst[0] = cm[(sum + 4) >> 3];

  470.         dst++;

  471.         src++;

  472.     }

  473. }

  474. 

  475. /* deinterlacing : 2 temporal taps, 3 spatial taps linear filter. The

  476.    top field is copied as is, but the bottom field is deinterlaced

  477.    against the top field. */

  478. static void deinterlace_bottom_field(UINT8 *dst, int dst_wrap,

  479.                                      UINT8 *src1, int src_wrap,

  480.                                      int width, int height)

  481. {

  482.     UINT8 *src, *ptr;

  483.     int y, y1, i;

  484.     UINT8 buf[5 * width];

  485. 

  486.     src = src1;

  487.     for(y=0;y<height;y+=2) {

  488.         /* copy top field line */

  489.         memcpy(dst, src, width);

  490.         dst += dst_wrap;

  491.         src += (1 - 2) * src_wrap;

  492.         y1 = y - 2;

  493.         if (y1 >= 0 && (y1 + 4) < height) {

  494.             /* fast case : no edges */

  495.             deinterlace_line(dst, src, src_wrap, width);

  496.         } else {

  497.             /* in order to use the same function, we use an intermediate buffer */

  498.             ptr = buf;

  499.             for(i=0;i<5;i++) {

  500.                 if (y1 < 0)

  501.                     memcpy(ptr, src1, width);

  502.                 else if (y1 >= height) 

  503.                     memcpy(ptr, src1 + (height - 1) * src_wrap, width);

  504.                 else

  505.                     memcpy(ptr, src1 + y1 * src_wrap, width);

  506.                 y1++;

  507.                 ptr += width;

  508.             }

  509.             deinterlace_line(dst, buf, width, width);

  510.         }

  511.         dst += dst_wrap;

  512.         src += (2 + 1) * src_wrap;

  513.     }

  514. }

  515. 

  516. 

  517. /* deinterlace, return -1 if format not handled */

  518. int avpicture_deinterlace(AVPicture *dst, AVPicture *src,

  519.                           int pix_fmt, int width, int height)

  520. {

  521.     int i;

  522. 

  523.     if (pix_fmt != PIX_FMT_YUV420P &&

  524.         pix_fmt != PIX_FMT_YUV422P &&

  525.         pix_fmt != PIX_FMT_YUV444P)

  526.         return -1;

  527.     if ((width & 1) != 0 || (height & 3) != 0)

  528.         return -1;

  529.     

  530.     for(i=0;i<3;i++) {

  531.         if (i == 1) {

  532.             switch(pix_fmt) {

  533.             case PIX_FMT_YUV420P:

  534.                 width >>= 1;

  535.                 height >>= 1;

  536.                 break;

  537.             case PIX_FMT_YUV422P:

  538.                 width >>= 1;

  539.                 break;

  540.             default:

  541.                 break;

  542.             }

  543.         }

  544.         deinterlace_bottom_field(dst->data[i], dst->linesize[i],

  545.                                  src->data[i], src->linesize[i],

  546.                                  width, height);

  547.     }

  548.     return 0;

  549. }