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.
984 Commits
32 Branches
2.4GB
Tree: bdd7d51848
Branches Tags
${ item.name }
Create branch ${ searchTerm }
from 'bdd7d51848'
${ noResults }
FFmpeg/libavcodec/imgconvert.c

592 lines
17KB
Raw Blame History 

  1. /*

  2.  * Misc image convertion routines

  3.  * Copyright (c) 2001, 2002 Fabrice Bellard.

  4.  *

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

  6.  * modify it under the terms of the GNU Lesser General Public

  7.  * License as published by the Free Software Foundation; either

  8.  * version 2 of the License, or (at your option) any later version.

  9.  *

  10.  * This library 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 GNU

  13.  * Lesser General Public License for more details.

  14.  *

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

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

  17.  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

  18.  */

  19. #include "avcodec.h"

  20. #include "dsputil.h"

  21. 

  22. #ifdef USE_FASTMEMCPY

  23. #include "fastmemcpy.h"

  24. #endif

  25. /* XXX: totally non optimized */

  26. 

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

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

  29. {

  30.     int x, y;

  31.     UINT8 *p = src;

  32. 

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

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

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

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

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

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

  39.             p += 4;

  40.             lum += 2;

  41.             cb++;

  42.             cr++;

  43.         }

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

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

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

  47.             p += 4;

  48.             lum += 2;

  49.         }

  50.     }

  51. }

  52. 

  53. #define SCALEBITS 8

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

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

  56. 

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

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

  59. {

  60.     int wrap, wrap3, x, y;

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

  62.     UINT8 *p;

  63. 

  64.     wrap = width;

  65.     wrap3 = width * 3;

  66.     p = src;

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

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

  69.             r = p[0];

  70.             g = p[1];

  71.             b = p[2];

  72.             r1 = r;

  73.             g1 = g;

  74.             b1 = b;

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

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

  77.             r = p[3];

  78.             g = p[4];

  79.             b = p[5];

  80.             r1 += r;

  81.             g1 += g;

  82.             b1 += b;

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

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

  85.             p += wrap3;

  86.             lum += wrap;

  87. 

  88.             r = p[0];

  89.             g = p[1];

  90.             b = p[2];

  91.             r1 += r;

  92.             g1 += g;

  93.             b1 += b;

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

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

  96.             r = p[3];

  97.             g = p[4];

  98.             b = p[5];

  99.             r1 += r;

  100.             g1 += g;

  101.             b1 += b;

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

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

  104.             

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

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

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

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

  109. 

  110.             cb++;

  111.             cr++;

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

  113.             lum += -wrap + 2;

  114.         }

  115.         p += wrap3;

  116.         lum += wrap;

  117.     }

  118. }

  119. 

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

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

  122. {

  123.     int wrap, wrap3, x, y;

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

  125.     UINT8 *p;

  126. 

  127.     wrap = width;

  128.     wrap3 = width * 3;

  129.     p = src;

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

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

  132.             b = p[0];

  133.             g = p[1];

  134.             r = p[2];

  135.             r1 = r;

  136.             g1 = g;

  137.             b1 = b;

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

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

  140.             b = p[3];

  141.             g = p[4];

  142.             r = p[5];

  143.             r1 += r;

  144.             g1 += g;

  145.             b1 += b;

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

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

  148.             p += wrap3;

  149.             lum += wrap;

  150. 

  151.             b = p[0];

  152.             g = p[1];

  153.             r = p[2];

  154.             r1 += r;

  155.             g1 += g;

  156.             b1 += b;

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

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

  159.             b = p[3];

  160.             g = p[4];

  161.             r = p[5];

  162.             r1 += r;

  163.             g1 += g;

  164.             b1 += b;

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

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

  167.             

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

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

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

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

  172. 

  173.             cb++;

  174.             cr++;

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

  176.             lum += -wrap + 2;

  177.         }

  178.         p += wrap3;

  179.         lum += wrap;

  180.     }

  181. }

  182. 

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

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

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

  186.                     UINT8 *src, int src_wrap,

  187.                     int width, int height)

  188. {

  189.     int w;

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

  191. 

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

  193.         s1 = src;

  194.         s2 = s1 + src_wrap;

  195.         d = dst;

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

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

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

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

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

  201.             s1 += 4;

  202.             s2 += 4;

  203.             d += 4;

  204.         }

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

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

  207.             s1++;

  208.             s2++;

  209.             d++;

  210.         }

  211.         src += 2 * src_wrap;

  212.         dst += dst_wrap;

  213.     }

  214. }

  215. 

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

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

  218.                      UINT8 *src, int src_wrap,

  219.                      int width, int height)

  220. {

  221.     int w;

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

  223. 

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

  225.         s1 = src;

  226.         s2 = s1 + src_wrap;

  227.         d = dst;

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

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

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

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

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

  233.             s1 += 8;

  234.             s2 += 8;

  235.             d += 4;

  236.         }

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

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

  239.             s1 += 2;

  240.             s2 += 2;

  241.             d++;

  242.         }

  243.         src += 2 * src_wrap;

  244.         dst += dst_wrap;

  245.     }

  246. }

  247. 

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

  249. static void grow22(UINT8 *dst, int dst_wrap,

  250.                      UINT8 *src, int src_wrap,

  251.                      int width, int height)

  252. {

  253.     int w;

  254.     UINT8 *s1, *d;

  255. 

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

  257.         s1 = src;

  258.         d = dst;

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

  260.             d[1] = d[0] = s1[0];

  261.             d[3] = d[2] = s1[1];

  262.             s1 += 2;

  263.             d += 4;

  264.         }

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

  266.             d[0] = s1[0];

  267.             s1 ++;

  268.             d++;

  269.         }

  270.         if (height%2)

  271.             src += src_wrap;

  272.         dst += dst_wrap;

  273.     }

  274. }

  275. 

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

  277.                      UINT8 *src, int src_wrap,

  278.                      int width, int height)

  279. {

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

  281.         memcpy(dst, src, width);

  282.         dst += dst_wrap;

  283.         src += src_wrap;

  284.     }

  285. }

  286. 

  287. #define SCALE_BITS 10

  288. 

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

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

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

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

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

  294. 

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

  296. {\

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

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

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

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

  301. }

  302. 

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

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

  305.                              int width, int height)

  306. {

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

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

  309.     UINT8 *cm = cropTbl + MAX_NEG_CROP;

  310. 

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

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

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

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

  315.     width2 = width >> 1;

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

  317.         d1 = d;

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

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

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

  321.             cb = cb_ptr[0] - 128;

  322.             cr = cr_ptr[0] - 128;

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

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

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

  326.             

  327.             /* output 4 pixels */

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

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

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

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

  332. 

  333.             d1 += 6;

  334.             d2 += 6;

  335.             y1_ptr += 2;

  336.             y2_ptr += 2;

  337.             cb_ptr++;

  338.             cr_ptr++;

  339.         }

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

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

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

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

  344.     }

  345. }

  346. 

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

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

  349.                              int width, int height)

  350. {

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

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

  353.     UINT8 *cm = cropTbl + MAX_NEG_CROP;

  354. 

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

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

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

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

  359.     width2 = width >> 1;

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

  361.         d1 = d;

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

  363.             cb = cb_ptr[0] - 128;

  364.             cr = cr_ptr[0] - 128;

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

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

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

  368.             

  369.             /* output 2 pixels */

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

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

  372. 

  373.             d1 += 6;

  374.             y1_ptr += 2;

  375.             cb_ptr++;

  376.             cr_ptr++;

  377.         }

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

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

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

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

  382.     }

  383. }

  384. 

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

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

  387.                 AVPicture *src, int pix_fmt, 

  388.                 int width, int height)

  389. {

  390.     int i;

  391. 

  392.     assert(pix_fmt != PIX_FMT_ANY && dst_pix_fmt != PIX_FMT_ANY);

  393. 

  394.     if (dst_pix_fmt == pix_fmt) {

  395.         switch(pix_fmt) {

  396.         case PIX_FMT_YUV420P:

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

  398.                 if (i == 1) {

  399.                     width >>= 1;

  400.                     height >>= 1;

  401.                 }

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

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

  404.                          width, height);

  405.             }

  406.             break;

  407.         default:

  408.             return -1;

  409.         }

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

  411.         

  412.         switch(pix_fmt) {

  413.         case PIX_FMT_YUV410P:

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

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

  416.                      width, height);

  417.             grow22(dst->data[1], dst->linesize[1],

  418.                      src->data[1], src->linesize[1],

  419.                      width/2, height/2);

  420.             grow22(dst->data[2], dst->linesize[2],

  421.                      src->data[2], src->linesize[2],

  422.                      width/2, height/2);

  423.             break;

  424.         case PIX_FMT_YUV420P:

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

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

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

  428.                          width, height);

  429.             }

  430.             break;

  431.         case PIX_FMT_YUV422P:

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

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

  434.                      width, height);

  435.             width >>= 1;

  436.             height >>= 1;

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

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

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

  440.                         width, height);

  441.             }

  442.             break;

  443.         case PIX_FMT_YUV444P:

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

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

  446.                      width, height);

  447.             width >>= 1;

  448.             height >>= 1;

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

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

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

  452.                          width, height);

  453.             }

  454.             break;

  455.         case PIX_FMT_YUV422:

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

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

  458.             break;

  459.         case PIX_FMT_RGB24:

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

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

  462.             break;

  463.         case PIX_FMT_BGR24:

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

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

  466.             break;

  467.         default:

  468.             return -1;

  469.         }

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

  471.         switch(pix_fmt) {

  472.         case PIX_FMT_YUV420P:

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

  474.             break;

  475.         case PIX_FMT_YUV422P:

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

  477.             break;

  478.         default:

  479.             return -1;

  480.         }

  481.     } else {

  482.         return -1;

  483.     }

  484.     return 0;

  485. }

  486. 

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

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

  489.                              int size)

  490. {

  491.     UINT8 *cm = cropTbl + MAX_NEG_CROP;

  492.     int sum;

  493.     UINT8 *s;

  494. 

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

  496.         s = src;

  497.         sum = -s[0];

  498.         s += src_wrap;

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

  500.         s += src_wrap;

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

  502.         s += src_wrap;

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

  504.         s += src_wrap;

  505.         sum += -s[0];

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

  507.         dst++;

  508.         src++;

  509.     }

  510. }

  511. 

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

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

  514.    against the top field. */

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

  516.                                      UINT8 *src1, int src_wrap,

  517.                                      int width, int height)

  518. {

  519.     UINT8 *src, *ptr;

  520.     int y, y1, i;

  521.     UINT8 *buf;

  522. 

  523.     buf = (UINT8*)av_malloc(5 * width);

  524. 

  525.     src = src1;

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

  527.         /* copy top field line */

  528.         memcpy(dst, src, width);

  529.         dst += dst_wrap;

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

  531.         y1 = y - 2;

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

  533.             /* fast case : no edges */

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

  535.         } else {

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

  537.             ptr = buf;

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

  539.                 if (y1 < 0)

  540.                     memcpy(ptr, src1, width);

  541.                 else if (y1 >= height) 

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

  543.                 else

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

  545.                 y1++;

  546.                 ptr += width;

  547.             }

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

  549.         }

  550.         dst += dst_wrap;

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

  552.     }

  553.     av_free(buf);

  554. }

  555. 

  556. 

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

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

  559.                           int pix_fmt, int width, int height)

  560. {

  561.     int i;

  562. 

  563.     if (pix_fmt != PIX_FMT_YUV420P &&

  564.         pix_fmt != PIX_FMT_YUV422P &&

  565.         pix_fmt != PIX_FMT_YUV444P)

  566.         return -1;

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

  568.         return -1;

  569.     

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

  571.         if (i == 1) {

  572.             switch(pix_fmt) {

  573.             case PIX_FMT_YUV420P:

  574.                 width >>= 1;

  575.                 height >>= 1;

  576.                 break;

  577.             case PIX_FMT_YUV422P:

  578.                 width >>= 1;

  579.                 break;

  580.             default:

  581.                 break;

  582.             }

  583.         }

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

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

  586.                                  width, height);

  587.     }

  588.     return 0;

  589. }

  590. 

  591. #undef FIX