Update to MPlayer SVN rev 29978 and FFmpeg SVN rev 20757.
[vaapi:challenzhous-mplayer.git] / libavcodec / .svn / text-base / error_resilience.c.svn-base
1 /*
2  * Error resilience / concealment
3  *
4  * Copyright (c) 2002-2004 Michael Niedermayer <michaelni@gmx.at>
5  *
6  * This file is part of FFmpeg.
7  *
8  * FFmpeg is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU Lesser General Public
10  * License as published by the Free Software Foundation; either
11  * version 2.1 of the License, or (at your option) any later version.
12  *
13  * FFmpeg is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16  * Lesser General Public License for more details.
17  *
18  * You should have received a copy of the GNU Lesser General Public
19  * License along with FFmpeg; if not, write to the Free Software
20  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
21  */
22
23 /**
24  * @file libavcodec/error_resilience.c
25  * Error resilience / concealment.
26  */
27
28 #include <limits.h>
29
30 #include "avcodec.h"
31 #include "dsputil.h"
32 #include "mpegvideo.h"
33
34 static void decode_mb(MpegEncContext *s){
35     s->dest[0] = s->current_picture.data[0] + (s->mb_y * 16* s->linesize  ) + s->mb_x * 16;
36     s->dest[1] = s->current_picture.data[1] + (s->mb_y * (16>>s->chroma_y_shift) * s->uvlinesize) + s->mb_x * (16>>s->chroma_x_shift);
37     s->dest[2] = s->current_picture.data[2] + (s->mb_y * (16>>s->chroma_y_shift) * s->uvlinesize) + s->mb_x * (16>>s->chroma_x_shift);
38
39     MPV_decode_mb(s, s->block);
40 }
41
42 /**
43  * replaces the current MB with a flat dc only version.
44  */
45 static void put_dc(MpegEncContext *s, uint8_t *dest_y, uint8_t *dest_cb, uint8_t *dest_cr, int mb_x, int mb_y)
46 {
47     int dc, dcu, dcv, y, i;
48     for(i=0; i<4; i++){
49         dc= s->dc_val[0][mb_x*2 + (i&1) + (mb_y*2 + (i>>1))*s->b8_stride];
50         if(dc<0) dc=0;
51         else if(dc>2040) dc=2040;
52         for(y=0; y<8; y++){
53             int x;
54             for(x=0; x<8; x++){
55                 dest_y[x + (i&1)*8 + (y + (i>>1)*8)*s->linesize]= dc/8;
56             }
57         }
58     }
59     dcu = s->dc_val[1][mb_x + mb_y*s->mb_stride];
60     dcv = s->dc_val[2][mb_x + mb_y*s->mb_stride];
61     if     (dcu<0   ) dcu=0;
62     else if(dcu>2040) dcu=2040;
63     if     (dcv<0   ) dcv=0;
64     else if(dcv>2040) dcv=2040;
65     for(y=0; y<8; y++){
66         int x;
67         for(x=0; x<8; x++){
68             dest_cb[x + y*(s->uvlinesize)]= dcu/8;
69             dest_cr[x + y*(s->uvlinesize)]= dcv/8;
70         }
71     }
72 }
73
74 static void filter181(int16_t *data, int width, int height, int stride){
75     int x,y;
76
77     /* horizontal filter */
78     for(y=1; y<height-1; y++){
79         int prev_dc= data[0 + y*stride];
80
81         for(x=1; x<width-1; x++){
82             int dc;
83
84             dc= - prev_dc
85                 + data[x     + y*stride]*8
86                 - data[x + 1 + y*stride];
87             dc= (dc*10923 + 32768)>>16;
88             prev_dc= data[x + y*stride];
89             data[x + y*stride]= dc;
90         }
91     }
92
93     /* vertical filter */
94     for(x=1; x<width-1; x++){
95         int prev_dc= data[x];
96
97         for(y=1; y<height-1; y++){
98             int dc;
99
100             dc= - prev_dc
101                 + data[x +  y   *stride]*8
102                 - data[x + (y+1)*stride];
103             dc= (dc*10923 + 32768)>>16;
104             prev_dc= data[x + y*stride];
105             data[x + y*stride]= dc;
106         }
107     }
108 }
109
110 /**
111  * guess the dc of blocks which do not have an undamaged dc
112  * @param w     width in 8 pixel blocks
113  * @param h     height in 8 pixel blocks
114  */
115 static void guess_dc(MpegEncContext *s, int16_t *dc, int w, int h, int stride, int is_luma){
116     int b_x, b_y;
117
118     for(b_y=0; b_y<h; b_y++){
119         for(b_x=0; b_x<w; b_x++){
120             int color[4]={1024,1024,1024,1024};
121             int distance[4]={9999,9999,9999,9999};
122             int mb_index, error, j;
123             int64_t guess, weight_sum;
124
125             mb_index= (b_x>>is_luma) + (b_y>>is_luma)*s->mb_stride;
126
127             error= s->error_status_table[mb_index];
128
129             if(IS_INTER(s->current_picture.mb_type[mb_index])) continue; //inter
130             if(!(error&DC_ERROR)) continue;           //dc-ok
131
132             /* right block */
133             for(j=b_x+1; j<w; j++){
134                 int mb_index_j= (j>>is_luma) + (b_y>>is_luma)*s->mb_stride;
135                 int error_j= s->error_status_table[mb_index_j];
136                 int intra_j= IS_INTRA(s->current_picture.mb_type[mb_index_j]);
137                 if(intra_j==0 || !(error_j&DC_ERROR)){
138                     color[0]= dc[j + b_y*stride];
139                     distance[0]= j-b_x;
140                     break;
141                 }
142             }
143
144             /* left block */
145             for(j=b_x-1; j>=0; j--){
146                 int mb_index_j= (j>>is_luma) + (b_y>>is_luma)*s->mb_stride;
147                 int error_j= s->error_status_table[mb_index_j];
148                 int intra_j= IS_INTRA(s->current_picture.mb_type[mb_index_j]);
149                 if(intra_j==0 || !(error_j&DC_ERROR)){
150                     color[1]= dc[j + b_y*stride];
151                     distance[1]= b_x-j;
152                     break;
153                 }
154             }
155
156             /* bottom block */
157             for(j=b_y+1; j<h; j++){
158                 int mb_index_j= (b_x>>is_luma) + (j>>is_luma)*s->mb_stride;
159                 int error_j= s->error_status_table[mb_index_j];
160                 int intra_j= IS_INTRA(s->current_picture.mb_type[mb_index_j]);
161                 if(intra_j==0 || !(error_j&DC_ERROR)){
162                     color[2]= dc[b_x + j*stride];
163                     distance[2]= j-b_y;
164                     break;
165                 }
166             }
167
168             /* top block */
169             for(j=b_y-1; j>=0; j--){
170                 int mb_index_j= (b_x>>is_luma) + (j>>is_luma)*s->mb_stride;
171                 int error_j= s->error_status_table[mb_index_j];
172                 int intra_j= IS_INTRA(s->current_picture.mb_type[mb_index_j]);
173                 if(intra_j==0 || !(error_j&DC_ERROR)){
174                     color[3]= dc[b_x + j*stride];
175                     distance[3]= b_y-j;
176                     break;
177                 }
178             }
179
180             weight_sum=0;
181             guess=0;
182             for(j=0; j<4; j++){
183                 int64_t weight= 256*256*256*16/distance[j];
184                 guess+= weight*(int64_t)color[j];
185                 weight_sum+= weight;
186             }
187             guess= (guess + weight_sum/2) / weight_sum;
188
189             dc[b_x + b_y*stride]= guess;
190         }
191     }
192 }
193
194 /**
195  * simple horizontal deblocking filter used for error resilience
196  * @param w     width in 8 pixel blocks
197  * @param h     height in 8 pixel blocks
198  */
199 static void h_block_filter(MpegEncContext *s, uint8_t *dst, int w, int h, int stride, int is_luma){
200     int b_x, b_y;
201     uint8_t *cm = ff_cropTbl + MAX_NEG_CROP;
202
203     for(b_y=0; b_y<h; b_y++){
204         for(b_x=0; b_x<w-1; b_x++){
205             int y;
206             int left_status = s->error_status_table[( b_x   >>is_luma) + (b_y>>is_luma)*s->mb_stride];
207             int right_status= s->error_status_table[((b_x+1)>>is_luma) + (b_y>>is_luma)*s->mb_stride];
208             int left_intra=   IS_INTRA(s->current_picture.mb_type      [( b_x   >>is_luma) + (b_y>>is_luma)*s->mb_stride]);
209             int right_intra=  IS_INTRA(s->current_picture.mb_type      [((b_x+1)>>is_luma) + (b_y>>is_luma)*s->mb_stride]);
210             int left_damage =  left_status&(DC_ERROR|AC_ERROR|MV_ERROR);
211             int right_damage= right_status&(DC_ERROR|AC_ERROR|MV_ERROR);
212             int offset= b_x*8 + b_y*stride*8;
213             int16_t *left_mv=  s->current_picture.motion_val[0][s->b8_stride*(b_y<<(1-is_luma)) + ( b_x   <<(1-is_luma))];
214             int16_t *right_mv= s->current_picture.motion_val[0][s->b8_stride*(b_y<<(1-is_luma)) + ((b_x+1)<<(1-is_luma))];
215
216             if(!(left_damage||right_damage)) continue; // both undamaged
217
218             if(   (!left_intra) && (!right_intra)
219                && FFABS(left_mv[0]-right_mv[0]) + FFABS(left_mv[1]+right_mv[1]) < 2) continue;
220
221             for(y=0; y<8; y++){
222                 int a,b,c,d;
223
224                 a= dst[offset + 7 + y*stride] - dst[offset + 6 + y*stride];
225                 b= dst[offset + 8 + y*stride] - dst[offset + 7 + y*stride];
226                 c= dst[offset + 9 + y*stride] - dst[offset + 8 + y*stride];
227
228                 d= FFABS(b) - ((FFABS(a) + FFABS(c) + 1)>>1);
229                 d= FFMAX(d, 0);
230                 if(b<0) d= -d;
231
232                 if(d==0) continue;
233
234                 if(!(left_damage && right_damage))
235                     d= d*16/9;
236
237                 if(left_damage){
238                     dst[offset + 7 + y*stride] = cm[dst[offset + 7 + y*stride] + ((d*7)>>4)];
239                     dst[offset + 6 + y*stride] = cm[dst[offset + 6 + y*stride] + ((d*5)>>4)];
240                     dst[offset + 5 + y*stride] = cm[dst[offset + 5 + y*stride] + ((d*3)>>4)];
241                     dst[offset + 4 + y*stride] = cm[dst[offset + 4 + y*stride] + ((d*1)>>4)];
242                 }
243                 if(right_damage){
244                     dst[offset + 8 + y*stride] = cm[dst[offset + 8 + y*stride] - ((d*7)>>4)];
245                     dst[offset + 9 + y*stride] = cm[dst[offset + 9 + y*stride] - ((d*5)>>4)];
246                     dst[offset + 10+ y*stride] = cm[dst[offset +10 + y*stride] - ((d*3)>>4)];
247                     dst[offset + 11+ y*stride] = cm[dst[offset +11 + y*stride] - ((d*1)>>4)];
248                 }
249             }
250         }
251     }
252 }
253
254 /**
255  * simple vertical deblocking filter used for error resilience
256  * @param w     width in 8 pixel blocks
257  * @param h     height in 8 pixel blocks
258  */
259 static void v_block_filter(MpegEncContext *s, uint8_t *dst, int w, int h, int stride, int is_luma){
260     int b_x, b_y;
261     uint8_t *cm = ff_cropTbl + MAX_NEG_CROP;
262
263     for(b_y=0; b_y<h-1; b_y++){
264         for(b_x=0; b_x<w; b_x++){
265             int x;
266             int top_status   = s->error_status_table[(b_x>>is_luma) + ( b_y   >>is_luma)*s->mb_stride];
267             int bottom_status= s->error_status_table[(b_x>>is_luma) + ((b_y+1)>>is_luma)*s->mb_stride];
268             int top_intra=     IS_INTRA(s->current_picture.mb_type      [(b_x>>is_luma) + ( b_y   >>is_luma)*s->mb_stride]);
269             int bottom_intra=  IS_INTRA(s->current_picture.mb_type      [(b_x>>is_luma) + ((b_y+1)>>is_luma)*s->mb_stride]);
270             int top_damage =      top_status&(DC_ERROR|AC_ERROR|MV_ERROR);
271             int bottom_damage= bottom_status&(DC_ERROR|AC_ERROR|MV_ERROR);
272             int offset= b_x*8 + b_y*stride*8;
273             int16_t *top_mv=    s->current_picture.motion_val[0][s->b8_stride*( b_y   <<(1-is_luma)) + (b_x<<(1-is_luma))];
274             int16_t *bottom_mv= s->current_picture.motion_val[0][s->b8_stride*((b_y+1)<<(1-is_luma)) + (b_x<<(1-is_luma))];
275
276             if(!(top_damage||bottom_damage)) continue; // both undamaged
277
278             if(   (!top_intra) && (!bottom_intra)
279                && FFABS(top_mv[0]-bottom_mv[0]) + FFABS(top_mv[1]+bottom_mv[1]) < 2) continue;
280
281             for(x=0; x<8; x++){
282                 int a,b,c,d;
283
284                 a= dst[offset + x + 7*stride] - dst[offset + x + 6*stride];
285                 b= dst[offset + x + 8*stride] - dst[offset + x + 7*stride];
286                 c= dst[offset + x + 9*stride] - dst[offset + x + 8*stride];
287
288                 d= FFABS(b) - ((FFABS(a) + FFABS(c)+1)>>1);
289                 d= FFMAX(d, 0);
290                 if(b<0) d= -d;
291
292                 if(d==0) continue;
293
294                 if(!(top_damage && bottom_damage))
295                     d= d*16/9;
296
297                 if(top_damage){
298                     dst[offset + x +  7*stride] = cm[dst[offset + x +  7*stride] + ((d*7)>>4)];
299                     dst[offset + x +  6*stride] = cm[dst[offset + x +  6*stride] + ((d*5)>>4)];
300                     dst[offset + x +  5*stride] = cm[dst[offset + x +  5*stride] + ((d*3)>>4)];
301                     dst[offset + x +  4*stride] = cm[dst[offset + x +  4*stride] + ((d*1)>>4)];
302                 }
303                 if(bottom_damage){
304                     dst[offset + x +  8*stride] = cm[dst[offset + x +  8*stride] - ((d*7)>>4)];
305                     dst[offset + x +  9*stride] = cm[dst[offset + x +  9*stride] - ((d*5)>>4)];
306                     dst[offset + x + 10*stride] = cm[dst[offset + x + 10*stride] - ((d*3)>>4)];
307                     dst[offset + x + 11*stride] = cm[dst[offset + x + 11*stride] - ((d*1)>>4)];
308                 }
309             }
310         }
311     }
312 }
313
314 static void guess_mv(MpegEncContext *s){
315     uint8_t fixed[s->mb_stride * s->mb_height];
316 #define MV_FROZEN    3
317 #define MV_CHANGED   2
318 #define MV_UNCHANGED 1
319     const int mb_stride = s->mb_stride;
320     const int mb_width = s->mb_width;
321     const int mb_height= s->mb_height;
322     int i, depth, num_avail;
323     int mb_x, mb_y;
324
325     num_avail=0;
326     for(i=0; i<s->mb_num; i++){
327         const int mb_xy= s->mb_index2xy[ i ];
328         int f=0;
329         int error= s->error_status_table[mb_xy];
330
331         if(IS_INTRA(s->current_picture.mb_type[mb_xy])) f=MV_FROZEN; //intra //FIXME check
332         if(!(error&MV_ERROR)) f=MV_FROZEN;           //inter with undamaged MV
333
334         fixed[mb_xy]= f;
335         if(f==MV_FROZEN)
336             num_avail++;
337     }
338
339     if((!(s->avctx->error_concealment&FF_EC_GUESS_MVS)) || num_avail <= mb_width/2){
340         for(mb_y=0; mb_y<s->mb_height; mb_y++){
341             for(mb_x=0; mb_x<s->mb_width; mb_x++){
342                 const int mb_xy= mb_x + mb_y*s->mb_stride;
343
344                 if(IS_INTRA(s->current_picture.mb_type[mb_xy]))  continue;
345                 if(!(s->error_status_table[mb_xy]&MV_ERROR)) continue;
346
347                 s->mv_dir = s->last_picture.data[0] ? MV_DIR_FORWARD : MV_DIR_BACKWARD;
348                 s->mb_intra=0;
349                 s->mv_type = MV_TYPE_16X16;
350                 s->mb_skipped=0;
351
352                 s->dsp.clear_blocks(s->block[0]);
353
354                 s->mb_x= mb_x;
355                 s->mb_y= mb_y;
356                 s->mv[0][0][0]= 0;
357                 s->mv[0][0][1]= 0;
358                 decode_mb(s);
359             }
360         }
361         return;
362     }
363
364     for(depth=0;; depth++){
365         int changed, pass, none_left;
366
367         none_left=1;
368         changed=1;
369         for(pass=0; (changed || pass<2) && pass<10; pass++){
370             int mb_x, mb_y;
371 int score_sum=0;
372
373             changed=0;
374             for(mb_y=0; mb_y<s->mb_height; mb_y++){
375                 for(mb_x=0; mb_x<s->mb_width; mb_x++){
376                     const int mb_xy= mb_x + mb_y*s->mb_stride;
377                     int mv_predictor[8][2]={{0}};
378                     int pred_count=0;
379                     int j;
380                     int best_score=256*256*256*64;
381                     int best_pred=0;
382                     const int mot_stride= s->b8_stride;
383                     const int mot_index= mb_x*2 + mb_y*2*mot_stride;
384                     int prev_x= s->current_picture.motion_val[0][mot_index][0];
385                     int prev_y= s->current_picture.motion_val[0][mot_index][1];
386
387                     if((mb_x^mb_y^pass)&1) continue;
388
389                     if(fixed[mb_xy]==MV_FROZEN) continue;
390                     assert(!IS_INTRA(s->current_picture.mb_type[mb_xy]));
391                     assert(s->last_picture_ptr && s->last_picture_ptr->data[0]);
392
393                     j=0;
394                     if(mb_x>0           && fixed[mb_xy-1        ]==MV_FROZEN) j=1;
395                     if(mb_x+1<mb_width  && fixed[mb_xy+1        ]==MV_FROZEN) j=1;
396                     if(mb_y>0           && fixed[mb_xy-mb_stride]==MV_FROZEN) j=1;
397                     if(mb_y+1<mb_height && fixed[mb_xy+mb_stride]==MV_FROZEN) j=1;
398                     if(j==0) continue;
399
400                     j=0;
401                     if(mb_x>0           && fixed[mb_xy-1        ]==MV_CHANGED) j=1;
402                     if(mb_x+1<mb_width  && fixed[mb_xy+1        ]==MV_CHANGED) j=1;
403                     if(mb_y>0           && fixed[mb_xy-mb_stride]==MV_CHANGED) j=1;
404                     if(mb_y+1<mb_height && fixed[mb_xy+mb_stride]==MV_CHANGED) j=1;
405                     if(j==0 && pass>1) continue;
406
407                     none_left=0;
408
409                     if(mb_x>0 && fixed[mb_xy-1]){
410                         mv_predictor[pred_count][0]= s->current_picture.motion_val[0][mot_index - 2][0];
411                         mv_predictor[pred_count][1]= s->current_picture.motion_val[0][mot_index - 2][1];
412                         pred_count++;
413                     }
414                     if(mb_x+1<mb_width && fixed[mb_xy+1]){
415                         mv_predictor[pred_count][0]= s->current_picture.motion_val[0][mot_index + 2][0];
416                         mv_predictor[pred_count][1]= s->current_picture.motion_val[0][mot_index + 2][1];
417                         pred_count++;
418                     }
419                     if(mb_y>0 && fixed[mb_xy-mb_stride]){
420                         mv_predictor[pred_count][0]= s->current_picture.motion_val[0][mot_index - mot_stride*2][0];
421                         mv_predictor[pred_count][1]= s->current_picture.motion_val[0][mot_index - mot_stride*2][1];
422                         pred_count++;
423                     }
424                     if(mb_y+1<mb_height && fixed[mb_xy+mb_stride]){
425                         mv_predictor[pred_count][0]= s->current_picture.motion_val[0][mot_index + mot_stride*2][0];
426                         mv_predictor[pred_count][1]= s->current_picture.motion_val[0][mot_index + mot_stride*2][1];
427                         pred_count++;
428                     }
429                     if(pred_count==0) continue;
430
431                     if(pred_count>1){
432                         int sum_x=0, sum_y=0;
433                         int max_x, max_y, min_x, min_y;
434
435                         for(j=0; j<pred_count; j++){
436                             sum_x+= mv_predictor[j][0];
437                             sum_y+= mv_predictor[j][1];
438                         }
439
440                         /* mean */
441                         mv_predictor[pred_count][0] = sum_x/j;
442                         mv_predictor[pred_count][1] = sum_y/j;
443
444                         /* median */
445                         if(pred_count>=3){
446                             min_y= min_x= 99999;
447                             max_y= max_x=-99999;
448                         }else{
449                             min_x=min_y=max_x=max_y=0;
450                         }
451                         for(j=0; j<pred_count; j++){
452                             max_x= FFMAX(max_x, mv_predictor[j][0]);
453                             max_y= FFMAX(max_y, mv_predictor[j][1]);
454                             min_x= FFMIN(min_x, mv_predictor[j][0]);
455                             min_y= FFMIN(min_y, mv_predictor[j][1]);
456                         }
457                         mv_predictor[pred_count+1][0] = sum_x - max_x - min_x;
458                         mv_predictor[pred_count+1][1] = sum_y - max_y - min_y;
459
460                         if(pred_count==4){
461                             mv_predictor[pred_count+1][0] /= 2;
462                             mv_predictor[pred_count+1][1] /= 2;
463                         }
464                         pred_count+=2;
465                     }
466
467                     /* zero MV */
468                     pred_count++;
469
470                     /* last MV */
471                     mv_predictor[pred_count][0]= s->current_picture.motion_val[0][mot_index][0];
472                     mv_predictor[pred_count][1]= s->current_picture.motion_val[0][mot_index][1];
473                     pred_count++;
474
475                     s->mv_dir = MV_DIR_FORWARD;
476                     s->mb_intra=0;
477                     s->mv_type = MV_TYPE_16X16;
478                     s->mb_skipped=0;
479
480                     s->dsp.clear_blocks(s->block[0]);
481
482                     s->mb_x= mb_x;
483                     s->mb_y= mb_y;
484
485                     for(j=0; j<pred_count; j++){
486                         int score=0;
487                         uint8_t *src= s->current_picture.data[0] + mb_x*16 + mb_y*16*s->linesize;
488
489                         s->current_picture.motion_val[0][mot_index][0]= s->mv[0][0][0]= mv_predictor[j][0];
490                         s->current_picture.motion_val[0][mot_index][1]= s->mv[0][0][1]= mv_predictor[j][1];
491
492                         decode_mb(s);
493
494                         if(mb_x>0 && fixed[mb_xy-1]){
495                             int k;
496                             for(k=0; k<16; k++)
497                                 score += FFABS(src[k*s->linesize-1 ]-src[k*s->linesize   ]);
498                         }
499                         if(mb_x+1<mb_width && fixed[mb_xy+1]){
500                             int k;
501                             for(k=0; k<16; k++)
502                                 score += FFABS(src[k*s->linesize+15]-src[k*s->linesize+16]);
503                         }
504                         if(mb_y>0 && fixed[mb_xy-mb_stride]){
505                             int k;
506                             for(k=0; k<16; k++)
507                                 score += FFABS(src[k-s->linesize   ]-src[k               ]);
508                         }
509                         if(mb_y+1<mb_height && fixed[mb_xy+mb_stride]){
510                             int k;
511                             for(k=0; k<16; k++)
512                                 score += FFABS(src[k+s->linesize*15]-src[k+s->linesize*16]);
513                         }
514
515                         if(score <= best_score){ // <= will favor the last MV
516                             best_score= score;
517                             best_pred= j;
518                         }
519                     }
520 score_sum+= best_score;
521 //FIXME no need to set s->current_picture.motion_val[0][mot_index][0] explicit
522                     s->current_picture.motion_val[0][mot_index][0]= s->mv[0][0][0]= mv_predictor[best_pred][0];
523                     s->current_picture.motion_val[0][mot_index][1]= s->mv[0][0][1]= mv_predictor[best_pred][1];
524
525                     decode_mb(s);
526
527
528                     if(s->mv[0][0][0] != prev_x || s->mv[0][0][1] != prev_y){
529                         fixed[mb_xy]=MV_CHANGED;
530                         changed++;
531                     }else
532                         fixed[mb_xy]=MV_UNCHANGED;
533                 }
534             }
535
536 //            printf(".%d/%d", changed, score_sum); fflush(stdout);
537         }
538
539         if(none_left)
540             return;
541
542         for(i=0; i<s->mb_num; i++){
543             int mb_xy= s->mb_index2xy[i];
544             if(fixed[mb_xy])
545                 fixed[mb_xy]=MV_FROZEN;
546         }
547 //        printf(":"); fflush(stdout);
548     }
549 }
550
551 static int is_intra_more_likely(MpegEncContext *s){
552     int is_intra_likely, i, j, undamaged_count, skip_amount, mb_x, mb_y;
553
554     if(!s->last_picture_ptr || !s->last_picture_ptr->data[0]) return 1; //no previous frame available -> use spatial prediction
555
556     undamaged_count=0;
557     for(i=0; i<s->mb_num; i++){
558         const int mb_xy= s->mb_index2xy[i];
559         const int error= s->error_status_table[mb_xy];
560         if(!((error&DC_ERROR) && (error&MV_ERROR)))
561             undamaged_count++;
562     }
563
564     if(undamaged_count < 5) return 0; //almost all MBs damaged -> use temporal prediction
565
566     //prevent dsp.sad() check, that requires access to the image
567     if(CONFIG_MPEG_XVMC_DECODER && s->avctx->xvmc_acceleration && s->pict_type == FF_I_TYPE)
568         return 1;
569
570     skip_amount= FFMAX(undamaged_count/50, 1); //check only upto 50 MBs
571     is_intra_likely=0;
572
573     j=0;
574     for(mb_y= 0; mb_y<s->mb_height-1; mb_y++){
575         for(mb_x= 0; mb_x<s->mb_width; mb_x++){
576             int error;
577             const int mb_xy= mb_x + mb_y*s->mb_stride;
578
579             error= s->error_status_table[mb_xy];
580             if((error&DC_ERROR) && (error&MV_ERROR))
581                 continue; //skip damaged
582
583             j++;
584             if((j%skip_amount) != 0) continue; //skip a few to speed things up
585
586             if(s->pict_type==FF_I_TYPE){
587                 uint8_t *mb_ptr     = s->current_picture.data[0] + mb_x*16 + mb_y*16*s->linesize;
588                 uint8_t *last_mb_ptr= s->last_picture.data   [0] + mb_x*16 + mb_y*16*s->linesize;
589
590                 is_intra_likely += s->dsp.sad[0](NULL, last_mb_ptr, mb_ptr                    , s->linesize, 16);
591                 is_intra_likely -= s->dsp.sad[0](NULL, last_mb_ptr, last_mb_ptr+s->linesize*16, s->linesize, 16);
592             }else{
593                 if(IS_INTRA(s->current_picture.mb_type[mb_xy]))
594                    is_intra_likely++;
595                 else
596                    is_intra_likely--;
597             }
598         }
599     }
600 //printf("is_intra_likely: %d type:%d\n", is_intra_likely, s->pict_type);
601     return is_intra_likely > 0;
602 }
603
604 void ff_er_frame_start(MpegEncContext *s){
605     if(!s->error_recognition) return;
606
607     memset(s->error_status_table, MV_ERROR|AC_ERROR|DC_ERROR|VP_START|AC_END|DC_END|MV_END, s->mb_stride*s->mb_height*sizeof(uint8_t));
608     s->error_count= 3*s->mb_num;
609 }
610
611 /**
612  * adds a slice.
613  * @param endx x component of the last macroblock, can be -1 for the last of the previous line
614  * @param status the status at the end (MV_END, AC_ERROR, ...), it is assumed that no earlier end or
615  *               error of the same type occurred
616  */
617 void ff_er_add_slice(MpegEncContext *s, int startx, int starty, int endx, int endy, int status){
618     const int start_i= av_clip(startx + starty * s->mb_width    , 0, s->mb_num-1);
619     const int end_i  = av_clip(endx   + endy   * s->mb_width    , 0, s->mb_num);
620     const int start_xy= s->mb_index2xy[start_i];
621     const int end_xy  = s->mb_index2xy[end_i];
622     int mask= -1;
623
624     if(s->avctx->hwaccel)
625         return;
626
627     if(start_i > end_i || start_xy > end_xy){
628         av_log(s->avctx, AV_LOG_ERROR, "internal error, slice end before start\n");
629         return;
630     }
631
632     if(!s->error_recognition) return;
633
634     mask &= ~VP_START;
635     if(status & (AC_ERROR|AC_END)){
636         mask &= ~(AC_ERROR|AC_END);
637         s->error_count -= end_i - start_i + 1;
638     }
639     if(status & (DC_ERROR|DC_END)){
640         mask &= ~(DC_ERROR|DC_END);
641         s->error_count -= end_i - start_i + 1;
642     }
643     if(status & (MV_ERROR|MV_END)){
644         mask &= ~(MV_ERROR|MV_END);
645         s->error_count -= end_i - start_i + 1;
646     }
647
648     if(status & (AC_ERROR|DC_ERROR|MV_ERROR)) s->error_count= INT_MAX;
649
650     if(mask == ~0x7F){
651         memset(&s->error_status_table[start_xy], 0, (end_xy - start_xy) * sizeof(uint8_t));
652     }else{
653         int i;
654         for(i=start_xy; i<end_xy; i++){
655             s->error_status_table[ i ] &= mask;
656         }
657     }
658
659     if(end_i == s->mb_num)
660         s->error_count= INT_MAX;
661     else{
662         s->error_status_table[end_xy] &= mask;
663         s->error_status_table[end_xy] |= status;
664     }
665
666     s->error_status_table[start_xy] |= VP_START;
667
668     if(start_xy > 0 && s->avctx->thread_count <= 1 && s->avctx->skip_top*s->mb_width < start_i){
669         int prev_status= s->error_status_table[ s->mb_index2xy[start_i - 1] ];
670
671         prev_status &= ~ VP_START;
672         if(prev_status != (MV_END|DC_END|AC_END)) s->error_count= INT_MAX;
673     }
674 }
675
676 void ff_er_frame_end(MpegEncContext *s){
677     int i, mb_x, mb_y, error, error_type, dc_error, mv_error, ac_error;
678     int distance;
679     int threshold_part[4]= {100,100,100};
680     int threshold= 50;
681     int is_intra_likely;
682     int size = s->b8_stride * 2 * s->mb_height;
683     Picture *pic= s->current_picture_ptr;
684
685     if(!s->error_recognition || s->error_count==0 || s->avctx->lowres ||
686        s->avctx->hwaccel ||
687        s->avctx->codec->capabilities&CODEC_CAP_HWACCEL_VDPAU ||
688        s->picture_structure != PICT_FRAME || // we dont support ER of field pictures yet, though it should not crash if enabled
689        s->error_count==3*s->mb_width*(s->avctx->skip_top + s->avctx->skip_bottom)) return;
690
691     if(s->current_picture.motion_val[0] == NULL){
692         av_log(s->avctx, AV_LOG_ERROR, "Warning MVs not available\n");
693
694         for(i=0; i<2; i++){
695             pic->ref_index[i]= av_mallocz(size * sizeof(uint8_t));
696             pic->motion_val_base[i]= av_mallocz((size+4) * 2 * sizeof(uint16_t));
697             pic->motion_val[i]= pic->motion_val_base[i]+4;
698         }
699         pic->motion_subsample_log2= 3;
700         s->current_picture= *s->current_picture_ptr;
701     }
702
703     for(i=0; i<2; i++){
704         if(pic->ref_index[i])
705             memset(pic->ref_index[i], 0, size * sizeof(uint8_t));
706     }
707
708     if(s->avctx->debug&FF_DEBUG_ER){
709         for(mb_y=0; mb_y<s->mb_height; mb_y++){
710             for(mb_x=0; mb_x<s->mb_width; mb_x++){
711                 int status= s->error_status_table[mb_x + mb_y*s->mb_stride];
712
713                 av_log(s->avctx, AV_LOG_DEBUG, "%2X ", status);
714             }
715             av_log(s->avctx, AV_LOG_DEBUG, "\n");
716         }
717     }
718
719 #if 1
720     /* handle overlapping slices */
721     for(error_type=1; error_type<=3; error_type++){
722         int end_ok=0;
723
724         for(i=s->mb_num-1; i>=0; i--){
725             const int mb_xy= s->mb_index2xy[i];
726             int error= s->error_status_table[mb_xy];
727
728             if(error&(1<<error_type))
729                 end_ok=1;
730             if(error&(8<<error_type))
731                 end_ok=1;
732
733             if(!end_ok)
734                 s->error_status_table[mb_xy]|= 1<<error_type;
735
736             if(error&VP_START)
737                 end_ok=0;
738         }
739     }
740 #endif
741 #if 1
742     /* handle slices with partitions of different length */
743     if(s->partitioned_frame){
744         int end_ok=0;
745
746         for(i=s->mb_num-1; i>=0; i--){
747             const int mb_xy= s->mb_index2xy[i];
748             int error= s->error_status_table[mb_xy];
749
750             if(error&AC_END)
751                 end_ok=0;
752             if((error&MV_END) || (error&DC_END) || (error&AC_ERROR))
753                 end_ok=1;
754
755             if(!end_ok)
756                 s->error_status_table[mb_xy]|= AC_ERROR;
757
758             if(error&VP_START)
759                 end_ok=0;
760         }
761     }
762 #endif
763     /* handle missing slices */
764     if(s->error_recognition>=4){
765         int end_ok=1;
766
767         for(i=s->mb_num-2; i>=s->mb_width+100; i--){ //FIXME +100 hack
768             const int mb_xy= s->mb_index2xy[i];
769             int error1= s->error_status_table[mb_xy  ];
770             int error2= s->error_status_table[s->mb_index2xy[i+1]];
771
772             if(error1&VP_START)
773                 end_ok=1;
774
775             if(   error2==(VP_START|DC_ERROR|AC_ERROR|MV_ERROR|AC_END|DC_END|MV_END)
776                && error1!=(VP_START|DC_ERROR|AC_ERROR|MV_ERROR|AC_END|DC_END|MV_END)
777                && ((error1&AC_END) || (error1&DC_END) || (error1&MV_END))){ //end & uninit
778                 end_ok=0;
779             }
780
781             if(!end_ok)
782                 s->error_status_table[mb_xy]|= DC_ERROR|AC_ERROR|MV_ERROR;
783         }
784     }
785
786 #if 1
787     /* backward mark errors */
788     distance=9999999;
789     for(error_type=1; error_type<=3; error_type++){
790         for(i=s->mb_num-1; i>=0; i--){
791             const int mb_xy= s->mb_index2xy[i];
792             int error= s->error_status_table[mb_xy];
793
794             if(!s->mbskip_table[mb_xy]) //FIXME partition specific
795                 distance++;
796             if(error&(1<<error_type))
797                 distance= 0;
798
799             if(s->partitioned_frame){
800                 if(distance < threshold_part[error_type-1])
801                     s->error_status_table[mb_xy]|= 1<<error_type;
802             }else{
803                 if(distance < threshold)
804                     s->error_status_table[mb_xy]|= 1<<error_type;
805             }
806
807             if(error&VP_START)
808                 distance= 9999999;
809         }
810     }
811 #endif
812
813     /* forward mark errors */
814     error=0;
815     for(i=0; i<s->mb_num; i++){
816         const int mb_xy= s->mb_index2xy[i];
817         int old_error= s->error_status_table[mb_xy];
818
819         if(old_error&VP_START)
820             error= old_error& (DC_ERROR|AC_ERROR|MV_ERROR);
821         else{
822             error|= old_error& (DC_ERROR|AC_ERROR|MV_ERROR);
823             s->error_status_table[mb_xy]|= error;
824         }
825     }
826 #if 1
827     /* handle not partitioned case */
828     if(!s->partitioned_frame){
829         for(i=0; i<s->mb_num; i++){
830             const int mb_xy= s->mb_index2xy[i];
831             error= s->error_status_table[mb_xy];
832             if(error&(AC_ERROR|DC_ERROR|MV_ERROR))
833                 error|= AC_ERROR|DC_ERROR|MV_ERROR;
834             s->error_status_table[mb_xy]= error;
835         }
836     }
837 #endif
838
839     dc_error= ac_error= mv_error=0;
840     for(i=0; i<s->mb_num; i++){
841         const int mb_xy= s->mb_index2xy[i];
842         error= s->error_status_table[mb_xy];
843         if(error&DC_ERROR) dc_error ++;
844         if(error&AC_ERROR) ac_error ++;
845         if(error&MV_ERROR) mv_error ++;
846     }
847     av_log(s->avctx, AV_LOG_INFO, "concealing %d DC, %d AC, %d MV errors\n", dc_error, ac_error, mv_error);
848
849     is_intra_likely= is_intra_more_likely(s);
850
851     /* set unknown mb-type to most likely */
852     for(i=0; i<s->mb_num; i++){
853         const int mb_xy= s->mb_index2xy[i];
854         error= s->error_status_table[mb_xy];
855         if(!((error&DC_ERROR) && (error&MV_ERROR)))
856             continue;
857
858         if(is_intra_likely)
859             s->current_picture.mb_type[mb_xy]= MB_TYPE_INTRA4x4;
860         else
861             s->current_picture.mb_type[mb_xy]= MB_TYPE_16x16 | MB_TYPE_L0;
862     }
863
864     // change inter to intra blocks if no reference frames are available
865     if (!s->last_picture.data[0] && !s->next_picture.data[0])
866         for(i=0; i<s->mb_num; i++){
867             const int mb_xy= s->mb_index2xy[i];
868             if(!IS_INTRA(s->current_picture.mb_type[mb_xy]))
869                 s->current_picture.mb_type[mb_xy]= MB_TYPE_INTRA4x4;
870         }
871
872     /* handle inter blocks with damaged AC */
873     for(mb_y=0; mb_y<s->mb_height; mb_y++){
874         for(mb_x=0; mb_x<s->mb_width; mb_x++){
875             const int mb_xy= mb_x + mb_y * s->mb_stride;
876             const int mb_type= s->current_picture.mb_type[mb_xy];
877             int dir = !s->last_picture.data[0];
878             error= s->error_status_table[mb_xy];
879
880             if(IS_INTRA(mb_type)) continue; //intra
881             if(error&MV_ERROR) continue;              //inter with damaged MV
882             if(!(error&AC_ERROR)) continue;           //undamaged inter
883
884             s->mv_dir = dir ? MV_DIR_BACKWARD : MV_DIR_FORWARD;
885             s->mb_intra=0;
886             s->mb_skipped=0;
887             if(IS_8X8(mb_type)){
888                 int mb_index= mb_x*2 + mb_y*2*s->b8_stride;
889                 int j;
890                 s->mv_type = MV_TYPE_8X8;
891                 for(j=0; j<4; j++){
892                     s->mv[0][j][0] = s->current_picture.motion_val[dir][ mb_index + (j&1) + (j>>1)*s->b8_stride ][0];
893                     s->mv[0][j][1] = s->current_picture.motion_val[dir][ mb_index + (j&1) + (j>>1)*s->b8_stride ][1];
894                 }
895             }else{
896                 s->mv_type = MV_TYPE_16X16;
897                 s->mv[0][0][0] = s->current_picture.motion_val[dir][ mb_x*2 + mb_y*2*s->b8_stride ][0];
898                 s->mv[0][0][1] = s->current_picture.motion_val[dir][ mb_x*2 + mb_y*2*s->b8_stride ][1];
899             }
900
901             s->dsp.clear_blocks(s->block[0]);
902
903             s->mb_x= mb_x;
904             s->mb_y= mb_y;
905             decode_mb(s);
906         }
907     }
908
909     /* guess MVs */
910     if(s->pict_type==FF_B_TYPE){
911         for(mb_y=0; mb_y<s->mb_height; mb_y++){
912             for(mb_x=0; mb_x<s->mb_width; mb_x++){
913                 int xy= mb_x*2 + mb_y*2*s->b8_stride;
914                 const int mb_xy= mb_x + mb_y * s->mb_stride;
915                 const int mb_type= s->current_picture.mb_type[mb_xy];
916                 error= s->error_status_table[mb_xy];
917
918                 if(IS_INTRA(mb_type)) continue;
919                 if(!(error&MV_ERROR)) continue;           //inter with undamaged MV
920                 if(!(error&AC_ERROR)) continue;           //undamaged inter
921
922                 s->mv_dir = MV_DIR_FORWARD|MV_DIR_BACKWARD;
923                 if(!s->last_picture.data[0]) s->mv_dir &= ~MV_DIR_FORWARD;
924                 if(!s->next_picture.data[0]) s->mv_dir &= ~MV_DIR_BACKWARD;
925                 s->mb_intra=0;
926                 s->mv_type = MV_TYPE_16X16;
927                 s->mb_skipped=0;
928
929                 if(s->pp_time){
930                     int time_pp= s->pp_time;
931                     int time_pb= s->pb_time;
932
933                     s->mv[0][0][0] = s->next_picture.motion_val[0][xy][0]*time_pb/time_pp;
934                     s->mv[0][0][1] = s->next_picture.motion_val[0][xy][1]*time_pb/time_pp;
935                     s->mv[1][0][0] = s->next_picture.motion_val[0][xy][0]*(time_pb - time_pp)/time_pp;
936                     s->mv[1][0][1] = s->next_picture.motion_val[0][xy][1]*(time_pb - time_pp)/time_pp;
937                 }else{
938                     s->mv[0][0][0]= 0;
939                     s->mv[0][0][1]= 0;
940                     s->mv[1][0][0]= 0;
941                     s->mv[1][0][1]= 0;
942                 }
943
944                 s->dsp.clear_blocks(s->block[0]);
945                 s->mb_x= mb_x;
946                 s->mb_y= mb_y;
947                 decode_mb(s);
948             }
949         }
950     }else
951         guess_mv(s);
952
953     /* the filters below are not XvMC compatible, skip them */
954     if(CONFIG_MPEG_XVMC_DECODER && s->avctx->xvmc_acceleration)
955         goto ec_clean;
956     /* fill DC for inter blocks */
957     for(mb_y=0; mb_y<s->mb_height; mb_y++){
958         for(mb_x=0; mb_x<s->mb_width; mb_x++){
959             int dc, dcu, dcv, y, n;
960             int16_t *dc_ptr;
961             uint8_t *dest_y, *dest_cb, *dest_cr;
962             const int mb_xy= mb_x + mb_y * s->mb_stride;
963             const int mb_type= s->current_picture.mb_type[mb_xy];
964
965             error= s->error_status_table[mb_xy];
966
967             if(IS_INTRA(mb_type) && s->partitioned_frame) continue;
968 //            if(error&MV_ERROR) continue; //inter data damaged FIXME is this good?
969
970             dest_y = s->current_picture.data[0] + mb_x*16 + mb_y*16*s->linesize;
971             dest_cb= s->current_picture.data[1] + mb_x*8  + mb_y*8 *s->uvlinesize;
972             dest_cr= s->current_picture.data[2] + mb_x*8  + mb_y*8 *s->uvlinesize;
973
974             dc_ptr= &s->dc_val[0][mb_x*2 + mb_y*2*s->b8_stride];
975             for(n=0; n<4; n++){
976                 dc=0;
977                 for(y=0; y<8; y++){
978                     int x;
979                     for(x=0; x<8; x++){
980                        dc+= dest_y[x + (n&1)*8 + (y + (n>>1)*8)*s->linesize];
981                     }
982                 }
983                 dc_ptr[(n&1) + (n>>1)*s->b8_stride]= (dc+4)>>3;
984             }
985
986             dcu=dcv=0;
987             for(y=0; y<8; y++){
988                 int x;
989                 for(x=0; x<8; x++){
990                     dcu+=dest_cb[x + y*(s->uvlinesize)];
991                     dcv+=dest_cr[x + y*(s->uvlinesize)];
992                 }
993             }
994             s->dc_val[1][mb_x + mb_y*s->mb_stride]= (dcu+4)>>3;
995             s->dc_val[2][mb_x + mb_y*s->mb_stride]= (dcv+4)>>3;
996         }
997     }
998 #if 1
999     /* guess DC for damaged blocks */
1000     guess_dc(s, s->dc_val[0], s->mb_width*2, s->mb_height*2, s->b8_stride, 1);
1001     guess_dc(s, s->dc_val[1], s->mb_width  , s->mb_height  , s->mb_stride, 0);
1002     guess_dc(s, s->dc_val[2], s->mb_width  , s->mb_height  , s->mb_stride, 0);
1003 #endif
1004     /* filter luma DC */
1005     filter181(s->dc_val[0], s->mb_width*2, s->mb_height*2, s->b8_stride);
1006
1007 #if 1
1008     /* render DC only intra */
1009     for(mb_y=0; mb_y<s->mb_height; mb_y++){
1010         for(mb_x=0; mb_x<s->mb_width; mb_x++){
1011             uint8_t *dest_y, *dest_cb, *dest_cr;
1012             const int mb_xy= mb_x + mb_y * s->mb_stride;
1013             const int mb_type= s->current_picture.mb_type[mb_xy];
1014
1015             error= s->error_status_table[mb_xy];
1016
1017             if(IS_INTER(mb_type)) continue;
1018             if(!(error&AC_ERROR)) continue;              //undamaged
1019
1020             dest_y = s->current_picture.data[0] + mb_x*16 + mb_y*16*s->linesize;
1021             dest_cb= s->current_picture.data[1] + mb_x*8  + mb_y*8 *s->uvlinesize;
1022             dest_cr= s->current_picture.data[2] + mb_x*8  + mb_y*8 *s->uvlinesize;
1023
1024             put_dc(s, dest_y, dest_cb, dest_cr, mb_x, mb_y);
1025         }
1026     }
1027 #endif
1028
1029     if(s->avctx->error_concealment&FF_EC_DEBLOCK){
1030         /* filter horizontal block boundaries */
1031         h_block_filter(s, s->current_picture.data[0], s->mb_width*2, s->mb_height*2, s->linesize  , 1);
1032         h_block_filter(s, s->current_picture.data[1], s->mb_width  , s->mb_height  , s->uvlinesize, 0);
1033         h_block_filter(s, s->current_picture.data[2], s->mb_width  , s->mb_height  , s->uvlinesize, 0);
1034
1035         /* filter vertical block boundaries */
1036         v_block_filter(s, s->current_picture.data[0], s->mb_width*2, s->mb_height*2, s->linesize  , 1);
1037         v_block_filter(s, s->current_picture.data[1], s->mb_width  , s->mb_height  , s->uvlinesize, 0);
1038         v_block_filter(s, s->current_picture.data[2], s->mb_width  , s->mb_height  , s->uvlinesize, 0);
1039     }
1040
1041 ec_clean:
1042     /* clean a few tables */
1043     for(i=0; i<s->mb_num; i++){
1044         const int mb_xy= s->mb_index2xy[i];
1045         int error= s->error_status_table[mb_xy];
1046
1047         if(s->pict_type!=FF_B_TYPE && (error&(DC_ERROR|MV_ERROR|AC_ERROR))){
1048             s->mbskip_table[mb_xy]=0;
1049         }
1050         s->mbintra_table[mb_xy]=1;
1051     }
1052 }