me.c
上传用户:hjq518
上传日期:2021-12-09
资源大小:5084k
文件大小:37k
源码类别:

Audio

开发平台:

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 "me.h"
  26. /* presets selected from good points on the speed-vs-quality curve of several test videos
  27.  * subpel_iters[i_subpel_refine] = { refine_hpel, refine_qpel, me_hpel, me_qpel }
  28.  * where me_* are the number of EPZS iterations run on all candidate block types,
  29.  * and refine_* are run only on the winner.
  30.  * the subme=7 values are much higher because any amount of satd search makes
  31.  * up its time by reducing the number of rd iterations. */
  32. static const int subpel_iterations[][4] =
  33.    {{1,0,0,0},
  34.     {1,1,0,0},
  35.     {0,1,1,0},
  36.     {0,2,1,0},
  37.     {0,2,1,1},
  38.     {0,2,1,2},
  39.     {0,0,2,2},
  40.     {0,0,4,10}};
  41. /* (x-1)%6 */
  42. static const int mod6m1[8] = {5,0,1,2,3,4,5,0};
  43. /* radius 2 hexagon. repeated entries are to avoid having to compute mod6 every time. */
  44. static const int hex2[8][2] = {{-1,-2}, {-2,0}, {-1,2}, {1,2}, {2,0}, {1,-2}, {-1,-2}, {-2,0}};
  45. static const int square1[8][2] = {{0,-1}, {0,1}, {-1,0}, {1,0}, {-1,-1}, {1,1}, {-1,1}, {1,-1}};
  46. 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 );
  47. #define BITS_MVD( mx, my )
  48.     (p_cost_mvx[(mx)<<2] + p_cost_mvy[(my)<<2])
  49. #define COST_MV( mx, my )
  50. {
  51.     int cost = h->pixf.fpelcmp[i_pixel]( m->p_fenc[0], FENC_STRIDE,
  52.                    &p_fref[(my)*m->i_stride[0]+(mx)], m->i_stride[0] )
  53.              + BITS_MVD(mx,my);
  54.     COPY3_IF_LT( bcost, cost, bmx, mx, bmy, my );
  55. }
  56. #define COST_MV_HPEL( mx, my ) 
  57.     int stride = 16; 
  58.     uint8_t *src = h->mc.get_ref( pix, &stride, m->p_fref, m->i_stride[0], mx, my, bw, bh ); 
  59.     int cost = h->pixf.fpelcmp[i_pixel]( m->p_fenc[0], FENC_STRIDE, src, stride ) 
  60.              + p_cost_mvx[ mx ] + p_cost_mvy[ my ]; 
  61.     COPY3_IF_LT( bpred_cost, cost, bpred_mx, mx, bpred_my, my ); 
  62. }
  63. #define COST_MV_X3_DIR( m0x, m0y, m1x, m1y, m2x, m2y, costs )
  64. {
  65.     uint8_t *pix_base = p_fref + bmx + bmy*m->i_stride[0];
  66.     h->pixf.fpelcmp_x3[i_pixel]( m->p_fenc[0],
  67.         pix_base + (m0x) + (m0y)*m->i_stride[0],
  68.         pix_base + (m1x) + (m1y)*m->i_stride[0],
  69.         pix_base + (m2x) + (m2y)*m->i_stride[0],
  70.         m->i_stride[0], costs );
  71.     (costs)[0] += BITS_MVD( bmx+(m0x), bmy+(m0y) );
  72.     (costs)[1] += BITS_MVD( bmx+(m1x), bmy+(m1y) );
  73.     (costs)[2] += BITS_MVD( bmx+(m2x), bmy+(m2y) );
  74. }
  75. #define COST_MV_X4( m0x, m0y, m1x, m1y, m2x, m2y, m3x, m3y )
  76. {
  77.     uint8_t *pix_base = p_fref + omx + omy*m->i_stride[0];
  78.     h->pixf.fpelcmp_x4[i_pixel]( m->p_fenc[0],
  79.         pix_base + (m0x) + (m0y)*m->i_stride[0],
  80.         pix_base + (m1x) + (m1y)*m->i_stride[0],
  81.         pix_base + (m2x) + (m2y)*m->i_stride[0],
  82.         pix_base + (m3x) + (m3y)*m->i_stride[0],
  83.         m->i_stride[0], costs );
  84.     costs[0] += BITS_MVD( omx+(m0x), omy+(m0y) );
  85.     costs[1] += BITS_MVD( omx+(m1x), omy+(m1y) );
  86.     costs[2] += BITS_MVD( omx+(m2x), omy+(m2y) );
  87.     costs[3] += BITS_MVD( omx+(m3x), omy+(m3y) );
  88.     COPY3_IF_LT( bcost, costs[0], bmx, omx+(m0x), bmy, omy+(m0y) );
  89.     COPY3_IF_LT( bcost, costs[1], bmx, omx+(m1x), bmy, omy+(m1y) );
  90.     COPY3_IF_LT( bcost, costs[2], bmx, omx+(m2x), bmy, omy+(m2y) );
  91.     COPY3_IF_LT( bcost, costs[3], bmx, omx+(m3x), bmy, omy+(m3y) );
  92. }
  93. #define COST_MV_X3_ABS( m0x, m0y, m1x, m1y, m2x, m2y )
  94. {
  95.     h->pixf.fpelcmp_x3[i_pixel]( m->p_fenc[0],
  96.         p_fref + (m0x) + (m0y)*m->i_stride[0],
  97.         p_fref + (m1x) + (m1y)*m->i_stride[0],
  98.         p_fref + (m2x) + (m2y)*m->i_stride[0],
  99.         m->i_stride[0], costs );
  100.     costs[0] += p_cost_mvx[(m0x)<<2]; /* no cost_mvy */
  101.     costs[1] += p_cost_mvx[(m1x)<<2];
  102.     costs[2] += p_cost_mvx[(m2x)<<2];
  103.     COPY3_IF_LT( bcost, costs[0], bmx, m0x, bmy, m0y );
  104.     COPY3_IF_LT( bcost, costs[1], bmx, m1x, bmy, m1y );
  105.     COPY3_IF_LT( bcost, costs[2], bmx, m2x, bmy, m2y );
  106. }
  107. /*  1  */
  108. /* 101 */
  109. /*  1  */
  110. #define DIA1_ITER( mx, my )
  111. {
  112.     omx = mx; omy = my;
  113.     COST_MV_X4( 0,-1, 0,1, -1,0, 1,0 );
  114. }
  115. #define CROSS( start, x_max, y_max )
  116. {
  117.     i = start;
  118.     if( x_max <= X264_MIN(mv_x_max-omx, omx-mv_x_min) )
  119.         for( ; i < x_max-2; i+=4 )
  120.             COST_MV_X4( i,0, -i,0, i+2,0, -i-2,0 );
  121.     for( ; i < x_max; i+=2 )
  122.     {
  123.         if( omx+i <= mv_x_max )
  124.             COST_MV( omx+i, omy );
  125.         if( omx-i >= mv_x_min )
  126.             COST_MV( omx-i, omy );
  127.     }
  128.     i = start;
  129.     if( y_max <= X264_MIN(mv_y_max-omy, omy-mv_y_min) )
  130.         for( ; i < y_max-2; i+=4 )
  131.             COST_MV_X4( 0,i, 0,-i, 0,i+2, 0,-i-2 );
  132.     for( ; i < y_max; i+=2 )
  133.     {
  134.         if( omy+i <= mv_y_max )
  135.             COST_MV( omx, omy+i );
  136.         if( omy-i >= mv_y_min )
  137.             COST_MV( omx, omy-i );
  138.     }
  139. }
  140. void x264_me_search_ref( x264_t *h, x264_me_t *m, int16_t (*mvc)[2], int i_mvc, int *p_halfpel_thresh )
  141. {
  142.     const int bw = x264_pixel_size[m->i_pixel].w;
  143.     const int bh = x264_pixel_size[m->i_pixel].h;
  144.     const int i_pixel = m->i_pixel;
  145.     int i_me_range = h->param.analyse.i_me_range;
  146.     int bmx, bmy, bcost;
  147.     int bpred_mx = 0, bpred_my = 0, bpred_cost = COST_MAX;
  148.     int omx, omy, pmx, pmy;
  149.     uint8_t *p_fref = m->p_fref[0];
  150.     DECLARE_ALIGNED_16( uint8_t pix[16*16] );
  151.     int i = 0, j;
  152.     int dir;
  153.     int costs[6];
  154.     int mv_x_min = h->mb.mv_min_fpel[0];
  155.     int mv_y_min = h->mb.mv_min_fpel[1];
  156.     int mv_x_max = h->mb.mv_max_fpel[0];
  157.     int mv_y_max = h->mb.mv_max_fpel[1];
  158. #define CHECK_MVRANGE(mx,my) ( mx >= mv_x_min && mx <= mv_x_max && my >= mv_y_min && my <= mv_y_max )
  159.     const int16_t *p_cost_mvx = m->p_cost_mv - m->mvp[0];
  160.     const int16_t *p_cost_mvy = m->p_cost_mv - m->mvp[1];
  161.     bmx = x264_clip3( m->mvp[0], mv_x_min*4, mv_x_max*4 );
  162.     bmy = x264_clip3( m->mvp[1], mv_y_min*4, mv_y_max*4 );
  163.     pmx = ( bmx + 2 ) >> 2;
  164.     pmy = ( bmy + 2 ) >> 2;
  165.     bcost = COST_MAX;
  166.     /* try extra predictors if provided */
  167.     if( h->mb.i_subpel_refine >= 3 )
  168.     {
  169.         uint32_t bmv = pack16to32_mask(bmx,bmy);
  170.         COST_MV_HPEL( bmx, bmy );
  171.         do
  172.         {
  173.             if( *(uint32_t*)mvc[i] && (bmv - *(uint32_t*)mvc[i]) )
  174.             {
  175.                 int mx = x264_clip3( mvc[i][0], mv_x_min*4, mv_x_max*4 );
  176.                 int my = x264_clip3( mvc[i][1], mv_y_min*4, mv_y_max*4 );
  177.                 COST_MV_HPEL( mx, my );
  178.             }
  179.         } while( ++i < i_mvc );
  180.         bmx = ( bpred_mx + 2 ) >> 2;
  181.         bmy = ( bpred_my + 2 ) >> 2;
  182.         COST_MV( bmx, bmy );
  183.     }
  184.     else
  185.     {
  186.         /* check the MVP */
  187.         COST_MV( pmx, pmy );
  188.         /* Because we are rounding the predicted motion vector to fullpel, there will be
  189.          * an extra MV cost in 15 out of 16 cases.  However, when the predicted MV is
  190.          * chosen as the best predictor, it is often the case that the subpel search will
  191.          * result in a vector at or next to the predicted motion vector.  Therefore, it is
  192.          * sensible to remove the cost of the MV from the rounded MVP to avoid unfairly
  193.          * biasing against use of the predicted motion vector. */
  194.         bcost -= BITS_MVD( pmx, pmy );
  195.         do
  196.         {
  197.             int mx = (mvc[i][0] + 2) >> 2;
  198.             int my = (mvc[i][1] + 2) >> 2;
  199.             if( (mx | my) && ((mx-bmx) | (my-bmy)) )
  200.             {
  201.                 mx = x264_clip3( mx, mv_x_min, mv_x_max );
  202.                 my = x264_clip3( my, mv_y_min, mv_y_max );
  203.                 COST_MV( mx, my );
  204.             }
  205.         } while( ++i < i_mvc );
  206.     }
  207.     COST_MV( 0, 0 );
  208.     switch( h->mb.i_me_method )
  209.     {
  210.     case X264_ME_DIA:
  211.         /* diamond search, radius 1 */
  212.         i = 0;
  213.         do
  214.         {
  215.             DIA1_ITER( bmx, bmy );
  216.             if( (bmx == omx) & (bmy == omy) )
  217.                 break;
  218.             if( !CHECK_MVRANGE(bmx, bmy) )
  219.                 break;
  220.         } while( ++i < i_me_range );
  221.         break;
  222.     case X264_ME_HEX:
  223. me_hex2:
  224.         /* hexagon search, radius 2 */
  225. #if 0
  226.         for( i = 0; i < i_me_range/2; i++ )
  227.         {
  228.             omx = bmx; omy = bmy;
  229.             COST_MV( omx-2, omy   );
  230.             COST_MV( omx-1, omy+2 );
  231.             COST_MV( omx+1, omy+2 );
  232.             COST_MV( omx+2, omy   );
  233.             COST_MV( omx+1, omy-2 );
  234.             COST_MV( omx-1, omy-2 );
  235.             if( bmx == omx && bmy == omy )
  236.                 break;
  237.             if( !CHECK_MVRANGE(bmx, bmy) )
  238.                 break;
  239.         }
  240. #else
  241.         /* equivalent to the above, but eliminates duplicate candidates */
  242.         dir = -2;
  243.         /* hexagon */
  244.         COST_MV_X3_DIR( -2,0, -1, 2,  1, 2, costs   );
  245.         COST_MV_X3_DIR(  2,0,  1,-2, -1,-2, costs+3 );
  246.         COPY2_IF_LT( bcost, costs[0], dir, 0 );
  247.         COPY2_IF_LT( bcost, costs[1], dir, 1 );
  248.         COPY2_IF_LT( bcost, costs[2], dir, 2 );
  249.         COPY2_IF_LT( bcost, costs[3], dir, 3 );
  250.         COPY2_IF_LT( bcost, costs[4], dir, 4 );
  251.         COPY2_IF_LT( bcost, costs[5], dir, 5 );
  252.         if( dir != -2 )
  253.         {
  254.             bmx += hex2[dir+1][0];
  255.             bmy += hex2[dir+1][1];
  256.             /* half hexagon, not overlapping the previous iteration */
  257.             for( i = 1; i < i_me_range/2 && CHECK_MVRANGE(bmx, bmy); i++ )
  258.             {
  259.                 const int odir = mod6m1[dir+1];
  260.                 COST_MV_X3_DIR( hex2[odir+0][0], hex2[odir+0][1],
  261.                                 hex2[odir+1][0], hex2[odir+1][1],
  262.                                 hex2[odir+2][0], hex2[odir+2][1],
  263.                                 costs );
  264.                 dir = -2;
  265.                 COPY2_IF_LT( bcost, costs[0], dir, odir-1 );
  266.                 COPY2_IF_LT( bcost, costs[1], dir, odir   );
  267.                 COPY2_IF_LT( bcost, costs[2], dir, odir+1 );
  268.                 if( dir == -2 )
  269.                     break;
  270.                 bmx += hex2[dir+1][0];
  271.                 bmy += hex2[dir+1][1];
  272.             }
  273.         }
  274. #endif
  275.         /* square refine */
  276.         omx = bmx; omy = bmy;
  277.         COST_MV_X4(  0,-1,  0,1, -1,0, 1,0 );
  278.         COST_MV_X4( -1,-1, -1,1, 1,-1, 1,1 );
  279.         break;
  280.     case X264_ME_UMH:
  281.         {
  282.             /* Uneven-cross Multi-Hexagon-grid Search
  283.              * as in JM, except with different early termination */
  284.             static const int x264_pixel_size_shift[7] = { 0, 1, 1, 2, 3, 3, 4 };
  285.             int ucost1, ucost2;
  286.             int cross_start = 1;
  287.             /* refine predictors */
  288.             ucost1 = bcost;
  289.             DIA1_ITER( pmx, pmy );
  290.             if( pmx | pmy )
  291.                 DIA1_ITER( 0, 0 );
  292.             if(i_pixel == PIXEL_4x4)
  293.                 goto me_hex2;
  294.             ucost2 = bcost;
  295.             if( (bmx | bmy) && ((bmx-pmx) | (bmy-pmy)) )
  296.                 DIA1_ITER( bmx, bmy );
  297.             if( bcost == ucost2 )
  298.                 cross_start = 3;
  299.             omx = bmx; omy = bmy;
  300.             /* early termination */
  301. #define SAD_THRESH(v) ( bcost < ( v >> x264_pixel_size_shift[i_pixel] ) )
  302.             if( bcost == ucost2 && SAD_THRESH(2000) )
  303.             {
  304.                 COST_MV_X4( 0,-2, -1,-1, 1,-1, -2,0 );
  305.                 COST_MV_X4( 2, 0, -1, 1, 1, 1,  0,2 );
  306.                 if( bcost == ucost1 && SAD_THRESH(500) )
  307.                     break;
  308.                 if( bcost == ucost2 )
  309.                 {
  310.                     int range = (i_me_range>>1) | 1;
  311.                     CROSS( 3, range, range );
  312.                     COST_MV_X4( -1,-2, 1,-2, -2,-1, 2,-1 );
  313.                     COST_MV_X4( -2, 1, 2, 1, -1, 2, 1, 2 );
  314.                     if( bcost == ucost2 )
  315.                         break;
  316.                     cross_start = range + 2;
  317.                 }
  318.             }
  319.             /* adaptive search range */
  320.             if( i_mvc )
  321.             {
  322.                 /* range multipliers based on casual inspection of some statistics of
  323.                  * average distance between current predictor and final mv found by ESA.
  324.                  * these have not been tuned much by actual encoding. */
  325.                 static const int range_mul[4][4] =
  326.                 {
  327.                     { 3, 3, 4, 4 },
  328.                     { 3, 4, 4, 4 },
  329.                     { 4, 4, 4, 5 },
  330.                     { 4, 4, 5, 6 },
  331.                 };
  332.                 int mvd;
  333.                 int sad_ctx, mvd_ctx;
  334.                 int denom = 1;
  335.                 if( i_mvc == 1 )
  336.                 {
  337.                     if( i_pixel == PIXEL_16x16 )
  338.                         /* mvc is probably the same as mvp, so the difference isn't meaningful.
  339.                          * but prediction usually isn't too bad, so just use medium range */
  340.                         mvd = 25;
  341.                     else
  342.                         mvd = abs( m->mvp[0] - mvc[0][0] )
  343.                             + abs( m->mvp[1] - mvc[0][1] );
  344.                 }
  345.                 else
  346.                 {
  347.                     /* calculate the degree of agreement between predictors. */
  348.                     /* in 16x16, mvc includes all the neighbors used to make mvp,
  349.                      * so don't count mvp separately. */
  350.                     denom = i_mvc - 1;
  351.                     mvd = 0;
  352.                     if( i_pixel != PIXEL_16x16 )
  353.                     {
  354.                         mvd = abs( m->mvp[0] - mvc[0][0] )
  355.                             + abs( m->mvp[1] - mvc[0][1] );
  356.                         denom++;
  357.                     }
  358.                     mvd += x264_predictor_difference( mvc, i_mvc );
  359.                 }
  360.                 sad_ctx = SAD_THRESH(1000) ? 0
  361.                         : SAD_THRESH(2000) ? 1
  362.                         : SAD_THRESH(4000) ? 2 : 3;
  363.                 mvd_ctx = mvd < 10*denom ? 0
  364.                         : mvd < 20*denom ? 1
  365.                         : mvd < 40*denom ? 2 : 3;
  366.                 i_me_range = i_me_range * range_mul[mvd_ctx][sad_ctx] / 4;
  367.             }
  368.             /* FIXME if the above DIA2/OCT2/CROSS found a new mv, it has not updated omx/omy.
  369.              * we are still centered on the same place as the DIA2. is this desirable? */
  370.             CROSS( cross_start, i_me_range, i_me_range/2 );
  371.             COST_MV_X4( -2,-2, -2,2, 2,-2, 2,2 );
  372.             /* hexagon grid */
  373.             omx = bmx; omy = bmy;
  374.             i = 1;
  375.             do
  376.             {
  377.                 static const int hex4[16][2] = {
  378.                     {-4, 2}, {-4, 1}, {-4, 0}, {-4,-1}, {-4,-2},
  379.                     { 4,-2}, { 4,-1}, { 4, 0}, { 4, 1}, { 4, 2},
  380.                     { 2, 3}, { 0, 4}, {-2, 3},
  381.                     {-2,-3}, { 0,-4}, { 2,-3},
  382.                 };
  383.                 if( 4*i > X264_MIN4( mv_x_max-omx, omx-mv_x_min,
  384.                                      mv_y_max-omy, omy-mv_y_min ) )
  385.                 {
  386.                     for( j = 0; j < 16; j++ )
  387.                     {
  388.                         int mx = omx + hex4[j][0]*i;
  389.                         int my = omy + hex4[j][1]*i;
  390.                         if( CHECK_MVRANGE(mx, my) )
  391.                             COST_MV( mx, my );
  392.                     }
  393.                 }
  394.                 else
  395.                 {
  396.                     COST_MV_X4( -4*i, 2*i, -4*i, 1*i, -4*i, 0*i, -4*i,-1*i );
  397.                     COST_MV_X4( -4*i,-2*i,  4*i,-2*i,  4*i,-1*i,  4*i, 0*i );
  398.                     COST_MV_X4(  4*i, 1*i,  4*i, 2*i,  2*i, 3*i,  0*i, 4*i );
  399.                     COST_MV_X4( -2*i, 3*i, -2*i,-3*i,  0*i,-4*i,  2*i,-3*i );
  400.                 }
  401.             } while( ++i <= i_me_range/4 );
  402.             if( bmy <= mv_y_max )
  403.                 goto me_hex2;
  404.             break;
  405.         }
  406.     case X264_ME_ESA:
  407.     case X264_ME_TESA:
  408.         {
  409.             const int min_x = X264_MAX( bmx - i_me_range, mv_x_min );
  410.             const int min_y = X264_MAX( bmy - i_me_range, mv_y_min );
  411.             const int max_x = X264_MIN( bmx + i_me_range, mv_x_max );
  412.             const int max_y = X264_MIN( bmy + i_me_range, mv_y_max );
  413.             /* SEA is fastest in multiples of 4 */
  414.             const int width = (max_x - min_x + 3) & ~3;
  415.             int my;
  416. #if 0
  417.             /* plain old exhaustive search */
  418.             int mx;
  419.             for( my = min_y; my <= max_y; my++ )
  420.                 for( mx = min_x; mx <= max_x; mx++ )
  421.                     COST_MV( mx, my );
  422. #else
  423.             /* successive elimination by comparing DC before a full SAD,
  424.              * because sum(abs(diff)) >= abs(diff(sum)). */
  425.             const int stride = m->i_stride[0];
  426.             uint16_t *sums_base = m->integral;
  427.             /* due to a GCC bug on some platforms (win32?), zero[] may not actually be aligned.
  428.              * unlike the similar case in ratecontrol.c, this is not a problem because it is not used for any
  429.              * SSE instructions and the only loss is a tiny bit of performance. */
  430.             DECLARE_ALIGNED_16( static uint8_t zero[8*FENC_STRIDE] );
  431.             DECLARE_ALIGNED_16( int enc_dc[4] );
  432.             int sad_size = i_pixel <= PIXEL_8x8 ? PIXEL_8x8 : PIXEL_4x4;
  433.             int delta = x264_pixel_size[sad_size].w;
  434.             int16_t xs_buf[64];
  435.             int16_t *xs = width<=64 ? xs_buf : x264_malloc( (width+15)*sizeof(int16_t) );
  436.             int xn;
  437.             uint16_t *cost_fpel_mvx = x264_cost_mv_fpel[h->mb.i_qp][-m->mvp[0]&3] + (-m->mvp[0]>>2);
  438.             h->pixf.sad_x4[sad_size]( zero, m->p_fenc[0], m->p_fenc[0]+delta,
  439.                 m->p_fenc[0]+delta*FENC_STRIDE, m->p_fenc[0]+delta+delta*FENC_STRIDE,
  440.                 FENC_STRIDE, enc_dc );
  441.             if( delta == 4 )
  442.                 sums_base += stride * (h->fenc->i_lines[0] + PADV*2);
  443.             if( i_pixel == PIXEL_16x16 || i_pixel == PIXEL_8x16 || i_pixel == PIXEL_4x8 )
  444.                 delta *= stride;
  445.             if( i_pixel == PIXEL_8x16 || i_pixel == PIXEL_4x8 )
  446.                 enc_dc[1] = enc_dc[2];
  447.             if( h->mb.i_me_method == X264_ME_TESA )
  448.             {
  449.                 // ADS threshold, then SAD threshold, then keep the best few SADs, then SATD
  450.                 typedef struct {
  451.                     int sad;
  452.                     int16_t mx, my;
  453.                 } mvsad_t;
  454.                 mvsad_t *mvsads = x264_malloc( width*(max_y-min_y+1)*sizeof(mvsad_t) );
  455.                 int nmvsad = 0, limit;
  456.                 int sad_thresh = i_me_range <= 16 ? 10 : i_me_range <= 24 ? 11 : 12;
  457.                 int bsad = h->pixf.sad[i_pixel]( m->p_fenc[0], FENC_STRIDE, p_fref+bmy*stride+bmx, stride )
  458.                          + BITS_MVD( bmx, bmy );
  459.                 for( my = min_y; my <= max_y; my++ )
  460.                 {
  461.                     int ycost = p_cost_mvy[my<<2];
  462.                     if( bsad <= ycost )
  463.                         continue;
  464.                     bsad -= ycost;
  465.                     xn = h->pixf.ads[i_pixel]( enc_dc, sums_base + min_x + my * stride, delta,
  466.                                                cost_fpel_mvx+min_x, xs, width, bsad*17/16 );
  467.                     for( i=0; i<xn-2; i+=3 )
  468.                     {
  469.                         uint8_t *ref = p_fref+min_x+my*stride;
  470.                         int sads[3];
  471.                         h->pixf.sad_x3[i_pixel]( m->p_fenc[0], ref+xs[i], ref+xs[i+1], ref+xs[i+2], stride, sads );
  472.                         for( j=0; j<3; j++ )
  473.                         {
  474.                             int sad = sads[j] + cost_fpel_mvx[xs[i+j]];
  475.                             if( sad < bsad*sad_thresh>>3 )
  476.                             {
  477.                                 COPY1_IF_LT( bsad, sad );
  478.                                 mvsads[nmvsad].sad = sad + ycost;
  479.                                 mvsads[nmvsad].mx = min_x+xs[i+j];
  480.                                 mvsads[nmvsad].my = my;
  481.                                 nmvsad++;
  482.                             }
  483.                         }
  484.                     }
  485.                     for( ; i<xn; i++ )
  486.                     {
  487.                         int mx = min_x+xs[i];
  488.                         int sad = h->pixf.sad[i_pixel]( m->p_fenc[0], FENC_STRIDE, p_fref+mx+my*stride, stride )
  489.                                 + cost_fpel_mvx[xs[i]];
  490.                         if( sad < bsad*sad_thresh>>3 )
  491.                         {
  492.                             COPY1_IF_LT( bsad, sad );
  493.                             mvsads[nmvsad].sad = sad + ycost;
  494.                             mvsads[nmvsad].mx = mx;
  495.                             mvsads[nmvsad].my = my;
  496.                             nmvsad++;
  497.                         }
  498.                     }
  499.                     bsad += ycost;
  500.                 }
  501.                 limit = i_me_range / 2;
  502.                 if( nmvsad > limit*2 )
  503.                 {
  504.                     // halve the range if the domain is too large... eh, close enough
  505.                     bsad = bsad*(sad_thresh+8)>>4;
  506.                     for( i=0; i<nmvsad && mvsads[i].sad <= bsad; i++ );
  507.                     for( j=i; j<nmvsad; j++ )
  508.                         if( mvsads[j].sad <= bsad )
  509.                         {
  510.                             /* mvsad_t is not guaranteed to be 8 bytes on all archs, so check before using explicit write-combining */
  511.                             if( sizeof( mvsad_t ) == sizeof( uint64_t ) )
  512.                                 *(uint64_t*)&mvsads[i++] = *(uint64_t*)&mvsads[j];
  513.                             else
  514.                                 mvsads[i++] = mvsads[j];
  515.                         }
  516.                     nmvsad = i;
  517.                 }
  518.                 if( nmvsad > limit )
  519.                 {
  520.                     for( i=0; i<limit; i++ )
  521.                     {
  522.                         int bj = i;
  523.                         int bsad = mvsads[bj].sad;
  524.                         for( j=i+1; j<nmvsad; j++ )
  525.                             COPY2_IF_LT( bsad, mvsads[j].sad, bj, j );
  526.                         if( bj > i )
  527.                         {
  528.                             if( sizeof( mvsad_t ) == sizeof( uint64_t ) )
  529.                                 XCHG( uint64_t, *(uint64_t*)&mvsads[i], *(uint64_t*)&mvsads[bj] );
  530.                             else
  531.                                 XCHG( mvsad_t, mvsads[i], mvsads[bj] );
  532.                         }
  533.                     }
  534.                     nmvsad = limit;
  535.                 }
  536.                 for( i=0; i<nmvsad; i++ )
  537.                     COST_MV( mvsads[i].mx, mvsads[i].my );
  538.                 x264_free( mvsads );
  539.             }
  540.             else
  541.             {
  542.                 // just ADS and SAD
  543.                 for( my = min_y; my <= max_y; my++ )
  544.                 {
  545.                     int ycost = p_cost_mvy[my<<2];
  546.                     if( bcost <= ycost )
  547.                         continue;
  548.                     bcost -= ycost;
  549.                     xn = h->pixf.ads[i_pixel]( enc_dc, sums_base + min_x + my * stride, delta,
  550.                                                cost_fpel_mvx+min_x, xs, width, bcost );
  551.                     for( i=0; i<xn-2; i+=3 )
  552.                         COST_MV_X3_ABS( min_x+xs[i],my, min_x+xs[i+1],my, min_x+xs[i+2],my );
  553.                     bcost += ycost;
  554.                     for( ; i<xn; i++ )
  555.                         COST_MV( min_x+xs[i], my );
  556.                 }
  557.             }
  558.             if( xs != xs_buf )
  559.                 x264_free( xs );
  560. #endif
  561.         }
  562.         break;
  563.     }
  564.     /* -> qpel mv */
  565.     if( bpred_cost < bcost )
  566.     {
  567.         m->mv[0] = bpred_mx;
  568.         m->mv[1] = bpred_my;
  569.         m->cost = bpred_cost;
  570.     }
  571.     else
  572.     {
  573.         m->mv[0] = bmx << 2;
  574.         m->mv[1] = bmy << 2;
  575.         m->cost = bcost;
  576.     }
  577.     /* compute the real cost */
  578.     m->cost_mv = p_cost_mvx[ m->mv[0] ] + p_cost_mvy[ m->mv[1] ];
  579.     if( bmx == pmx && bmy == pmy && h->mb.i_subpel_refine < 3 )
  580.         m->cost += m->cost_mv;
  581.     /* subpel refine */
  582.     if( h->mb.i_subpel_refine >= 2 )
  583.     {
  584.         int hpel = subpel_iterations[h->mb.i_subpel_refine][2];
  585.         int qpel = subpel_iterations[h->mb.i_subpel_refine][3];
  586.         refine_subpel( h, m, hpel, qpel, p_halfpel_thresh, 0 );
  587.     }
  588.     else if( m->mv[1] > h->mb.mv_max_spel[1] )
  589.         m->mv[1] = h->mb.mv_max_spel[1];
  590. }
  591. #undef COST_MV
  592. void x264_me_refine_qpel( x264_t *h, x264_me_t *m )
  593. {
  594.     int hpel = subpel_iterations[h->mb.i_subpel_refine][0];
  595.     int qpel = subpel_iterations[h->mb.i_subpel_refine][1];
  596.     if( m->i_pixel <= PIXEL_8x8 && h->sh.i_type == SLICE_TYPE_P )
  597.         m->cost -= m->i_ref_cost;
  598.     refine_subpel( h, m, hpel, qpel, NULL, 1 );
  599. }
  600. #define COST_MV_SAD( mx, my ) 
  601.     int stride = 16; 
  602.     uint8_t *src = h->mc.get_ref( pix[0], &stride, m->p_fref, m->i_stride[0], mx, my, bw, bh ); 
  603.     int cost = h->pixf.fpelcmp[i_pixel]( m->p_fenc[0], FENC_STRIDE, src, stride ) 
  604.              + p_cost_mvx[ mx ] + p_cost_mvy[ my ]; 
  605.     COPY3_IF_LT( bcost, cost, bmx, mx, bmy, my ); 
  606. }
  607. #define COST_MV_SATD( mx, my, dir ) 
  608. if( b_refine_qpel || (dir^1) != odir ) 
  609.     int stride = 16; 
  610.     uint8_t *src = h->mc.get_ref( pix[0], &stride, m->p_fref, m->i_stride[0], mx, my, bw, bh ); 
  611.     int cost = h->pixf.mbcmp_unaligned[i_pixel]( m->p_fenc[0], FENC_STRIDE, src, stride ) 
  612.              + p_cost_mvx[ mx ] + p_cost_mvy[ my ]; 
  613.     if( b_chroma_me && cost < bcost ) 
  614.     { 
  615.         h->mc.mc_chroma( pix[0], 8, m->p_fref[4], m->i_stride[1], mx, my, bw/2, bh/2 ); 
  616.         cost += h->pixf.mbcmp[i_pixel+3]( m->p_fenc[1], FENC_STRIDE, pix[0], 8 ); 
  617.         if( cost < bcost ) 
  618.         { 
  619.             h->mc.mc_chroma( pix[0], 8, m->p_fref[5], m->i_stride[1], mx, my, bw/2, bh/2 ); 
  620.             cost += h->pixf.mbcmp[i_pixel+3]( m->p_fenc[2], FENC_STRIDE, pix[0], 8 ); 
  621.         } 
  622.     } 
  623.     if( cost < bcost ) 
  624.     {                  
  625.         bcost = cost;  
  626.         bmx = mx;      
  627.         bmy = my;      
  628.         bdir = dir;    
  629.     } 
  630. }
  631. 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 )
  632. {
  633.     const int bw = x264_pixel_size[m->i_pixel].w;
  634.     const int bh = x264_pixel_size[m->i_pixel].h;
  635.     const int16_t *p_cost_mvx = m->p_cost_mv - m->mvp[0];
  636.     const int16_t *p_cost_mvy = m->p_cost_mv - m->mvp[1];
  637.     const int i_pixel = m->i_pixel;
  638.     const int b_chroma_me = h->mb.b_chroma_me && i_pixel <= PIXEL_8x8;
  639.     DECLARE_ALIGNED_16( uint8_t pix[2][32*18] ); // really 17x17, but round up for alignment
  640.     int omx, omy;
  641.     int i;
  642.     int bmx = m->mv[0];
  643.     int bmy = m->mv[1];
  644.     int bcost = m->cost;
  645.     int odir = -1, bdir;
  646.     /* try the subpel component of the predicted mv */
  647.     if( hpel_iters && h->mb.i_subpel_refine < 3 )
  648.     {
  649.         int mx = x264_clip3( m->mvp[0], h->mb.mv_min_spel[0], h->mb.mv_max_spel[0] );
  650.         int my = x264_clip3( m->mvp[1], h->mb.mv_min_spel[1], h->mb.mv_max_spel[1] );
  651.         if( (mx-bmx)|(my-bmy) )
  652.             COST_MV_SAD( mx, my );
  653.     }
  654.     /* halfpel diamond search */
  655.     for( i = hpel_iters; i > 0; i-- )
  656.     {
  657.         int omx = bmx, omy = bmy;
  658.         int costs[4];
  659.         int stride = 32; // candidates are either all hpel or all qpel, so one stride is enough
  660.         uint8_t *src0, *src1, *src2, *src3;
  661.         src0 = h->mc.get_ref( pix[0], &stride, m->p_fref, m->i_stride[0], omx, omy-2, bw, bh+1 );
  662.         src2 = h->mc.get_ref( pix[1], &stride, m->p_fref, m->i_stride[0], omx-2, omy, bw+4, bh );
  663.         src1 = src0 + stride;
  664.         src3 = src2 + 1;
  665.         h->pixf.fpelcmp_x4[i_pixel]( m->p_fenc[0], src0, src1, src2, src3, stride, costs );
  666.         COPY2_IF_LT( bcost, costs[0] + p_cost_mvx[omx  ] + p_cost_mvy[omy-2], bmy, omy-2 );
  667.         COPY2_IF_LT( bcost, costs[1] + p_cost_mvx[omx  ] + p_cost_mvy[omy+2], bmy, omy+2 );
  668.         COPY3_IF_LT( bcost, costs[2] + p_cost_mvx[omx-2] + p_cost_mvy[omy  ], bmx, omx-2, bmy, omy );
  669.         COPY3_IF_LT( bcost, costs[3] + p_cost_mvx[omx+2] + p_cost_mvy[omy  ], bmx, omx+2, bmy, omy );
  670.         if( (bmx == omx) & (bmy == omy) )
  671.             break;
  672.     }
  673.     if( !b_refine_qpel )
  674.     {
  675.         /* check for mvrange */
  676.         if( bmy > h->mb.mv_max_spel[1] )
  677.             bmy = h->mb.mv_max_spel[1];
  678.         bcost = COST_MAX;
  679.         COST_MV_SATD( bmx, bmy, -1 );
  680.     }
  681.     /* early termination when examining multiple reference frames */
  682.     if( p_halfpel_thresh )
  683.     {
  684.         if( (bcost*7)>>3 > *p_halfpel_thresh )
  685.         {
  686.             m->cost = bcost;
  687.             m->mv[0] = bmx;
  688.             m->mv[1] = bmy;
  689.             // don't need cost_mv
  690.             return;
  691.         }
  692.         else if( bcost < *p_halfpel_thresh )
  693.             *p_halfpel_thresh = bcost;
  694.     }
  695.     /* quarterpel diamond search */
  696.     bdir = -1;
  697.     for( i = qpel_iters; i > 0; i-- )
  698.     {
  699.         odir = bdir;
  700.         omx = bmx;
  701.         omy = bmy;
  702.         COST_MV_SATD( omx, omy - 1, 0 );
  703.         COST_MV_SATD( omx, omy + 1, 1 );
  704.         COST_MV_SATD( omx - 1, omy, 2 );
  705.         COST_MV_SATD( omx + 1, omy, 3 );
  706.         if( bmx == omx && bmy == omy )
  707.             break;
  708.     }
  709.     /* check for mvrange */
  710.     if( bmy > h->mb.mv_max_spel[1] )
  711.     {
  712.         bmy = h->mb.mv_max_spel[1];
  713.         bcost = COST_MAX;
  714.         COST_MV_SATD( bmx, bmy, -1 );
  715.     }
  716.     m->cost = bcost;
  717.     m->mv[0] = bmx;
  718.     m->mv[1] = bmy;
  719.     m->cost_mv = p_cost_mvx[ bmx ] + p_cost_mvy[ bmy ];
  720. }
  721. #define BIME_CACHE( dx, dy ) 
  722.     int i = 4 + 3*dx + dy; 
  723.     h->mc.mc_luma( pix0[i], bw, m0->p_fref, m0->i_stride[0], om0x+dx, om0y+dy, bw, bh ); 
  724.     h->mc.mc_luma( pix1[i], bw, m1->p_fref, m1->i_stride[0], om1x+dx, om1y+dy, bw, bh ); 
  725. }
  726. #define BIME_CACHE2(a,b) 
  727.     BIME_CACHE(a,b) 
  728.     BIME_CACHE(-(a),-(b))
  729. #define COST_BIMV_SATD( m0x, m0y, m1x, m1y ) 
  730. if( pass == 0 || !((visited[(m0x)&7][(m0y)&7][(m1x)&7] & (1<<((m1y)&7)))) ) 
  731.     int cost; 
  732.     int i0 = 4 + 3*(m0x-om0x) + (m0y-om0y); 
  733.     int i1 = 4 + 3*(m1x-om1x) + (m1y-om1y); 
  734.     visited[(m0x)&7][(m0y)&7][(m1x)&7] |= (1<<((m1y)&7));
  735.     h->mc.memcpy_aligned( pix, pix0[i0], bs ); 
  736.     if( i_weight == 32 ) 
  737.         h->mc.avg[i_pixel]( pix, bw, pix1[i1], bw ); 
  738.     else 
  739.         h->mc.avg_weight[i_pixel]( pix, bw, pix1[i1], bw, i_weight ); 
  740.     cost = h->pixf.mbcmp[i_pixel]( m0->p_fenc[0], FENC_STRIDE, pix, bw ) 
  741.          + p_cost_m0x[ m0x ] + p_cost_m0y[ m0y ] 
  742.          + p_cost_m1x[ m1x ] + p_cost_m1y[ m1y ]; 
  743.     if( cost < bcost ) 
  744.     {                  
  745.         bcost = cost;  
  746.         bm0x = m0x;    
  747.         bm0y = m0y;    
  748.         bm1x = m1x;    
  749.         bm1y = m1y;    
  750.     } 
  751. }
  752. #define CHECK_BIDIR(a,b,c,d) 
  753.     COST_BIMV_SATD(om0x+a, om0y+b, om1x+c, om1y+d)
  754. #define CHECK_BIDIR2(a,b,c,d) 
  755.     CHECK_BIDIR(a,b,c,d) 
  756.     CHECK_BIDIR(-(a),-(b),-(c),-(d))
  757. #define CHECK_BIDIR8(a,b,c,d) 
  758.     CHECK_BIDIR2(a,b,c,d) 
  759.     CHECK_BIDIR2(b,c,d,a) 
  760.     CHECK_BIDIR2(c,d,a,b) 
  761.     CHECK_BIDIR2(d,a,b,c)
  762. int x264_me_refine_bidir( x264_t *h, x264_me_t *m0, x264_me_t *m1, int i_weight )
  763. {
  764.     const int i_pixel = m0->i_pixel;
  765.     const int bw = x264_pixel_size[i_pixel].w;
  766.     const int bh = x264_pixel_size[i_pixel].h;
  767.     const int bs = bw*bh;
  768.     const int16_t *p_cost_m0x = m0->p_cost_mv - x264_clip3( m0->mvp[0], h->mb.mv_min_spel[0], h->mb.mv_max_spel[0] );
  769.     const int16_t *p_cost_m0y = m0->p_cost_mv - x264_clip3( m0->mvp[1], h->mb.mv_min_spel[0], h->mb.mv_max_spel[0] );
  770.     const int16_t *p_cost_m1x = m1->p_cost_mv - x264_clip3( m1->mvp[0], h->mb.mv_min_spel[0], h->mb.mv_max_spel[0] );
  771.     const int16_t *p_cost_m1y = m1->p_cost_mv - x264_clip3( m1->mvp[1], h->mb.mv_min_spel[0], h->mb.mv_max_spel[0] );
  772.     DECLARE_ALIGNED_16( uint8_t pix0[9][16*16] );
  773.     DECLARE_ALIGNED_16( uint8_t pix1[9][16*16] );
  774.     DECLARE_ALIGNED_16( uint8_t pix[16*16] );
  775.     int bm0x = m0->mv[0], om0x = bm0x;
  776.     int bm0y = m0->mv[1], om0y = bm0y;
  777.     int bm1x = m1->mv[0], om1x = bm1x;
  778.     int bm1y = m1->mv[1], om1y = bm1y;
  779.     int bcost = COST_MAX;
  780.     int pass = 0;
  781.     /* each byte of visited represents 8 possible m1y positions, so a 4D array isn't needed */
  782.     uint8_t visited[8][8][8];
  783.     h->mc.memzero_aligned( visited, sizeof(visited) );
  784.     BIME_CACHE( 0, 0 );
  785.     CHECK_BIDIR( 0, 0, 0, 0 );
  786.     if( bm0y > h->mb.mv_max_spel[1] - 8 ||
  787.         bm1y > h->mb.mv_max_spel[1] - 8 )
  788.         return bcost;
  789.     for( pass = 0; pass < 8; pass++ )
  790.     {
  791.         /* check all mv pairs that differ in at most 2 components from the current mvs. */
  792.         /* doesn't do chroma ME. this probably doesn't matter, as the gains
  793.          * from bidir ME are the same with and without chroma ME. */
  794.         BIME_CACHE2( 1, 0 );
  795.         BIME_CACHE2( 0, 1 );
  796.         BIME_CACHE2( 1, 1 );
  797.         BIME_CACHE2( 1,-1 );
  798.         CHECK_BIDIR8( 0, 0, 0, 1 );
  799.         CHECK_BIDIR8( 0, 0, 1, 1 );
  800.         CHECK_BIDIR2( 0, 1, 0, 1 );
  801.         CHECK_BIDIR2( 1, 0, 1, 0 );
  802.         CHECK_BIDIR8( 0, 0,-1, 1 );
  803.         CHECK_BIDIR2( 0,-1, 0, 1 );
  804.         CHECK_BIDIR2(-1, 0, 1, 0 );
  805.         if( om0x == bm0x && om0y == bm0y && om1x == bm1x && om1y == bm1y )
  806.             break;
  807.         om0x = bm0x;
  808.         om0y = bm0y;
  809.         om1x = bm1x;
  810.         om1y = bm1y;
  811.         BIME_CACHE( 0, 0 );
  812.     }
  813.     m0->mv[0] = bm0x;
  814.     m0->mv[1] = bm0y;
  815.     m1->mv[0] = bm1x;
  816.     m1->mv[1] = bm1y;
  817.     return bcost;
  818. }
  819. #undef COST_MV_SATD
  820. #define COST_MV_SATD( mx, my, dst ) 
  821.     int stride = 16; 
  822.     uint8_t *src = h->mc.get_ref( pix, &stride, m->p_fref, m->i_stride[0], mx, my, bw*4, bh*4 ); 
  823.     dst = h->pixf.mbcmp_unaligned[i_pixel]( m->p_fenc[0], FENC_STRIDE, src, stride ) 
  824.         + p_cost_mvx[mx] + p_cost_mvy[my]; 
  825.     COPY1_IF_LT( bsatd, dst ); 
  826. }
  827. #define COST_MV_RD( mx, my, satd, do_dir, mdir ) 
  828.     if( satd <= bsatd * SATD_THRESH )
  829.     { 
  830.         uint64_t cost; 
  831.         *(uint32_t*)cache_mv = *(uint32_t*)cache_mv2 = pack16to32_mask(mx,my); 
  832.         cost = x264_rd_cost_part( h, i_lambda2, i8, m->i_pixel ); 
  833.         COPY4_IF_LT( bcost, cost, bmx, mx, bmy, my, dir, do_dir?mdir:dir ); 
  834.     } 
  835. }
  836. #define SATD_THRESH 17/16
  837. void x264_me_refine_qpel_rd( x264_t *h, x264_me_t *m, int i_lambda2, int i8 )
  838. {
  839.     // don't have to fill the whole mv cache rectangle
  840.     static const int pixel_mv_offs[] = { 0, 4, 4*8, 0 };
  841.     int16_t *cache_mv = h->mb.cache.mv[0][x264_scan8[i8*4]];
  842.     int16_t *cache_mv2 = cache_mv + pixel_mv_offs[m->i_pixel];
  843.     const int16_t *p_cost_mvx, *p_cost_mvy;
  844.     const int bw = x264_pixel_size[m->i_pixel].w>>2;
  845.     const int bh = x264_pixel_size[m->i_pixel].h>>2;
  846.     const int i_pixel = m->i_pixel;
  847.     DECLARE_ALIGNED_16( uint8_t pix[16*16] );
  848.     uint64_t bcost = m->i_pixel == PIXEL_16x16 ? m->cost : COST_MAX64;
  849.     int bmx = m->mv[0];
  850.     int bmy = m->mv[1];
  851.     int omx = bmx;
  852.     int omy = bmy;
  853.     int pmx, pmy, i, j;
  854.     unsigned bsatd;
  855.     int satd = 0;
  856.     int dir = -2;
  857.     int satds[8];
  858.     if( m->i_pixel != PIXEL_16x16 && i8 != 0 )
  859.         x264_mb_predict_mv( h, 0, i8*4, bw, m->mvp );
  860.     pmx = m->mvp[0];
  861.     pmy = m->mvp[1];
  862.     p_cost_mvx = m->p_cost_mv - pmx;
  863.     p_cost_mvy = m->p_cost_mv - pmy;
  864.     COST_MV_SATD( bmx, bmy, bsatd );
  865.     COST_MV_RD( bmx, bmy, 0, 0, 0 );
  866.     /* check the predicted mv */
  867.     if( (bmx != pmx || bmy != pmy)
  868.         && pmx >= h->mb.mv_min_spel[0] && pmx <= h->mb.mv_max_spel[0]
  869.         && pmy >= h->mb.mv_min_spel[1] && pmy <= h->mb.mv_max_spel[1] )
  870.     {
  871.         COST_MV_SATD( pmx, pmy, satd );
  872.         COST_MV_RD( pmx, pmy, satd, 0,0 );
  873.     }
  874.     /* subpel hex search, same pattern as ME HEX. */
  875.     dir = -2;
  876.     omx = bmx;
  877.     omy = bmy;
  878.     for( j=0; j<6; j++ ) COST_MV_SATD( omx + hex2[j+1][0], omy + hex2[j+1][1], satds[j] );
  879.     for( j=0; j<6; j++ ) COST_MV_RD  ( omx + hex2[j+1][0], omy + hex2[j+1][1], satds[j], 1,j );
  880.     if( dir != -2 )
  881.     {
  882.         /* half hexagon, not overlapping the previous iteration */
  883.         for( i = 1; i < 10; i++ )
  884.         {
  885.             const int odir = mod6m1[dir+1];
  886.             if( bmy > h->mb.mv_max_spel[1] - 2 ||
  887.                 bmy < h->mb.mv_min_spel[1] - 2 )
  888.                 break;
  889.             dir = -2;
  890.             omx = bmx;
  891.             omy = bmy;
  892.             for( j=0; j<3; j++ ) COST_MV_SATD( omx + hex2[odir+j][0], omy + hex2[odir+j][1], satds[j] );
  893.             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 );
  894.             if( dir == -2 )
  895.                 break;
  896.         }
  897.     }
  898.     /* square refine, same as pattern as ME HEX. */
  899.     omx = bmx;
  900.     omy = bmy;
  901.     for( i=0; i<8; i++ ) COST_MV_SATD( omx + square1[i][0], omy  + square1[i][1], satds[i] );
  902.     for( i=0; i<8; i++ ) COST_MV_RD  ( omx + square1[i][0], omy  + square1[i][1], satds[i], 0,0 );
  903.     bmy = x264_clip3( bmy, h->mb.mv_min_spel[1],  h->mb.mv_max_spel[1] );
  904.     m->cost = bcost;
  905.     m->mv[0] = bmx;
  906.     m->mv[1] = bmy;
  907.     x264_macroblock_cache_mv ( h, 2*(i8&1), i8&2, bw, bh, 0, pack16to32_mask(bmx, bmy) );
  908.     x264_macroblock_cache_mvd( h, 2*(i8&1), i8&2, bw, bh, 0, pack16to32_mask(bmx - pmx, bmy - pmy) );
  909. }