me.c
上传用户:lctgjx
上传日期:2022-06-04
资源大小:8887k
文件大小:43k
源码类别:

流媒体/Mpeg4/MP4

开发平台:

Visual C++

  1. /*****************************************************************************
  2.  * me.c: h264 encoder library (Motion Estimation)
  3.  *****************************************************************************
  4.  * Copyright (C) 2003-2008 x264 project
  5.  *
  6.  * Authors: Loren Merritt <lorenm@u.washington.edu>
  7.  *          Laurent Aimar <fenrir@via.ecp.fr>
  8.  *          Jason Garrett-Glaser <darkshikari@gmail.com>
  9.  *
  10.  * This program is free software; you can redistribute it and/or modify
  11.  * it under the terms of the GNU General Public License as published by
  12.  * the Free Software Foundation; either version 2 of the License, or
  13.  * (at your option) any later version.
  14.  *
  15.  * This program is distributed in the hope that it will be useful,
  16.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18.  * GNU General Public License for more details.
  19.  *
  20.  * You should have received a copy of the GNU General Public License
  21.  * along with this program; if not, write to the Free Software
  22.  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02111, USA.
  23.  *****************************************************************************/
  24. #include "common/common.h"
  25. #include "macroblock.h"
  26. #include "me.h"
  27. /* presets selected from good points on the speed-vs-quality curve of several test videos
  28.  * subpel_iters[i_subpel_refine] = { refine_hpel, refine_qpel, me_hpel, me_qpel }
  29.  * where me_* are the number of EPZS iterations run on all candidate block types,
  30.  * and refine_* are run only on the winner.
  31.  * the subme=8,9 values are much higher because any amount of satd search makes
  32.  * up its time by reducing the number of qpel-rd iterations. */
  33. static const int subpel_iterations[][4] =
  34.    {{0,0,0,0},
  35.     {1,1,0,0},
  36.     {0,1,1,0},
  37.     {0,2,1,0},
  38.     {0,2,1,1},
  39.     {0,2,1,2},
  40.     {0,0,2,2},
  41.     {0,0,2,2},
  42.     {0,0,4,10},
  43.     {0,0,4,10},
  44.     {0,0,4,10}};
  45. /* (x-1)%6 */
  46. static const int mod6m1[8] = {5,0,1,2,3,4,5,0};
  47. /* radius 2 hexagon. repeated entries are to avoid having to compute mod6 every time. */
  48. static const int hex2[8][2] = {{-1,-2}, {-2,0}, {-1,2}, {1,2}, {2,0}, {1,-2}, {-1,-2}, {-2,0}};
  49. static const int square1[9][2] = {{0,0}, {0,-1}, {0,1}, {-1,0}, {1,0}, {-1,-1}, {-1,1}, {1,-1}, {1,1}};
  50. static void refine_subpel( x264_t *h, x264_me_t *m, int hpel_iters, int qpel_iters, int *p_halfpel_thresh, int b_refine_qpel );
  51. #define BITS_MVD( mx, my )
  52.     (p_cost_mvx[(mx)<<2] + p_cost_mvy[(my)<<2])
  53. #define COST_MV( mx, my )
  54. {
  55.     int cost = h->pixf.fpelcmp[i_pixel]( p_fenc, FENC_STRIDE,
  56.                    &p_fref[(my)*stride+(mx)], stride )
  57.              + BITS_MVD(mx,my);
  58.     COPY3_IF_LT( bcost, cost, bmx, mx, bmy, my );
  59. }
  60. #define COST_MV_HPEL( mx, my ) 
  61.     int stride2 = 16; 
  62.     uint8_t *src = h->mc.get_ref( pix, &stride2, m->p_fref, stride, mx, my, bw, bh ); 
  63.     int cost = h->pixf.fpelcmp[i_pixel]( p_fenc, FENC_STRIDE, src, stride2 ) 
  64.              + p_cost_mvx[ mx ] + p_cost_mvy[ my ]; 
  65.     COPY3_IF_LT( bpred_cost, cost, bpred_mx, mx, bpred_my, my ); 
  66. }
  67. #define COST_MV_X3_DIR( m0x, m0y, m1x, m1y, m2x, m2y, costs )
  68. {
  69.     uint8_t *pix_base = p_fref + bmx + bmy*stride;
  70.     h->pixf.fpelcmp_x3[i_pixel]( p_fenc,
  71.         pix_base + (m0x) + (m0y)*stride,
  72.         pix_base + (m1x) + (m1y)*stride,
  73.         pix_base + (m2x) + (m2y)*stride,
  74.         stride, costs );
  75.     (costs)[0] += BITS_MVD( bmx+(m0x), bmy+(m0y) );
  76.     (costs)[1] += BITS_MVD( bmx+(m1x), bmy+(m1y) );
  77.     (costs)[2] += BITS_MVD( bmx+(m2x), bmy+(m2y) );
  78. }
  79. #define COST_MV_X4_DIR( m0x, m0y, m1x, m1y, m2x, m2y, m3x, m3y, costs )
  80. {
  81.     uint8_t *pix_base = p_fref + bmx + bmy*stride;
  82.     h->pixf.fpelcmp_x4[i_pixel]( p_fenc,
  83.         pix_base + (m0x) + (m0y)*stride,
  84.         pix_base + (m1x) + (m1y)*stride,
  85.         pix_base + (m2x) + (m2y)*stride,
  86.         pix_base + (m3x) + (m3y)*stride,
  87.         stride, costs );
  88.     (costs)[0] += BITS_MVD( bmx+(m0x), bmy+(m0y) );
  89.     (costs)[1] += BITS_MVD( bmx+(m1x), bmy+(m1y) );
  90.     (costs)[2] += BITS_MVD( bmx+(m2x), bmy+(m2y) );
  91.     (costs)[3] += BITS_MVD( bmx+(m3x), bmy+(m3y) );
  92. }
  93. #define COST_MV_X4( m0x, m0y, m1x, m1y, m2x, m2y, m3x, m3y )
  94. {
  95.     uint8_t *pix_base = p_fref + omx + omy*stride;
  96.     h->pixf.fpelcmp_x4[i_pixel]( p_fenc,
  97.         pix_base + (m0x) + (m0y)*stride,
  98.         pix_base + (m1x) + (m1y)*stride,
  99.         pix_base + (m2x) + (m2y)*stride,
  100.         pix_base + (m3x) + (m3y)*stride,
  101.         stride, costs );
  102.     costs[0] += BITS_MVD( omx+(m0x), omy+(m0y) );
  103.     costs[1] += BITS_MVD( omx+(m1x), omy+(m1y) );
  104.     costs[2] += BITS_MVD( omx+(m2x), omy+(m2y) );
  105.     costs[3] += BITS_MVD( omx+(m3x), omy+(m3y) );
  106.     COPY3_IF_LT( bcost, costs[0], bmx, omx+(m0x), bmy, omy+(m0y) );
  107.     COPY3_IF_LT( bcost, costs[1], bmx, omx+(m1x), bmy, omy+(m1y) );
  108.     COPY3_IF_LT( bcost, costs[2], bmx, omx+(m2x), bmy, omy+(m2y) );
  109.     COPY3_IF_LT( bcost, costs[3], bmx, omx+(m3x), bmy, omy+(m3y) );
  110. }
  111. #define COST_MV_X3_ABS( m0x, m0y, m1x, m1y, m2x, m2y )
  112. {
  113.     h->pixf.fpelcmp_x3[i_pixel]( p_fenc,
  114.         p_fref + (m0x) + (m0y)*stride,
  115.         p_fref + (m1x) + (m1y)*stride,
  116.         p_fref + (m2x) + (m2y)*stride,
  117.         stride, costs );
  118.     costs[0] += p_cost_mvx[(m0x)<<2]; /* no cost_mvy */
  119.     costs[1] += p_cost_mvx[(m1x)<<2];
  120.     costs[2] += p_cost_mvx[(m2x)<<2];
  121.     COPY3_IF_LT( bcost, costs[0], bmx, m0x, bmy, m0y );
  122.     COPY3_IF_LT( bcost, costs[1], bmx, m1x, bmy, m1y );
  123.     COPY3_IF_LT( bcost, costs[2], bmx, m2x, bmy, m2y );
  124. }
  125. /*  1  */
  126. /* 101 */
  127. /*  1  */
  128. #define DIA1_ITER( mx, my )
  129. {
  130.     omx = mx; omy = my;
  131.     COST_MV_X4( 0,-1, 0,1, -1,0, 1,0 );
  132. }
  133. #define CROSS( start, x_max, y_max )
  134. {
  135.     i = start;
  136.     if( x_max <= X264_MIN(mv_x_max-omx, omx-mv_x_min) )
  137.         for( ; i < x_max-2; i+=4 )
  138.             COST_MV_X4( i,0, -i,0, i+2,0, -i-2,0 );
  139.     for( ; i < x_max; i+=2 )
  140.     {
  141.         if( omx+i <= mv_x_max )
  142.             COST_MV( omx+i, omy );
  143.         if( omx-i >= mv_x_min )
  144.             COST_MV( omx-i, omy );
  145.     }
  146.     i = start;
  147.     if( y_max <= X264_MIN(mv_y_max-omy, omy-mv_y_min) )
  148.         for( ; i < y_max-2; i+=4 )
  149.             COST_MV_X4( 0,i, 0,-i, 0,i+2, 0,-i-2 );
  150.     for( ; i < y_max; i+=2 )
  151.     {
  152.         if( omy+i <= mv_y_max )
  153.             COST_MV( omx, omy+i );
  154.         if( omy-i >= mv_y_min )
  155.             COST_MV( omx, omy-i );
  156.     }
  157. }
  158. void x264_me_search_ref( x264_t *h, x264_me_t *m, int16_t (*mvc)[2], int i_mvc, int *p_halfpel_thresh )
  159. {
  160.     const int bw = x264_pixel_size[m->i_pixel].w;
  161.     const int bh = x264_pixel_size[m->i_pixel].h;
  162.     const int i_pixel = m->i_pixel;
  163.     const int stride = m->i_stride[0];
  164.     int i_me_range = h->param.analyse.i_me_range;
  165.     int bmx, bmy, bcost;
  166.     int bpred_mx = 0, bpred_my = 0, bpred_cost = COST_MAX;
  167.     int omx, omy, pmx, pmy;
  168.     uint8_t *p_fenc = m->p_fenc[0];
  169.     uint8_t *p_fref = m->p_fref[0];
  170.     ALIGNED_ARRAY_16( uint8_t, pix,[16*16] );
  171.     int i, j;
  172.     int dir;
  173.     int costs[16];
  174.     int mv_x_min = h->mb.mv_min_fpel[0];
  175.     int mv_y_min = h->mb.mv_min_fpel[1];
  176.     int mv_x_max = h->mb.mv_max_fpel[0];
  177.     int mv_y_max = h->mb.mv_max_fpel[1];
  178. #define CHECK_MVRANGE(mx,my) ( mx >= mv_x_min && mx <= mv_x_max && my >= mv_y_min && my <= mv_y_max )
  179.     const uint16_t *p_cost_mvx = m->p_cost_mv - m->mvp[0];
  180.     const uint16_t *p_cost_mvy = m->p_cost_mv - m->mvp[1];
  181.     bmx = x264_clip3( m->mvp[0], mv_x_min*4, mv_x_max*4 );
  182.     bmy = x264_clip3( m->mvp[1], mv_y_min*4, mv_y_max*4 );
  183.     pmx = ( bmx + 2 ) >> 2;
  184.     pmy = ( bmy + 2 ) >> 2;
  185.     bcost = COST_MAX;
  186.     /* try extra predictors if provided */
  187.     if( h->mb.i_subpel_refine >= 3 )
  188.     {
  189.         uint32_t bmv = pack16to32_mask(bmx,bmy);
  190.         COST_MV_HPEL( bmx, bmy );
  191.         for( i = 0; i < i_mvc; i++ )
  192.         {
  193.             if( *(uint32_t*)mvc[i] && (bmv - *(uint32_t*)mvc[i]) )
  194.             {
  195.                 int mx = x264_clip3( mvc[i][0], mv_x_min*4, mv_x_max*4 );
  196.                 int my = x264_clip3( mvc[i][1], mv_y_min*4, mv_y_max*4 );
  197.                 COST_MV_HPEL( mx, my );
  198.             }
  199.         }
  200.         bmx = ( bpred_mx + 2 ) >> 2;
  201.         bmy = ( bpred_my + 2 ) >> 2;
  202.         COST_MV( bmx, bmy );
  203.     }
  204.     else
  205.     {
  206.         /* check the MVP */
  207.         COST_MV( pmx, pmy );
  208.         /* Because we are rounding the predicted motion vector to fullpel, there will be
  209.          * an extra MV cost in 15 out of 16 cases.  However, when the predicted MV is
  210.          * chosen as the best predictor, it is often the case that the subpel search will
  211.          * result in a vector at or next to the predicted motion vector.  Therefore, it is
  212.          * sensible to remove the cost of the MV from the rounded MVP to avoid unfairly
  213.          * biasing against use of the predicted motion vector. */
  214.         bcost -= BITS_MVD( pmx, pmy );
  215.         for( i = 0; i < i_mvc; i++ )
  216.         {
  217.             int mx = (mvc[i][0] + 2) >> 2;
  218.             int my = (mvc[i][1] + 2) >> 2;
  219.             if( (mx | my) && ((mx-bmx) | (my-bmy)) )
  220.             {
  221.                 mx = x264_clip3( mx, mv_x_min, mv_x_max );
  222.                 my = x264_clip3( my, mv_y_min, mv_y_max );
  223.                 COST_MV( mx, my );
  224.             }
  225.         }
  226.     }
  227.     COST_MV( 0, 0 );
  228.     switch( h->mb.i_me_method )
  229.     {
  230.     case X264_ME_DIA:
  231.         /* diamond search, radius 1 */
  232.         i = 0;
  233.         bcost <<= 4;
  234.         do
  235.         {
  236.             COST_MV_X4_DIR( 0,-1, 0,1, -1,0, 1,0, costs );
  237.             COPY1_IF_LT( bcost, (costs[0]<<4)+1 );
  238.             COPY1_IF_LT( bcost, (costs[1]<<4)+3 );
  239.             COPY1_IF_LT( bcost, (costs[2]<<4)+4 );
  240.             COPY1_IF_LT( bcost, (costs[3]<<4)+12 );
  241.             if( !(bcost&15) )
  242.                 break;
  243.             bmx -= (bcost<<28)>>30;
  244.             bmy -= (bcost<<30)>>30;
  245.             bcost &= ~15;
  246.             if( !CHECK_MVRANGE(bmx, bmy) )
  247.                 break;
  248.         } while( ++i < i_me_range );
  249.         bcost >>= 4;
  250.         break;
  251.     case X264_ME_HEX:
  252. me_hex2:
  253.         /* hexagon search, radius 2 */
  254. #if 0
  255.         for( i = 0; i < i_me_range/2; i++ )
  256.         {
  257.             omx = bmx; omy = bmy;
  258.             COST_MV( omx-2, omy   );
  259.             COST_MV( omx-1, omy+2 );
  260.             COST_MV( omx+1, omy+2 );
  261.             COST_MV( omx+2, omy   );
  262.             COST_MV( omx+1, omy-2 );
  263.             COST_MV( omx-1, omy-2 );
  264.             if( bmx == omx && bmy == omy )
  265.                 break;
  266.             if( !CHECK_MVRANGE(bmx, bmy) )
  267.                 break;
  268.         }
  269. #else
  270.         /* equivalent to the above, but eliminates duplicate candidates */
  271.         /* hexagon */
  272.         COST_MV_X3_DIR( -2,0, -1, 2,  1, 2, costs   );
  273.         COST_MV_X3_DIR(  2,0,  1,-2, -1,-2, costs+3 );
  274.         bcost <<= 3;
  275.         COPY1_IF_LT( bcost, (costs[0]<<3)+2 );
  276.         COPY1_IF_LT( bcost, (costs[1]<<3)+3 );
  277.         COPY1_IF_LT( bcost, (costs[2]<<3)+4 );
  278.         COPY1_IF_LT( bcost, (costs[3]<<3)+5 );
  279.         COPY1_IF_LT( bcost, (costs[4]<<3)+6 );
  280.         COPY1_IF_LT( bcost, (costs[5]<<3)+7 );
  281.         if( bcost&7 )
  282.         {
  283.             dir = (bcost&7)-2;
  284.             bmx += hex2[dir+1][0];
  285.             bmy += hex2[dir+1][1];
  286.             /* half hexagon, not overlapping the previous iteration */
  287.             for( i = 1; i < i_me_range/2 && CHECK_MVRANGE(bmx, bmy); i++ )
  288.             {
  289.                 COST_MV_X3_DIR( hex2[dir+0][0], hex2[dir+0][1],
  290.                                 hex2[dir+1][0], hex2[dir+1][1],
  291.                                 hex2[dir+2][0], hex2[dir+2][1],
  292.                                 costs );
  293.                 bcost &= ~7;
  294.                 COPY1_IF_LT( bcost, (costs[0]<<3)+1 );
  295.                 COPY1_IF_LT( bcost, (costs[1]<<3)+2 );
  296.                 COPY1_IF_LT( bcost, (costs[2]<<3)+3 );
  297.                 if( !(bcost&7) )
  298.                     break;
  299.                 dir += (bcost&7)-2;
  300.                 dir = mod6m1[dir+1];
  301.                 bmx += hex2[dir+1][0];
  302.                 bmy += hex2[dir+1][1];
  303.             }
  304.         }
  305.         bcost >>= 3;
  306. #endif
  307.         /* square refine */
  308.         dir = 0;
  309.         COST_MV_X4_DIR(  0,-1,  0,1, -1,0, 1,0, costs );
  310.         COPY2_IF_LT( bcost, costs[0], dir, 1 );
  311.         COPY2_IF_LT( bcost, costs[1], dir, 2 );
  312.         COPY2_IF_LT( bcost, costs[2], dir, 3 );
  313.         COPY2_IF_LT( bcost, costs[3], dir, 4 );
  314.         COST_MV_X4_DIR( -1,-1, -1,1, 1,-1, 1,1, costs );
  315.         COPY2_IF_LT( bcost, costs[0], dir, 5 );
  316.         COPY2_IF_LT( bcost, costs[1], dir, 6 );
  317.         COPY2_IF_LT( bcost, costs[2], dir, 7 );
  318.         COPY2_IF_LT( bcost, costs[3], dir, 8 );
  319.         bmx += square1[dir][0];
  320.         bmy += square1[dir][1];
  321.         break;
  322.     case X264_ME_UMH:
  323.         {
  324.             /* Uneven-cross Multi-Hexagon-grid Search
  325.              * as in JM, except with different early termination */
  326.             static const int x264_pixel_size_shift[7] = { 0, 1, 1, 2, 3, 3, 4 };
  327. //C程序不能中间定义变量 --@lia
  328. const uint16_t *p_cost_omvx,*p_cost_omvy;
  329.             int ucost1, ucost2;
  330.             int cross_start = 1;
  331.             /* refine predictors */
  332.             ucost1 = bcost;
  333.             DIA1_ITER( pmx, pmy );
  334.             if( pmx | pmy )
  335.                 DIA1_ITER( 0, 0 );
  336.             if(i_pixel == PIXEL_4x4)
  337.                 goto me_hex2;
  338.             ucost2 = bcost;
  339.             if( (bmx | bmy) && ((bmx-pmx) | (bmy-pmy)) )
  340.                 DIA1_ITER( bmx, bmy );
  341.             if( bcost == ucost2 )
  342.                 cross_start = 3;
  343.             omx = bmx; omy = bmy;
  344.             /* early termination */
  345. #define SAD_THRESH(v) ( bcost < ( v >> x264_pixel_size_shift[i_pixel] ) )
  346.             if( bcost == ucost2 && SAD_THRESH(2000) )
  347.             {
  348.                 COST_MV_X4( 0,-2, -1,-1, 1,-1, -2,0 );
  349.                 COST_MV_X4( 2, 0, -1, 1, 1, 1,  0,2 );
  350.                 if( bcost == ucost1 && SAD_THRESH(500) )
  351.                     break;
  352.                 if( bcost == ucost2 )
  353.                 {
  354.                     int range = (i_me_range>>1) | 1;
  355.                     CROSS( 3, range, range );
  356.                     COST_MV_X4( -1,-2, 1,-2, -2,-1, 2,-1 );
  357.                     COST_MV_X4( -2, 1, 2, 1, -1, 2, 1, 2 );
  358.                     if( bcost == ucost2 )
  359.                         break;
  360.                     cross_start = range + 2;
  361.                 }
  362.             }
  363.             /* adaptive search range */
  364.             if( i_mvc )
  365.             {
  366.                 /* range multipliers based on casual inspection of some statistics of
  367.                  * average distance between current predictor and final mv found by ESA.
  368.                  * these have not been tuned much by actual encoding. */
  369.                 static const int range_mul[4][4] =
  370.                 {
  371.                     { 3, 3, 4, 4 },
  372.                     { 3, 4, 4, 4 },
  373.                     { 4, 4, 4, 5 },
  374.                     { 4, 4, 5, 6 },
  375.                 };
  376.                 int mvd;
  377.                 int sad_ctx, mvd_ctx;
  378.                 int denom = 1;
  379.                 if( i_mvc == 1 )
  380.                 {
  381.                     if( i_pixel == PIXEL_16x16 )
  382.                         /* mvc is probably the same as mvp, so the difference isn't meaningful.
  383.                          * but prediction usually isn't too bad, so just use medium range */
  384.                         mvd = 25;
  385.                     else
  386.                         mvd = abs( m->mvp[0] - mvc[0][0] )
  387.                             + abs( m->mvp[1] - mvc[0][1] );
  388.                 }
  389.                 else
  390.                 {
  391.                     /* calculate the degree of agreement between predictors. */
  392.                     /* in 16x16, mvc includes all the neighbors used to make mvp,
  393.                      * so don't count mvp separately. */
  394.                     denom = i_mvc - 1;
  395.                     mvd = 0;
  396.                     if( i_pixel != PIXEL_16x16 )
  397.                     {
  398.                         mvd = abs( m->mvp[0] - mvc[0][0] )
  399.                             + abs( m->mvp[1] - mvc[0][1] );
  400.                         denom++;
  401.                     }
  402.                     mvd += x264_predictor_difference( mvc, i_mvc );
  403.                 }
  404.                 sad_ctx = SAD_THRESH(1000) ? 0
  405.                         : SAD_THRESH(2000) ? 1
  406.                         : SAD_THRESH(4000) ? 2 : 3;
  407.                 mvd_ctx = mvd < 10*denom ? 0
  408.                         : mvd < 20*denom ? 1
  409.                         : mvd < 40*denom ? 2 : 3;
  410.                 i_me_range = i_me_range * range_mul[mvd_ctx][sad_ctx] / 4;
  411.             }
  412.             /* FIXME if the above DIA2/OCT2/CROSS found a new mv, it has not updated omx/omy.
  413.              * we are still centered on the same place as the DIA2. is this desirable? */
  414.             CROSS( cross_start, i_me_range, i_me_range/2 );
  415.             COST_MV_X4( -2,-2, -2,2, 2,-2, 2,2 );
  416.             /* hexagon grid */
  417.             omx = bmx; omy = bmy;
  418.             
  419. //C程序不能中间定义变量 --@lia
  420. //const uint16_t *
  421. p_cost_omvx = p_cost_mvx + omx*4;
  422.             //const uint16_t *
  423. p_cost_omvy = p_cost_mvy + omy*4;
  424.             i = 1;
  425.             do
  426.             {
  427.                 static const int hex4[16][2] = {
  428.                     { 0,-4}, { 0, 4}, {-2,-3}, { 2,-3},
  429.                     {-4,-2}, { 4,-2}, {-4,-1}, { 4,-1},
  430.                     {-4, 0}, { 4, 0}, {-4, 1}, { 4, 1},
  431.                     {-4, 2}, { 4, 2}, {-2, 3}, { 2, 3},
  432.                 };
  433.                 if( 4*i > X264_MIN4( mv_x_max-omx, omx-mv_x_min,
  434.                                      mv_y_max-omy, omy-mv_y_min ) )
  435.                 {
  436.                     for( j = 0; j < 16; j++ )
  437.                     {
  438.                         int mx = omx + hex4[j][0]*i;
  439.                         int my = omy + hex4[j][1]*i;
  440.                         if( CHECK_MVRANGE(mx, my) )
  441.                             COST_MV( mx, my );
  442.                     }
  443.                 }
  444.                 else
  445.                 {
  446.                     int dir = 0;
  447.                     uint8_t *pix_base = p_fref + omx + (omy-4*i)*stride;
  448.                     int dy = i*stride;
  449. #define SADS(k,x0,y0,x1,y1,x2,y2,x3,y3)
  450.                     h->pixf.fpelcmp_x4[i_pixel]( p_fenc,
  451.                             pix_base x0*i+(y0-2*k+4)*dy,
  452.                             pix_base x1*i+(y1-2*k+4)*dy,
  453.                             pix_base x2*i+(y2-2*k+4)*dy,
  454.                             pix_base x3*i+(y3-2*k+4)*dy,
  455.                             stride, costs+4*k );
  456.                     pix_base += 2*dy;
  457. #define ADD_MVCOST(k,x,y) costs[k] += p_cost_omvx[x*4*i] + p_cost_omvy[y*4*i]
  458. #define MIN_MV(k,x,y)     COPY2_IF_LT( bcost, costs[k], dir, x*16+(y&15) )
  459.                     SADS( 0, +0,-4, +0,+4, -2,-3, +2,-3 );
  460.                     SADS( 1, -4,-2, +4,-2, -4,-1, +4,-1 );
  461.                     SADS( 2, -4,+0, +4,+0, -4,+1, +4,+1 );
  462.                     SADS( 3, -4,+2, +4,+2, -2,+3, +2,+3 );
  463.                     ADD_MVCOST(  0, 0,-4 );
  464.                     ADD_MVCOST(  1, 0, 4 );
  465.                     ADD_MVCOST(  2,-2,-3 );
  466.                     ADD_MVCOST(  3, 2,-3 );
  467.                     ADD_MVCOST(  4,-4,-2 );
  468.                     ADD_MVCOST(  5, 4,-2 );
  469.                     ADD_MVCOST(  6,-4,-1 );
  470.                     ADD_MVCOST(  7, 4,-1 );
  471.                     ADD_MVCOST(  8,-4, 0 );
  472.                     ADD_MVCOST(  9, 4, 0 );
  473.                     ADD_MVCOST( 10,-4, 1 );
  474.                     ADD_MVCOST( 11, 4, 1 );
  475.                     ADD_MVCOST( 12,-4, 2 );
  476.                     ADD_MVCOST( 13, 4, 2 );
  477.                     ADD_MVCOST( 14,-2, 3 );
  478.                     ADD_MVCOST( 15, 2, 3 );
  479.                     MIN_MV(  0, 0,-4 );
  480.                     MIN_MV(  1, 0, 4 );
  481.                     MIN_MV(  2,-2,-3 );
  482.                     MIN_MV(  3, 2,-3 );
  483.                     MIN_MV(  4,-4,-2 );
  484.                     MIN_MV(  5, 4,-2 );
  485.                     MIN_MV(  6,-4,-1 );
  486.                     MIN_MV(  7, 4,-1 );
  487.                     MIN_MV(  8,-4, 0 );
  488.                     MIN_MV(  9, 4, 0 );
  489.                     MIN_MV( 10,-4, 1 );
  490.                     MIN_MV( 11, 4, 1 );
  491.                     MIN_MV( 12,-4, 2 );
  492.                     MIN_MV( 13, 4, 2 );
  493.                     MIN_MV( 14,-2, 3 );
  494.                     MIN_MV( 15, 2, 3 );
  495. #undef SADS
  496. #undef ADD_MVCOST
  497. #undef MIN_MV
  498.                     if(dir)
  499.                     {
  500.                         bmx = omx + i*(dir>>4);
  501.                         bmy = omy + i*((dir<<28)>>28);
  502.                     }
  503.                 }
  504.             } while( ++i <= i_me_range/4 );
  505.             if( bmy <= mv_y_max && bmy >= mv_y_min )
  506.                 goto me_hex2;
  507.             break;
  508.         }
  509.     case X264_ME_ESA:
  510.     case X264_ME_TESA:
  511.         {
  512.             const int min_x = X264_MAX( bmx - i_me_range, mv_x_min );
  513.             const int min_y = X264_MAX( bmy - i_me_range, mv_y_min );
  514.             const int max_x = X264_MIN( bmx + i_me_range, mv_x_max );
  515.             const int max_y = X264_MIN( bmy + i_me_range, mv_y_max );
  516.             /* SEA is fastest in multiples of 4 */
  517.             const int width = (max_x - min_x + 3) & ~3;
  518.             int my;
  519. #if 0
  520.             /* plain old exhaustive search */
  521.             int mx;
  522.             for( my = min_y; my <= max_y; my++ )
  523.                 for( mx = min_x; mx <= max_x; mx++ )
  524.                     COST_MV( mx, my );
  525. #else
  526.             /* successive elimination by comparing DC before a full SAD,
  527.              * because sum(abs(diff)) >= abs(diff(sum)). */
  528.             uint16_t *sums_base = m->integral;
  529.             /* due to a GCC bug on some platforms (win32?), zero[] may not actually be aligned.
  530.              * this is not a problem because it is not used for any SSE instructions. */
  531.             ALIGNED_16( static uint8_t zero[8*FENC_STRIDE] );
  532.             ALIGNED_ARRAY_16( int, enc_dc,[4] );
  533.             int sad_size = i_pixel <= PIXEL_8x8 ? PIXEL_8x8 : PIXEL_4x4;
  534.             int delta = x264_pixel_size[sad_size].w;
  535.             int16_t *xs = h->scratch_buffer;
  536.             int xn;
  537.             uint16_t *cost_fpel_mvx = h->cost_mv_fpel[x264_lambda_tab[h->mb.i_qp]][-m->mvp[0]&3] + (-m->mvp[0]>>2);
  538.             h->pixf.sad_x4[sad_size]( zero, p_fenc, p_fenc+delta,
  539.                 p_fenc+delta*FENC_STRIDE, p_fenc+delta+delta*FENC_STRIDE,
  540.                 FENC_STRIDE, enc_dc );
  541.             if( delta == 4 )
  542.                 sums_base += stride * (h->fenc->i_lines[0] + PADV*2);
  543.             if( i_pixel == PIXEL_16x16 || i_pixel == PIXEL_8x16 || i_pixel == PIXEL_4x8 )
  544.                 delta *= stride;
  545.             if( i_pixel == PIXEL_8x16 || i_pixel == PIXEL_4x8 )
  546.                 enc_dc[1] = enc_dc[2];
  547.             if( h->mb.i_me_method == X264_ME_TESA )
  548.             {
  549.                 // ADS threshold, then SAD threshold, then keep the best few SADs, then SATD
  550.                 mvsad_t *mvsads = (mvsad_t *)(xs + ((width+15)&~15));
  551.                 int nmvsad = 0, limit;
  552.                 int sad_thresh = i_me_range <= 16 ? 10 : i_me_range <= 24 ? 11 : 12;
  553.                 int bsad = h->pixf.sad[i_pixel]( p_fenc, FENC_STRIDE, p_fref+bmy*stride+bmx, stride )
  554.                          + BITS_MVD( bmx, bmy );
  555.                 for( my = min_y; my <= max_y; my++ )
  556.                 {
  557.                     int ycost = p_cost_mvy[my<<2];
  558.                     if( bsad <= ycost )
  559.                         continue;
  560.                     bsad -= ycost;
  561.                     xn = h->pixf.ads[i_pixel]( enc_dc, sums_base + min_x + my * stride, delta,
  562.                                                cost_fpel_mvx+min_x, xs, width, bsad*17/16 );
  563.                     for( i=0; i<xn-2; i+=3 )
  564.                     {
  565.                         uint8_t *ref = p_fref+min_x+my*stride;
  566.                         int sads[3];
  567.                         h->pixf.sad_x3[i_pixel]( p_fenc, ref+xs[i], ref+xs[i+1], ref+xs[i+2], stride, sads );
  568.                         for( j=0; j<3; j++ )
  569.                         {
  570.                             int sad = sads[j] + cost_fpel_mvx[xs[i+j]];
  571.                             if( sad < bsad*sad_thresh>>3 )
  572.                             {
  573.                                 COPY1_IF_LT( bsad, sad );
  574.                                 mvsads[nmvsad].sad = sad + ycost;
  575.                                 mvsads[nmvsad].mx = min_x+xs[i+j];
  576.                                 mvsads[nmvsad].my = my;
  577.                                 nmvsad++;
  578.                             }
  579.                         }
  580.                     }
  581.                     for( ; i<xn; i++ )
  582.                     {
  583.                         int mx = min_x+xs[i];
  584.                         int sad = h->pixf.sad[i_pixel]( p_fenc, FENC_STRIDE, p_fref+mx+my*stride, stride )
  585.                                 + cost_fpel_mvx[xs[i]];
  586.                         if( sad < bsad*sad_thresh>>3 )
  587.                         {
  588.                             COPY1_IF_LT( bsad, sad );
  589.                             mvsads[nmvsad].sad = sad + ycost;
  590.                             mvsads[nmvsad].mx = mx;
  591.                             mvsads[nmvsad].my = my;
  592.                             nmvsad++;
  593.                         }
  594.                     }
  595.                     bsad += ycost;
  596.                 }
  597.                 limit = i_me_range / 2;
  598.                 sad_thresh = bsad*sad_thresh>>3;
  599.                 while( nmvsad > limit*2 && sad_thresh > bsad )
  600.                 {
  601.                     // halve the range if the domain is too large... eh, close enough
  602.                     sad_thresh = (sad_thresh + bsad) >> 1;
  603.                     for( i=0; i<nmvsad && mvsads[i].sad <= sad_thresh; i++ );
  604.                     for( j=i; j<nmvsad; j++ )
  605.                     {
  606.                         /* mvsad_t is not guaranteed to be 8 bytes on all archs, so check before using explicit write-combining */
  607.                         if( sizeof( mvsad_t ) == sizeof( uint64_t ) )
  608.                             *(uint64_t*)&mvsads[i] = *(uint64_t*)&mvsads[j];
  609.                         else
  610.                             mvsads[i] = mvsads[j];
  611.                         i += mvsads[j].sad <= sad_thresh;
  612.                     }
  613.                     nmvsad = i;
  614.                 }
  615.                 while( nmvsad > limit )
  616.                 {
  617.                     int bsad = mvsads[0].sad;
  618.                     int bi = 0;
  619.                     for( i=1; i<nmvsad; i++ )
  620.                         COPY2_IF_GT( bsad, mvsads[i].sad, bi, i );
  621.                     nmvsad--;
  622.                     mvsads[bi] = mvsads[nmvsad];
  623.                     if( sizeof( mvsad_t ) == sizeof( uint64_t ) )
  624.                         *(uint64_t*)&mvsads[bi] = *(uint64_t*)&mvsads[nmvsad];
  625.                     else
  626.                         mvsads[bi] = mvsads[nmvsad];
  627.                 }
  628.                 for( i=0; i<nmvsad; i++ )
  629.                     COST_MV( mvsads[i].mx, mvsads[i].my );
  630.             }
  631.             else
  632.             {
  633.                 // just ADS and SAD
  634.                 for( my = min_y; my <= max_y; my++ )
  635.                 {
  636.                     int ycost = p_cost_mvy[my<<2];
  637.                     if( bcost <= ycost )
  638.                         continue;
  639.                     bcost -= ycost;
  640.                     xn = h->pixf.ads[i_pixel]( enc_dc, sums_base + min_x + my * stride, delta,
  641.                                                cost_fpel_mvx+min_x, xs, width, bcost );
  642.                     for( i=0; i<xn-2; i+=3 )
  643.                         COST_MV_X3_ABS( min_x+xs[i],my, min_x+xs[i+1],my, min_x+xs[i+2],my );
  644.                     bcost += ycost;
  645.                     for( ; i<xn; i++ )
  646.                         COST_MV( min_x+xs[i], my );
  647.                 }
  648.             }
  649. #endif
  650.         }
  651.         break;
  652.     }
  653.     /* -> qpel mv */
  654.     if( bpred_cost < bcost )
  655.     {
  656.         m->mv[0] = bpred_mx;
  657.         m->mv[1] = bpred_my;
  658.         m->cost = bpred_cost;
  659.     }
  660.     else
  661.     {
  662.         m->mv[0] = bmx << 2;
  663.         m->mv[1] = bmy << 2;
  664.         m->cost = bcost;
  665.     }
  666.     /* compute the real cost */
  667.     m->cost_mv = p_cost_mvx[ m->mv[0] ] + p_cost_mvy[ m->mv[1] ];
  668.     if( bmx == pmx && bmy == pmy && h->mb.i_subpel_refine < 3 )
  669.         m->cost += m->cost_mv;
  670.     /* subpel refine */
  671.     if( h->mb.i_subpel_refine >= 2 )
  672.     {
  673.         int hpel = subpel_iterations[h->mb.i_subpel_refine][2];
  674.         int qpel = subpel_iterations[h->mb.i_subpel_refine][3];
  675.         refine_subpel( h, m, hpel, qpel, p_halfpel_thresh, 0 );
  676.     }
  677. }
  678. #undef COST_MV
  679. void x264_me_refine_qpel( x264_t *h, x264_me_t *m )
  680. {
  681.     int hpel = subpel_iterations[h->mb.i_subpel_refine][0];
  682.     int qpel = subpel_iterations[h->mb.i_subpel_refine][1];
  683.     if( m->i_pixel <= PIXEL_8x8 && h->sh.i_type == SLICE_TYPE_P )
  684.         m->cost -= m->i_ref_cost;
  685.     refine_subpel( h, m, hpel, qpel, NULL, 1 );
  686. }
  687. #define COST_MV_SAD( mx, my ) 
  688.     int stride = 16; 
  689.     uint8_t *src = h->mc.get_ref( pix[0], &stride, m->p_fref, m->i_stride[0], mx, my, bw, bh ); 
  690.     int cost = h->pixf.fpelcmp[i_pixel]( m->p_fenc[0], FENC_STRIDE, src, stride ) 
  691.              + p_cost_mvx[ mx ] + p_cost_mvy[ my ]; 
  692.     COPY3_IF_LT( bcost, cost, bmx, mx, bmy, my ); 
  693. }
  694. #define COST_MV_SATD( mx, my, dir ) 
  695. if( b_refine_qpel || (dir^1) != odir ) 
  696.     int stride = 16; 
  697.     uint8_t *src = h->mc.get_ref( pix[0], &stride, m->p_fref, m->i_stride[0], mx, my, bw, bh ); 
  698.     int cost = h->pixf.mbcmp_unaligned[i_pixel]( m->p_fenc[0], FENC_STRIDE, src, stride ) 
  699.              + p_cost_mvx[ mx ] + p_cost_mvy[ my ]; 
  700.     if( b_chroma_me && cost < bcost ) 
  701.     { 
  702.         h->mc.mc_chroma( pix[0], 8, m->p_fref[4], m->i_stride[1], mx, my, bw/2, bh/2 ); 
  703.         cost += h->pixf.mbcmp[i_pixel+3]( m->p_fenc[1], FENC_STRIDE, pix[0], 8 ); 
  704.         if( cost < bcost ) 
  705.         { 
  706.             h->mc.mc_chroma( pix[0], 8, m->p_fref[5], m->i_stride[1], mx, my, bw/2, bh/2 ); 
  707.             cost += h->pixf.mbcmp[i_pixel+3]( m->p_fenc[2], FENC_STRIDE, pix[0], 8 ); 
  708.         } 
  709.     } 
  710.     if( cost < bcost ) 
  711.     {                  
  712.         bcost = cost;  
  713.         bmx = mx;      
  714.         bmy = my;      
  715.         bdir = dir;    
  716.     } 
  717. }
  718. static void refine_subpel( x264_t *h, x264_me_t *m, int hpel_iters, int qpel_iters, int *p_halfpel_thresh, int b_refine_qpel )
  719. {
  720.     const int bw = x264_pixel_size[m->i_pixel].w;
  721.     const int bh = x264_pixel_size[m->i_pixel].h;
  722.     const uint16_t *p_cost_mvx = m->p_cost_mv - m->mvp[0];
  723.     const uint16_t *p_cost_mvy = m->p_cost_mv - m->mvp[1];
  724.     const int i_pixel = m->i_pixel;
  725.     const int b_chroma_me = h->mb.b_chroma_me && i_pixel <= PIXEL_8x8;
  726.     ALIGNED_ARRAY_16( uint8_t, pix,[2],[32*18] );   // really 17x17, but round up for alignment
  727.     int omx, omy;
  728.     int i;
  729.     int bmx = m->mv[0];
  730.     int bmy = m->mv[1];
  731.     int bcost = m->cost;
  732.     int odir = -1, bdir;
  733.     /* try the subpel component of the predicted mv */
  734.     if( hpel_iters && h->mb.i_subpel_refine < 3 )
  735.     {
  736.         int mx = x264_clip3( m->mvp[0], h->mb.mv_min_spel[0]+2, h->mb.mv_max_spel[0]-2 );
  737.         int my = x264_clip3( m->mvp[1], h->mb.mv_min_spel[1]+2, h->mb.mv_max_spel[1]-2 );
  738.         if( (mx-bmx)|(my-bmy) )
  739.             COST_MV_SAD( mx, my );
  740.     }
  741.     /* halfpel diamond search */
  742.     for( i = hpel_iters; i > 0; i-- )
  743.     {
  744.         int omx = bmx, omy = bmy;
  745.         int costs[4];
  746.         int stride = 32; // candidates are either all hpel or all qpel, so one stride is enough
  747.         uint8_t *src0, *src1, *src2, *src3;
  748.         src0 = h->mc.get_ref( pix[0], &stride, m->p_fref, m->i_stride[0], omx, omy-2, bw, bh+1 );
  749.         src2 = h->mc.get_ref( pix[1], &stride, m->p_fref, m->i_stride[0], omx-2, omy, bw+4, bh );
  750.         src1 = src0 + stride;
  751.         src3 = src2 + 1;
  752.         h->pixf.fpelcmp_x4[i_pixel]( m->p_fenc[0], src0, src1, src2, src3, stride, costs );
  753.         COPY2_IF_LT( bcost, costs[0] + p_cost_mvx[omx  ] + p_cost_mvy[omy-2], bmy, omy-2 );
  754.         COPY2_IF_LT( bcost, costs[1] + p_cost_mvx[omx  ] + p_cost_mvy[omy+2], bmy, omy+2 );
  755.         COPY3_IF_LT( bcost, costs[2] + p_cost_mvx[omx-2] + p_cost_mvy[omy  ], bmx, omx-2, bmy, omy );
  756.         COPY3_IF_LT( bcost, costs[3] + p_cost_mvx[omx+2] + p_cost_mvy[omy  ], bmx, omx+2, bmy, omy );
  757.         if( (bmx == omx) & (bmy == omy) )
  758.             break;
  759.     }
  760.     if( !b_refine_qpel )
  761.     {
  762.         bcost = COST_MAX;
  763.         COST_MV_SATD( bmx, bmy, -1 );
  764.     }
  765.     /* early termination when examining multiple reference frames */
  766.     if( p_halfpel_thresh )
  767.     {
  768.         if( (bcost*7)>>3 > *p_halfpel_thresh )
  769.         {
  770.             m->cost = bcost;
  771.             m->mv[0] = bmx;
  772.             m->mv[1] = bmy;
  773.             // don't need cost_mv
  774.             return;
  775.         }
  776.         else if( bcost < *p_halfpel_thresh )
  777.             *p_halfpel_thresh = bcost;
  778.     }
  779.     /* quarterpel diamond search */
  780.     bdir = -1;
  781.     for( i = qpel_iters; i > 0; i-- )
  782.     {
  783.         if( bmy <= h->mb.mv_min_spel[1] || bmy >= h->mb.mv_max_spel[1] )
  784.             break;
  785.         odir = bdir;
  786.         omx = bmx;
  787.         omy = bmy;
  788.         COST_MV_SATD( omx, omy - 1, 0 );
  789.         COST_MV_SATD( omx, omy + 1, 1 );
  790.         COST_MV_SATD( omx - 1, omy, 2 );
  791.         COST_MV_SATD( omx + 1, omy, 3 );
  792.         if( bmx == omx && bmy == omy )
  793.             break;
  794.     }
  795.     m->cost = bcost;
  796.     m->mv[0] = bmx;
  797.     m->mv[1] = bmy;
  798.     m->cost_mv = p_cost_mvx[ bmx ] + p_cost_mvy[ bmy ];
  799. }
  800. #define BIME_CACHE( dx, dy, list ) 
  801.     x264_me_t *m = m##list;
  802.     int i = 4 + 3*dx + dy; 
  803.     int mvx = om##list##x+dx;
  804.     int mvy = om##list##y+dy;
  805.     stride##list[i] = bw;
  806.     src##list[i] = h->mc.get_ref( pixy_buf[list][i], &stride##list[i], m->p_fref, m->i_stride[0], mvx, mvy, bw, bh ); 
  807.     if( rd )
  808.     {
  809.         if( h->mb.b_interlaced & ref##list )
  810.             mvy += (h->mb.i_mb_y & 1)*4 - 2;
  811.         h->mc.mc_chroma( pixu_buf[list][i], 8, m->p_fref[4], m->i_stride[1], mvx, mvy, bw>>1, bh>>1 );
  812.         h->mc.mc_chroma( pixv_buf[list][i], 8, m->p_fref[5], m->i_stride[1], mvx, mvy, bw>>1, bh>>1 );
  813.     }
  814. }
  815. #define BIME_CACHE2(a,b,list) 
  816.     BIME_CACHE(a,b,list) 
  817.     BIME_CACHE(-(a),-(b),list)
  818. #define BIME_CACHE8(list) 
  819. {
  820.     BIME_CACHE2( 1, 0, list );
  821.     BIME_CACHE2( 0, 1, list );
  822.     BIME_CACHE2( 1, 1, list );
  823.     BIME_CACHE2( 1,-1, list );
  824. }
  825. #define SATD_THRESH 17/16
  826. #define COST_BIMV_SATD( m0x, m0y, m1x, m1y ) 
  827. if( pass == 0 || !((visited[(m0x)&7][(m0y)&7][(m1x)&7] & (1<<((m1y)&7)))) ) 
  828.     int cost; 
  829.     int i0 = 4 + 3*(m0x-om0x) + (m0y-om0y); 
  830.     int i1 = 4 + 3*(m1x-om1x) + (m1y-om1y); 
  831.     visited[(m0x)&7][(m0y)&7][(m1x)&7] |= (1<<((m1y)&7));
  832.     h->mc.avg[i_pixel]( pix, FDEC_STRIDE, src0[i0], stride0[i0], src1[i1], stride1[i1], i_weight ); 
  833.     cost = h->pixf.mbcmp[i_pixel]( m0->p_fenc[0], FENC_STRIDE, pix, FDEC_STRIDE ) 
  834.          + p_cost_m0x[ m0x ] + p_cost_m0y[ m0y ] 
  835.          + p_cost_m1x[ m1x ] + p_cost_m1y[ m1y ]; 
  836.     if( rd ) 
  837.     { 
  838.         if( cost < bcost * SATD_THRESH ) 
  839.         { 
  840.             uint64_t costrd; 
  841.             if( cost < bcost ) 
  842.                 bcost = cost; 
  843.             *(uint32_t*)cache0_mv = *(uint32_t*)cache0_mv2 = pack16to32_mask(m0x,m0y); 
  844.             *(uint32_t*)cache1_mv = *(uint32_t*)cache1_mv2 = pack16to32_mask(m1x,m1y); 
  845.             h->mc.avg[i_pixel+3]( pixu, FDEC_STRIDE, pixu_buf[0][i0], 8, pixu_buf[1][i1], 8, i_weight );
  846.             h->mc.avg[i_pixel+3]( pixv, FDEC_STRIDE, pixv_buf[0][i0], 8, pixv_buf[1][i1], 8, i_weight );
  847.             costrd = x264_rd_cost_part( h, i_lambda2, i8*4, m0->i_pixel ); 
  848.             if( costrd < bcostrd ) 
  849.             {
  850.                 bcostrd = costrd;
  851.                 bm0x = m0x;      
  852.                 bm0y = m0y;      
  853.                 bm1x = m1x;      
  854.                 bm1y = m1y;      
  855.             }
  856.         } 
  857.     } 
  858.     else if( cost < bcost ) 
  859.     {                  
  860.         bcost = cost;  
  861.         bm0x = m0x;    
  862.         bm0y = m0y;    
  863.         bm1x = m1x;    
  864.         bm1y = m1y;    
  865.     } 
  866. }
  867. #define CHECK_BIDIR(a,b,c,d) 
  868.     COST_BIMV_SATD(om0x+a, om0y+b, om1x+c, om1y+d)
  869. static void ALWAYS_INLINE x264_me_refine_bidir( x264_t *h, x264_me_t *m0, x264_me_t *m1, int i_weight, int i8, int i_lambda2, int rd )
  870. {
  871.     static const int pixel_mv_offs[] = { 0, 4, 4*8, 0 };
  872.     int16_t *cache0_mv = h->mb.cache.mv[0][x264_scan8[i8*4]];
  873.     int16_t *cache0_mv2 = cache0_mv + pixel_mv_offs[m0->i_pixel];
  874.     int16_t *cache1_mv = h->mb.cache.mv[1][x264_scan8[i8*4]];
  875.     int16_t *cache1_mv2 = cache1_mv + pixel_mv_offs[m0->i_pixel];
  876.     const int i_pixel = m0->i_pixel;
  877.     const int bw = x264_pixel_size[i_pixel].w;
  878.     const int bh = x264_pixel_size[i_pixel].h;
  879.     const uint16_t *p_cost_m0x = m0->p_cost_mv - m0->mvp[0];
  880.     const uint16_t *p_cost_m0y = m0->p_cost_mv - m0->mvp[1];
  881.     const uint16_t *p_cost_m1x = m1->p_cost_mv - m1->mvp[0];
  882.     const uint16_t *p_cost_m1y = m1->p_cost_mv - m1->mvp[1];
  883.     ALIGNED_ARRAY_16( uint8_t, pixy_buf,[2],[9][16*16] );
  884.     ALIGNED_8( uint8_t pixu_buf[2][9][8*8] );
  885.     ALIGNED_8( uint8_t pixv_buf[2][9][8*8] );
  886.     uint8_t *src0[9];
  887.     uint8_t *src1[9];
  888.     uint8_t *pix  = &h->mb.pic.p_fdec[0][(i8>>1)*8*FDEC_STRIDE+(i8&1)*8];
  889.     uint8_t *pixu = &h->mb.pic.p_fdec[1][(i8>>1)*4*FDEC_STRIDE+(i8&1)*4];
  890.     uint8_t *pixv = &h->mb.pic.p_fdec[2][(i8>>1)*4*FDEC_STRIDE+(i8&1)*4];
  891.     int ref0 = h->mb.cache.ref[0][x264_scan8[i8*4]];
  892.     int ref1 = h->mb.cache.ref[1][x264_scan8[i8*4]];
  893.     int stride0[9];
  894.     int stride1[9];
  895.     int bm0x = m0->mv[0], om0x = bm0x;
  896.     int bm0y = m0->mv[1], om0y = bm0y;
  897.     int bm1x = m1->mv[0], om1x = bm1x;
  898.     int bm1y = m1->mv[1], om1y = bm1y;
  899.     int bcost = COST_MAX;
  900.     int pass = 0;
  901.     int j;
  902.     int mc_list0 = 1, mc_list1 = 1;
  903.     uint64_t bcostrd = COST_MAX64;
  904.     /* each byte of visited represents 8 possible m1y positions, so a 4D array isn't needed */
  905.     ALIGNED_ARRAY_16( uint8_t, visited,[8],[8][8] );
  906.     /* all permutations of an offset in up to 2 of the dimensions */
  907.     static const int8_t dia4d[32][4] = {
  908.         {0,0,0,1}, {0,0,0,-1}, {0,0,1,0}, {0,0,-1,0},
  909.         {0,1,0,0}, {0,-1,0,0}, {1,0,0,0}, {-1,0,0,0},
  910.         {0,0,1,1}, {0,0,-1,-1},{0,1,1,0}, {0,-1,-1,0},
  911.         {1,1,0,0}, {-1,-1,0,0},{1,0,0,1}, {-1,0,0,-1},
  912.         {0,1,0,1}, {0,-1,0,-1},{1,0,1,0}, {-1,0,-1,0},
  913.         {0,0,-1,1},{0,0,1,-1}, {0,-1,1,0},{0,1,-1,0},
  914.         {-1,1,0,0},{1,-1,0,0}, {1,0,0,-1},{-1,0,0,1},
  915.         {0,-1,0,1},{0,1,0,-1}, {-1,0,1,0},{1,0,-1,0},
  916.     };
  917.     if( bm0y < h->mb.mv_min_spel[1] + 8 || bm1y < h->mb.mv_min_spel[1] + 8 ||
  918.         bm0y > h->mb.mv_max_spel[1] - 8 || bm1y > h->mb.mv_max_spel[1] - 8 )
  919.         return;
  920.     h->mc.memzero_aligned( visited, sizeof(uint8_t[8][8][8]) );
  921.     BIME_CACHE( 0, 0, 0 );
  922.     BIME_CACHE( 0, 0, 1 );
  923.     CHECK_BIDIR( 0, 0, 0, 0 );
  924.     for( pass = 0; pass < 8; pass++ )
  925.     {
  926.         /* check all mv pairs that differ in at most 2 components from the current mvs. */
  927.         /* doesn't do chroma ME. this probably doesn't matter, as the gains
  928.          * from bidir ME are the same with and without chroma ME. */
  929.         if( mc_list0 )
  930.             BIME_CACHE8( 0 );
  931.         if( mc_list1 )
  932.             BIME_CACHE8( 1 );
  933.         for( j=0; j<32; j++ )
  934.             CHECK_BIDIR( dia4d[j][0], dia4d[j][1], dia4d[j][2], dia4d[j][3] );
  935.         mc_list0 = (om0x-bm0x)|(om0y-bm0y);
  936.         mc_list1 = (om1x-bm1x)|(om1y-bm1y);
  937.         if( !mc_list0 && !mc_list1 )
  938.             break;
  939.         om0x = bm0x;
  940.         om0y = bm0y;
  941.         om1x = bm1x;
  942.         om1y = bm1y;
  943.         if( mc_list0 )
  944.             BIME_CACHE( 0, 0, 0 );
  945.         if( mc_list1 )
  946.             BIME_CACHE( 0, 0, 1 );
  947.     }
  948.     m0->mv[0] = bm0x;
  949.     m0->mv[1] = bm0y;
  950.     m1->mv[0] = bm1x;
  951.     m1->mv[1] = bm1y;
  952. }
  953. void x264_me_refine_bidir_satd( x264_t *h, x264_me_t *m0, x264_me_t *m1, int i_weight )
  954. {
  955.     x264_me_refine_bidir( h, m0, m1, i_weight, 0, 0, 0 );
  956. }
  957. void x264_me_refine_bidir_rd( x264_t *h, x264_me_t *m0, x264_me_t *m1, int i_weight, int i8, int i_lambda2 )
  958. {
  959.     /* Motion compensation is done as part of bidir_rd; don't repeat
  960.      * it in encoding. */
  961.     h->mb.b_skip_mc = 1;
  962.     x264_me_refine_bidir( h, m0, m1, i_weight, i8, i_lambda2, 1 );
  963.     h->mb.b_skip_mc = 0;
  964. }
  965. #undef COST_MV_SATD
  966. #define COST_MV_SATD( mx, my, dst, avoid_mvp ) 
  967.     if( !avoid_mvp || !(mx == pmx && my == pmy) ) 
  968.     { 
  969.         int stride = 16; 
  970.         uint8_t *src = h->mc.get_ref( pix, &stride, m->p_fref, m->i_stride[0], mx, my, bw*4, bh*4 ); 
  971.         dst = h->pixf.mbcmp_unaligned[i_pixel]( m->p_fenc[0], FENC_STRIDE, src, stride ) 
  972.             + p_cost_mvx[mx] + p_cost_mvy[my]; 
  973.         COPY1_IF_LT( bsatd, dst ); 
  974.     } 
  975.     else 
  976.         dst = COST_MAX; 
  977. }
  978. #define COST_MV_RD( mx, my, satd, do_dir, mdir ) 
  979.     if( satd <= bsatd * SATD_THRESH ) 
  980.     { 
  981.         uint64_t cost; 
  982.         *(uint32_t*)cache_mv = *(uint32_t*)cache_mv2 = pack16to32_mask(mx,my); 
  983.         cost = x264_rd_cost_part( h, i_lambda2, i4, m->i_pixel ); 
  984.         COPY4_IF_LT( bcost, cost, bmx, mx, bmy, my, dir, do_dir?mdir:dir ); 
  985.     } 
  986. }
  987. void x264_me_refine_qpel_rd( x264_t *h, x264_me_t *m, int i_lambda2, int i4, int i_list )
  988. {
  989.     // don't have to fill the whole mv cache rectangle
  990.     static const int pixel_mv_offs[] = { 0, 4, 4*8, 0, 2, 2*8, 0 };
  991.     int16_t *cache_mv = h->mb.cache.mv[i_list][x264_scan8[i4]];
  992.     int16_t *cache_mv2 = cache_mv + pixel_mv_offs[m->i_pixel];
  993.     const uint16_t *p_cost_mvx, *p_cost_mvy;
  994.     const int bw = x264_pixel_size[m->i_pixel].w>>2;
  995.     const int bh = x264_pixel_size[m->i_pixel].h>>2;
  996.     const int i_pixel = m->i_pixel;
  997.     ALIGNED_ARRAY_16( uint8_t, pix,[16*16] );
  998.     uint64_t bcost = COST_MAX64;
  999.     int bmx = m->mv[0];
  1000.     int bmy = m->mv[1];
  1001.     int omx, omy, pmx, pmy, i, j;
  1002.     unsigned bsatd;
  1003.     int satd = 0;
  1004.     int dir = -2;
  1005.     int satds[8];
  1006.     if( m->i_pixel != PIXEL_16x16 && i4 != 0 )
  1007.         x264_mb_predict_mv( h, i_list, i4, bw, m->mvp );
  1008.     pmx = m->mvp[0];
  1009.     pmy = m->mvp[1];
  1010.     p_cost_mvx = m->p_cost_mv - pmx;
  1011.     p_cost_mvy = m->p_cost_mv - pmy;
  1012.     COST_MV_SATD( bmx, bmy, bsatd, 0 );
  1013.     if( m->i_pixel != PIXEL_16x16 )
  1014.         COST_MV_RD( bmx, bmy, 0, 0, 0 )
  1015.     else
  1016.         bcost = m->cost;
  1017.     /* check the predicted mv */
  1018.     if( (bmx != pmx || bmy != pmy)
  1019.         && pmx >= h->mb.mv_min_spel[0] && pmx <= h->mb.mv_max_spel[0]
  1020.         && pmy >= h->mb.mv_min_spel[1] && pmy <= h->mb.mv_max_spel[1] )
  1021.     {
  1022.         COST_MV_SATD( pmx, pmy, satd, 0 );
  1023.         COST_MV_RD( pmx, pmy, satd, 0,0 );
  1024.         /* The hex motion search is guaranteed to not repeat the center candidate,
  1025.          * so if pmv is chosen, set the "MV to avoid checking" to bmv instead. */
  1026.         if( bmx == pmx && bmy == pmy )
  1027.         {
  1028.             pmx = m->mv[0];
  1029.             pmy = m->mv[1];
  1030.         }
  1031.     }
  1032.     if( bmy < h->mb.mv_min_spel[1] + 3 ||
  1033.         bmy > h->mb.mv_max_spel[1] - 3 )
  1034.         return;
  1035.     /* subpel hex search, same pattern as ME HEX. */
  1036.     dir = -2;
  1037.     omx = bmx;
  1038.     omy = bmy;
  1039.     for( j=0; j<6; j++ ) COST_MV_SATD( omx + hex2[j+1][0], omy + hex2[j+1][1], satds[j], 1 );
  1040.     for( j=0; j<6; j++ ) COST_MV_RD  ( omx + hex2[j+1][0], omy + hex2[j+1][1], satds[j], 1,j );
  1041.     if( dir != -2 )
  1042.     {
  1043.         /* half hexagon, not overlapping the previous iteration */
  1044.         for( i = 1; i < 10; i++ )
  1045.         {
  1046.             const int odir = mod6m1[dir+1];
  1047.             if( bmy < h->mb.mv_min_spel[1] + 3 ||
  1048.                 bmy > h->mb.mv_max_spel[1] - 3 )
  1049.                 break;
  1050.             dir = -2;
  1051.             omx = bmx;
  1052.             omy = bmy;
  1053.             for( j=0; j<3; j++ ) COST_MV_SATD( omx + hex2[odir+j][0], omy + hex2[odir+j][1], satds[j], 1 );
  1054.             for( j=0; j<3; j++ ) COST_MV_RD  ( omx + hex2[odir+j][0], omy + hex2[odir+j][1], satds[j], 1, odir-1+j );
  1055.             if( dir == -2 )
  1056.                 break;
  1057.         }
  1058.     }
  1059.     /* square refine, same pattern as ME HEX. */
  1060.     omx = bmx;
  1061.     omy = bmy;
  1062.     for( i=0; i<8; i++ ) COST_MV_SATD( omx + square1[i+1][0], omy + square1[i+1][1], satds[i], 1 );
  1063.     for( i=0; i<8; i++ ) COST_MV_RD  ( omx + square1[i+1][0], omy + square1[i+1][1], satds[i], 0,0 );
  1064.     m->cost = bcost;
  1065.     m->mv[0] = bmx;
  1066.     m->mv[1] = bmy;
  1067.     x264_macroblock_cache_mv ( h, block_idx_x[i4], block_idx_y[i4], bw, bh, i_list, pack16to32_mask(bmx, bmy) );
  1068.     x264_macroblock_cache_mvd( h, block_idx_x[i4], block_idx_y[i4], bw, bh, i_list, pack16to32_mask(bmx - m->mvp[0], bmy - m->mvp[1]) );
  1069. }