Bugfix for error accumulator stats
[profile/ivi/libvpx.git] / vp8 / encoder / pickinter.c
1 /*
2  *  Copyright (c) 2010 The WebM project authors. All Rights Reserved.
3  *
4  *  Use of this source code is governed by a BSD-style license
5  *  that can be found in the LICENSE file in the root of the source
6  *  tree. An additional intellectual property rights grant can be found
7  *  in the file PATENTS.  All contributing project authors may
8  *  be found in the AUTHORS file in the root of the source tree.
9  */
10
11
12 #include <limits.h>
13 #include "vpx_ports/config.h"
14 #include "onyx_int.h"
15 #include "modecosts.h"
16 #include "encodeintra.h"
17 #include "vp8/common/entropymode.h"
18 #include "pickinter.h"
19 #include "vp8/common/findnearmv.h"
20 #include "encodemb.h"
21 #include "vp8/common/reconinter.h"
22 #include "vp8/common/reconintra.h"
23 #include "vp8/common/reconintra4x4.h"
24 #include "vp8/common/g_common.h"
25 #include "variance.h"
26 #include "mcomp.h"
27 #include "rdopt.h"
28 #include "vpx_mem/vpx_mem.h"
29
30 #if CONFIG_RUNTIME_CPU_DETECT
31 #define IF_RTCD(x) (x)
32 #else
33 #define IF_RTCD(x)  NULL
34 #endif
35
36 extern int VP8_UVSSE(MACROBLOCK *x, const vp8_variance_rtcd_vtable_t *rtcd);
37
38 #ifdef SPEEDSTATS
39 extern unsigned int cnt_pm;
40 #endif
41
42 extern const MV_REFERENCE_FRAME vp8_ref_frame_order[MAX_MODES];
43 extern const MB_PREDICTION_MODE vp8_mode_order[MAX_MODES];
44
45
46 extern unsigned int (*vp8_get16x16pred_error)(unsigned char *src_ptr, int src_stride, unsigned char *ref_ptr, int ref_stride);
47 extern unsigned int (*vp8_get4x4sse_cs)(unsigned char *src_ptr, int  source_stride, unsigned char *ref_ptr, int  recon_stride);
48 extern int vp8_rd_pick_best_mbsegmentation(VP8_COMP *cpi, MACROBLOCK *x, MV *best_ref_mv, int best_rd, int *, int *, int *, int, int *mvcost[2], int, int fullpixel);
49 extern int vp8_cost_mv_ref(MB_PREDICTION_MODE m, const int near_mv_ref_ct[4]);
50 extern void vp8_set_mbmode_and_mvs(MACROBLOCK *x, MB_PREDICTION_MODE mb, MV *mv);
51
52
53 int vp8_skip_fractional_mv_step(MACROBLOCK *mb, BLOCK *b, BLOCKD *d, MV *bestmv, MV *ref_mv, int error_per_bit, const vp8_variance_fn_ptr_t *vfp, int *mvcost[2])
54 {
55     (void) b;
56     (void) d;
57     (void) ref_mv;
58     (void) error_per_bit;
59     (void) vfp;
60     (void) mvcost;
61     bestmv->row <<= 3;
62     bestmv->col <<= 3;
63     return 0;
64 }
65
66
67 static int get_inter_mbpred_error(MACROBLOCK *mb, const vp8_variance_fn_ptr_t *vfp, unsigned int *sse)
68 {
69
70     BLOCK *b = &mb->block[0];
71     BLOCKD *d = &mb->e_mbd.block[0];
72     unsigned char *what = (*(b->base_src) + b->src);
73     int what_stride = b->src_stride;
74     unsigned char *in_what = *(d->base_pre) + d->pre ;
75     int in_what_stride = d->pre_stride;
76     int xoffset = d->bmi.mv.as_mv.col & 7;
77     int yoffset = d->bmi.mv.as_mv.row & 7;
78
79     in_what += (d->bmi.mv.as_mv.row >> 3) * d->pre_stride + (d->bmi.mv.as_mv.col >> 3);
80
81     if (xoffset | yoffset)
82     {
83         return vfp->svf(in_what, in_what_stride, xoffset, yoffset, what, what_stride, sse);
84     }
85     else
86     {
87         return vfp->vf(what, what_stride, in_what, in_what_stride, sse);
88     }
89
90 }
91
92 unsigned int vp8_get16x16pred_error_c
93 (
94     const unsigned char *src_ptr,
95     int src_stride,
96     const unsigned char *ref_ptr,
97     int ref_stride,
98     int max_sad
99 )
100 {
101     unsigned pred_error = 0;
102     int i, j;
103     int sum = 0;
104
105     for (i = 0; i < 16; i++)
106     {
107         int diff;
108
109         for (j = 0; j < 16; j++)
110         {
111             diff = src_ptr[j] - ref_ptr[j];
112             sum += diff;
113             pred_error += diff * diff;
114         }
115
116         src_ptr += src_stride;
117         ref_ptr += ref_stride;
118     }
119
120     pred_error -= sum * sum / 256;
121     return pred_error;
122 }
123
124
125 unsigned int vp8_get4x4sse_cs_c
126 (
127     const unsigned char *src_ptr,
128     int  source_stride,
129     const unsigned char *ref_ptr,
130     int  recon_stride,
131     int max_sad
132 )
133 {
134     int distortion = 0;
135     int r, c;
136
137     for (r = 0; r < 4; r++)
138     {
139         for (c = 0; c < 4; c++)
140         {
141             int diff = src_ptr[c] - ref_ptr[c];
142             distortion += diff * diff;
143         }
144
145         src_ptr += source_stride;
146         ref_ptr += recon_stride;
147     }
148
149     return distortion;
150 }
151
152 static int get_prediction_error(BLOCK *be, BLOCKD *b, const vp8_variance_rtcd_vtable_t *rtcd)
153 {
154     unsigned char *sptr;
155     unsigned char *dptr;
156     sptr = (*(be->base_src) + be->src);
157     dptr = b->predictor;
158
159     return VARIANCE_INVOKE(rtcd, get4x4sse_cs)(sptr, be->src_stride, dptr, 16, 0x7fffffff);
160
161 }
162
163 static int pick_intra4x4block(
164     const VP8_ENCODER_RTCD *rtcd,
165     MACROBLOCK *x,
166     BLOCK *be,
167     BLOCKD *b,
168     B_PREDICTION_MODE *best_mode,
169     B_PREDICTION_MODE above,
170     B_PREDICTION_MODE left,
171
172     int *bestrate,
173     int *bestdistortion)
174 {
175     B_PREDICTION_MODE mode;
176     int best_rd = INT_MAX;       // 1<<30
177     int rate;
178     int distortion;
179     unsigned int *mode_costs;
180
181     if (x->e_mbd.frame_type == KEY_FRAME)
182     {
183         mode_costs = x->bmode_costs[above][left];
184     }
185     else
186     {
187         mode_costs = x->inter_bmode_costs;
188     }
189
190     for (mode = B_DC_PRED; mode <= B_HE_PRED /*B_HU_PRED*/; mode++)
191     {
192         int this_rd;
193
194         rate = mode_costs[mode];
195         vp8_predict_intra4x4(b, mode, b->predictor);
196         distortion = get_prediction_error(be, b, &rtcd->variance);
197         this_rd = RD_ESTIMATE(x->rdmult, x->rddiv, rate, distortion);
198
199         if (this_rd < best_rd)
200         {
201             *bestrate = rate;
202             *bestdistortion = distortion;
203             best_rd = this_rd;
204             *best_mode = mode;
205         }
206     }
207
208     b->bmi.mode = (B_PREDICTION_MODE)(*best_mode);
209     vp8_encode_intra4x4block(rtcd, x, be, b, b->bmi.mode);
210
211     return best_rd;
212 }
213
214
215 int vp8_pick_intra4x4mby_modes(const VP8_ENCODER_RTCD *rtcd, MACROBLOCK *mb, int *Rate, int *best_dist)
216 {
217     MACROBLOCKD *const xd = &mb->e_mbd;
218     int i;
219     int cost = mb->mbmode_cost [xd->frame_type] [B_PRED];
220     int error;
221     int distortion = 0;
222
223     vp8_intra_prediction_down_copy(xd);
224
225     for (i = 0; i < 16; i++)
226     {
227         MODE_INFO *const mic = xd->mode_info_context;
228         const int mis = xd->mode_info_stride;
229         const B_PREDICTION_MODE A = vp8_above_bmi(mic, i, mis)->mode;
230         const B_PREDICTION_MODE L = vp8_left_bmi(mic, i)->mode;
231         B_PREDICTION_MODE UNINITIALIZED_IS_SAFE(best_mode);
232         int UNINITIALIZED_IS_SAFE(r), UNINITIALIZED_IS_SAFE(d);
233
234         pick_intra4x4block(rtcd, mb, mb->block + i, xd->block + i,
235                                &best_mode, A, L, &r, &d);
236
237         cost += r;
238         distortion += d;
239
240         mic->bmi[i].mode = xd->block[i].bmi.mode = best_mode;
241
242         // Break out case where we have already exceeded best so far value that was bassed in
243         if (distortion > *best_dist)
244             break;
245     }
246
247     for (i = 0; i < 16; i++)
248         xd->block[i].bmi.mv.as_int = 0;
249
250     *Rate = cost;
251
252     if (i == 16)
253     {
254         *best_dist = distortion;
255         error = RD_ESTIMATE(mb->rdmult, mb->rddiv, cost, distortion);
256     }
257     else
258     {
259         *best_dist = INT_MAX;
260         error = INT_MAX;
261     }
262
263     return error;
264 }
265
266 void vp8_pick_intra_mbuv_mode(MACROBLOCK *mb)
267 {
268
269     MACROBLOCKD *x = &mb->e_mbd;
270     unsigned char *uabove_row = x->dst.u_buffer - x->dst.uv_stride;
271     unsigned char *vabove_row = x->dst.v_buffer - x->dst.uv_stride;
272     unsigned char *usrc_ptr = (mb->block[16].src + *mb->block[16].base_src);
273     unsigned char *vsrc_ptr = (mb->block[20].src + *mb->block[20].base_src);
274     int uvsrc_stride = mb->block[16].src_stride;
275     unsigned char uleft_col[8];
276     unsigned char vleft_col[8];
277     unsigned char utop_left = uabove_row[-1];
278     unsigned char vtop_left = vabove_row[-1];
279     int i, j;
280     int expected_udc;
281     int expected_vdc;
282     int shift;
283     int Uaverage = 0;
284     int Vaverage = 0;
285     int diff;
286     int pred_error[4] = {0, 0, 0, 0}, best_error = INT_MAX;
287     MB_PREDICTION_MODE UNINITIALIZED_IS_SAFE(best_mode);
288
289
290     for (i = 0; i < 8; i++)
291     {
292         uleft_col[i] = x->dst.u_buffer [i* x->dst.uv_stride -1];
293         vleft_col[i] = x->dst.v_buffer [i* x->dst.uv_stride -1];
294     }
295
296     if (!x->up_available && !x->left_available)
297     {
298         expected_udc = 128;
299         expected_vdc = 128;
300     }
301     else
302     {
303         shift = 2;
304
305         if (x->up_available)
306         {
307
308             for (i = 0; i < 8; i++)
309             {
310                 Uaverage += uabove_row[i];
311                 Vaverage += vabove_row[i];
312             }
313
314             shift ++;
315
316         }
317
318         if (x->left_available)
319         {
320             for (i = 0; i < 8; i++)
321             {
322                 Uaverage += uleft_col[i];
323                 Vaverage += vleft_col[i];
324             }
325
326             shift ++;
327
328         }
329
330         expected_udc = (Uaverage + (1 << (shift - 1))) >> shift;
331         expected_vdc = (Vaverage + (1 << (shift - 1))) >> shift;
332     }
333
334
335     for (i = 0; i < 8; i++)
336     {
337         for (j = 0; j < 8; j++)
338         {
339
340             int predu = uleft_col[i] + uabove_row[j] - utop_left;
341             int predv = vleft_col[i] + vabove_row[j] - vtop_left;
342             int u_p, v_p;
343
344             u_p = usrc_ptr[j];
345             v_p = vsrc_ptr[j];
346
347             if (predu < 0)
348                 predu = 0;
349
350             if (predu > 255)
351                 predu = 255;
352
353             if (predv < 0)
354                 predv = 0;
355
356             if (predv > 255)
357                 predv = 255;
358
359
360             diff = u_p - expected_udc;
361             pred_error[DC_PRED] += diff * diff;
362             diff = v_p - expected_vdc;
363             pred_error[DC_PRED] += diff * diff;
364
365
366             diff = u_p - uabove_row[j];
367             pred_error[V_PRED] += diff * diff;
368             diff = v_p - vabove_row[j];
369             pred_error[V_PRED] += diff * diff;
370
371
372             diff = u_p - uleft_col[i];
373             pred_error[H_PRED] += diff * diff;
374             diff = v_p - vleft_col[i];
375             pred_error[H_PRED] += diff * diff;
376
377
378             diff = u_p - predu;
379             pred_error[TM_PRED] += diff * diff;
380             diff = v_p - predv;
381             pred_error[TM_PRED] += diff * diff;
382
383
384         }
385
386         usrc_ptr += uvsrc_stride;
387         vsrc_ptr += uvsrc_stride;
388
389         if (i == 3)
390         {
391             usrc_ptr = (mb->block[18].src + *mb->block[18].base_src);
392             vsrc_ptr = (mb->block[22].src + *mb->block[22].base_src);
393         }
394
395
396
397     }
398
399
400     for (i = DC_PRED; i <= TM_PRED; i++)
401     {
402         if (best_error > pred_error[i])
403         {
404             best_error = pred_error[i];
405             best_mode = (MB_PREDICTION_MODE)i;
406         }
407     }
408
409
410     mb->e_mbd.mode_info_context->mbmi.uv_mode = best_mode;
411
412 }
413
414 void vp8_pick_inter_mode(VP8_COMP *cpi, MACROBLOCK *x, int recon_yoffset, int recon_uvoffset, int *returnrate, int *returndistortion, int *returnintra)
415 {
416     BLOCK *b = &x->block[0];
417     BLOCKD *d = &x->e_mbd.block[0];
418     MACROBLOCKD *xd = &x->e_mbd;
419     B_MODE_INFO best_bmodes[16];
420     MB_MODE_INFO best_mbmode;
421     PARTITION_INFO best_partition;
422     MV best_ref_mv;
423     MV mode_mv[MB_MODE_COUNT];
424     MB_PREDICTION_MODE this_mode;
425     int num00;
426     int i;
427     int mdcounts[4];
428     int best_rd = INT_MAX; // 1 << 30;
429     int best_intra_rd = INT_MAX;
430     int mode_index;
431     int ref_frame_cost[MAX_REF_FRAMES];
432     int rate;
433     int rate2;
434     int distortion2;
435     int bestsme;
436     //int all_rds[MAX_MODES];         // Experimental debug code.
437     int best_mode_index = 0;
438     int sse = INT_MAX;
439
440     MV mvp;
441     int near_sadidx[8] = {0, 1, 2, 3, 4, 5, 6, 7};
442     int saddone=0;
443     int sr=0;    //search range got from mv_pred(). It uses step_param levels. (0-7)
444
445     MV nearest_mv[4];
446     MV near_mv[4];
447     MV frame_best_ref_mv[4];
448     int MDCounts[4][4];
449     unsigned char *y_buffer[4];
450     unsigned char *u_buffer[4];
451     unsigned char *v_buffer[4];
452
453     int skip_mode[4] = {0, 0, 0, 0};
454
455     vpx_memset(mode_mv, 0, sizeof(mode_mv));
456     vpx_memset(nearest_mv, 0, sizeof(nearest_mv));
457     vpx_memset(near_mv, 0, sizeof(near_mv));
458     vpx_memset(&best_mbmode, 0, sizeof(best_mbmode));
459
460
461     // set up all the refframe dependent pointers.
462     if (cpi->ref_frame_flags & VP8_LAST_FLAG)
463     {
464         YV12_BUFFER_CONFIG *lst_yv12 = &cpi->common.yv12_fb[cpi->common.lst_fb_idx];
465
466         vp8_find_near_mvs(&x->e_mbd, x->e_mbd.mode_info_context, &nearest_mv[LAST_FRAME], &near_mv[LAST_FRAME],
467                           &frame_best_ref_mv[LAST_FRAME], MDCounts[LAST_FRAME], LAST_FRAME, cpi->common.ref_frame_sign_bias);
468
469         y_buffer[LAST_FRAME] = lst_yv12->y_buffer + recon_yoffset;
470         u_buffer[LAST_FRAME] = lst_yv12->u_buffer + recon_uvoffset;
471         v_buffer[LAST_FRAME] = lst_yv12->v_buffer + recon_uvoffset;
472     }
473     else
474         skip_mode[LAST_FRAME] = 1;
475
476     if (cpi->ref_frame_flags & VP8_GOLD_FLAG)
477     {
478         YV12_BUFFER_CONFIG *gld_yv12 = &cpi->common.yv12_fb[cpi->common.gld_fb_idx];
479
480         vp8_find_near_mvs(&x->e_mbd, x->e_mbd.mode_info_context, &nearest_mv[GOLDEN_FRAME], &near_mv[GOLDEN_FRAME],
481                           &frame_best_ref_mv[GOLDEN_FRAME], MDCounts[GOLDEN_FRAME], GOLDEN_FRAME, cpi->common.ref_frame_sign_bias);
482
483         y_buffer[GOLDEN_FRAME] = gld_yv12->y_buffer + recon_yoffset;
484         u_buffer[GOLDEN_FRAME] = gld_yv12->u_buffer + recon_uvoffset;
485         v_buffer[GOLDEN_FRAME] = gld_yv12->v_buffer + recon_uvoffset;
486     }
487     else
488         skip_mode[GOLDEN_FRAME] = 1;
489
490     if (cpi->ref_frame_flags & VP8_ALT_FLAG && cpi->source_alt_ref_active)
491     {
492         YV12_BUFFER_CONFIG *alt_yv12 = &cpi->common.yv12_fb[cpi->common.alt_fb_idx];
493
494         vp8_find_near_mvs(&x->e_mbd, x->e_mbd.mode_info_context, &nearest_mv[ALTREF_FRAME], &near_mv[ALTREF_FRAME],
495                           &frame_best_ref_mv[ALTREF_FRAME], MDCounts[ALTREF_FRAME], ALTREF_FRAME, cpi->common.ref_frame_sign_bias);
496
497         y_buffer[ALTREF_FRAME] = alt_yv12->y_buffer + recon_yoffset;
498         u_buffer[ALTREF_FRAME] = alt_yv12->u_buffer + recon_uvoffset;
499         v_buffer[ALTREF_FRAME] = alt_yv12->v_buffer + recon_uvoffset;
500     }
501     else
502         skip_mode[ALTREF_FRAME] = 1;
503
504     cpi->mbs_tested_so_far++;          // Count of the number of MBs tested so far this frame
505
506     *returnintra = INT_MAX;
507     x->skip = 0;
508
509     ref_frame_cost[INTRA_FRAME]   = vp8_cost_zero(cpi->prob_intra_coded);
510
511     // Special case treatment when GF and ARF are not sensible options for reference
512     if (cpi->ref_frame_flags == VP8_LAST_FLAG)
513     {
514         ref_frame_cost[LAST_FRAME]    = vp8_cost_one(cpi->prob_intra_coded)
515                                         + vp8_cost_zero(255);
516         ref_frame_cost[GOLDEN_FRAME]  = vp8_cost_one(cpi->prob_intra_coded)
517                                         + vp8_cost_one(255)
518                                         + vp8_cost_zero(128);
519         ref_frame_cost[ALTREF_FRAME]  = vp8_cost_one(cpi->prob_intra_coded)
520                                         + vp8_cost_one(255)
521                                         + vp8_cost_one(128);
522     }
523     else
524     {
525         ref_frame_cost[LAST_FRAME]    = vp8_cost_one(cpi->prob_intra_coded)
526                                         + vp8_cost_zero(cpi->prob_last_coded);
527         ref_frame_cost[GOLDEN_FRAME]  = vp8_cost_one(cpi->prob_intra_coded)
528                                         + vp8_cost_one(cpi->prob_last_coded)
529                                         + vp8_cost_zero(cpi->prob_gf_coded);
530         ref_frame_cost[ALTREF_FRAME]  = vp8_cost_one(cpi->prob_intra_coded)
531                                         + vp8_cost_one(cpi->prob_last_coded)
532                                         + vp8_cost_one(cpi->prob_gf_coded);
533     }
534
535     x->e_mbd.mode_info_context->mbmi.ref_frame = INTRA_FRAME;
536
537     // if we encode a new mv this is important
538     // find the best new motion vector
539     for (mode_index = 0; mode_index < MAX_MODES; mode_index++)
540     {
541         int frame_cost;
542         int this_rd = INT_MAX;
543
544         if (best_rd <= cpi->rd_threshes[mode_index])
545             continue;
546
547         x->e_mbd.mode_info_context->mbmi.ref_frame = vp8_ref_frame_order[mode_index];
548
549         if (skip_mode[x->e_mbd.mode_info_context->mbmi.ref_frame])
550             continue;
551
552         // Check to see if the testing frequency for this mode is at its max
553         // If so then prevent it from being tested and increase the threshold for its testing
554         if (cpi->mode_test_hit_counts[mode_index] && (cpi->mode_check_freq[mode_index] > 1))
555         {
556             //if ( (cpi->mbs_tested_so_far / cpi->mode_test_hit_counts[mode_index]) <= cpi->mode_check_freq[mode_index] )
557             if (cpi->mbs_tested_so_far <= (cpi->mode_check_freq[mode_index] * cpi->mode_test_hit_counts[mode_index]))
558             {
559                 // Increase the threshold for coding this mode to make it less likely to be chosen
560                 cpi->rd_thresh_mult[mode_index] += 4;
561
562                 if (cpi->rd_thresh_mult[mode_index] > MAX_THRESHMULT)
563                     cpi->rd_thresh_mult[mode_index] = MAX_THRESHMULT;
564
565                 cpi->rd_threshes[mode_index] = (cpi->rd_baseline_thresh[mode_index] >> 7) * cpi->rd_thresh_mult[mode_index];
566
567                 continue;
568             }
569         }
570
571         // We have now reached the point where we are going to test the current mode so increment the counter for the number of times it has been tested
572         cpi->mode_test_hit_counts[mode_index] ++;
573
574         rate2 = 0;
575         distortion2 = 0;
576
577         this_mode = vp8_mode_order[mode_index];
578
579         // Experimental debug code.
580         //all_rds[mode_index] = -1;
581
582         x->e_mbd.mode_info_context->mbmi.mode = this_mode;
583         x->e_mbd.mode_info_context->mbmi.uv_mode = DC_PRED;
584
585         // Work out the cost assosciated with selecting the reference frame
586         frame_cost = ref_frame_cost[x->e_mbd.mode_info_context->mbmi.ref_frame];
587         rate2 += frame_cost;
588
589         // everything but intra
590         if (x->e_mbd.mode_info_context->mbmi.ref_frame)
591         {
592             x->e_mbd.pre.y_buffer = y_buffer[x->e_mbd.mode_info_context->mbmi.ref_frame];
593             x->e_mbd.pre.u_buffer = u_buffer[x->e_mbd.mode_info_context->mbmi.ref_frame];
594             x->e_mbd.pre.v_buffer = v_buffer[x->e_mbd.mode_info_context->mbmi.ref_frame];
595             mode_mv[NEARESTMV] = nearest_mv[x->e_mbd.mode_info_context->mbmi.ref_frame];
596             mode_mv[NEARMV] = near_mv[x->e_mbd.mode_info_context->mbmi.ref_frame];
597             best_ref_mv = frame_best_ref_mv[x->e_mbd.mode_info_context->mbmi.ref_frame];
598             memcpy(mdcounts, MDCounts[x->e_mbd.mode_info_context->mbmi.ref_frame], sizeof(mdcounts));
599         }
600
601         // Only consider ZEROMV/ALTREF_FRAME for alt ref frame,
602         // unless ARNR filtering is enabled in which case we want
603         // an unfiltered alternative
604         if (cpi->is_src_frame_alt_ref && (cpi->oxcf.arnr_max_frames == 0))
605         {
606             if (this_mode != ZEROMV || x->e_mbd.mode_info_context->mbmi.ref_frame != ALTREF_FRAME)
607                 continue;
608         }
609
610         if(cpi->sf.improved_mv_pred && x->e_mbd.mode_info_context->mbmi.mode == NEWMV)
611         {
612             if(!saddone)
613             {
614                 vp8_cal_sad(cpi,xd,x, recon_yoffset ,&near_sadidx[0] );
615                 saddone = 1;
616             }
617
618             vp8_mv_pred(cpi, &x->e_mbd, x->e_mbd.mode_info_context, &mvp,
619                         x->e_mbd.mode_info_context->mbmi.ref_frame, cpi->common.ref_frame_sign_bias, &sr, &near_sadidx[0]);
620
621             /* adjust mvp to make sure it is within MV range */
622             if(mvp.row > best_ref_mv.row + MAX_FULL_PEL_VAL)
623                 mvp.row = best_ref_mv.row + MAX_FULL_PEL_VAL;
624             else if(mvp.row < best_ref_mv.row - MAX_FULL_PEL_VAL)
625                 mvp.row = best_ref_mv.row - MAX_FULL_PEL_VAL;
626             if(mvp.col > best_ref_mv.col + MAX_FULL_PEL_VAL)
627                 mvp.col = best_ref_mv.col + MAX_FULL_PEL_VAL;
628             else if(mvp.col < best_ref_mv.col - MAX_FULL_PEL_VAL)
629                 mvp.col = best_ref_mv.col - MAX_FULL_PEL_VAL;
630         }
631
632         switch (this_mode)
633         {
634         case B_PRED:
635             distortion2 = *returndistortion;                    // Best so far passed in as breakout value to vp8_pick_intra4x4mby_modes
636             vp8_pick_intra4x4mby_modes(IF_RTCD(&cpi->rtcd), x, &rate, &distortion2);
637             rate2 += rate;
638             distortion2 = VARIANCE_INVOKE(&cpi->rtcd.variance, get16x16prederror)(x->src.y_buffer, x->src.y_stride, x->e_mbd.predictor, 16, 0x7fffffff);
639
640             if (distortion2 == INT_MAX)
641             {
642                 this_rd = INT_MAX;
643             }
644             else
645             {
646                 this_rd = RD_ESTIMATE(x->rdmult, x->rddiv, rate2, distortion2);
647
648                 if (this_rd < best_intra_rd)
649                 {
650                     best_intra_rd = this_rd;
651                     *returnintra = distortion2;
652                 }
653             }
654
655             break;
656
657         case SPLITMV:
658
659             // Split MV modes currently not supported when RD is nopt enabled.
660             break;
661
662         case DC_PRED:
663         case V_PRED:
664         case H_PRED:
665         case TM_PRED:
666             RECON_INVOKE(&cpi->common.rtcd.recon, build_intra_predictors_mby)
667                 (&x->e_mbd);
668             distortion2 = VARIANCE_INVOKE(&cpi->rtcd.variance, get16x16prederror)(x->src.y_buffer, x->src.y_stride, x->e_mbd.predictor, 16, 0x7fffffff);
669             rate2 += x->mbmode_cost[x->e_mbd.frame_type][x->e_mbd.mode_info_context->mbmi.mode];
670             this_rd = RD_ESTIMATE(x->rdmult, x->rddiv, rate2, distortion2);
671
672             if (this_rd < best_intra_rd)
673             {
674                 best_intra_rd = this_rd;
675                 *returnintra = distortion2;
676             }
677             break;
678
679         case NEWMV:
680         {
681             int thissme;
682             int step_param;
683             int further_steps;
684             int n = 0;
685             int sadpb = x->sadperbit16;
686
687             int col_min;
688             int col_max;
689             int row_min;
690             int row_max;
691
692             int tmp_col_min = x->mv_col_min;
693             int tmp_col_max = x->mv_col_max;
694             int tmp_row_min = x->mv_row_min;
695             int tmp_row_max = x->mv_row_max;
696
697             int speed_adjust = (cpi->Speed > 5) ? ((cpi->Speed >= 8)? 3 : 2) : 1;
698
699             // Further step/diamond searches as necessary
700             step_param = cpi->sf.first_step + speed_adjust;
701
702             if(cpi->sf.improved_mv_pred)
703             {
704                 sr += speed_adjust;
705                 //adjust search range according to sr from mv prediction
706                 if(sr > step_param)
707                     step_param = sr;
708
709                 col_min = (best_ref_mv.col - MAX_FULL_PEL_VAL) >>3;
710                 col_max = (best_ref_mv.col + MAX_FULL_PEL_VAL) >>3;
711                 row_min = (best_ref_mv.row - MAX_FULL_PEL_VAL) >>3;
712                 row_max = (best_ref_mv.row + MAX_FULL_PEL_VAL) >>3;
713
714                 // Get intersection of UMV window and valid MV window to reduce # of checks in diamond search.
715                 if (x->mv_col_min < col_min )
716                     x->mv_col_min = col_min;
717                 if (x->mv_col_max > col_max )
718                     x->mv_col_max = col_max;
719                 if (x->mv_row_min < row_min )
720                     x->mv_row_min = row_min;
721                 if (x->mv_row_max > row_max )
722                     x->mv_row_max = row_max;
723             }else
724             {
725                 mvp.row = best_ref_mv.row;
726                 mvp.col = best_ref_mv.col;
727             }
728
729             further_steps = (cpi->Speed >= 8)? 0: (cpi->sf.max_step_search_steps - 1 - step_param);
730
731             if (cpi->sf.search_method == HEX)
732             {
733                 bestsme = vp8_hex_search(x, b, d, &mvp, &d->bmi.mv.as_mv, step_param, sadpb/*x->errorperbit*/, &num00, &cpi->fn_ptr[BLOCK_16X16], x->mvsadcost, x->mvcost, &best_ref_mv);
734                 mode_mv[NEWMV].row = d->bmi.mv.as_mv.row;
735                 mode_mv[NEWMV].col = d->bmi.mv.as_mv.col;
736             }
737             else
738             {
739                 bestsme = cpi->diamond_search_sad(x, b, d, &mvp, &d->bmi.mv.as_mv, step_param, sadpb / 2/*x->errorperbit*/, &num00, &cpi->fn_ptr[BLOCK_16X16], x->mvcost, &best_ref_mv); //sadpb < 9
740                 mode_mv[NEWMV].row = d->bmi.mv.as_mv.row;
741                 mode_mv[NEWMV].col = d->bmi.mv.as_mv.col;
742
743                 // Further step/diamond searches as necessary
744                 n = 0;
745                 //further_steps = (cpi->sf.max_step_search_steps - 1) - step_param;
746
747                 n = num00;
748                 num00 = 0;
749
750                 while (n < further_steps)
751                 {
752                     n++;
753
754                     if (num00)
755                         num00--;
756                     else
757                     {
758                         thissme = cpi->diamond_search_sad(x, b, d, &mvp, &d->bmi.mv.as_mv, step_param + n, sadpb / 4/*x->errorperbit*/, &num00, &cpi->fn_ptr[BLOCK_16X16], x->mvcost, &best_ref_mv); //sadpb = 9
759
760                         if (thissme < bestsme)
761                         {
762                             bestsme = thissme;
763                             mode_mv[NEWMV].row = d->bmi.mv.as_mv.row;
764                             mode_mv[NEWMV].col = d->bmi.mv.as_mv.col;
765                         }
766                         else
767                         {
768                             d->bmi.mv.as_mv.row = mode_mv[NEWMV].row;
769                             d->bmi.mv.as_mv.col = mode_mv[NEWMV].col;
770                         }
771                     }
772                 }
773             }
774
775             if(cpi->sf.improved_mv_pred)
776             {
777                 x->mv_col_min = tmp_col_min;
778                 x->mv_col_max = tmp_col_max;
779                 x->mv_row_min = tmp_row_min;
780                 x->mv_row_max = tmp_row_max;
781             }
782
783             if (bestsme < INT_MAX)
784                 cpi->find_fractional_mv_step(x, b, d, &d->bmi.mv.as_mv, &best_ref_mv, x->errorperbit, &cpi->fn_ptr[BLOCK_16X16], cpi->mb.mvcost);
785
786             mode_mv[NEWMV].row = d->bmi.mv.as_mv.row;
787             mode_mv[NEWMV].col = d->bmi.mv.as_mv.col;
788
789             // mv cost;
790             rate2 += vp8_mv_bit_cost(&mode_mv[NEWMV], &best_ref_mv, cpi->mb.mvcost, 128);
791         }
792
793         case NEARESTMV:
794         case NEARMV:
795
796             if (mode_mv[this_mode].row == 0 && mode_mv[this_mode].col == 0)
797                 continue;
798
799         case ZEROMV:
800
801             // Trap vectors that reach beyond the UMV borders
802             // Note that ALL New MV, Nearest MV Near MV and Zero MV code drops through to this point
803             // because of the lack of break statements in the previous two cases.
804             if (((mode_mv[this_mode].row >> 3) < x->mv_row_min) || ((mode_mv[this_mode].row >> 3) > x->mv_row_max) ||
805                 ((mode_mv[this_mode].col >> 3) < x->mv_col_min) || ((mode_mv[this_mode].col >> 3) > x->mv_col_max))
806                 continue;
807
808             rate2 += vp8_cost_mv_ref(this_mode, mdcounts);
809             x->e_mbd.mode_info_context->mbmi.mode = this_mode;
810             x->e_mbd.mode_info_context->mbmi.mv.as_mv = mode_mv[this_mode];
811             x->e_mbd.block[0].bmi.mode = this_mode;
812             x->e_mbd.block[0].bmi.mv.as_int = x->e_mbd.mode_info_context->mbmi.mv.as_int;
813
814             distortion2 = get_inter_mbpred_error(x, &cpi->fn_ptr[BLOCK_16X16], (unsigned int *)(&sse));
815
816             this_rd = RD_ESTIMATE(x->rdmult, x->rddiv, rate2, distortion2);
817
818             if (cpi->active_map_enabled && x->active_ptr[0] == 0)
819             {
820                 x->skip = 1;
821             }
822             else if (sse < x->encode_breakout)
823             {
824                 // Check u and v to make sure skip is ok
825                 int sse2 = 0;
826
827                 sse2 = VP8_UVSSE(x, IF_RTCD(&cpi->rtcd.variance));
828
829                 if (sse2 * 2 < x->encode_breakout)
830                     x->skip = 1;
831                 else
832                     x->skip = 0;
833             }
834
835             break;
836         default:
837             break;
838         }
839
840         // Experimental debug code.
841         //all_rds[mode_index] = this_rd;
842
843         if (this_rd < best_rd || x->skip)
844         {
845             // Note index of best mode
846             best_mode_index = mode_index;
847
848             *returnrate = rate2;
849             *returndistortion = distortion2;
850             best_rd = this_rd;
851             vpx_memcpy(&best_mbmode, &x->e_mbd.mode_info_context->mbmi, sizeof(MB_MODE_INFO));
852             vpx_memcpy(&best_partition, x->partition_info, sizeof(PARTITION_INFO));
853
854             if (this_mode == B_PRED || this_mode == SPLITMV)
855                 for (i = 0; i < 16; i++)
856                 {
857                     vpx_memcpy(&best_bmodes[i], &x->e_mbd.block[i].bmi, sizeof(B_MODE_INFO));
858                 }
859             else
860             {
861                 best_bmodes[0].mv = x->e_mbd.block[0].bmi.mv;
862             }
863
864             // Testing this mode gave rise to an improvement in best error score. Lower threshold a bit for next time
865             cpi->rd_thresh_mult[mode_index] = (cpi->rd_thresh_mult[mode_index] >= (MIN_THRESHMULT + 2)) ? cpi->rd_thresh_mult[mode_index] - 2 : MIN_THRESHMULT;
866             cpi->rd_threshes[mode_index] = (cpi->rd_baseline_thresh[mode_index] >> 7) * cpi->rd_thresh_mult[mode_index];
867         }
868
869         // If the mode did not help improve the best error case then raise the threshold for testing that mode next time around.
870         else
871         {
872             cpi->rd_thresh_mult[mode_index] += 4;
873
874             if (cpi->rd_thresh_mult[mode_index] > MAX_THRESHMULT)
875                 cpi->rd_thresh_mult[mode_index] = MAX_THRESHMULT;
876
877             cpi->rd_threshes[mode_index] = (cpi->rd_baseline_thresh[mode_index] >> 7) * cpi->rd_thresh_mult[mode_index];
878         }
879
880         if (x->skip)
881             break;
882     }
883
884     // Reduce the activation RD thresholds for the best choice mode
885     if ((cpi->rd_baseline_thresh[best_mode_index] > 0) && (cpi->rd_baseline_thresh[best_mode_index] < (INT_MAX >> 2)))
886     {
887         int best_adjustment = (cpi->rd_thresh_mult[best_mode_index] >> 3);
888
889         cpi->rd_thresh_mult[best_mode_index] = (cpi->rd_thresh_mult[best_mode_index] >= (MIN_THRESHMULT + best_adjustment)) ? cpi->rd_thresh_mult[best_mode_index] - best_adjustment : MIN_THRESHMULT;
890         cpi->rd_threshes[best_mode_index] = (cpi->rd_baseline_thresh[best_mode_index] >> 7) * cpi->rd_thresh_mult[best_mode_index];
891     }
892
893     // Keep a record of best mode index for use in next loop
894     cpi->last_best_mode_index = best_mode_index;
895
896     if (best_mbmode.mode <= B_PRED)
897     {
898         x->e_mbd.mode_info_context->mbmi.ref_frame = INTRA_FRAME;
899         vp8_pick_intra_mbuv_mode(x);
900         best_mbmode.uv_mode = x->e_mbd.mode_info_context->mbmi.uv_mode;
901     }
902
903
904     {
905         int this_rdbin = (*returndistortion >> 7);
906
907         if (this_rdbin >= 1024)
908         {
909             this_rdbin = 1023;
910         }
911
912         cpi->error_bins[this_rdbin] ++;
913     }
914
915
916     if (cpi->is_src_frame_alt_ref && (best_mbmode.mode != ZEROMV || best_mbmode.ref_frame != ALTREF_FRAME))
917     {
918         best_mbmode.mode = ZEROMV;
919         best_mbmode.ref_frame = ALTREF_FRAME;
920         best_mbmode.mv.as_int = 0;
921         best_mbmode.uv_mode = 0;
922         best_mbmode.mb_skip_coeff = (cpi->common.mb_no_coeff_skip) ? 1 : 0;
923         best_mbmode.partitioning = 0;
924         best_mbmode.dc_diff = 0;
925
926         vpx_memcpy(&x->e_mbd.mode_info_context->mbmi, &best_mbmode, sizeof(MB_MODE_INFO));
927         vpx_memcpy(x->partition_info, &best_partition, sizeof(PARTITION_INFO));
928
929         for (i = 0; i < 16; i++)
930         {
931             vpx_memset(&x->e_mbd.block[i].bmi, 0, sizeof(B_MODE_INFO));
932         }
933
934         x->e_mbd.mode_info_context->mbmi.mv.as_int = 0;
935         return;
936     }
937
938
939     // macroblock modes
940     vpx_memcpy(&x->e_mbd.mode_info_context->mbmi, &best_mbmode, sizeof(MB_MODE_INFO));
941     vpx_memcpy(x->partition_info, &best_partition, sizeof(PARTITION_INFO));
942
943     if (x->e_mbd.mode_info_context->mbmi.mode == B_PRED || x->e_mbd.mode_info_context->mbmi.mode == SPLITMV)
944         for (i = 0; i < 16; i++)
945         {
946             vpx_memcpy(&x->e_mbd.block[i].bmi, &best_bmodes[i], sizeof(B_MODE_INFO));
947
948         }
949     else
950     {
951         vp8_set_mbmode_and_mvs(x, x->e_mbd.mode_info_context->mbmi.mode, &best_bmodes[0].mv.as_mv);
952     }
953
954     x->e_mbd.mode_info_context->mbmi.mv.as_mv = x->e_mbd.block[15].bmi.mv.as_mv;
955 }