1 /*****************************************************************************
2 * me.c: h264 encoder library (Motion Estimation)
3 *****************************************************************************
4 * Copyright (C) 2003 Laurent Aimar
5 * $Id: me.c,v 1.1 2004/06/03 19:27:08 fenrir Exp $
7 * Authors: Laurent Aimar <fenrir@via.ecp.fr>
8 * Loren Merritt <lorenm@u.washington.edu>
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.
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.
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., 59 Temple Place - Suite 330, Boston, MA 02111, USA.
23 *****************************************************************************/
25 #include "common/common.h"
28 /* presets selected from good points on the speed-vs-quality curve of several test videos
29 * subpel_iters[i_subpel_refine] = { refine_hpel, refine_qpel, me_hpel, me_qpel }
30 * where me_* are the number of EPZS iterations run on all candidate block types,
31 * and refine_* are run only on the winner.
32 * the subme=7 values are much higher because any amount of satd search makes
33 * up its time by reducing the number of rd iterations. */
34 static const int subpel_iterations[][4] =
45 static const int mod6m1[8] = {5,0,1,2,3,4,5,0};
46 /* radius 2 hexagon. repeated entries are to avoid having to compute mod6 every time. */
47 static const int hex2[8][2] = {{-1,-2}, {-2,0}, {-1,2}, {1,2}, {2,0}, {1,-2}, {-1,-2}, {-2,0}};
48 static const int square1[8][2] = {{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 );
52 #define BITS_MVD( mx, my )\
53 (p_cost_mvx[(mx)<<2] + p_cost_mvy[(my)<<2])
55 #define COST_MV( mx, my )\
57 int cost = h->pixf.fpelcmp[i_pixel]( m->p_fenc[0], FENC_STRIDE,\
58 &p_fref[(my)*m->i_stride[0]+(mx)], m->i_stride[0] )\
60 COPY3_IF_LT( bcost, cost, bmx, mx, bmy, my );\
63 #define COST_MV_HPEL( mx, my ) \
66 uint8_t *src = h->mc.get_ref( pix, &stride, m->p_fref, m->i_stride[0], mx, my, bw, bh ); \
67 int cost = h->pixf.fpelcmp[i_pixel]( m->p_fenc[0], FENC_STRIDE, src, stride ) \
68 + p_cost_mvx[ mx ] + p_cost_mvy[ my ]; \
69 COPY3_IF_LT( bpred_cost, cost, bpred_mx, mx, bpred_my, my ); \
72 #define COST_MV_X3_DIR( m0x, m0y, m1x, m1y, m2x, m2y, costs )\
74 uint8_t *pix_base = p_fref + bmx + bmy*m->i_stride[0];\
75 h->pixf.fpelcmp_x3[i_pixel]( m->p_fenc[0],\
76 pix_base + (m0x) + (m0y)*m->i_stride[0],\
77 pix_base + (m1x) + (m1y)*m->i_stride[0],\
78 pix_base + (m2x) + (m2y)*m->i_stride[0],\
79 m->i_stride[0], costs );\
80 (costs)[0] += BITS_MVD( bmx+(m0x), bmy+(m0y) );\
81 (costs)[1] += BITS_MVD( bmx+(m1x), bmy+(m1y) );\
82 (costs)[2] += BITS_MVD( bmx+(m2x), bmy+(m2y) );\
85 #define COST_MV_X4( m0x, m0y, m1x, m1y, m2x, m2y, m3x, m3y )\
87 uint8_t *pix_base = p_fref + omx + omy*m->i_stride[0];\
88 h->pixf.fpelcmp_x4[i_pixel]( m->p_fenc[0],\
89 pix_base + (m0x) + (m0y)*m->i_stride[0],\
90 pix_base + (m1x) + (m1y)*m->i_stride[0],\
91 pix_base + (m2x) + (m2y)*m->i_stride[0],\
92 pix_base + (m3x) + (m3y)*m->i_stride[0],\
93 m->i_stride[0], costs );\
94 costs[0] += BITS_MVD( omx+(m0x), omy+(m0y) );\
95 costs[1] += BITS_MVD( omx+(m1x), omy+(m1y) );\
96 costs[2] += BITS_MVD( omx+(m2x), omy+(m2y) );\
97 costs[3] += BITS_MVD( omx+(m3x), omy+(m3y) );\
98 COPY3_IF_LT( bcost, costs[0], bmx, omx+(m0x), bmy, omy+(m0y) );\
99 COPY3_IF_LT( bcost, costs[1], bmx, omx+(m1x), bmy, omy+(m1y) );\
100 COPY3_IF_LT( bcost, costs[2], bmx, omx+(m2x), bmy, omy+(m2y) );\
101 COPY3_IF_LT( bcost, costs[3], bmx, omx+(m3x), bmy, omy+(m3y) );\
104 #define COST_MV_X3_ABS( m0x, m0y, m1x, m1y, m2x, m2y )\
106 h->pixf.fpelcmp_x3[i_pixel]( m->p_fenc[0],\
107 p_fref + (m0x) + (m0y)*m->i_stride[0],\
108 p_fref + (m1x) + (m1y)*m->i_stride[0],\
109 p_fref + (m2x) + (m2y)*m->i_stride[0],\
110 m->i_stride[0], costs );\
111 costs[0] += p_cost_mvx[(m0x)<<2]; /* no cost_mvy */\
112 costs[1] += p_cost_mvx[(m1x)<<2];\
113 costs[2] += p_cost_mvx[(m2x)<<2];\
114 COPY3_IF_LT( bcost, costs[0], bmx, m0x, bmy, m0y );\
115 COPY3_IF_LT( bcost, costs[1], bmx, m1x, bmy, m1y );\
116 COPY3_IF_LT( bcost, costs[2], bmx, m2x, bmy, m2y );\
122 #define DIA1_ITER( mx, my )\
125 COST_MV_X4( 0,-1, 0,1, -1,0, 1,0 );\
128 #define CROSS( start, x_max, y_max )\
131 if( x_max <= X264_MIN(mv_x_max-omx, omx-mv_x_min) )\
132 for( ; i < x_max-2; i+=4 )\
133 COST_MV_X4( i,0, -i,0, i+2,0, -i-2,0 );\
134 for( ; i < x_max; i+=2 )\
136 if( omx+i <= mv_x_max )\
137 COST_MV( omx+i, omy );\
138 if( omx-i >= mv_x_min )\
139 COST_MV( omx-i, omy );\
142 if( y_max <= X264_MIN(mv_y_max-omy, omy-mv_y_min) )\
143 for( ; i < y_max-2; i+=4 )\
144 COST_MV_X4( 0,i, 0,-i, 0,i+2, 0,-i-2 );\
145 for( ; i < y_max; i+=2 )\
147 if( omy+i <= mv_y_max )\
148 COST_MV( omx, omy+i );\
149 if( omy-i >= mv_y_min )\
150 COST_MV( omx, omy-i );\
154 void x264_me_search_ref( x264_t *h, x264_me_t *m, int16_t (*mvc)[2], int i_mvc, int *p_halfpel_thresh )
156 const int bw = x264_pixel_size[m->i_pixel].w;
157 const int bh = x264_pixel_size[m->i_pixel].h;
158 const int i_pixel = m->i_pixel;
159 int i_me_range = h->param.analyse.i_me_range;
161 int bpred_mx = 0, bpred_my = 0, bpred_cost = COST_MAX;
162 int omx, omy, pmx, pmy;
163 uint8_t *p_fref = m->p_fref[0];
164 DECLARE_ALIGNED_16( uint8_t pix[16*16] );
170 int mv_x_min = h->mb.mv_min_fpel[0];
171 int mv_y_min = h->mb.mv_min_fpel[1];
172 int mv_x_max = h->mb.mv_max_fpel[0];
173 int mv_y_max = h->mb.mv_max_fpel[1];
175 #define CHECK_MVRANGE(mx,my) ( mx >= mv_x_min && mx <= mv_x_max && my >= mv_y_min && my <= mv_y_max )
177 const int16_t *p_cost_mvx = m->p_cost_mv - m->mvp[0];
178 const int16_t *p_cost_mvy = m->p_cost_mv - m->mvp[1];
180 bmx = x264_clip3( m->mvp[0], mv_x_min*4, mv_x_max*4 );
181 bmy = x264_clip3( m->mvp[1], mv_y_min*4, mv_y_max*4 );
182 pmx = ( bmx + 2 ) >> 2;
183 pmy = ( bmy + 2 ) >> 2;
186 /* try extra predictors if provided */
187 if( h->mb.i_subpel_refine >= 3 )
189 COST_MV_HPEL( bmx, bmy );
190 uint32_t bmv = pack16to32_mask(bmx,bmy);
193 if( *(uint32_t*)mvc[i] && (bmv - *(uint32_t*)mvc[i]) )
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 );
200 } while( i < i_mvc );
201 bmx = ( bpred_mx + 2 ) >> 2;
202 bmy = ( bpred_my + 2 ) >> 2;
209 /* Because we are rounding the predicted motion vector to fullpel, there will be
210 * an extra MV cost in 15 out of 16 cases. However, when the predicted MV is
211 * chosen as the best predictor, it is often the case that the subpel search will
212 * result in a vector at or next to the predicted motion vector. Therefore, it is
213 * sensible to remove the cost of the MV from the rounded MVP to avoid unfairly
214 * biasing against use of the predicted motion vector. */
215 bcost -= BITS_MVD( pmx, pmy );
218 int mx = (mvc[i][0] + 2) >> 2;
219 int my = (mvc[i][1] + 2) >> 2;
220 if( (mx | my) && ((mx-bmx) | (my-bmy)) )
222 mx = x264_clip3( mx, mv_x_min, mv_x_max );
223 my = x264_clip3( my, mv_y_min, mv_y_max );
227 } while( i < i_mvc );
231 switch( h->mb.i_me_method )
234 /* diamond search, radius 1 */
235 for( i = 0; i < i_me_range; i++ )
237 DIA1_ITER( bmx, bmy );
238 if( bmx == omx && bmy == omy )
240 if( !CHECK_MVRANGE(bmx, bmy) )
247 /* hexagon search, radius 2 */
249 for( i = 0; i < i_me_range/2; i++ )
251 omx = bmx; omy = bmy;
252 COST_MV( omx-2, omy );
253 COST_MV( omx-1, omy+2 );
254 COST_MV( omx+1, omy+2 );
255 COST_MV( omx+2, omy );
256 COST_MV( omx+1, omy-2 );
257 COST_MV( omx-1, omy-2 );
258 if( bmx == omx && bmy == omy )
260 if( !CHECK_MVRANGE(bmx, bmy) )
264 /* equivalent to the above, but eliminates duplicate candidates */
268 COST_MV_X3_DIR( -2,0, -1, 2, 1, 2, costs );
269 COST_MV_X3_DIR( 2,0, 1,-2, -1,-2, costs+3 );
270 COPY2_IF_LT( bcost, costs[0], dir, 0 );
271 COPY2_IF_LT( bcost, costs[1], dir, 1 );
272 COPY2_IF_LT( bcost, costs[2], dir, 2 );
273 COPY2_IF_LT( bcost, costs[3], dir, 3 );
274 COPY2_IF_LT( bcost, costs[4], dir, 4 );
275 COPY2_IF_LT( bcost, costs[5], dir, 5 );
279 bmx += hex2[dir+1][0];
280 bmy += hex2[dir+1][1];
281 /* half hexagon, not overlapping the previous iteration */
282 for( i = 1; i < i_me_range/2 && CHECK_MVRANGE(bmx, bmy); i++ )
284 const int odir = mod6m1[dir+1];
285 COST_MV_X3_DIR( hex2[odir+0][0], hex2[odir+0][1],
286 hex2[odir+1][0], hex2[odir+1][1],
287 hex2[odir+2][0], hex2[odir+2][1],
290 COPY2_IF_LT( bcost, costs[0], dir, odir-1 );
291 COPY2_IF_LT( bcost, costs[1], dir, odir );
292 COPY2_IF_LT( bcost, costs[2], dir, odir+1 );
295 bmx += hex2[dir+1][0];
296 bmy += hex2[dir+1][1];
301 omx = bmx; omy = bmy;
302 COST_MV_X4( 0,-1, 0,1, -1,0, 1,0 );
303 COST_MV_X4( -1,-1, -1,1, 1,-1, 1,1 );
308 /* Uneven-cross Multi-Hexagon-grid Search
309 * as in JM, except with different early termination */
311 static const int x264_pixel_size_shift[7] = { 0, 1, 1, 2, 3, 3, 4 };
316 /* refine predictors */
318 DIA1_ITER( pmx, pmy );
322 if(i_pixel == PIXEL_4x4)
326 if( (bmx | bmy) && ((bmx-pmx) | (bmy-pmy)) )
327 DIA1_ITER( bmx, bmy );
328 if( bcost == ucost2 )
330 omx = bmx; omy = bmy;
332 /* early termination */
333 #define SAD_THRESH(v) ( bcost < ( v >> x264_pixel_size_shift[i_pixel] ) )
334 if( bcost == ucost2 && SAD_THRESH(2000) )
336 COST_MV_X4( 0,-2, -1,-1, 1,-1, -2,0 );
337 COST_MV_X4( 2, 0, -1, 1, 1, 1, 0,2 );
338 if( bcost == ucost1 && SAD_THRESH(500) )
340 if( bcost == ucost2 )
342 int range = (i_me_range>>1) | 1;
343 CROSS( 3, range, range );
344 COST_MV_X4( -1,-2, 1,-2, -2,-1, 2,-1 );
345 COST_MV_X4( -2, 1, 2, 1, -1, 2, 1, 2 );
346 if( bcost == ucost2 )
348 cross_start = range + 2;
352 /* adaptive search range */
355 /* range multipliers based on casual inspection of some statistics of
356 * average distance between current predictor and final mv found by ESA.
357 * these have not been tuned much by actual encoding. */
358 static const int range_mul[4][4] =
366 int sad_ctx, mvd_ctx;
371 if( i_pixel == PIXEL_16x16 )
372 /* mvc is probably the same as mvp, so the difference isn't meaningful.
373 * but prediction usually isn't too bad, so just use medium range */
376 mvd = abs( m->mvp[0] - mvc[0][0] )
377 + abs( m->mvp[1] - mvc[0][1] );
381 /* calculate the degree of agreement between predictors. */
382 /* in 16x16, mvc includes all the neighbors used to make mvp,
383 * so don't count mvp separately. */
386 if( i_pixel != PIXEL_16x16 )
388 mvd = abs( m->mvp[0] - mvc[0][0] )
389 + abs( m->mvp[1] - mvc[0][1] );
392 for( i = 0; i < i_mvc-1; i++ )
393 mvd += abs( mvc[i][0] - mvc[i+1][0] )
394 + abs( mvc[i][1] - mvc[i+1][1] );
397 sad_ctx = SAD_THRESH(1000) ? 0
398 : SAD_THRESH(2000) ? 1
399 : SAD_THRESH(4000) ? 2 : 3;
400 mvd_ctx = mvd < 10*denom ? 0
402 : mvd < 40*denom ? 2 : 3;
404 i_me_range = i_me_range * range_mul[mvd_ctx][sad_ctx] / 4;
407 /* FIXME if the above DIA2/OCT2/CROSS found a new mv, it has not updated omx/omy.
408 * we are still centered on the same place as the DIA2. is this desirable? */
409 CROSS( cross_start, i_me_range, i_me_range/2 );
411 COST_MV_X4( -2,-2, -2,2, 2,-2, 2,2 );
414 omx = bmx; omy = bmy;
415 for( i = 1; i <= i_me_range/4; i++ )
417 static const int hex4[16][2] = {
418 {-4, 2}, {-4, 1}, {-4, 0}, {-4,-1}, {-4,-2},
419 { 4,-2}, { 4,-1}, { 4, 0}, { 4, 1}, { 4, 2},
420 { 2, 3}, { 0, 4}, {-2, 3},
421 {-2,-3}, { 0,-4}, { 2,-3},
424 if( 4*i > X264_MIN4( mv_x_max-omx, omx-mv_x_min,
425 mv_y_max-omy, omy-mv_y_min ) )
427 for( j = 0; j < 16; j++ )
429 int mx = omx + hex4[j][0]*i;
430 int my = omy + hex4[j][1]*i;
431 if( CHECK_MVRANGE(mx, my) )
437 COST_MV_X4( -4*i, 2*i, -4*i, 1*i, -4*i, 0*i, -4*i,-1*i );
438 COST_MV_X4( -4*i,-2*i, 4*i,-2*i, 4*i,-1*i, 4*i, 0*i );
439 COST_MV_X4( 4*i, 1*i, 4*i, 2*i, 2*i, 3*i, 0*i, 4*i );
440 COST_MV_X4( -2*i, 3*i, -2*i,-3*i, 0*i,-4*i, 2*i,-3*i );
443 if( bmy <= mv_y_max )
451 const int min_x = X264_MAX( bmx - i_me_range, mv_x_min );
452 const int min_y = X264_MAX( bmy - i_me_range, mv_y_min );
453 const int max_x = X264_MIN( bmx + i_me_range, mv_x_max );
454 const int max_y = X264_MIN( bmy + i_me_range, mv_y_max );
455 /* SEA is fastest in multiples of 4 */
456 const int width = (max_x - min_x + 3) & ~3;
459 /* plain old exhaustive search */
461 for( my = min_y; my <= max_y; my++ )
462 for( mx = min_x; mx <= max_x; mx++ )
465 /* successive elimination by comparing DC before a full SAD,
466 * because sum(abs(diff)) >= abs(diff(sum)). */
467 const int stride = m->i_stride[0];
468 uint16_t *sums_base = m->integral;
469 DECLARE_ALIGNED_16( static uint8_t zero[16*16] );
470 DECLARE_ALIGNED_16( int enc_dc[4] );
471 int sad_size = i_pixel <= PIXEL_8x8 ? PIXEL_8x8 : PIXEL_4x4;
472 int delta = x264_pixel_size[sad_size].w;
474 int16_t *xs = width<=64 ? xs_buf : x264_malloc( (width+15)*sizeof(int16_t) );
476 uint16_t *cost_fpel_mvx = x264_cost_mv_fpel[h->mb.i_qp][-m->mvp[0]&3] + (-m->mvp[0]>>2);
478 h->pixf.sad_x4[sad_size]( zero, m->p_fenc[0], m->p_fenc[0]+delta,
479 m->p_fenc[0]+delta*FENC_STRIDE, m->p_fenc[0]+delta+delta*FENC_STRIDE,
480 FENC_STRIDE, enc_dc );
482 sums_base += stride * (h->fenc->i_lines[0] + PADV*2);
483 if( i_pixel == PIXEL_16x16 || i_pixel == PIXEL_8x16 || i_pixel == PIXEL_4x8 )
485 if( i_pixel == PIXEL_8x16 || i_pixel == PIXEL_4x8 )
486 enc_dc[1] = enc_dc[2];
488 if( h->mb.i_me_method == X264_ME_TESA )
490 // ADS threshold, then SAD threshold, then keep the best few SADs, then SATD
495 mvsad_t *mvsads = x264_malloc( width*(max_y-min_y+1)*sizeof(mvsad_t) );
496 int nmvsad = 0, limit;
497 int sad_thresh = i_me_range <= 16 ? 10 : i_me_range <= 24 ? 11 : 12;
498 int bsad = h->pixf.sad[i_pixel]( m->p_fenc[0], FENC_STRIDE, p_fref+bmy*stride+bmx, stride )
499 + BITS_MVD( bmx, bmy );
500 for( my = min_y; my <= max_y; my++ )
502 int ycost = p_cost_mvy[my<<2];
506 xn = h->pixf.ads[i_pixel]( enc_dc, sums_base + min_x + my * stride, delta,
507 cost_fpel_mvx+min_x, xs, width, bsad*17/16 );
508 for( i=0; i<xn-2; i+=3 )
510 uint8_t *ref = p_fref+min_x+my*stride;
512 h->pixf.sad_x3[i_pixel]( m->p_fenc[0], ref+xs[i], ref+xs[i+1], ref+xs[i+2], stride, sads );
515 int sad = sads[j] + cost_fpel_mvx[xs[i+j]];
516 if( sad < bsad*sad_thresh>>3 )
518 COPY1_IF_LT( bsad, sad );
519 mvsads[nmvsad].sad = sad + ycost;
520 mvsads[nmvsad].mx = min_x+xs[i+j];
521 mvsads[nmvsad].my = my;
528 int mx = min_x+xs[i];
529 int sad = h->pixf.sad[i_pixel]( m->p_fenc[0], FENC_STRIDE, p_fref+mx+my*stride, stride )
530 + cost_fpel_mvx[xs[i]];
531 if( sad < bsad*sad_thresh>>3 )
533 COPY1_IF_LT( bsad, sad );
534 mvsads[nmvsad].sad = sad + ycost;
535 mvsads[nmvsad].mx = mx;
536 mvsads[nmvsad].my = my;
543 limit = i_me_range / 2;
544 if( nmvsad > limit*2 )
546 // halve the range if the domain is too large... eh, close enough
547 bsad = bsad*(sad_thresh+8)>>4;
548 for( i=0; i<nmvsad && mvsads[i].sad <= bsad; i++ );
549 for( j=i; j<nmvsad; j++ )
550 if( mvsads[j].sad <= bsad )
551 mvsads[i++] = mvsads[j];
556 for( i=0; i<limit; i++ )
559 int bsad = mvsads[bj].sad;
560 for( j=i+1; j<nmvsad; j++ )
561 COPY2_IF_LT( bsad, mvsads[j].sad, bj, j );
563 XCHG( mvsad_t, mvsads[i], mvsads[bj] );
567 for( i=0; i<nmvsad; i++ )
568 COST_MV( mvsads[i].mx, mvsads[i].my );
574 for( my = min_y; my <= max_y; my++ )
576 int ycost = p_cost_mvy[my<<2];
580 xn = h->pixf.ads[i_pixel]( enc_dc, sums_base + min_x + my * stride, delta,
581 cost_fpel_mvx+min_x, xs, width, bcost );
582 for( i=0; i<xn-2; i+=3 )
583 COST_MV_X3_ABS( min_x+xs[i],my, min_x+xs[i+1],my, min_x+xs[i+2],my );
586 COST_MV( min_x+xs[i], my );
598 if( bpred_cost < bcost )
602 m->cost = bpred_cost;
611 /* compute the real cost */
612 m->cost_mv = p_cost_mvx[ m->mv[0] ] + p_cost_mvy[ m->mv[1] ];
613 if( bmx == pmx && bmy == pmy && h->mb.i_subpel_refine < 3 )
614 m->cost += m->cost_mv;
617 if( h->mb.i_subpel_refine >= 2 )
619 int hpel = subpel_iterations[h->mb.i_subpel_refine][2];
620 int qpel = subpel_iterations[h->mb.i_subpel_refine][3];
621 refine_subpel( h, m, hpel, qpel, p_halfpel_thresh, 0 );
623 else if( m->mv[1] > h->mb.mv_max_spel[1] )
624 m->mv[1] = h->mb.mv_max_spel[1];
628 void x264_me_refine_qpel( x264_t *h, x264_me_t *m )
630 int hpel = subpel_iterations[h->mb.i_subpel_refine][0];
631 int qpel = subpel_iterations[h->mb.i_subpel_refine][1];
633 if( m->i_pixel <= PIXEL_8x8 && h->sh.i_type == SLICE_TYPE_P )
634 m->cost -= m->i_ref_cost;
636 refine_subpel( h, m, hpel, qpel, NULL, 1 );
639 #define COST_MV_SAD( mx, my ) \
642 uint8_t *src = h->mc.get_ref( pix[0], &stride, m->p_fref, m->i_stride[0], mx, my, bw, bh ); \
643 int cost = h->pixf.fpelcmp[i_pixel]( m->p_fenc[0], FENC_STRIDE, src, stride ) \
644 + p_cost_mvx[ mx ] + p_cost_mvy[ my ]; \
645 COPY3_IF_LT( bcost, cost, bmx, mx, bmy, my ); \
648 #define COST_MV_SATD( mx, my, dir ) \
649 if( b_refine_qpel || (dir^1) != odir ) \
652 uint8_t *src = h->mc.get_ref( pix[0], &stride, m->p_fref, m->i_stride[0], mx, my, bw, bh ); \
653 int cost = h->pixf.mbcmp[i_pixel]( m->p_fenc[0], FENC_STRIDE, src, stride ) \
654 + p_cost_mvx[ mx ] + p_cost_mvy[ my ]; \
655 if( b_chroma_me && cost < bcost ) \
657 h->mc.mc_chroma( pix[0], 8, m->p_fref[4], m->i_stride[1], mx, my, bw/2, bh/2 ); \
658 cost += h->pixf.mbcmp[i_pixel+3]( m->p_fenc[1], FENC_STRIDE, pix[0], 8 ); \
661 h->mc.mc_chroma( pix[0], 8, m->p_fref[5], m->i_stride[1], mx, my, bw/2, bh/2 ); \
662 cost += h->pixf.mbcmp[i_pixel+3]( m->p_fenc[2], FENC_STRIDE, pix[0], 8 ); \
674 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 )
676 const int bw = x264_pixel_size[m->i_pixel].w;
677 const int bh = x264_pixel_size[m->i_pixel].h;
678 const int16_t *p_cost_mvx = m->p_cost_mv - m->mvp[0];
679 const int16_t *p_cost_mvy = m->p_cost_mv - m->mvp[1];
680 const int i_pixel = m->i_pixel;
681 const int b_chroma_me = h->mb.b_chroma_me && i_pixel <= PIXEL_8x8;
683 DECLARE_ALIGNED_16( uint8_t pix[2][32*18] ); // really 17x17, but round up for alignment
693 /* try the subpel component of the predicted mv */
694 if( hpel_iters && h->mb.i_subpel_refine < 3 )
696 int mx = x264_clip3( m->mvp[0], h->mb.mv_min_spel[0], h->mb.mv_max_spel[0] );
697 int my = x264_clip3( m->mvp[1], h->mb.mv_min_spel[1], h->mb.mv_max_spel[1] );
698 if( mx != bmx || my != bmy )
699 COST_MV_SAD( mx, my );
702 /* halfpel diamond search */
703 for( i = hpel_iters; i > 0; i-- )
705 int omx = bmx, omy = bmy;
707 int stride = 32; // candidates are either all hpel or all qpel, so one stride is enough
708 uint8_t *src0, *src1, *src2, *src3;
709 src0 = h->mc.get_ref( pix[0], &stride, m->p_fref, m->i_stride[0], omx, omy-2, bw, bh+1 );
710 src2 = h->mc.get_ref( pix[1], &stride, m->p_fref, m->i_stride[0], omx-2, omy, bw+4, bh );
711 src1 = src0 + stride;
713 h->pixf.fpelcmp_x4[i_pixel]( m->p_fenc[0], src0, src1, src2, src3, stride, costs );
714 COPY2_IF_LT( bcost, costs[0] + p_cost_mvx[omx ] + p_cost_mvy[omy-2], bmy, omy-2 );
715 COPY2_IF_LT( bcost, costs[1] + p_cost_mvx[omx ] + p_cost_mvy[omy+2], bmy, omy+2 );
716 COPY3_IF_LT( bcost, costs[2] + p_cost_mvx[omx-2] + p_cost_mvy[omy ], bmx, omx-2, bmy, omy );
717 COPY3_IF_LT( bcost, costs[3] + p_cost_mvx[omx+2] + p_cost_mvy[omy ], bmx, omx+2, bmy, omy );
718 if( bmx == omx && bmy == omy )
724 /* check for mvrange */
725 if( bmy > h->mb.mv_max_spel[1] )
726 bmy = h->mb.mv_max_spel[1];
728 COST_MV_SATD( bmx, bmy, -1 );
731 /* early termination when examining multiple reference frames */
732 if( p_halfpel_thresh )
734 if( (bcost*7)>>3 > *p_halfpel_thresh )
739 // don't need cost_mv
742 else if( bcost < *p_halfpel_thresh )
743 *p_halfpel_thresh = bcost;
746 /* quarterpel diamond search */
748 for( i = qpel_iters; i > 0; i-- )
753 COST_MV_SATD( omx, omy - 1, 0 );
754 COST_MV_SATD( omx, omy + 1, 1 );
755 COST_MV_SATD( omx - 1, omy, 2 );
756 COST_MV_SATD( omx + 1, omy, 3 );
757 if( bmx == omx && bmy == omy )
761 /* check for mvrange */
762 if( bmy > h->mb.mv_max_spel[1] )
764 bmy = h->mb.mv_max_spel[1];
766 COST_MV_SATD( bmx, bmy, -1 );
772 m->cost_mv = p_cost_mvx[ bmx ] + p_cost_mvy[ bmy ];
775 #define BIME_CACHE( dx, dy ) \
777 int i = 4 + 3*dx + dy; \
778 h->mc.mc_luma( pix0[i], bw, m0->p_fref, m0->i_stride[0], om0x+dx, om0y+dy, bw, bh ); \
779 h->mc.mc_luma( pix1[i], bw, m1->p_fref, m1->i_stride[0], om1x+dx, om1y+dy, bw, bh ); \
782 #define BIME_CACHE2(a,b) \
784 BIME_CACHE(-(a),-(b))
786 #define COST_BIMV_SATD( m0x, m0y, m1x, m1y ) \
787 if( pass == 0 || !visited[(m0x)&7][(m0y)&7][(m1x)&7][(m1y)&7] ) \
790 int i0 = 4 + 3*(m0x-om0x) + (m0y-om0y); \
791 int i1 = 4 + 3*(m1x-om1x) + (m1y-om1y); \
792 visited[(m0x)&7][(m0y)&7][(m1x)&7][(m1y)&7] = 1; \
793 h->mc.memcpy_aligned( pix, pix0[i0], bs ); \
794 if( i_weight == 32 ) \
795 h->mc.avg[i_pixel]( pix, bw, pix1[i1], bw ); \
797 h->mc.avg_weight[i_pixel]( pix, bw, pix1[i1], bw, i_weight ); \
798 cost = h->pixf.mbcmp[i_pixel]( m0->p_fenc[0], FENC_STRIDE, pix, bw ) \
799 + p_cost_m0x[ m0x ] + p_cost_m0y[ m0y ] \
800 + p_cost_m1x[ m1x ] + p_cost_m1y[ m1y ]; \
811 #define CHECK_BIDIR(a,b,c,d) \
812 COST_BIMV_SATD(om0x+a, om0y+b, om1x+c, om1y+d)
814 #define CHECK_BIDIR2(a,b,c,d) \
815 CHECK_BIDIR(a,b,c,d) \
816 CHECK_BIDIR(-(a),-(b),-(c),-(d))
818 #define CHECK_BIDIR8(a,b,c,d) \
819 CHECK_BIDIR2(a,b,c,d) \
820 CHECK_BIDIR2(b,c,d,a) \
821 CHECK_BIDIR2(c,d,a,b) \
822 CHECK_BIDIR2(d,a,b,c)
824 int x264_me_refine_bidir( x264_t *h, x264_me_t *m0, x264_me_t *m1, int i_weight )
826 const int i_pixel = m0->i_pixel;
827 const int bw = x264_pixel_size[i_pixel].w;
828 const int bh = x264_pixel_size[i_pixel].h;
829 const int bs = bw*bh;
830 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] );
831 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] );
832 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] );
833 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] );
834 DECLARE_ALIGNED_16( uint8_t pix0[9][16*16] );
835 DECLARE_ALIGNED_16( uint8_t pix1[9][16*16] );
836 DECLARE_ALIGNED_16( uint8_t pix[16*16] );
837 int bm0x = m0->mv[0], om0x = bm0x;
838 int bm0y = m0->mv[1], om0y = bm0y;
839 int bm1x = m1->mv[0], om1x = bm1x;
840 int bm1y = m1->mv[1], om1y = bm1y;
841 int bcost = COST_MAX;
843 uint8_t visited[8][8][8][8];
844 h->mc.memzero_aligned( visited, sizeof(visited) );
847 CHECK_BIDIR( 0, 0, 0, 0 );
849 if( bm0y > h->mb.mv_max_spel[1] - 8 ||
850 bm1y > h->mb.mv_max_spel[1] - 8 )
853 for( pass = 0; pass < 8; pass++ )
855 /* check all mv pairs that differ in at most 2 components from the current mvs. */
856 /* doesn't do chroma ME. this probably doesn't matter, as the gains
857 * from bidir ME are the same with and without chroma ME. */
864 CHECK_BIDIR8( 0, 0, 0, 1 );
865 CHECK_BIDIR8( 0, 0, 1, 1 );
866 CHECK_BIDIR2( 0, 1, 0, 1 );
867 CHECK_BIDIR2( 1, 0, 1, 0 );
868 CHECK_BIDIR8( 0, 0,-1, 1 );
869 CHECK_BIDIR2( 0,-1, 0, 1 );
870 CHECK_BIDIR2(-1, 0, 1, 0 );
872 if( om0x == bm0x && om0y == bm0y && om1x == bm1x && om1y == bm1y )
890 #define COST_MV_SATD( mx, my, dst ) \
893 uint8_t *src = h->mc.get_ref( pix, &stride, m->p_fref, m->i_stride[0], mx, my, bw*4, bh*4 ); \
894 dst = h->pixf.mbcmp[i_pixel]( m->p_fenc[0], FENC_STRIDE, src, stride ) \
895 + p_cost_mvx[mx] + p_cost_mvy[my]; \
896 COPY1_IF_LT( bsatd, dst ); \
899 #define COST_MV_RD( mx, my, satd, do_dir, mdir ) \
901 if( satd <= bsatd * SATD_THRESH )\
904 cache_mv[0] = cache_mv2[0] = mx; \
905 cache_mv[1] = cache_mv2[1] = my; \
906 cost = x264_rd_cost_part( h, i_lambda2, i8, m->i_pixel ); \
907 COPY4_IF_LT( bcost, cost, bmx, mx, bmy, my, dir, do_dir?mdir:dir ); \
911 #define SATD_THRESH 17/16
913 void x264_me_refine_qpel_rd( x264_t *h, x264_me_t *m, int i_lambda2, int i8 )
915 // don't have to fill the whole mv cache rectangle
916 static const int pixel_mv_offs[] = { 0, 4, 4*8, 0 };
917 int16_t *cache_mv = h->mb.cache.mv[0][x264_scan8[i8*4]];
918 int16_t *cache_mv2 = cache_mv + pixel_mv_offs[m->i_pixel];
919 const int16_t *p_cost_mvx, *p_cost_mvy;
920 const int bw = x264_pixel_size[m->i_pixel].w>>2;
921 const int bh = x264_pixel_size[m->i_pixel].h>>2;
922 const int i_pixel = m->i_pixel;
924 DECLARE_ALIGNED_16( uint8_t pix[16*16] );
925 int bcost = m->i_pixel == PIXEL_16x16 ? m->cost : COST_MAX;
936 if( m->i_pixel != PIXEL_16x16 && i8 != 0 )
937 x264_mb_predict_mv( h, 0, i8*4, bw, m->mvp );
940 p_cost_mvx = m->p_cost_mv - pmx;
941 p_cost_mvy = m->p_cost_mv - pmy;
942 COST_MV_SATD( bmx, bmy, bsatd );
943 COST_MV_RD( bmx, bmy, 0, 0, 0);
945 /* check the predicted mv */
946 if( (bmx != pmx || bmy != pmy)
947 && pmx >= h->mb.mv_min_spel[0] && pmx <= h->mb.mv_max_spel[0]
948 && pmy >= h->mb.mv_min_spel[1] && pmy <= h->mb.mv_max_spel[1] )
950 COST_MV_SATD( pmx, pmy, satd );
951 COST_MV_RD( pmx, pmy, satd, 0,0 );
954 /* subpel hex search, same pattern as ME HEX. */
958 for( j=0; j<6; j++ ) COST_MV_SATD( omx + hex2[j+1][0], omy + hex2[j+1][1], satds[j] );
959 for( j=0; j<6; j++ ) COST_MV_RD ( omx + hex2[j+1][0], omy + hex2[j+1][1], satds[j], 1,j );
962 /* half hexagon, not overlapping the previous iteration */
963 for( i = 1; i < 10; i++ )
965 const int odir = mod6m1[dir+1];
966 if( bmy > h->mb.mv_max_spel[1] - 2 ||
967 bmy < h->mb.mv_min_spel[1] - 2 )
972 for( j=0; j<3; j++ ) COST_MV_SATD( omx + hex2[odir+j][0], omy + hex2[odir+j][1], satds[j] );
973 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 );
979 /* square refine, same as pattern as ME HEX. */
982 for( i=0; i<8; i++ ) COST_MV_SATD( omx + square1[i][0], omy + square1[i][1], satds[i] );
983 for( i=0; i<8; i++ ) COST_MV_RD ( omx + square1[i][0], omy + square1[i][1], satds[i], 0,0 );
985 bmy = x264_clip3( bmy, h->mb.mv_min_spel[1], h->mb.mv_max_spel[1] );
989 x264_macroblock_cache_mv ( h, 2*(i8&1), i8&2, bw, bh, 0, pack16to32_mask(bmx, bmy) );
990 x264_macroblock_cache_mvd( h, 2*(i8&1), i8&2, bw, bh, 0, pack16to32_mask(bmx - pmx, bmy - pmy) );