[cvs] / xvidcore / src / decoder.c Repository:
ViewVC logotype

Diff of /xvidcore/src/decoder.c

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

revision 1.21, Sat Jun 22 07:23:09 2002 UTC revision 1.49.2.19, Thu Nov 13 22:35:30 2003 UTC
# Line 1  Line 1 
1  /**************************************************************************  /*****************************************************************************
2   *   *
3   *  XVID MPEG-4 VIDEO CODEC   *  XVID MPEG-4 VIDEO CODEC
4   *  -  Decoder main module  -   *  - Decoder Module -
5   *   *
6   *  This program is an implementation of a part of one or more MPEG-4   *  Copyright(C) 2002      MinChen <chenm001@163.com>
7   *  Video tools as specified in ISO/IEC 14496-2 standard.  Those intending   *               2002-2003 Peter Ross <pross@xvid.org>
  *  to use this software module in hardware or software products are  
  *  advised that its use may infringe existing patents or copyrights, and  
  *  any such use would be at such party's own risk.  The original  
  *  developer of this software module and his/her company, and subsequent  
  *  editors and their companies, will have no liability for use of this  
  *  software or modifications or derivatives thereof.  
8   *   *
9   *  This program is free software; you can redistribute it and/or modify   *  This program is free software; you can redistribute it and/or modify
10   *  it under the terms of the GNU General Public License as published by   *  it under the terms of the GNU General Public License as published by
# Line 26  Line 20 
20   *  along with this program; if not, write to the Free Software   *  along with this program; if not, write to the Free Software
21   *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA   *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
22   *   *
  *************************************************************************/  
   
 /**************************************************************************  
  *  
  *  History:  
  *  
  *      22.06.2002      added primative N_VOP support  
  *                              #define BFRAMES_DEC now enables Minchenm's bframe decoder  
  *  08.05.2002  add low_delay support for B_VOP decode  
  *              MinChen <chenm001@163.com>  
  *  05.05.2002  fix some B-frame decode problem  
  *  02.05.2002  add B-frame decode support(have some problem);  
  *              MinChen <chenm001@163.com>  
  *  22.04.2002  add some B-frame decode support;  chenm001 <chenm001@163.com>  
  *  29.03.2002  interlacing fix - compensated block wasn't being used when  
  *              reconstructing blocks, thus artifacts  
  *              interlacing speedup - used transfers to re-interlace  
  *              interlaced decoding should be as fast as progressive now  
  *  26.03.2002  interlacing support - moved transfers outside decode loop  
  *  26.12.2001  decoder_mbinter: dequant/idct moved within if(coded) block  
  *  22.12.2001  lock based interpolation  
  *  01.12.2001  inital version; (c)2001 peter ross <pross@cs.rmit.edu.au>  
  *  
23   *  $Id$   *  $Id$
24   *   *
25   *************************************************************************/   ****************************************************************************/
26    
27    #include <stdio.h>
28  #include <stdlib.h>  #include <stdlib.h>
29  #include <string.h>  #include <string.h>
30    
31    #ifdef BFRAMES_DEC_DEBUG
32            #define BFRAMES_DEC
33    #endif
34    
35  #include "xvid.h"  #include "xvid.h"
36  #include "portab.h"  #include "portab.h"
37    #include "global.h"
38    
39  #include "decoder.h"  #include "decoder.h"
40  #include "bitstream/bitstream.h"  #include "bitstream/bitstream.h"
41  #include "bitstream/mbcoding.h"  #include "bitstream/mbcoding.h"
42    
43  #include "quant/quant_h263.h"  #include "quant/quant.h"
 #include "quant/quant_mpeg4.h"  
44  #include "dct/idct.h"  #include "dct/idct.h"
45  #include "dct/fdct.h"  #include "dct/fdct.h"
46  #include "utils/mem_transfer.h"  #include "utils/mem_transfer.h"
47  #include "image/interpolate8x8.h"  #include "image/interpolate8x8.h"
48    #include "image/reduced.h"
49    #include "image/font.h"
50    
51  #include "bitstream/mbcoding.h"  #include "bitstream/mbcoding.h"
52  #include "prediction/mbprediction.h"  #include "prediction/mbprediction.h"
53  #include "utils/timer.h"  #include "utils/timer.h"
54  #include "utils/emms.h"  #include "utils/emms.h"
55    #include "motion/motion.h"
56    #include "motion/gmc.h"
57    
58  #include "image/image.h"  #include "image/image.h"
59  #include "image/colorspace.h"  #include "image/colorspace.h"
60  #include "utils/mem_align.h"  #include "utils/mem_align.h"
61    
62  int  static int
63  decoder_create(XVID_DEC_PARAM * param)  decoder_resize(DECODER * dec)
64  {  {
65          DECODER *dec;          /* free existing */
66            image_destroy(&dec->cur, dec->edged_width, dec->edged_height);
67            image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);
68            image_destroy(&dec->refn[1], dec->edged_width, dec->edged_height);
69            image_destroy(&dec->tmp, dec->edged_width, dec->edged_height);
70            image_destroy(&dec->qtmp, dec->edged_width, dec->edged_height);
71    
72          dec = xvid_malloc(sizeof(DECODER), CACHE_LINE);          image_destroy(&dec->gmc, dec->edged_width, dec->edged_height);
         if (dec == NULL) {  
                 return XVID_ERR_MEMORY;  
         }  
         param->handle = dec;  
73    
74          dec->width = param->width;          if (dec->last_mbs)
75          dec->height = param->height;                  xvid_free(dec->last_mbs);
76            if (dec->mbs)
77                    xvid_free(dec->mbs);
78    
79            /* realloc */
80          dec->mb_width = (dec->width + 15) / 16;          dec->mb_width = (dec->width + 15) / 16;
81          dec->mb_height = (dec->height + 15) / 16;          dec->mb_height = (dec->height + 15) / 16;
82    
83          dec->edged_width = 16 * dec->mb_width + 2 * EDGE_SIZE;          dec->edged_width = 16 * dec->mb_width + 2 * EDGE_SIZE;
84          dec->edged_height = 16 * dec->mb_height + 2 * EDGE_SIZE;          dec->edged_height = 16 * dec->mb_height + 2 * EDGE_SIZE;
         dec->low_delay = 0;  
85    
86          if (image_create(&dec->cur, dec->edged_width, dec->edged_height)) {          if (image_create(&dec->cur, dec->edged_width, dec->edged_height)) {
87                  xvid_free(dec);                  xvid_free(dec);
# Line 110  Line 93 
93                  xvid_free(dec);                  xvid_free(dec);
94                  return XVID_ERR_MEMORY;                  return XVID_ERR_MEMORY;
95          }          }
96          // add by chenm001 <chenm001@163.com>  
97          // for support B-frame to reference last 2 frame          /* Support B-frame to reference last 2 frame */
98          if (image_create(&dec->refn[1], dec->edged_width, dec->edged_height)) {          if (image_create(&dec->refn[1], dec->edged_width, dec->edged_height)) {
99                  image_destroy(&dec->cur, dec->edged_width, dec->edged_height);                  image_destroy(&dec->cur, dec->edged_width, dec->edged_height);
100                  image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);                  image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);
101                  xvid_free(dec);                  xvid_free(dec);
102                  return XVID_ERR_MEMORY;                  return XVID_ERR_MEMORY;
103          }          }
104          if (image_create(&dec->refn[2], dec->edged_width, dec->edged_height)) {          if (image_create(&dec->tmp, dec->edged_width, dec->edged_height)) {
105                    image_destroy(&dec->cur, dec->edged_width, dec->edged_height);
106                    image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);
107                    image_destroy(&dec->refn[1], dec->edged_width, dec->edged_height);
108                    xvid_free(dec);
109                    return XVID_ERR_MEMORY;
110            }
111    
112            if (image_create(&dec->qtmp, dec->edged_width, dec->edged_height)) {
113                    image_destroy(&dec->cur, dec->edged_width, dec->edged_height);
114                    image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);
115                    image_destroy(&dec->refn[1], dec->edged_width, dec->edged_height);
116                    image_destroy(&dec->tmp, dec->edged_width, dec->edged_height);
117                    xvid_free(dec);
118                    return XVID_ERR_MEMORY;
119            }
120    
121            if (image_create(&dec->gmc, dec->edged_width, dec->edged_height)) {
122                    image_destroy(&dec->qtmp, dec->edged_width, dec->edged_height);
123                  image_destroy(&dec->cur, dec->edged_width, dec->edged_height);                  image_destroy(&dec->cur, dec->edged_width, dec->edged_height);
124                  image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);                  image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);
125                  image_destroy(&dec->refn[1], dec->edged_width, dec->edged_height);                  image_destroy(&dec->refn[1], dec->edged_width, dec->edged_height);
126                    image_destroy(&dec->tmp, dec->edged_width, dec->edged_height);
127                  xvid_free(dec);                  xvid_free(dec);
128                  return XVID_ERR_MEMORY;                  return XVID_ERR_MEMORY;
129          }          }
# Line 133  Line 135 
135                  image_destroy(&dec->cur, dec->edged_width, dec->edged_height);                  image_destroy(&dec->cur, dec->edged_width, dec->edged_height);
136                  image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);                  image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);
137                  image_destroy(&dec->refn[1], dec->edged_width, dec->edged_height);                  image_destroy(&dec->refn[1], dec->edged_width, dec->edged_height);
138                  image_destroy(&dec->refn[2], dec->edged_width, dec->edged_height);                  image_destroy(&dec->tmp, dec->edged_width, dec->edged_height);
139                    image_destroy(&dec->qtmp, dec->edged_width, dec->edged_height);
140                  xvid_free(dec);                  xvid_free(dec);
141                  return XVID_ERR_MEMORY;                  return XVID_ERR_MEMORY;
142          }          }
   
143          memset(dec->mbs, 0, sizeof(MACROBLOCK) * dec->mb_width * dec->mb_height);          memset(dec->mbs, 0, sizeof(MACROBLOCK) * dec->mb_width * dec->mb_height);
144    
145          // add by chenm001 <chenm001@163.com>          /* For skip MB flag */
         // for skip MB flag  
146          dec->last_mbs =          dec->last_mbs =
147                  xvid_malloc(sizeof(MACROBLOCK) * dec->mb_width * dec->mb_height,                  xvid_malloc(sizeof(MACROBLOCK) * dec->mb_width * dec->mb_height,
148                                          CACHE_LINE);                                          CACHE_LINE);
# Line 150  Line 151 
151                  image_destroy(&dec->cur, dec->edged_width, dec->edged_height);                  image_destroy(&dec->cur, dec->edged_width, dec->edged_height);
152                  image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);                  image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);
153                  image_destroy(&dec->refn[1], dec->edged_width, dec->edged_height);                  image_destroy(&dec->refn[1], dec->edged_width, dec->edged_height);
154                  image_destroy(&dec->refn[2], dec->edged_width, dec->edged_height);                  image_destroy(&dec->tmp, dec->edged_width, dec->edged_height);
155                    image_destroy(&dec->qtmp, dec->edged_width, dec->edged_height);
156                  xvid_free(dec);                  xvid_free(dec);
157                  return XVID_ERR_MEMORY;                  return XVID_ERR_MEMORY;
158          }          }
159    
160          memset(dec->last_mbs, 0, sizeof(MACROBLOCK) * dec->mb_width * dec->mb_height);          memset(dec->last_mbs, 0, sizeof(MACROBLOCK) * dec->mb_width * dec->mb_height);
161    
162            return 0;
163    }
164    
165    
166    int
167    decoder_create(xvid_dec_create_t * create)
168    {
169            DECODER *dec;
170    
171            if (XVID_VERSION_MAJOR(create->version) != 1)   /* v1.x.x */
172                    return XVID_ERR_VERSION;
173    
174            dec = xvid_malloc(sizeof(DECODER), CACHE_LINE);
175            if (dec == NULL) {
176                    return XVID_ERR_MEMORY;
177            }
178            memset(dec, 0, sizeof(DECODER));
179    
180            create->handle = dec;
181    
182            dec->width = create->width;
183            dec->height = create->height;
184    
185            image_null(&dec->cur);
186            image_null(&dec->refn[0]);
187            image_null(&dec->refn[1]);
188            image_null(&dec->tmp);
189            image_null(&dec->qtmp);
190    
191            /* image based GMC */
192            image_null(&dec->gmc);
193    
194    
195            dec->mbs = NULL;
196            dec->last_mbs = NULL;
197    
198          init_timer();          init_timer();
199    
200          // add by chenm001 <chenm001@163.com>          /* For B-frame support (used to save reference frame's time */
201          // for support B-frame to save reference frame's time          dec->frames = 0;
         dec->frames = -1;  
202          dec->time = dec->time_base = dec->last_time_base = 0;          dec->time = dec->time_base = dec->last_time_base = 0;
203            dec->low_delay = 0;
204            dec->packed_mode = 0;
205    
206          return XVID_ERR_OK;          dec->fixed_dimensions = (dec->width > 0 && dec->height > 0);
207    
208            if (dec->fixed_dimensions)
209                    return decoder_resize(dec);
210            else
211                    return 0;
212  }  }
213    
214    
# Line 173  Line 217 
217  {  {
218          xvid_free(dec->last_mbs);          xvid_free(dec->last_mbs);
219          xvid_free(dec->mbs);          xvid_free(dec->mbs);
220    
221            /* image based GMC */
222            image_destroy(&dec->gmc, dec->edged_width, dec->edged_height);
223    
224          image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);          image_destroy(&dec->refn[0], dec->edged_width, dec->edged_height);
225          image_destroy(&dec->refn[1], dec->edged_width, dec->edged_height);          image_destroy(&dec->refn[1], dec->edged_width, dec->edged_height);
226          image_destroy(&dec->refn[2], dec->edged_width, dec->edged_height);          image_destroy(&dec->tmp, dec->edged_width, dec->edged_height);
227            image_destroy(&dec->qtmp, dec->edged_width, dec->edged_height);
228          image_destroy(&dec->cur, dec->edged_width, dec->edged_height);          image_destroy(&dec->cur, dec->edged_width, dec->edged_height);
229          xvid_free(dec);          xvid_free(dec);
230    
231          write_timer();          write_timer();
232          return XVID_ERR_OK;          return 0;
233  }  }
234    
   
   
235  static const int32_t dquant_table[4] = {  static const int32_t dquant_table[4] = {
236          -1, -2, 1, 2          -1, -2, 1, 2
237  };  };
238    
239    /* decode an intra macroblock */
240    static void
   
 // decode an intra macroblock  
   
 void  
241  decoder_mbintra(DECODER * dec,  decoder_mbintra(DECODER * dec,
242                                  MACROBLOCK * pMB,                                  MACROBLOCK * pMB,
243                                  const uint32_t x_pos,                                  const uint32_t x_pos,
# Line 203  Line 246 
246                                  const uint32_t cbp,                                  const uint32_t cbp,
247                                  Bitstream * bs,                                  Bitstream * bs,
248                                  const uint32_t quant,                                  const uint32_t quant,
249                                  const uint32_t intra_dc_threshold)                                  const uint32_t intra_dc_threshold,
250                                    const unsigned int bound,
251                                    const int reduced_resolution)
252  {  {
253    
254          DECLARE_ALIGNED_MATRIX(block, 6, 64, int16_t, CACHE_LINE);          DECLARE_ALIGNED_MATRIX(block, 6, 64, int16_t, CACHE_LINE);
# Line 216  Line 261 
261          uint32_t iQuant = pMB->quant;          uint32_t iQuant = pMB->quant;
262          uint8_t *pY_Cur, *pU_Cur, *pV_Cur;          uint8_t *pY_Cur, *pU_Cur, *pV_Cur;
263    
264            if (reduced_resolution) {
265                    pY_Cur = dec->cur.y + (y_pos << 5) * stride + (x_pos << 5);
266                    pU_Cur = dec->cur.u + (y_pos << 4) * stride2 + (x_pos << 4);
267                    pV_Cur = dec->cur.v + (y_pos << 4) * stride2 + (x_pos << 4);
268            }else{
269          pY_Cur = dec->cur.y + (y_pos << 4) * stride + (x_pos << 4);          pY_Cur = dec->cur.y + (y_pos << 4) * stride + (x_pos << 4);
270          pU_Cur = dec->cur.u + (y_pos << 3) * stride2 + (x_pos << 3);          pU_Cur = dec->cur.u + (y_pos << 3) * stride2 + (x_pos << 3);
271          pV_Cur = dec->cur.v + (y_pos << 3) * stride2 + (x_pos << 3);          pV_Cur = dec->cur.v + (y_pos << 3) * stride2 + (x_pos << 3);
272            }
273    
274          memset(block, 0, 6 * 64 * sizeof(int16_t));     // clear          memset(block, 0, 6 * 64 * sizeof(int16_t));     /* clear */
275    
276          for (i = 0; i < 6; i++) {          for (i = 0; i < 6; i++) {
277                  uint32_t iDcScaler = get_dc_scaler(iQuant, i < 4);                  uint32_t iDcScaler = get_dc_scaler(iQuant, i < 4);
# Line 229  Line 280 
280    
281                  start_timer();                  start_timer();
282                  predict_acdc(dec->mbs, x_pos, y_pos, dec->mb_width, i, &block[i * 64],                  predict_acdc(dec->mbs, x_pos, y_pos, dec->mb_width, i, &block[i * 64],
283                                           iQuant, iDcScaler, predictors);                                           iQuant, iDcScaler, predictors, bound);
284                  if (!acpred_flag) {                  if (!acpred_flag) {
285                          pMB->acpred_directions[i] = 0;                          pMB->acpred_directions[i] = 0;
286                  }                  }
# Line 243  Line 294 
294                          dc_dif = dc_size ? get_dc_dif(bs, dc_size) : 0;                          dc_dif = dc_size ? get_dc_dif(bs, dc_size) : 0;
295    
296                          if (dc_size > 8) {                          if (dc_size > 8) {
297                                  BitstreamSkip(bs, 1);   // marker                                  BitstreamSkip(bs, 1);   /* marker */
298                          }                          }
299    
300                          block[i * 64 + 0] = dc_dif;                          block[i * 64 + 0] = dc_dif;
301                          start_coeff = 1;                          start_coeff = 1;
302    
303                            DPRINTF(XVID_DEBUG_COEFF,"block[0] %i\n", dc_dif);
304                  } else {                  } else {
305                          start_coeff = 0;                          start_coeff = 0;
306                  }                  }
307    
308                  start_timer();                  start_timer();
309                  if (cbp & (1 << (5 - i)))       // coded                  if (cbp & (1 << (5 - i)))       /* coded */
310                  {                  {
311                          get_intra_block(bs, &block[i * 64], pMB->acpred_directions[i],                          int direction = dec->alternate_vertical_scan ?
312                                                          start_coeff);                                  2 : pMB->acpred_directions[i];
313    
314                            get_intra_block(bs, &block[i * 64], direction, start_coeff);
315                  }                  }
316                  stop_coding_timer();                  stop_coding_timer();
317    
# Line 266  Line 321 
321    
322                  start_timer();                  start_timer();
323                  if (dec->quant_type == 0) {                  if (dec->quant_type == 0) {
324                          dequant_intra(&data[i * 64], &block[i * 64], iQuant, iDcScaler);                          dequant_h263_intra(&data[i * 64], &block[i * 64], iQuant, iDcScaler);
325                  } else {                  } else {
326                          dequant4_intra(&data[i * 64], &block[i * 64], iQuant, iDcScaler);                          dequant_mpeg_intra(&data[i * 64], &block[i * 64], iQuant, iDcScaler);
327                  }                  }
328                  stop_iquant_timer();                  stop_iquant_timer();
329    
330                  start_timer();                  start_timer();
331                  idct(&data[i * 64]);                  idct(&data[i * 64]);
332                  stop_idct_timer();                  stop_idct_timer();
333    
334          }          }
335    
336          if (dec->interlacing && pMB->field_dct) {          if (dec->interlacing && pMB->field_dct) {
# Line 283  Line 339 
339          }          }
340    
341          start_timer();          start_timer();
342    
343            if (reduced_resolution)
344            {
345                    next_block*=2;
346                    copy_upsampled_8x8_16to8(pY_Cur, &data[0 * 64], stride);
347                    copy_upsampled_8x8_16to8(pY_Cur + 16, &data[1 * 64], stride);
348                    copy_upsampled_8x8_16to8(pY_Cur + next_block, &data[2 * 64], stride);
349                    copy_upsampled_8x8_16to8(pY_Cur + 16 + next_block, &data[3 * 64], stride);
350                    copy_upsampled_8x8_16to8(pU_Cur, &data[4 * 64], stride2);
351                    copy_upsampled_8x8_16to8(pV_Cur, &data[5 * 64], stride2);
352            }else{
353          transfer_16to8copy(pY_Cur, &data[0 * 64], stride);          transfer_16to8copy(pY_Cur, &data[0 * 64], stride);
354          transfer_16to8copy(pY_Cur + 8, &data[1 * 64], stride);          transfer_16to8copy(pY_Cur + 8, &data[1 * 64], stride);
355          transfer_16to8copy(pY_Cur + next_block, &data[2 * 64], stride);          transfer_16to8copy(pY_Cur + next_block, &data[2 * 64], stride);
356          transfer_16to8copy(pY_Cur + 8 + next_block, &data[3 * 64], stride);          transfer_16to8copy(pY_Cur + 8 + next_block, &data[3 * 64], stride);
357          transfer_16to8copy(pU_Cur, &data[4 * 64], stride2);          transfer_16to8copy(pU_Cur, &data[4 * 64], stride2);
358          transfer_16to8copy(pV_Cur, &data[5 * 64], stride2);          transfer_16to8copy(pV_Cur, &data[5 * 64], stride2);
359            }
360          stop_transfer_timer();          stop_transfer_timer();
361  }  }
362    
363    static void
364    decoder_mb_decode(DECODER * dec,
365                                    const uint32_t cbp,
366                                    Bitstream * bs,
367                                    uint8_t * pY_Cur,
368                                    uint8_t * pU_Cur,
369                                    uint8_t * pV_Cur,
370                                    const int reduced_resolution,
371                                    const MACROBLOCK * pMB)
372    {
373            DECLARE_ALIGNED_MATRIX(block, 1, 64, int16_t, CACHE_LINE);
374            DECLARE_ALIGNED_MATRIX(data, 6, 64, int16_t, CACHE_LINE);
375    
376            int stride = dec->edged_width;
377            int next_block = stride * (reduced_resolution ? 16 : 8);
378            const int stride2 = stride/2;
379            int i;
380            const uint32_t iQuant = pMB->quant;
381            const int direction = dec->alternate_vertical_scan ? 2 : 0;
382            const quant_interFuncPtr dequant = dec->quant_type == 0 ? dequant_h263_inter : dequant_mpeg_inter;
383    
384            for (i = 0; i < 6; i++) {
385    
386                    if (cbp & (1 << (5 - i))) {     /* coded */
387    
388                            memset(block, 0, 64 * sizeof(int16_t)); /* clear */
389    
390                            start_timer();
391                            get_inter_block(bs, block, direction);
392                            stop_coding_timer();
393    
394                            start_timer();
395                            dequant(&data[i * 64], block, iQuant);
396                            stop_iquant_timer();
397    
398  #define SIGN(X) (((X)>0)?1:-1)                          start_timer();
399  #define ABS(X) (((X)>0)?(X):-(X))                          idct(&data[i * 64]);
400  static const uint32_t roundtab[16] =                          stop_idct_timer();
401          { 0, 0, 0, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 2, 2 };                  }
402            }
403    
404            if (dec->interlacing && pMB->field_dct) {
405                    next_block = stride;
406                    stride *= 2;
407            }
408    
409  // decode an inter macroblock          start_timer();
410            if (reduced_resolution) {
411                    if (cbp & 32)
412                            add_upsampled_8x8_16to8(pY_Cur, &data[0 * 64], stride);
413                    if (cbp & 16)
414                            add_upsampled_8x8_16to8(pY_Cur + 16, &data[1 * 64], stride);
415                    if (cbp & 8)
416                            add_upsampled_8x8_16to8(pY_Cur + next_block, &data[2 * 64], stride);
417                    if (cbp & 4)
418                            add_upsampled_8x8_16to8(pY_Cur + 16 + next_block, &data[3 * 64], stride);
419                    if (cbp & 2)
420                            add_upsampled_8x8_16to8(pU_Cur, &data[4 * 64], stride2);
421                    if (cbp & 1)
422                            add_upsampled_8x8_16to8(pV_Cur, &data[5 * 64], stride2);
423            } else {
424                    if (cbp & 32)
425                            transfer_16to8add(pY_Cur, &data[0 * 64], stride);
426                    if (cbp & 16)
427                            transfer_16to8add(pY_Cur + 8, &data[1 * 64], stride);
428                    if (cbp & 8)
429                            transfer_16to8add(pY_Cur + next_block, &data[2 * 64], stride);
430                    if (cbp & 4)
431                            transfer_16to8add(pY_Cur + 8 + next_block, &data[3 * 64], stride);
432                    if (cbp & 2)
433                            transfer_16to8add(pU_Cur, &data[4 * 64], stride2);
434                    if (cbp & 1)
435                            transfer_16to8add(pV_Cur, &data[5 * 64], stride2);
436            }
437            stop_transfer_timer();
438    }
439    
440  void  /* decode an inter macroblock */
441    static void
442  decoder_mbinter(DECODER * dec,  decoder_mbinter(DECODER * dec,
443                                  const MACROBLOCK * pMB,                                  const MACROBLOCK * pMB,
444                                  const uint32_t x_pos,                                  const uint32_t x_pos,
445                                  const uint32_t y_pos,                                  const uint32_t y_pos,
                                 const uint32_t acpred_flag,  
446                                  const uint32_t cbp,                                  const uint32_t cbp,
447                                  Bitstream * bs,                                  Bitstream * bs,
448                                  const uint32_t quant,                                  const uint32_t rounding,
449                                  const uint32_t rounding)                                  const int reduced_resolution,
450                                    const int ref)
451  {  {
   
         DECLARE_ALIGNED_MATRIX(block, 6, 64, int16_t, CACHE_LINE);  
         DECLARE_ALIGNED_MATRIX(data, 6, 64, int16_t, CACHE_LINE);  
   
452          uint32_t stride = dec->edged_width;          uint32_t stride = dec->edged_width;
453          uint32_t stride2 = stride / 2;          uint32_t stride2 = stride / 2;
         uint32_t next_block = stride * 8;  
454          uint32_t i;          uint32_t i;
455          uint32_t iQuant = pMB->quant;  
456          uint8_t *pY_Cur, *pU_Cur, *pV_Cur;          uint8_t *pY_Cur, *pU_Cur, *pV_Cur;
457    
458          int uv_dx, uv_dy;          int uv_dx, uv_dy;
459            VECTOR mv[4];   /* local copy of mvs */
460    
461            if (reduced_resolution) {
462                    pY_Cur = dec->cur.y + (y_pos << 5) * stride + (x_pos << 5);
463                    pU_Cur = dec->cur.u + (y_pos << 4) * stride2 + (x_pos << 4);
464                    pV_Cur = dec->cur.v + (y_pos << 4) * stride2 + (x_pos << 4);
465                    for (i = 0; i < 4; i++) {
466                            mv[i].x = RRV_MV_SCALEUP(pMB->mvs[i].x);
467                            mv[i].y = RRV_MV_SCALEUP(pMB->mvs[i].y);
468                    }
469            } else {
470          pY_Cur = dec->cur.y + (y_pos << 4) * stride + (x_pos << 4);          pY_Cur = dec->cur.y + (y_pos << 4) * stride + (x_pos << 4);
471          pU_Cur = dec->cur.u + (y_pos << 3) * stride2 + (x_pos << 3);          pU_Cur = dec->cur.u + (y_pos << 3) * stride2 + (x_pos << 3);
472          pV_Cur = dec->cur.v + (y_pos << 3) * stride2 + (x_pos << 3);          pV_Cur = dec->cur.v + (y_pos << 3) * stride2 + (x_pos << 3);
473                    for (i = 0; i < 4; i++)
474                            mv[i] = pMB->mvs[i];
475            }
476    
477          if (pMB->mode == MODE_INTER || pMB->mode == MODE_INTER_Q) {          start_timer();
                 uv_dx = pMB->mvs[0].x;  
                 uv_dy = pMB->mvs[0].y;  
478    
479                  uv_dx = (uv_dx & 3) ? (uv_dx >> 1) | 1 : uv_dx / 2;          if (pMB->mode != MODE_INTER4V) { /* INTER, INTER_Q, NOT_CODED, FORWARD, BACKWARD */
                 uv_dy = (uv_dy & 3) ? (uv_dy >> 1) | 1 : uv_dy / 2;  
         } else {  
                 int sum;  
480    
481                  sum = pMB->mvs[0].x + pMB->mvs[1].x + pMB->mvs[2].x + pMB->mvs[3].x;                  uv_dx = mv[0].x;
482                  uv_dx =                  uv_dy = mv[0].y;
483                          (sum ==                  if (dec->quarterpel) {
484                           0 ? 0 : SIGN(sum) * (roundtab[ABS(sum) % 16] +                          uv_dx /= 2;
485                                                                    (ABS(sum) / 16) * 2));                          uv_dy /= 2;
   
                 sum = pMB->mvs[0].y + pMB->mvs[1].y + pMB->mvs[2].y + pMB->mvs[3].y;  
                 uv_dy =  
                         (sum ==  
                          0 ? 0 : SIGN(sum) * (roundtab[ABS(sum) % 16] +  
                                                                   (ABS(sum) / 16) * 2));  
486          }          }
487                    uv_dx = (uv_dx >> 1) + roundtab_79[uv_dx & 0x3];
488                    uv_dy = (uv_dy >> 1) + roundtab_79[uv_dy & 0x3];
489    
490          start_timer();                  if (reduced_resolution)
491                            interpolate32x32_switch(dec->cur.y, dec->refn[0].y, 32*x_pos, 32*y_pos,
492                                                                            mv[0].x, mv[0].y, stride, rounding);
493                    else if (dec->quarterpel)
494                            interpolate16x16_quarterpel(dec->cur.y, dec->refn[ref].y, dec->qtmp.y, dec->qtmp.y + 64,
495                                                                            dec->qtmp.y + 128, 16*x_pos, 16*y_pos,
496                                                                                            mv[0].x, mv[0].y, stride, rounding);
497                    else
498                            interpolate16x16_switch(dec->cur.y, dec->refn[ref].y, 16*x_pos, 16*y_pos,
499                                                                            mv[0].x, mv[0].y, stride, rounding);
500    
501            } else {        /* MODE_INTER4V */
502    
503                    if(dec->quarterpel) {
504                            uv_dx = (mv[0].x / 2) + (mv[1].x / 2) + (mv[2].x / 2) + (mv[3].x / 2);
505                            uv_dy = (mv[0].y / 2) + (mv[1].y / 2) + (mv[2].y / 2) + (mv[3].y / 2);
506                    } else {
507                            uv_dx = mv[0].x + mv[1].x + mv[2].x + mv[3].x;
508                            uv_dy = mv[0].y + mv[1].y + mv[2].y + mv[3].y;
509                    }
510    
511                    uv_dx = (uv_dx >> 3) + roundtab_76[uv_dx & 0xf];
512                    uv_dy = (uv_dy >> 3) + roundtab_76[uv_dy & 0xf];
513    
514                    if (reduced_resolution) {
515                            interpolate16x16_switch(dec->cur.y, dec->refn[0].y, 32*x_pos, 32*y_pos,
516                                                                    mv[0].x, mv[0].y, stride, rounding);
517                            interpolate16x16_switch(dec->cur.y, dec->refn[0].y , 32*x_pos + 16, 32*y_pos,
518                                                                    mv[1].x, mv[1].y, stride, rounding);
519                            interpolate16x16_switch(dec->cur.y, dec->refn[0].y , 32*x_pos, 32*y_pos + 16,
520                                                                    mv[2].x, mv[2].y, stride, rounding);
521                            interpolate16x16_switch(dec->cur.y, dec->refn[0].y , 32*x_pos + 16, 32*y_pos + 16,
522                                                                    mv[3].x, mv[3].y, stride, rounding);
523                            interpolate16x16_switch(dec->cur.u, dec->refn[0].u , 16 * x_pos, 16 * y_pos,
524                                                                    uv_dx, uv_dy, stride2, rounding);
525                            interpolate16x16_switch(dec->cur.v, dec->refn[0].v , 16 * x_pos, 16 * y_pos,
526                                                                    uv_dx, uv_dy, stride2, rounding);
527    
528                    } else if (dec->quarterpel) {
529                            interpolate8x8_quarterpel(dec->cur.y, dec->refn[0].y , dec->qtmp.y, dec->qtmp.y + 64,
530                                                                            dec->qtmp.y + 128, 16*x_pos, 16*y_pos,
531                                                                            mv[0].x, mv[0].y, stride, rounding);
532                            interpolate8x8_quarterpel(dec->cur.y, dec->refn[0].y , dec->qtmp.y, dec->qtmp.y + 64,
533                                                                            dec->qtmp.y + 128, 16*x_pos + 8, 16*y_pos,
534                                                                            mv[1].x, mv[1].y, stride, rounding);
535                            interpolate8x8_quarterpel(dec->cur.y, dec->refn[0].y , dec->qtmp.y, dec->qtmp.y + 64,
536                                                                            dec->qtmp.y + 128, 16*x_pos, 16*y_pos + 8,
537                                                                            mv[2].x, mv[2].y, stride, rounding);
538                            interpolate8x8_quarterpel(dec->cur.y, dec->refn[0].y , dec->qtmp.y, dec->qtmp.y + 64,
539                                                                            dec->qtmp.y + 128, 16*x_pos + 8, 16*y_pos + 8,
540                                                                            mv[3].x, mv[3].y, stride, rounding);
541                    } else {
542          interpolate8x8_switch(dec->cur.y, dec->refn[0].y, 16 * x_pos, 16 * y_pos,          interpolate8x8_switch(dec->cur.y, dec->refn[0].y, 16 * x_pos, 16 * y_pos,
543                                                    pMB->mvs[0].x, pMB->mvs[0].y, stride, rounding);                                                                  mv[0].x, mv[0].y, stride, rounding);
544          interpolate8x8_switch(dec->cur.y, dec->refn[0].y, 16 * x_pos + 8,                          interpolate8x8_switch(dec->cur.y, dec->refn[0].y , 16*x_pos + 8, 16*y_pos,
545                                                    16 * y_pos, pMB->mvs[1].x, pMB->mvs[1].y, stride,                                                                  mv[1].x, mv[1].y, stride, rounding);
546                                                    rounding);                          interpolate8x8_switch(dec->cur.y, dec->refn[0].y , 16*x_pos, 16*y_pos + 8,
547          interpolate8x8_switch(dec->cur.y, dec->refn[0].y, 16 * x_pos,                                                                  mv[2].x, mv[2].y, stride, rounding);
548                                                    16 * y_pos + 8, pMB->mvs[2].x, pMB->mvs[2].y, stride,                          interpolate8x8_switch(dec->cur.y, dec->refn[0].y , 16*x_pos + 8, 16*y_pos + 8,
549                                                    rounding);                                                                  mv[3].x, mv[3].y, stride, rounding);
550          interpolate8x8_switch(dec->cur.y, dec->refn[0].y, 16 * x_pos + 8,                  }
551                                                    16 * y_pos + 8, pMB->mvs[3].x, pMB->mvs[3].y, stride,          }
552                                                    rounding);  
553          interpolate8x8_switch(dec->cur.u, dec->refn[0].u, 8 * x_pos, 8 * y_pos,          /* chroma */
554            if (reduced_resolution) {
555                    interpolate16x16_switch(dec->cur.u, dec->refn[0].u, 16 * x_pos, 16 * y_pos,
556                                                    uv_dx, uv_dy, stride2, rounding);                                                    uv_dx, uv_dy, stride2, rounding);
557          interpolate8x8_switch(dec->cur.v, dec->refn[0].v, 8 * x_pos, 8 * y_pos,                  interpolate16x16_switch(dec->cur.v, dec->refn[0].v, 16 * x_pos, 16 * y_pos,
558                                                    uv_dx, uv_dy, stride2, rounding);                                                    uv_dx, uv_dy, stride2, rounding);
559            } else {
560                    interpolate8x8_switch(dec->cur.u, dec->refn[ref].u, 8 * x_pos, 8 * y_pos,
561                                                                    uv_dx, uv_dy, stride2, rounding);
562                    interpolate8x8_switch(dec->cur.v, dec->refn[ref].v, 8 * x_pos, 8 * y_pos,
563                                                                    uv_dx, uv_dy, stride2, rounding);
564            }
565    
566          stop_comp_timer();          stop_comp_timer();
567    
568          for (i = 0; i < 6; i++) {          if (cbp)
569                  if (cbp & (1 << (5 - i)))       // coded                  decoder_mb_decode(dec, cbp, bs, pY_Cur, pU_Cur, pV_Cur,
570                                                            reduced_resolution, pMB);
571    }
572    
573    static void
574    decoder_mbgmc(DECODER * dec,
575                                    MACROBLOCK * const pMB,
576                                    const uint32_t x_pos,
577                                    const uint32_t y_pos,
578                                    const uint32_t fcode,
579                                    const uint32_t cbp,
580                                    Bitstream * bs,
581                                    const uint32_t rounding)
582                  {                  {
583                          memset(&block[i * 64], 0, 64 * sizeof(int16_t));        // clear          const uint32_t stride = dec->edged_width;
584            const uint32_t stride2 = stride / 2;
585    
586                          start_timer();          uint8_t *const pY_Cur=dec->cur.y + (y_pos << 4) * stride + (x_pos << 4);
587                          get_inter_block(bs, &block[i * 64]);          uint8_t *const pU_Cur=dec->cur.u + (y_pos << 3) * stride2 + (x_pos << 3);
588                          stop_coding_timer();          uint8_t *const pV_Cur=dec->cur.v + (y_pos << 3) * stride2 + (x_pos << 3);
589    
590                          start_timer();          NEW_GMC_DATA * gmc_data = &dec->new_gmc_data;
591                          if (dec->quant_type == 0) {  
592                                  dequant_inter(&data[i * 64], &block[i * 64], iQuant);          pMB->mvs[0] = pMB->mvs[1] = pMB->mvs[2] = pMB->mvs[3] = pMB->amv;
                         } else {  
                                 dequant4_inter(&data[i * 64], &block[i * 64], iQuant);  
                         }  
                         stop_iquant_timer();  
593    
594                          start_timer();                          start_timer();
                         idct(&data[i * 64]);  
                         stop_idct_timer();  
                 }  
         }  
595    
596          if (dec->interlacing && pMB->field_dct) {  /* this is where the calculations are done */
597                  next_block = stride;  
598                  stride *= 2;          gmc_data->predict_16x16(gmc_data,
599          }                          dec->cur.y + y_pos*16*stride + x_pos*16, dec->refn[0].y,
600                            stride, stride, x_pos, y_pos, rounding);
601    
602            gmc_data->predict_8x8(gmc_data,
603                            dec->cur.u + y_pos*8*stride2 + x_pos*8, dec->refn[0].u,
604                            dec->cur.v + y_pos*8*stride2 + x_pos*8, dec->refn[0].v,
605                            stride2, stride2, x_pos, y_pos, rounding);
606    
607            gmc_data->get_average_mv(gmc_data, &pMB->amv, x_pos, y_pos, dec->quarterpel);
608    
609            pMB->amv.x = gmc_sanitize(pMB->amv.x, dec->quarterpel, fcode);
610            pMB->amv.y = gmc_sanitize(pMB->amv.y, dec->quarterpel, fcode);
611    
612            pMB->mvs[0] = pMB->mvs[1] = pMB->mvs[2] = pMB->mvs[3] = pMB->amv;
613    
         start_timer();  
         if (cbp & 32)  
                 transfer_16to8add(pY_Cur, &data[0 * 64], stride);  
         if (cbp & 16)  
                 transfer_16to8add(pY_Cur + 8, &data[1 * 64], stride);  
         if (cbp & 8)  
                 transfer_16to8add(pY_Cur + next_block, &data[2 * 64], stride);  
         if (cbp & 4)  
                 transfer_16to8add(pY_Cur + 8 + next_block, &data[3 * 64], stride);  
         if (cbp & 2)  
                 transfer_16to8add(pU_Cur, &data[4 * 64], stride2);  
         if (cbp & 1)  
                 transfer_16to8add(pV_Cur, &data[5 * 64], stride2);  
614          stop_transfer_timer();          stop_transfer_timer();
615    
616            if (cbp)
617                    decoder_mb_decode(dec, cbp, bs, pY_Cur, pU_Cur, pV_Cur, 0, pMB);
618    
619  }  }
620    
621    
622  void  static void
623  decoder_iframe(DECODER * dec,  decoder_iframe(DECODER * dec,
624                             Bitstream * bs,                             Bitstream * bs,
625                                    int reduced_resolution,
626                             int quant,                             int quant,
627                             int intra_dc_threshold)                             int intra_dc_threshold)
628  {  {
629            uint32_t bound;
630          uint32_t x, y;          uint32_t x, y;
631            uint32_t mb_width = dec->mb_width;
632            uint32_t mb_height = dec->mb_height;
633    
634          for (y = 0; y < dec->mb_height; y++) {          if (reduced_resolution) {
635                  for (x = 0; x < dec->mb_width; x++) {                  mb_width = (dec->width + 31) / 32;
636                          MACROBLOCK *mb = &dec->mbs[y * dec->mb_width + x];                  mb_height = (dec->height + 31) / 32;
637            }
638    
639            bound = 0;
640    
641            for (y = 0; y < mb_height; y++) {
642                    for (x = 0; x < mb_width; x++) {
643                            MACROBLOCK *mb;
644                          uint32_t mcbpc;                          uint32_t mcbpc;
645                          uint32_t cbpc;                          uint32_t cbpc;
646                          uint32_t acpred_flag;                          uint32_t acpred_flag;
647                          uint32_t cbpy;                          uint32_t cbpy;
648                          uint32_t cbp;                          uint32_t cbp;
649    
650                            while (BitstreamShowBits(bs, 9) == 1)
651                                    BitstreamSkip(bs, 9);
652    
653                            if (check_resync_marker(bs, 0))
654                            {
655                                    bound = read_video_packet_header(bs, dec, 0,
656                                                            &quant, NULL, NULL, &intra_dc_threshold);
657                                    x = bound % mb_width;
658                                    y = bound / mb_width;
659                            }
660                            mb = &dec->mbs[y * dec->mb_width + x];
661    
662                            DPRINTF(XVID_DEBUG_MB, "macroblock (%i,%i) %08x\n", x, y, BitstreamShowBits(bs, 32));
663    
664                          mcbpc = get_mcbpc_intra(bs);                          mcbpc = get_mcbpc_intra(bs);
665                          mb->mode = mcbpc & 7;                          mb->mode = mcbpc & 7;
666                          cbpc = (mcbpc >> 4);                          cbpc = (mcbpc >> 4);
667    
668                          acpred_flag = BitstreamGetBit(bs);                          acpred_flag = BitstreamGetBit(bs);
669    
                         if (mb->mode == MODE_STUFFING) {  
                                 DEBUG("-- STUFFING ?");  
                                 continue;  
                         }  
   
670                          cbpy = get_cbpy(bs, 1);                          cbpy = get_cbpy(bs, 1);
671                          cbp = (cbpy << 2) | cbpc;                          cbp = (cbpy << 2) | cbpc;
672    
# Line 458  Line 679 
679                                  }                                  }
680                          }                          }
681                          mb->quant = quant;                          mb->quant = quant;
682                            mb->mvs[0].x = mb->mvs[0].y =
683                            mb->mvs[1].x = mb->mvs[1].y =
684                            mb->mvs[2].x = mb->mvs[2].y =
685                            mb->mvs[3].x = mb->mvs[3].y =0;
686    
687                          if (dec->interlacing) {                          if (dec->interlacing) {
688                                  mb->field_dct = BitstreamGetBit(bs);                                  mb->field_dct = BitstreamGetBit(bs);
689                                  DEBUG1("deci: field_dct: ", mb->field_dct);                                  DPRINTF(XVID_DEBUG_MB,"deci: field_dct: %i\n", mb->field_dct);
690                          }                          }
691    
692                          decoder_mbintra(dec, mb, x, y, acpred_flag, cbp, bs, quant,                          decoder_mbintra(dec, mb, x, y, acpred_flag, cbp, bs, quant,
693                                                          intra_dc_threshold);                                                          intra_dc_threshold, bound, reduced_resolution);
694    
695                  }                  }
696                    if(dec->out_frm)
697                            output_slice(&dec->cur, dec->edged_width,dec->width,dec->out_frm,0,y,mb_width);
698          }          }
699    
700  }  }
701    
702    
703  void  static void
704  get_motion_vector(DECODER * dec,  get_motion_vector(DECODER * dec,
705                                    Bitstream * bs,                                    Bitstream * bs,
706                                    int x,                                    int x,
707                                    int y,                                    int y,
708                                    int k,                                    int k,
709                                    VECTOR * mv,                                  VECTOR * ret_mv,
710                                    int fcode)                                  int fcode,
711                                    const int bound)
712  {  {
713    
714          int scale_fac = 1 << (fcode - 1);          const int scale_fac = 1 << (fcode - 1);
715          int high = (32 * scale_fac) - 1;          const int high = (32 * scale_fac) - 1;
716          int low = ((-32) * scale_fac);          const int low = ((-32) * scale_fac);
717          int range = (64 * scale_fac);          const int range = (64 * scale_fac);
718    
719          VECTOR pmv[4];          const VECTOR pmv = get_pmv2(dec->mbs, dec->mb_width, bound, x, y, k);
720          int32_t psad[4];          VECTOR mv;
721    
722          int mv_x, mv_y;          mv.x = get_mv(bs, fcode);
723          int pmv_x, pmv_y;          mv.y = get_mv(bs, fcode);
724    
725            DPRINTF(XVID_DEBUG_MV,"mv_diff (%i,%i) pred (%i,%i) result (%i,%i)\n", mv.x, mv.y, pmv.x, pmv.y, mv.x+pmv.x, mv.y+pmv.y);
726    
727          get_pmvdata(dec->mbs, x, y, dec->mb_width, k, pmv, psad);          mv.x += pmv.x;
728            mv.y += pmv.y;
729    
730          pmv_x = pmv[0].x;          if (mv.x < low) {
731          pmv_y = pmv[0].y;                  mv.x += range;
732            } else if (mv.x > high) {
733          mv_x = get_mv(bs, fcode);                  mv.x -= range;
         mv_y = get_mv(bs, fcode);  
   
         mv_x += pmv_x;  
         mv_y += pmv_y;  
   
         if (mv_x < low) {  
                 mv_x += range;  
         } else if (mv_x > high) {  
                 mv_x -= range;  
734          }          }
735    
736          if (mv_y < low) {          if (mv.y < low) {
737                  mv_y += range;                  mv.y += range;
738          } else if (mv_y > high) {          } else if (mv.y > high) {
739                  mv_y -= range;                  mv.y -= range;
740          }          }
741    
742          mv->x = mv_x;          ret_mv->x = mv.x;
743          mv->y = mv_y;          ret_mv->y = mv.y;
   
744  }  }
745    
746    /* for P_VOP set gmc_warp to NULL */
747  void  static void
748  decoder_pframe(DECODER * dec,  decoder_pframe(DECODER * dec,
749                             Bitstream * bs,                             Bitstream * bs,
750                             int rounding,                             int rounding,
751                                    int reduced_resolution,
752                             int quant,                             int quant,
753                             int fcode,                             int fcode,
754                             int intra_dc_threshold)                                  int intra_dc_threshold,
755                                    const WARPPOINTS *const gmc_warp)
756  {  {
   
757          uint32_t x, y;          uint32_t x, y;
758            uint32_t bound;
759            int cp_mb, st_mb;
760            uint32_t mb_width = dec->mb_width;
761            uint32_t mb_height = dec->mb_height;
762    
763            if (reduced_resolution) {
764                    mb_width = (dec->width + 31) / 32;
765                    mb_height = (dec->height + 31) / 32;
766            }
767    
768          start_timer();          start_timer();
769          image_setedges(&dec->refn[0], dec->edged_width, dec->edged_height,          image_setedges(&dec->refn[0], dec->edged_width, dec->edged_height,
770                                     dec->width, dec->height, dec->interlacing);                                          dec->width, dec->height);
771          stop_edges_timer();          stop_edges_timer();
772    
773          for (y = 0; y < dec->mb_height; y++) {          if (gmc_warp) {
774                  for (x = 0; x < dec->mb_width; x++) {                  /* accuracy: 0==1/2, 1=1/4, 2=1/8, 3=1/16 */
775                          MACROBLOCK *mb = &dec->mbs[y * dec->mb_width + x];                  generate_GMCparameters( dec->sprite_warping_points,
776                                    dec->sprite_warping_accuracy, gmc_warp,
777                                    dec->width, dec->height, &dec->new_gmc_data);
778    
779                          //if (!(dec->mb_skip[y*dec->mb_width + x]=BitstreamGetBit(bs)))         // not_coded                  /* image warping is done block-based in decoder_mbgmc(), now */
780                          if (!(BitstreamGetBit(bs)))     // not_coded          }
781                          {  
782                                  uint32_t mcbpc;          bound = 0;
783                                  uint32_t cbpc;  
784                                  uint32_t acpred_flag;          for (y = 0; y < mb_height; y++) {
785                                  uint32_t cbpy;                  cp_mb = st_mb = 0;
786                                  uint32_t cbp;                  for (x = 0; x < mb_width; x++) {
787                                  uint32_t intra;                          MACROBLOCK *mb;
788    
789                            /* skip stuffing */
790                            while (BitstreamShowBits(bs, 10) == 1)
791                                    BitstreamSkip(bs, 10);
792    
793                            if (check_resync_marker(bs, fcode - 1)) {
794                                    bound = read_video_packet_header(bs, dec, fcode - 1,
795                                            &quant, &fcode, NULL, &intra_dc_threshold);
796                                    x = bound % mb_width;
797                                    y = bound / mb_width;
798                            }
799                            mb = &dec->mbs[y * dec->mb_width + x];
800    
801                            DPRINTF(XVID_DEBUG_MB, "macroblock (%i,%i) %08x\n", x, y, BitstreamShowBits(bs, 32));
802    
803                            if (!(BitstreamGetBit(bs)))     { /* block _is_ coded */
804                                    uint32_t mcbpc, cbpc, cbpy, cbp;
805                                    uint32_t intra, acpred_flag = 0;
806                                    int mcsel = 0;          /* mcsel: '0'=local motion, '1'=GMC */
807    
808                                    cp_mb++;
809                                  mcbpc = get_mcbpc_inter(bs);                                  mcbpc = get_mcbpc_inter(bs);
810                                  mb->mode = mcbpc & 7;                                  mb->mode = mcbpc & 7;
811                                  cbpc = (mcbpc >> 4);                                  cbpc = (mcbpc >> 4);
812                                  acpred_flag = 0;  
813                                    DPRINTF(XVID_DEBUG_MB, "mode %i\n", mb->mode);
814                                    DPRINTF(XVID_DEBUG_MB, "cbpc %i\n", cbpc);
815    
816                                  intra = (mb->mode == MODE_INTRA || mb->mode == MODE_INTRA_Q);                                  intra = (mb->mode == MODE_INTRA || mb->mode == MODE_INTRA_Q);
817    
818                                  if (intra) {                                  if (gmc_warp && (mb->mode == MODE_INTER || mb->mode == MODE_INTER_Q))
819                                            mcsel = BitstreamGetBit(bs);
820                                    else if (intra)
821                                          acpred_flag = BitstreamGetBit(bs);                                          acpred_flag = BitstreamGetBit(bs);
                                 }  
   
                                 if (mb->mode == MODE_STUFFING) {  
                                         DEBUG("-- STUFFING ?");  
                                         continue;  
                                 }  
822    
823                                  cbpy = get_cbpy(bs, intra);                                  cbpy = get_cbpy(bs, intra);
824                                    DPRINTF(XVID_DEBUG_MB, "cbpy %i mcsel %i \n", cbpy,mcsel);
825    
826                                  cbp = (cbpy << 2) | cbpc;                                  cbp = (cbpy << 2) | cbpc;
827    
828                                  if (mb->mode == MODE_INTER_Q || mb->mode == MODE_INTRA_Q) {                                  if (mb->mode == MODE_INTER_Q || mb->mode == MODE_INTRA_Q) {
829                                          quant += dquant_table[BitstreamGetBits(bs, 2)];                                          int dquant = dquant_table[BitstreamGetBits(bs, 2)];
830                                            DPRINTF(XVID_DEBUG_MB, "dquant %i\n", dquant);
831                                            quant += dquant;
832                                          if (quant > 31) {                                          if (quant > 31) {
833                                                  quant = 31;                                                  quant = 31;
834                                          } else if (mb->quant < 1) {                                          } else if (quant < 1) {
835                                                  quant = 1;                                                  quant = 1;
836                                          }                                          }
837                                            DPRINTF(XVID_DEBUG_MB, "quant %i\n", quant);
838                                  }                                  }
839                                  mb->quant = quant;                                  mb->quant = quant;
840    
841                                  if (dec->interlacing) {                                  if (dec->interlacing) {
842                                            if ((cbp || intra) && !mcsel) {
843                                          mb->field_dct = BitstreamGetBit(bs);                                          mb->field_dct = BitstreamGetBit(bs);
844                                          DEBUG1("decp: field_dct: ", mb->field_dct);                                                  DPRINTF(XVID_DEBUG_MB,"decp: field_dct: %i\n", mb->field_dct);
845                                            }
846    
847                                          if (mb->mode == MODE_INTER || mb->mode == MODE_INTER_Q) {                                          if (mb->mode == MODE_INTER || mb->mode == MODE_INTER_Q) {
848                                                  mb->field_pred = BitstreamGetBit(bs);                                                  mb->field_pred = BitstreamGetBit(bs);
849                                                  DEBUG1("decp: field_pred: ", mb->field_pred);                                                  DPRINTF(XVID_DEBUG_MB, "decp: field_pred: %i\n", mb->field_pred);
850    
851                                                  if (mb->field_pred) {                                                  if (mb->field_pred) {
852                                                          mb->field_for_top = BitstreamGetBit(bs);                                                          mb->field_for_top = BitstreamGetBit(bs);
853                                                          DEBUG1("decp: field_for_top: ", mb->field_for_top);                                                          DPRINTF(XVID_DEBUG_MB,"decp: field_for_top: %i\n", mb->field_for_top);
854                                                          mb->field_for_bot = BitstreamGetBit(bs);                                                          mb->field_for_bot = BitstreamGetBit(bs);
855                                                          DEBUG1("decp: field_for_bot: ", mb->field_for_bot);                                                          DPRINTF(XVID_DEBUG_MB,"decp: field_for_bot: %i\n", mb->field_for_bot);
856                                                  }                                                  }
857                                          }                                          }
858                                  }                                  }
859    
860                                  if (mb->mode == MODE_INTER || mb->mode == MODE_INTER_Q) {                                  if (mcsel) {
861                                            decoder_mbgmc(dec, mb, x, y, fcode, cbp, bs, rounding);
862                                            continue;
863    
864                                    } else if (mb->mode == MODE_INTER || mb->mode == MODE_INTER_Q) {
865    
866                                          if (dec->interlacing && mb->field_pred) {                                          if (dec->interlacing && mb->field_pred) {
867                                                  get_motion_vector(dec, bs, x, y, 0, &mb->mvs[0],                                                  get_motion_vector(dec, bs, x, y, 0, &mb->mvs[0], fcode, bound);
868                                                                                    fcode);                                                  get_motion_vector(dec, bs, x, y, 0, &mb->mvs[1], fcode, bound);
                                                 get_motion_vector(dec, bs, x, y, 0, &mb->mvs[1],  
                                                                                   fcode);  
869                                          } else {                                          } else {
870                                                  get_motion_vector(dec, bs, x, y, 0, &mb->mvs[0],                                                  get_motion_vector(dec, bs, x, y, 0, &mb->mvs[0], fcode, bound);
871                                                                                    fcode);                                                  mb->mvs[1] = mb->mvs[2] = mb->mvs[3] = mb->mvs[0];
872                                                  mb->mvs[1].x = mb->mvs[2].x = mb->mvs[3].x =                                          }
873                                                          mb->mvs[0].x;                                  } else if (mb->mode == MODE_INTER4V ) {
874                                                  mb->mvs[1].y = mb->mvs[2].y = mb->mvs[3].y =                                          get_motion_vector(dec, bs, x, y, 0, &mb->mvs[0], fcode, bound);
875                                                          mb->mvs[0].y;                                          get_motion_vector(dec, bs, x, y, 1, &mb->mvs[1], fcode, bound);
876                                          }                                          get_motion_vector(dec, bs, x, y, 2, &mb->mvs[2], fcode, bound);
877                                  } else if (mb->mode ==                                          get_motion_vector(dec, bs, x, y, 3, &mb->mvs[3], fcode, bound);
878                                                     MODE_INTER4V /* || mb->mode == MODE_INTER4V_Q */ ) {                                  } else {                /* MODE_INTRA, MODE_INTRA_Q */
879                                          get_motion_vector(dec, bs, x, y, 0, &mb->mvs[0], fcode);                                          mb->mvs[0].x = mb->mvs[1].x = mb->mvs[2].x = mb->mvs[3].x = 0;
880                                          get_motion_vector(dec, bs, x, y, 1, &mb->mvs[1], fcode);                                          mb->mvs[0].y = mb->mvs[1].y = mb->mvs[2].y = mb->mvs[3].y =     0;
                                         get_motion_vector(dec, bs, x, y, 2, &mb->mvs[2], fcode);  
                                         get_motion_vector(dec, bs, x, y, 3, &mb->mvs[3], fcode);  
                                 } else                  // MODE_INTRA, MODE_INTRA_Q  
                                 {  
                                         mb->mvs[0].x = mb->mvs[1].x = mb->mvs[2].x = mb->mvs[3].x =  
                                                 0;  
                                         mb->mvs[0].y = mb->mvs[1].y = mb->mvs[2].y = mb->mvs[3].y =  
                                                 0;  
881                                          decoder_mbintra(dec, mb, x, y, acpred_flag, cbp, bs, quant,                                          decoder_mbintra(dec, mb, x, y, acpred_flag, cbp, bs, quant,
882                                                                          intra_dc_threshold);                                                                          intra_dc_threshold, bound, reduced_resolution);
883                                          continue;                                          continue;
884                                  }                                  }
885    
886                                  decoder_mbinter(dec, mb, x, y, acpred_flag, cbp, bs, quant,                                  decoder_mbinter(dec, mb, x, y, cbp, bs,
887                                                                  rounding);                                                                  rounding, reduced_resolution, 0);
888                          } else                          // not coded  
889                          {                          } else if (gmc_warp) {  /* a not coded S(GMC)-VOP macroblock */
890                                  //DEBUG2("P-frame MB at (X,Y)=",x,y);                                  mb->mode = MODE_NOT_CODED_GMC;
891                                    decoder_mbgmc(dec, mb, x, y, fcode, 0x00, bs, rounding);
892    
893                                    if(dec->out_frm && cp_mb > 0) {
894                                            output_slice(&dec->cur, dec->edged_width,dec->width,dec->out_frm,st_mb,y,cp_mb);
895                                            cp_mb = 0;
896                                    }
897                                    st_mb = x+1;
898                            } else {        /* not coded P_VOP macroblock */
899                                  mb->mode = MODE_NOT_CODED;                                  mb->mode = MODE_NOT_CODED;
900    
901                                  mb->mvs[0].x = mb->mvs[1].x = mb->mvs[2].x = mb->mvs[3].x = 0;                                  mb->mvs[0].x = mb->mvs[1].x = mb->mvs[2].x = mb->mvs[3].x = 0;
902                                  mb->mvs[0].y = mb->mvs[1].y = mb->mvs[2].y = mb->mvs[3].y = 0;                                  mb->mvs[0].y = mb->mvs[1].y = mb->mvs[2].y = mb->mvs[3].y = 0;
903    
904                                  // copy macroblock directly from ref to cur                                  decoder_mbinter(dec, mb, x, y, 0, bs,
905                                                                    rounding, reduced_resolution, 0);
                                 start_timer();  
   
                                 transfer8x8_copy(dec->cur.y + (16 * y) * dec->edged_width +  
                                                                  (16 * x),  
                                                                  dec->refn[0].y + (16 * y) * dec->edged_width +  
                                                                  (16 * x), dec->edged_width);  
   
                                 transfer8x8_copy(dec->cur.y + (16 * y) * dec->edged_width +  
                                                                  (16 * x + 8),  
                                                                  dec->refn[0].y + (16 * y) * dec->edged_width +  
                                                                  (16 * x + 8), dec->edged_width);  
   
                                 transfer8x8_copy(dec->cur.y + (16 * y + 8) * dec->edged_width +  
                                                                  (16 * x),  
                                                                  dec->refn[0].y + (16 * y +  
                                                                                                    8) * dec->edged_width +  
                                                                  (16 * x), dec->edged_width);  
   
                                 transfer8x8_copy(dec->cur.y + (16 * y + 8) * dec->edged_width +  
                                                                  (16 * x + 8),  
                                                                  dec->refn[0].y + (16 * y +  
                                                                                                    8) * dec->edged_width +  
                                                                  (16 * x + 8), dec->edged_width);  
   
                                 transfer8x8_copy(dec->cur.u + (8 * y) * dec->edged_width / 2 +  
                                                                  (8 * x),  
                                                                  dec->refn[0].u +  
                                                                  (8 * y) * dec->edged_width / 2 + (8 * x),  
                                                                  dec->edged_width / 2);  
   
                                 transfer8x8_copy(dec->cur.v + (8 * y) * dec->edged_width / 2 +  
                                                                  (8 * x),  
                                                                  dec->refn[0].v +  
                                                                  (8 * y) * dec->edged_width / 2 + (8 * x),  
                                                                  dec->edged_width / 2);  
906    
907                                  stop_transfer_timer();                                  if(dec->out_frm && cp_mb > 0) {
908                                            output_slice(&dec->cur, dec->edged_width,dec->width,dec->out_frm,st_mb,y,cp_mb);
909                                            cp_mb = 0;
910                                    }
911                                    st_mb = x+1;
912                          }                          }
913                  }                  }
914    
915                    if(dec->out_frm && cp_mb > 0)
916                            output_slice(&dec->cur, dec->edged_width,dec->width,dec->out_frm,st_mb,y,cp_mb);
917          }          }
918  }  }
919    
920    
921  // add by MinChen <chenm001@163.com>  /* decode B-frame motion vector */
922  // decode B-frame motion vector  static void
923  void  get_b_motion_vector(Bitstream * bs,
 get_b_motion_vector(DECODER * dec,  
                                         Bitstream * bs,  
                                         int x,  
                                         int y,  
924                                          VECTOR * mv,                                          VECTOR * mv,
925                                          int fcode,                                          int fcode,
926                                          const VECTOR pmv)                                          const VECTOR pmv)
927  {  {
928          int scale_fac = 1 << (fcode - 1);          const int scale_fac = 1 << (fcode - 1);
929          int high = (32 * scale_fac) - 1;          const int high = (32 * scale_fac) - 1;
930          int low = ((-32) * scale_fac);          const int low = ((-32) * scale_fac);
931          int range = (64 * scale_fac);          const int range = (64 * scale_fac);
   
         int mv_x, mv_y;  
         int pmv_x, pmv_y;  
932    
933          pmv_x = pmv.x;          int mv_x = get_mv(bs, fcode);
934          pmv_y = pmv.y;          int mv_y = get_mv(bs, fcode);
935    
936          mv_x = get_mv(bs, fcode);          mv_x += pmv.x;
937          mv_y = get_mv(bs, fcode);          mv_y += pmv.y;
938    
939          mv_x += pmv_x;          if (mv_x < low)
         mv_y += pmv_y;  
   
         if (mv_x < low) {  
940                  mv_x += range;                  mv_x += range;
941          } else if (mv_x > high) {          else if (mv_x > high)
942                  mv_x -= range;                  mv_x -= range;
         }  
943    
944          if (mv_y < low) {          if (mv_y < low)
945                  mv_y += range;                  mv_y += range;
946          } else if (mv_y > high) {          else if (mv_y > high)
947                  mv_y -= range;                  mv_y -= range;
         }  
948    
949          mv->x = mv_x;          mv->x = mv_x;
950          mv->y = mv_y;          mv->y = mv_y;
951  }  }
952    
953    /* decode an B-frame direct & interpolate macroblock */
954  // add by MinChen <chenm001@163.com>  static void
955  // decode an B-frame forward & backward inter macroblock  decoder_bf_interpolate_mbinter(DECODER * dec,
956  void                                                                  IMAGE forward,
957  decoder_bf_mbinter(DECODER * dec,                                                                  IMAGE backward,
958                                     const MACROBLOCK * pMB,                                     const MACROBLOCK * pMB,
959                                     const uint32_t x_pos,                                     const uint32_t x_pos,
960                                     const uint32_t y_pos,                                     const uint32_t y_pos,
                                    const uint32_t cbp,  
961                                     Bitstream * bs,                                     Bitstream * bs,
962                                     const uint32_t quant,                                                                  const int direct)
                                    const uint8_t ref)  
963  {  {
   
         DECLARE_ALIGNED_MATRIX(block, 6, 64, int16_t, CACHE_LINE);  
         DECLARE_ALIGNED_MATRIX(data, 6, 64, int16_t, CACHE_LINE);  
   
964          uint32_t stride = dec->edged_width;          uint32_t stride = dec->edged_width;
965          uint32_t stride2 = stride / 2;          uint32_t stride2 = stride / 2;
         uint32_t next_block = stride * 8;  
         uint32_t i;  
         uint32_t iQuant = pMB->quant;  
         uint8_t *pY_Cur, *pU_Cur, *pV_Cur;  
966          int uv_dx, uv_dy;          int uv_dx, uv_dy;
967            int b_uv_dx, b_uv_dy;
968            uint8_t *pY_Cur, *pU_Cur, *pV_Cur;
969            const uint32_t cbp = pMB->cbp;
970    
971          pY_Cur = dec->cur.y + (y_pos << 4) * stride + (x_pos << 4);          pY_Cur = dec->cur.y + (y_pos << 4) * stride + (x_pos << 4);
972          pU_Cur = dec->cur.u + (y_pos << 3) * stride2 + (x_pos << 3);          pU_Cur = dec->cur.u + (y_pos << 3) * stride2 + (x_pos << 3);
973          pV_Cur = dec->cur.v + (y_pos << 3) * stride2 + (x_pos << 3);          pV_Cur = dec->cur.v + (y_pos << 3) * stride2 + (x_pos << 3);
974    
975          if (!(pMB->mode == MODE_INTER || pMB->mode == MODE_INTER_Q)) {          if (!direct) {
976                  uv_dx = pMB->mvs[0].x;                  uv_dx = pMB->mvs[0].x;
977                  uv_dy = pMB->mvs[0].y;                  uv_dy = pMB->mvs[0].y;
978    
979                  uv_dx = (uv_dx & 3) ? (uv_dx >> 1) | 1 : uv_dx / 2;                  b_uv_dx = pMB->b_mvs[0].x;
980                  uv_dy = (uv_dy & 3) ? (uv_dy >> 1) | 1 : uv_dy / 2;                  b_uv_dy = pMB->b_mvs[0].y;
         } else {  
                 int sum;  
981    
982                  sum = pMB->mvs[0].x + pMB->mvs[1].x + pMB->mvs[2].x + pMB->mvs[3].x;                  if (dec->quarterpel) {
983                  uv_dx =                          uv_dx /= 2;
984                          (sum ==                          uv_dy /= 2;
985                           0 ? 0 : SIGN(sum) * (roundtab[ABS(sum) % 16] +                          b_uv_dx /= 2;
986                                                                    (ABS(sum) / 16) * 2));                          b_uv_dy /= 2;
   
                 sum = pMB->mvs[0].y + pMB->mvs[1].y + pMB->mvs[2].y + pMB->mvs[3].y;  
                 uv_dy =  
                         (sum ==  
                          0 ? 0 : SIGN(sum) * (roundtab[ABS(sum) % 16] +  
                                                                   (ABS(sum) / 16) * 2));  
987          }          }
988    
989          start_timer();                  uv_dx = (uv_dx >> 1) + roundtab_79[uv_dx & 0x3];
990          interpolate8x8_switch(dec->cur.y, dec->refn[ref].y, 16 * x_pos, 16 * y_pos,                  uv_dy = (uv_dy >> 1) + roundtab_79[uv_dy & 0x3];
                                                   pMB->mvs[0].x, pMB->mvs[0].y, stride, 0);  
         interpolate8x8_switch(dec->cur.y, dec->refn[ref].y, 16 * x_pos + 8,  
                                                   16 * y_pos, pMB->mvs[1].x, pMB->mvs[1].y, stride, 0);  
         interpolate8x8_switch(dec->cur.y, dec->refn[ref].y, 16 * x_pos,  
                                                   16 * y_pos + 8, pMB->mvs[2].x, pMB->mvs[2].y, stride,  
                                                   0);  
         interpolate8x8_switch(dec->cur.y, dec->refn[ref].y, 16 * x_pos + 8,  
                                                   16 * y_pos + 8, pMB->mvs[3].x, pMB->mvs[3].y, stride,  
                                                   0);  
         interpolate8x8_switch(dec->cur.u, dec->refn[ref].u, 8 * x_pos, 8 * y_pos,  
                                                   uv_dx, uv_dy, stride2, 0);  
         interpolate8x8_switch(dec->cur.v, dec->refn[ref].v, 8 * x_pos, 8 * y_pos,  
                                                   uv_dx, uv_dy, stride2, 0);  
         stop_comp_timer();  
991    
992          for (i = 0; i < 6; i++) {                  b_uv_dx = (b_uv_dx >> 1) + roundtab_79[b_uv_dx & 0x3];
993                  if (cbp & (1 << (5 - i)))       // coded                  b_uv_dy = (b_uv_dy >> 1) + roundtab_79[b_uv_dy & 0x3];
                 {  
                         memset(&block[i * 64], 0, 64 * sizeof(int16_t));        // clear  
994    
                         start_timer();  
                         get_inter_block(bs, &block[i * 64]);  
                         stop_coding_timer();  
   
                         start_timer();  
                         if (dec->quant_type == 0) {  
                                 dequant_inter(&data[i * 64], &block[i * 64], iQuant);  
995                          } else {                          } else {
996                                  dequant4_inter(&data[i * 64], &block[i * 64], iQuant);                  if(dec->quarterpel) {
997                          }                          uv_dx = (pMB->mvs[0].x / 2) + (pMB->mvs[1].x / 2) + (pMB->mvs[2].x / 2) + (pMB->mvs[3].x / 2);
998                          stop_iquant_timer();                          uv_dy = (pMB->mvs[0].y / 2) + (pMB->mvs[1].y / 2) + (pMB->mvs[2].y / 2) + (pMB->mvs[3].y / 2);
999                            b_uv_dx = (pMB->b_mvs[0].x / 2) + (pMB->b_mvs[1].x / 2) + (pMB->b_mvs[2].x / 2) + (pMB->b_mvs[3].x / 2);
1000                          start_timer();                          b_uv_dy = (pMB->b_mvs[0].y / 2) + (pMB->b_mvs[1].y / 2) + (pMB->b_mvs[2].y / 2) + (pMB->b_mvs[3].y / 2);
1001                          idct(&data[i * 64]);                  } else {
1002                          stop_idct_timer();                          uv_dx = pMB->mvs[0].x + pMB->mvs[1].x + pMB->mvs[2].x + pMB->mvs[3].x;
1003                  }                          uv_dy = pMB->mvs[0].y + pMB->mvs[1].y + pMB->mvs[2].y + pMB->mvs[3].y;
1004                            b_uv_dx = pMB->b_mvs[0].x + pMB->b_mvs[1].x + pMB->b_mvs[2].x + pMB->b_mvs[3].x;
1005                            b_uv_dy = pMB->b_mvs[0].y + pMB->b_mvs[1].y + pMB->b_mvs[2].y + pMB->b_mvs[3].y;
1006          }          }
1007    
1008          if (dec->interlacing && pMB->field_dct) {                  uv_dx = (uv_dx >> 3) + roundtab_76[uv_dx & 0xf];
1009                  next_block = stride;                  uv_dy = (uv_dy >> 3) + roundtab_76[uv_dy & 0xf];
1010                  stride *= 2;                  b_uv_dx = (b_uv_dx >> 3) + roundtab_76[b_uv_dx & 0xf];
1011                    b_uv_dy = (b_uv_dy >> 3) + roundtab_76[b_uv_dy & 0xf];
1012          }          }
1013    
1014          start_timer();          start_timer();
1015          if (cbp & 32)          if(dec->quarterpel) {
1016                  transfer_16to8add(pY_Cur, &data[0 * 64], stride);                  if(!direct) {
1017          if (cbp & 16)                          interpolate16x16_quarterpel(dec->cur.y, forward.y, dec->qtmp.y, dec->qtmp.y + 64,
1018                  transfer_16to8add(pY_Cur + 8, &data[1 * 64], stride);                                                                                  dec->qtmp.y + 128, 16*x_pos, 16*y_pos,
1019          if (cbp & 8)                                                                                  pMB->mvs[0].x, pMB->mvs[0].y, stride, 0);
                 transfer_16to8add(pY_Cur + next_block, &data[2 * 64], stride);  
         if (cbp & 4)  
                 transfer_16to8add(pY_Cur + 8 + next_block, &data[3 * 64], stride);  
         if (cbp & 2)  
                 transfer_16to8add(pU_Cur, &data[4 * 64], stride2);  
         if (cbp & 1)  
                 transfer_16to8add(pV_Cur, &data[5 * 64], stride2);  
         stop_transfer_timer();  
 }  
   
   
 // add by MinChen <chenm001@163.com>  
 // decode an B-frame direct &  inter macroblock  
 void  
 decoder_bf_interpolate_mbinter(DECODER * dec,  
                                                            IMAGE forward,  
                                                            IMAGE backward,  
                                                            const MACROBLOCK * pMB,  
                                                            const uint32_t x_pos,  
                                                            const uint32_t y_pos,  
                                                            const uint32_t cbp,  
                                                            Bitstream * bs)  
 {  
   
         DECLARE_ALIGNED_MATRIX(block, 6, 64, int16_t, CACHE_LINE);  
         DECLARE_ALIGNED_MATRIX(data, 6, 64, int16_t, CACHE_LINE);  
   
         uint32_t stride = dec->edged_width;  
         uint32_t stride2 = stride / 2;  
         uint32_t next_block = stride * 8;  
         uint32_t iQuant = pMB->quant;  
         int uv_dx, uv_dy;  
         int b_uv_dx, b_uv_dy;  
         uint32_t i;  
         uint8_t *pY_Cur, *pU_Cur, *pV_Cur;  
   
         pY_Cur = dec->cur.y + (y_pos << 4) * stride + (x_pos << 4);  
         pU_Cur = dec->cur.u + (y_pos << 3) * stride2 + (x_pos << 3);  
         pV_Cur = dec->cur.v + (y_pos << 3) * stride2 + (x_pos << 3);  
   
         if ((pMB->mode == MODE_INTER || pMB->mode == MODE_INTER_Q)) {  
                 uv_dx = pMB->mvs[0].x;  
                 uv_dy = pMB->mvs[0].y;  
   
                 uv_dx = (uv_dx & 3) ? (uv_dx >> 1) | 1 : uv_dx / 2;  
                 uv_dy = (uv_dy & 3) ? (uv_dy >> 1) | 1 : uv_dy / 2;  
   
                 b_uv_dx = pMB->b_mvs[0].x;  
                 b_uv_dy = pMB->b_mvs[0].y;  
   
                 b_uv_dx = (uv_dx & 3) ? (uv_dx >> 1) | 1 : uv_dx / 2;  
                 b_uv_dy = (uv_dy & 3) ? (uv_dy >> 1) | 1 : uv_dy / 2;  
1020          } else {          } else {
1021                  int sum;                          interpolate8x8_quarterpel(dec->cur.y, forward.y, dec->qtmp.y, dec->qtmp.y + 64,
1022                                                                                    dec->qtmp.y + 128, 16*x_pos, 16*y_pos,
1023                  sum = pMB->mvs[0].x + pMB->mvs[1].x + pMB->mvs[2].x + pMB->mvs[3].x;                                                                                  pMB->mvs[0].x, pMB->mvs[0].y, stride, 0);
1024                  uv_dx =                          interpolate8x8_quarterpel(dec->cur.y, forward.y, dec->qtmp.y, dec->qtmp.y + 64,
1025                          (sum ==                                                                                  dec->qtmp.y + 128, 16*x_pos + 8, 16*y_pos,
1026                           0 ? 0 : SIGN(sum) * (roundtab[ABS(sum) % 16] +                                                                                  pMB->mvs[1].x, pMB->mvs[1].y, stride, 0);
1027                                                                    (ABS(sum) / 16) * 2));                          interpolate8x8_quarterpel(dec->cur.y, forward.y, dec->qtmp.y, dec->qtmp.y + 64,
1028                                                                                    dec->qtmp.y + 128, 16*x_pos, 16*y_pos + 8,
1029                  sum = pMB->mvs[0].y + pMB->mvs[1].y + pMB->mvs[2].y + pMB->mvs[3].y;                                                                                  pMB->mvs[2].x, pMB->mvs[2].y, stride, 0);
1030                  uv_dy =                          interpolate8x8_quarterpel(dec->cur.y, forward.y, dec->qtmp.y, dec->qtmp.y + 64,
1031                          (sum ==                                                                                  dec->qtmp.y + 128, 16*x_pos + 8, 16*y_pos + 8,
1032                           0 ? 0 : SIGN(sum) * (roundtab[ABS(sum) % 16] +                                                                                  pMB->mvs[3].x, pMB->mvs[3].y, stride, 0);
                                                                   (ABS(sum) / 16) * 2));  
   
                 sum =  
                         pMB->b_mvs[0].x + pMB->b_mvs[1].x + pMB->b_mvs[2].x +  
                         pMB->b_mvs[3].x;  
                 b_uv_dx =  
                         (sum ==  
                          0 ? 0 : SIGN(sum) * (roundtab[ABS(sum) % 16] +  
                                                                   (ABS(sum) / 16) * 2));  
   
                 sum =  
                         pMB->b_mvs[0].y + pMB->b_mvs[1].y + pMB->b_mvs[2].y +  
                         pMB->b_mvs[3].y;  
                 b_uv_dy =  
                         (sum ==  
                          0 ? 0 : SIGN(sum) * (roundtab[ABS(sum) % 16] +  
                                                                   (ABS(sum) / 16) * 2));  
1033          }          }
1034            } else {
   
         start_timer();  
1035          interpolate8x8_switch(dec->cur.y, forward.y, 16 * x_pos, 16 * y_pos,          interpolate8x8_switch(dec->cur.y, forward.y, 16 * x_pos, 16 * y_pos,
1036                                                    pMB->mvs[0].x, pMB->mvs[0].y, stride, 0);                                                    pMB->mvs[0].x, pMB->mvs[0].y, stride, 0);
1037          interpolate8x8_switch(dec->cur.y, forward.y, 16 * x_pos + 8, 16 * y_pos,          interpolate8x8_switch(dec->cur.y, forward.y, 16 * x_pos + 8, 16 * y_pos,
# Line 923  Line 1039 
1039          interpolate8x8_switch(dec->cur.y, forward.y, 16 * x_pos, 16 * y_pos + 8,          interpolate8x8_switch(dec->cur.y, forward.y, 16 * x_pos, 16 * y_pos + 8,
1040                                                    pMB->mvs[2].x, pMB->mvs[2].y, stride, 0);                                                    pMB->mvs[2].x, pMB->mvs[2].y, stride, 0);
1041          interpolate8x8_switch(dec->cur.y, forward.y, 16 * x_pos + 8,          interpolate8x8_switch(dec->cur.y, forward.y, 16 * x_pos + 8,
1042                                                    16 * y_pos + 8, pMB->mvs[3].x, pMB->mvs[3].y, stride,                                                          16 * y_pos + 8, pMB->mvs[3].x, pMB->mvs[3].y, stride, 0);
1043                                                    0);          }
1044    
1045          interpolate8x8_switch(dec->cur.u, forward.u, 8 * x_pos, 8 * y_pos, uv_dx,          interpolate8x8_switch(dec->cur.u, forward.u, 8 * x_pos, 8 * y_pos, uv_dx,
1046                                                    uv_dy, stride2, 0);                                                    uv_dy, stride2, 0);
1047          interpolate8x8_switch(dec->cur.v, forward.v, 8 * x_pos, 8 * y_pos, uv_dx,          interpolate8x8_switch(dec->cur.v, forward.v, 8 * x_pos, 8 * y_pos, uv_dx,
1048                                                    uv_dy, stride2, 0);                                                    uv_dy, stride2, 0);
1049    
1050    
1051          interpolate8x8_switch(dec->refn[2].y, backward.y, 16 * x_pos, 16 * y_pos,          if(dec->quarterpel) {
1052                    if(!direct) {
1053                            interpolate16x16_quarterpel(dec->tmp.y, backward.y, dec->qtmp.y, dec->qtmp.y + 64,
1054                                                                                    dec->qtmp.y + 128, 16*x_pos, 16*y_pos,
1055                                                    pMB->b_mvs[0].x, pMB->b_mvs[0].y, stride, 0);                                                    pMB->b_mvs[0].x, pMB->b_mvs[0].y, stride, 0);
1056          interpolate8x8_switch(dec->refn[2].y, backward.y, 16 * x_pos + 8,                  } else {
1057                                                    16 * y_pos, pMB->b_mvs[1].x, pMB->b_mvs[1].y, stride,                          interpolate8x8_quarterpel(dec->tmp.y, backward.y, dec->qtmp.y, dec->qtmp.y + 64,
1058                                                    0);                                                                                  dec->qtmp.y + 128, 16*x_pos, 16*y_pos,
1059          interpolate8x8_switch(dec->refn[2].y, backward.y, 16 * x_pos,                                                                                  pMB->b_mvs[0].x, pMB->b_mvs[0].y, stride, 0);
1060                                                    16 * y_pos + 8, pMB->b_mvs[2].x, pMB->b_mvs[2].y,                          interpolate8x8_quarterpel(dec->tmp.y, backward.y, dec->qtmp.y, dec->qtmp.y + 64,
1061                                                    stride, 0);                                                                                  dec->qtmp.y + 128, 16*x_pos + 8, 16*y_pos,
1062          interpolate8x8_switch(dec->refn[2].y, backward.y, 16 * x_pos + 8,                                                                                  pMB->b_mvs[1].x, pMB->b_mvs[1].y, stride, 0);
1063                                                    16 * y_pos + 8, pMB->b_mvs[3].x, pMB->b_mvs[3].y,                          interpolate8x8_quarterpel(dec->tmp.y, backward.y, dec->qtmp.y, dec->qtmp.y + 64,
1064                                                    stride, 0);                                                                                  dec->qtmp.y + 128, 16*x_pos, 16*y_pos + 8,
1065          interpolate8x8_switch(dec->refn[2].u, backward.u, 8 * x_pos, 8 * y_pos,                                                                                  pMB->b_mvs[2].x, pMB->b_mvs[2].y, stride, 0);
1066                            interpolate8x8_quarterpel(dec->tmp.y, backward.y, dec->qtmp.y, dec->qtmp.y + 64,
1067                                                                                    dec->qtmp.y + 128, 16*x_pos + 8, 16*y_pos + 8,
1068                                                                                    pMB->b_mvs[3].x, pMB->b_mvs[3].y, stride, 0);
1069                    }
1070            } else {
1071                    interpolate8x8_switch(dec->tmp.y, backward.y, 16 * x_pos, 16 * y_pos,
1072                                                            pMB->b_mvs[0].x, pMB->b_mvs[0].y, stride, 0);
1073                    interpolate8x8_switch(dec->tmp.y, backward.y, 16 * x_pos + 8,
1074                                                            16 * y_pos, pMB->b_mvs[1].x, pMB->b_mvs[1].y, stride, 0);
1075                    interpolate8x8_switch(dec->tmp.y, backward.y, 16 * x_pos,
1076                                                            16 * y_pos + 8, pMB->b_mvs[2].x, pMB->b_mvs[2].y, stride, 0);
1077                    interpolate8x8_switch(dec->tmp.y, backward.y, 16 * x_pos + 8,
1078                                                            16 * y_pos + 8, pMB->b_mvs[3].x, pMB->b_mvs[3].y, stride, 0);
1079            }
1080    
1081            interpolate8x8_switch(dec->tmp.u, backward.u, 8 * x_pos, 8 * y_pos,
1082                                                    b_uv_dx, b_uv_dy, stride2, 0);                                                    b_uv_dx, b_uv_dy, stride2, 0);
1083          interpolate8x8_switch(dec->refn[2].v, backward.v, 8 * x_pos, 8 * y_pos,          interpolate8x8_switch(dec->tmp.v, backward.v, 8 * x_pos, 8 * y_pos,
1084                                                    b_uv_dx, b_uv_dy, stride2, 0);                                                    b_uv_dx, b_uv_dy, stride2, 0);
1085    
1086          interpolate8x8_c(dec->cur.y, dec->refn[2].y, 16 * x_pos, 16 * y_pos,          interpolate8x8_avg2(dec->cur.y + (16 * y_pos * stride) + 16 * x_pos,
1087                                           stride);                                                  dec->cur.y + (16 * y_pos * stride) + 16 * x_pos,
1088          interpolate8x8_c(dec->cur.y, dec->refn[2].y, 16 * x_pos + 8, 16 * y_pos,                                                  dec->tmp.y + (16 * y_pos * stride) + 16 * x_pos,
1089                                           stride);                                                  stride, 1, 8);
1090          interpolate8x8_c(dec->cur.y, dec->refn[2].y, 16 * x_pos, 16 * y_pos + 8,  
1091                                           stride);          interpolate8x8_avg2(dec->cur.y + (16 * y_pos * stride) + 16 * x_pos + 8,
1092          interpolate8x8_c(dec->cur.y, dec->refn[2].y, 16 * x_pos + 8,                                                  dec->cur.y + (16 * y_pos * stride) + 16 * x_pos + 8,
1093                                           16 * y_pos + 8, stride);                                                  dec->tmp.y + (16 * y_pos * stride) + 16 * x_pos + 8,
1094          interpolate8x8_c(dec->cur.u, dec->refn[2].u, 8 * x_pos, 8 * y_pos,                                                  stride, 1, 8);
1095                                           stride2);  
1096          interpolate8x8_c(dec->cur.v, dec->refn[2].v, 8 * x_pos, 8 * y_pos,          interpolate8x8_avg2(dec->cur.y + ((16 * y_pos + 8) * stride) + 16 * x_pos,
1097                                           stride2);                                                  dec->cur.y + ((16 * y_pos + 8) * stride) + 16 * x_pos,
1098                                                    dec->tmp.y + ((16 * y_pos + 8) * stride) + 16 * x_pos,
1099                                                    stride, 1, 8);
1100    
1101            interpolate8x8_avg2(dec->cur.y + ((16 * y_pos + 8) * stride) + 16 * x_pos + 8,
1102                                                    dec->cur.y + ((16 * y_pos + 8) * stride) + 16 * x_pos + 8,
1103                                                    dec->tmp.y + ((16 * y_pos + 8) * stride) + 16 * x_pos + 8,
1104                                                    stride, 1, 8);
1105    
1106            interpolate8x8_avg2(dec->cur.u + (8 * y_pos * stride2) + 8 * x_pos,
1107                                                    dec->cur.u + (8 * y_pos * stride2) + 8 * x_pos,
1108                                                    dec->tmp.u + (8 * y_pos * stride2) + 8 * x_pos,
1109                                                    stride2, 1, 8);
1110    
1111            interpolate8x8_avg2(dec->cur.v + (8 * y_pos * stride2) + 8 * x_pos,
1112                                                    dec->cur.v + (8 * y_pos * stride2) + 8 * x_pos,
1113                                                    dec->tmp.v + (8 * y_pos * stride2) + 8 * x_pos,
1114                                                    stride2, 1, 8);
1115    
1116          stop_comp_timer();          stop_comp_timer();
1117    
1118          for (i = 0; i < 6; i++) {          if (cbp)
1119                  if (cbp & (1 << (5 - i)))       // coded                  decoder_mb_decode(dec, cbp, bs, pY_Cur, pU_Cur, pV_Cur, 0, pMB);
                 {  
                         memset(&block[i * 64], 0, 64 * sizeof(int16_t));        // clear  
   
                         start_timer();  
                         get_inter_block(bs, &block[i * 64]);  
                         stop_coding_timer();  
   
                         start_timer();  
                         if (dec->quant_type == 0) {  
                                 dequant_inter(&data[i * 64], &block[i * 64], iQuant);  
                         } else {  
                                 dequant4_inter(&data[i * 64], &block[i * 64], iQuant);  
                         }  
                         stop_iquant_timer();  
   
                         start_timer();  
                         idct(&data[i * 64]);  
                         stop_idct_timer();  
                 }  
         }  
   
         if (dec->interlacing && pMB->field_dct) {  
                 next_block = stride;  
                 stride *= 2;  
         }  
   
         start_timer();  
         if (cbp & 32)  
                 transfer_16to8add(pY_Cur, &data[0 * 64], stride);  
         if (cbp & 16)  
                 transfer_16to8add(pY_Cur + 8, &data[1 * 64], stride);  
         if (cbp & 8)  
                 transfer_16to8add(pY_Cur + next_block, &data[2 * 64], stride);  
         if (cbp & 4)  
                 transfer_16to8add(pY_Cur + 8 + next_block, &data[3 * 64], stride);  
         if (cbp & 2)  
                 transfer_16to8add(pU_Cur, &data[4 * 64], stride2);  
         if (cbp & 1)  
                 transfer_16to8add(pV_Cur, &data[5 * 64], stride2);  
         stop_transfer_timer();  
1120  }  }
1121    
1122    /* for decode B-frame dbquant */
1123  // add by MinChen <chenm001@163.com>  static __inline int32_t
 // for decode B-frame dbquant  
 int32_t __inline  
1124  get_dbquant(Bitstream * bs)  get_dbquant(Bitstream * bs)
1125  {  {
1126          if (!BitstreamGetBit(bs))       // '0'          if (!BitstreamGetBit(bs))               /*  '0' */
1127                  return (0);                  return (0);
1128          else if (!BitstreamGetBit(bs))  // '10'          else if (!BitstreamGetBit(bs))  /* '10' */
1129                  return (-2);                  return (-2);
1130          else          else                                                    /* '11' */
1131                  return (2);                             // '11'                  return (2);
1132  }  }
1133    
1134  // add by MinChen <chenm001@163.com>  /*
1135  // for decode B-frame mb_type   * decode B-frame mb_type
1136  // bit   ret_value   * bit          ret_value
1137  // 1        0   * 1            0
1138  // 01       1   * 01           1
1139  // 001      2   * 001          2
1140  // 0001     3   * 0001         3
1141  int32_t __inline   */
1142    static int32_t __inline
1143  get_mbtype(Bitstream * bs)  get_mbtype(Bitstream * bs)
1144  {  {
1145          int32_t mb_type;          int32_t mb_type;
1146    
1147          for (mb_type = 0; mb_type <= 3; mb_type++) {          for (mb_type = 0; mb_type <= 3; mb_type++)
1148                  if (BitstreamGetBit(bs))                  if (BitstreamGetBit(bs))
                         break;  
         }  
   
         if (mb_type <= 3)  
1149                  return (mb_type);                  return (mb_type);
1150          else  
1151                  return (-1);          return -1;
1152  }  }
1153    
1154  void  static void
1155  decoder_bframe(DECODER * dec,  decoder_bframe(DECODER * dec,
1156                             Bitstream * bs,                             Bitstream * bs,
1157                             int quant,                             int quant,
1158                             int fcode_forward,                             int fcode_forward,
1159                             int fcode_backward)                             int fcode_backward)
1160  {  {
   
1161          uint32_t x, y;          uint32_t x, y;
1162          VECTOR mv, zeromv;          VECTOR mv;
1163            const VECTOR zeromv = {0,0};
1164            const int64_t TRB = dec->time_pp - dec->time_bp, TRD = dec->time_pp;
1165            int i;
1166    
1167          start_timer();          start_timer();
1168          image_setedges(&dec->refn[0], dec->edged_width, dec->edged_height,          image_setedges(&dec->refn[0], dec->edged_width, dec->edged_height,
1169                                     dec->width, dec->height, dec->interlacing);                                          dec->width, dec->height);
1170          //image_setedges(&dec->refn[1], dec->edged_width, dec->edged_height, dec->width, dec->height, dec->interlacing);          image_setedges(&dec->refn[1], dec->edged_width, dec->edged_height,
1171                                            dec->width, dec->height);
1172          stop_edges_timer();          stop_edges_timer();
1173    
   
1174          for (y = 0; y < dec->mb_height; y++) {          for (y = 0; y < dec->mb_height; y++) {
1175                  // Initialize Pred Motion Vector                  /* Initialize Pred Motion Vector */
1176                  dec->p_fmv.x = dec->p_fmv.y = dec->p_bmv.x = dec->p_bmv.y = 0;                  dec->p_fmv = dec->p_bmv = zeromv;
1177                  for (x = 0; x < dec->mb_width; x++) {                  for (x = 0; x < dec->mb_width; x++) {
1178                          MACROBLOCK *mb = &dec->mbs[y * dec->mb_width + x];                          MACROBLOCK *mb = &dec->mbs[y * dec->mb_width + x];
1179                          MACROBLOCK *last_mb = &dec->last_mbs[y * dec->mb_width + x];                          MACROBLOCK *last_mb = &dec->last_mbs[y * dec->mb_width + x];
1180                            const int fcode_max = (fcode_forward>fcode_backward) ? fcode_forward : fcode_backward;
1181                            uint32_t intra_dc_threshold; /* fake variable */
1182    
1183                            if (check_resync_marker(bs, fcode_max  - 1)) {
1184                                    int bound = read_video_packet_header(bs, dec, fcode_max - 1, &quant,
1185                                                                                                             &fcode_forward, &fcode_backward, &intra_dc_threshold);
1186                                    x = bound % dec->mb_width;
1187                                    y = bound / dec->mb_width;
1188                                    /* reset predicted macroblocks */
1189                                    dec->p_fmv = dec->p_bmv = zeromv;
1190                            }
1191    
1192                            mv =
1193                            mb->b_mvs[0] = mb->b_mvs[1] = mb->b_mvs[2] = mb->b_mvs[3] =
1194                            mb->mvs[0] = mb->mvs[1] = mb->mvs[2] = mb->mvs[3] = zeromv;
1195                            mb->quant = quant;
1196    
1197                          mb->mvs[0].x = mb->mvs[0].y = zeromv.x = zeromv.y = mv.x = mv.y =                          /*
1198                                  0;                           * skip if the co-located P_VOP macroblock is not coded
1199                             * if not codec in co-located S_VOP macroblock is _not_
1200                             * automatically skipped
1201                             */
1202    
                         // the last P_VOP is skip macroblock ?  
1203                          if (last_mb->mode == MODE_NOT_CODED) {                          if (last_mb->mode == MODE_NOT_CODED) {
                                 //DEBUG2("Skip MB in B-frame at (X,Y)=!",x,y);  
                                 mb->mb_type = MODE_FORWARD;  
1204                                  mb->cbp = 0;                                  mb->cbp = 0;
1205                                  mb->mvs[1].x = mb->mvs[2].x = mb->mvs[3].x = mb->mvs[0].x;                                  mb->mode = MODE_FORWARD;
1206                                  mb->mvs[1].y = mb->mvs[2].y = mb->mvs[3].y = mb->mvs[0].y;                                  decoder_mbinter(dec, mb, x, y, mb->cbp, bs, 0, 0, 1);
                                 mb->quant = 8;  
   
                                 decoder_bf_mbinter(dec, mb, x, y, mb->cbp, bs, quant, 1);  
1207                                  continue;                                  continue;
1208                          }                          }
                         //t=BitstreamShowBits(bs,32);  
1209    
1210                          if (!BitstreamGetBit(bs)) {     // modb=='0'                          if (!BitstreamGetBit(bs)) {     /* modb=='0' */
1211                                  const uint8_t modb2 = BitstreamGetBit(bs);                                  const uint8_t modb2 = BitstreamGetBit(bs);
1212    
1213                                  mb->mb_type = get_mbtype(bs);                                  mb->mode = get_mbtype(bs);
1214    
1215                                  if (!modb2) {   // modb=='00'                                  if (!modb2)             /* modb=='00' */
1216                                          mb->cbp = BitstreamGetBits(bs, 6);                                          mb->cbp = BitstreamGetBits(bs, 6);
1217                                  } else {                                  else
1218                                          mb->cbp = 0;                                          mb->cbp = 0;
                                 }  
                                 if (mb->mb_type && mb->cbp) {  
                                         quant += get_dbquant(bs);  
1219    
1220                                          if (quant > 31) {                                  if (mb->mode && mb->cbp) {
1221                                            quant += get_dbquant(bs);
1222                                            if (quant > 31)
1223                                                  quant = 31;                                                  quant = 31;
1224                                          } else if (mb->quant < 1) {                                          else if (quant < 1)
1225                                                  quant = 1;                                                  quant = 1;
1226                                          }                                          }
                                 } else {  
                                         quant = 8;  
                                 }  
1227                                  mb->quant = quant;                                  mb->quant = quant;
1228    
1229                                    if (dec->interlacing) {
1230                                            if (mb->cbp) {
1231                                                    mb->field_dct = BitstreamGetBit(bs);
1232                                                    DPRINTF(XVID_DEBUG_MB,"decp: field_dct: %i\n", mb->field_dct);
1233                                            }
1234    
1235                                            if (mb->mode) {
1236                                                    mb->field_pred = BitstreamGetBit(bs);
1237                                                    DPRINTF(XVID_DEBUG_MB, "decp: field_pred: %i\n", mb->field_pred);
1238    
1239                                                    if (mb->field_pred) {
1240                                                            mb->field_for_top = BitstreamGetBit(bs);
1241                                                            DPRINTF(XVID_DEBUG_MB,"decp: field_for_top: %i\n", mb->field_for_top);
1242                                                            mb->field_for_bot = BitstreamGetBit(bs);
1243                                                            DPRINTF(XVID_DEBUG_MB,"decp: field_for_bot: %i\n", mb->field_for_bot);
1244                                                    }
1245                                            }
1246                                    }
1247    
1248                          } else {                          } else {
1249                                  mb->mb_type = MODE_DIRECT_NONE_MV;                                  mb->mode = MODE_DIRECT_NONE_MV;
1250                                  mb->cbp = 0;                                  mb->cbp = 0;
1251                          }                          }
1252    
1253                          mb->mode = MODE_INTER;                          switch (mb->mode) {
                         //DEBUG1("Switch bm_type=",mb->mb_type);  
   
                         switch (mb->mb_type) {  
1254                          case MODE_DIRECT:                          case MODE_DIRECT:
1255                                  get_b_motion_vector(dec, bs, x, y, &mb->mvs[0], 1, zeromv);                                  get_b_motion_vector(bs, &mv, 1, zeromv);
1256    
1257                          case MODE_DIRECT_NONE_MV:                          case MODE_DIRECT_NONE_MV:
                                 {                               // Because this file is a C file not C++ so I use '{' to define var  
                                         const int64_t TRB = dec->time_pp - dec->time_bp, TRD =  
                                                 dec->time_pp;  
                                         int i;  
   
1258                                          for (i = 0; i < 4; i++) {                                          for (i = 0; i < 4; i++) {
1259                                                  mb->mvs[i].x =                                          mb->mvs[i].x = (int32_t) ((TRB * last_mb->mvs[i].x) / TRD + mv.x);
1260                                                          (int32_t) ((TRB * last_mb->mvs[i].x) / TRD +                                          mb->b_mvs[i].x = (int32_t) ((mv.x == 0)
1261                                                                             mb->mvs[0].x);                                                                          ? ((TRB - TRD) * last_mb->mvs[i].x) / TRD
1262                                                  mb->b_mvs[i].x =                                                                          : mb->mvs[i].x - last_mb->mvs[i].x);
1263                                                          (int32_t) ((mb->mvs[0].x ==                                          mb->mvs[i].y = (int32_t) ((TRB * last_mb->mvs[i].y) / TRD + mv.y);
1264                                                                                  0) ? ((TRB -                                          mb->b_mvs[i].y = (int32_t) ((mv.y == 0)
1265                                                                                             TRD) * last_mb->mvs[i].x) /                                                                          ? ((TRB - TRD) * last_mb->mvs[i].y) / TRD
1266                                                                             TRD : mb->mvs[i].x - last_mb->mvs[i].x);                                                                          : mb->mvs[i].y - last_mb->mvs[i].y);
                                                 mb->mvs[i].y =  
                                                         (int32_t) ((TRB * last_mb->mvs[i].y) / TRD +  
                                                                            mb->mvs[0].y);  
                                                 mb->b_mvs[i].y =  
                                                         (int32_t) ((mb->mvs[0].y ==  
                                                                                 0) ? ((TRB -  
                                                                                            TRD) * last_mb->mvs[i].y) /  
                                                                            TRD : mb->mvs[i].y - last_mb->mvs[i].y);  
                                         }  
                                         //DEBUG("B-frame Direct!\n");  
1267                                  }                                  }
1268                                  mb->mode = MODE_INTER4V;  
1269                                  decoder_bf_interpolate_mbinter(dec, dec->refn[1], dec->refn[0],                                  decoder_bf_interpolate_mbinter(dec, dec->refn[1], dec->refn[0],
1270                                                                                             mb, x, y, mb->cbp, bs);                                                                                                  mb, x, y, bs, 1);
1271                                  break;                                  break;
1272    
1273                          case MODE_INTERPOLATE:                          case MODE_INTERPOLATE:
1274                                  get_b_motion_vector(dec, bs, x, y, &mb->mvs[0], fcode_forward,                                  get_b_motion_vector(bs, &mb->mvs[0], fcode_forward, dec->p_fmv);
1275                                                                          dec->p_fmv);                                  dec->p_fmv = mb->mvs[1] = mb->mvs[2] = mb->mvs[3] =     mb->mvs[0];
1276                                  dec->p_fmv.x = mb->mvs[1].x = mb->mvs[2].x = mb->mvs[3].x =  
1277                                          mb->mvs[0].x;                                  get_b_motion_vector(bs, &mb->b_mvs[0], fcode_backward, dec->p_bmv);
1278                                  dec->p_fmv.y = mb->mvs[1].y = mb->mvs[2].y = mb->mvs[3].y =                                  dec->p_bmv = mb->b_mvs[1] = mb->b_mvs[2] = mb->b_mvs[3] = mb->b_mvs[0];
                                         mb->mvs[0].y;  
   
                                 get_b_motion_vector(dec, bs, x, y, &mb->b_mvs[0],  
                                                                         fcode_backward, dec->p_bmv);  
                                 dec->p_bmv.x = mb->b_mvs[1].x = mb->b_mvs[2].x =  
                                         mb->b_mvs[3].x = mb->b_mvs[0].x;  
                                 dec->p_bmv.y = mb->b_mvs[1].y = mb->b_mvs[2].y =  
                                         mb->b_mvs[3].y = mb->b_mvs[0].y;  
1279    
1280                                  decoder_bf_interpolate_mbinter(dec, dec->refn[1], dec->refn[0],                                  decoder_bf_interpolate_mbinter(dec, dec->refn[1], dec->refn[0],
1281                                                                                             mb, x, y, mb->cbp, bs);                                                                                          mb, x, y, bs, 0);
                                 //DEBUG("B-frame Bidir!\n");  
1282                                  break;                                  break;
1283    
1284                          case MODE_BACKWARD:                          case MODE_BACKWARD:
1285                                  get_b_motion_vector(dec, bs, x, y, &mb->mvs[0], fcode_backward,                                  get_b_motion_vector(bs, &mb->mvs[0], fcode_backward, dec->p_bmv);
1286                                                                          dec->p_bmv);                                  dec->p_bmv = mb->mvs[1] = mb->mvs[2] = mb->mvs[3] =     mb->mvs[0];
                                 dec->p_bmv.x = mb->mvs[1].x = mb->mvs[2].x = mb->mvs[3].x =  
                                         mb->mvs[0].x;  
                                 dec->p_bmv.y = mb->mvs[1].y = mb->mvs[2].y = mb->mvs[3].y =  
                                         mb->mvs[0].y;  
1287    
1288                                  decoder_bf_mbinter(dec, mb, x, y, mb->cbp, bs, quant, 0);                                  decoder_mbinter(dec, mb, x, y, mb->cbp, bs, 0, 0, 0);
                                 //DEBUG("B-frame Backward!\n");  
1289                                  break;                                  break;
1290    
1291                          case MODE_FORWARD:                          case MODE_FORWARD:
1292                                  get_b_motion_vector(dec, bs, x, y, &mb->mvs[0], fcode_forward,                                  get_b_motion_vector(bs, &mb->mvs[0], fcode_forward, dec->p_fmv);
1293                                                                          dec->p_fmv);                                  dec->p_fmv = mb->mvs[1] = mb->mvs[2] = mb->mvs[3] =     mb->mvs[0];
                                 dec->p_fmv.x = mb->mvs[1].x = mb->mvs[2].x = mb->mvs[3].x =  
                                         mb->mvs[0].x;  
                                 dec->p_fmv.y = mb->mvs[1].y = mb->mvs[2].y = mb->mvs[3].y =  
                                         mb->mvs[0].y;  
1294    
1295                                  decoder_bf_mbinter(dec, mb, x, y, mb->cbp, bs, quant, 1);                                  decoder_mbinter(dec, mb, x, y, mb->cbp, bs, 0, 0, 1);
                                 //DEBUG("B-frame Forward!\n");  
1296                                  break;                                  break;
1297    
1298                          default:                          default:
1299                                  DEBUG1("Not support B-frame mb_type =", mb->mb_type);                                  DPRINTF(XVID_DEBUG_ERROR,"Not supported B-frame mb_type = %i\n", mb->mode);
1300                          }                          }
1301                    } /* End of for */
                 }                                               // end of FOR  
1302          }          }
1303  }  }
1304    
1305  // swap two MACROBLOCK array  /* perform post processing if necessary, and output the image */
1306  void  void decoder_output(DECODER * dec, IMAGE * img, MACROBLOCK * mbs,
1307  mb_swap(MACROBLOCK ** mb1,                                          xvid_dec_frame_t * frame, xvid_dec_stats_t * stats, int coding_type)
                 MACROBLOCK ** mb2)  
1308  {  {
1309          MACROBLOCK *temp = *mb1;          image_output(img, dec->width, dec->height,
1310                                     dec->edged_width, (uint8_t**)frame->output.plane, frame->output.stride,
1311                                     frame->output.csp, dec->interlacing);
1312    
1313          *mb1 = *mb2;          if (stats) {
1314          *mb2 = temp;                  stats->type = coding2type(coding_type);
1315                    stats->data.vop.time_base = (int)dec->time_base;
1316                    stats->data.vop.time_increment = 0;     /* XXX: todo */
1317  }  }
1318    }
1319    
1320    
1321  int  int
1322  decoder_decode(DECODER * dec,  decoder_decode(DECODER * dec,
1323                             XVID_DEC_FRAME * frame)                                  xvid_dec_frame_t * frame, xvid_dec_stats_t * stats)
1324  {  {
1325    
1326          Bitstream bs;          Bitstream bs;
1327          uint32_t rounding;          uint32_t rounding;
1328            uint32_t reduced_resolution;
1329          uint32_t quant;          uint32_t quant;
1330          uint32_t fcode_forward;          uint32_t fcode_forward;
1331          uint32_t fcode_backward;          uint32_t fcode_backward;
1332          uint32_t intra_dc_threshold;          uint32_t intra_dc_threshold;
1333          uint32_t vop_type;          WARPPOINTS gmc_warp;
1334            int coding_type;
1335            int success, output, seen_something;
1336    
1337            if (XVID_VERSION_MAJOR(frame->version) != 1 || (stats && XVID_VERSION_MAJOR(stats->version) != 1))      /* v1.x.x */
1338                    return XVID_ERR_VERSION;
1339    
1340          start_global_timer();          start_global_timer();
1341    
1342            dec->low_delay_default = (frame->general & XVID_LOWDELAY);
1343            if ((frame->general & XVID_DISCONTINUITY))
1344                    dec->frames = 0;
1345            dec->out_frm = (frame->output.csp == XVID_CSP_SLICE) ? &frame->output : NULL;
1346    
1347            if (frame->length < 0) {        /* decoder flush */
1348                    int ret;
1349                    /* if not decoding "low_delay/packed", and this isn't low_delay and
1350                            we have a reference frame, then outout the reference frame */
1351                    if (!(dec->low_delay_default && dec->packed_mode) && !dec->low_delay && dec->frames>0) {
1352                            decoder_output(dec, &dec->refn[0], dec->last_mbs, frame, stats, dec->last_coding_type);
1353                            dec->frames = 0;
1354                            ret = 0;
1355                    } else {
1356                            if (stats) stats->type = XVID_TYPE_NOTHING;
1357                            ret = XVID_ERR_END;
1358                    }
1359    
1360                    emms();
1361                    stop_global_timer();
1362                    return ret;
1363            }
1364    
1365          BitstreamInit(&bs, frame->bitstream, frame->length);          BitstreamInit(&bs, frame->bitstream, frame->length);
1366    
1367          // add by chenm001 <chenm001@163.com>          /* XXX: 0x7f is only valid whilst decoding vfw xvid/divx5 avi's */
1368          // for support B-frame to reference last 2 frame          if(dec->low_delay_default && frame->length == 1 && BitstreamShowBits(&bs, 8) == 0x7f)
1369          dec->frames++;          {
1370          vop_type =                  image_output(&dec->refn[0], dec->width, dec->height, dec->edged_width,
1371                  BitstreamReadHeaders(&bs, dec, &rounding, &quant, &fcode_forward,                                           (uint8_t**)frame->output.plane, frame->output.stride, frame->output.csp, dec->interlacing);
1372                                                           &fcode_backward, &intra_dc_threshold);                  if (stats) stats->type = XVID_TYPE_NOTHING;
1373                    emms();
1374                    return 1;       /* one byte consumed */
1375            }
1376    
1377          dec->p_bmv.x = dec->p_bmv.y = dec->p_fmv.y = dec->p_fmv.y = 0;  // init pred vector to 0          success = 0;
1378            output = 0;
1379            seen_something = 0;
1380    
1381          switch (vop_type) {  repeat:
         case P_VOP:  
                 decoder_pframe(dec, &bs, rounding, quant, fcode_forward,  
                                            intra_dc_threshold);  
                 DEBUG1("P_VOP  Time=", dec->time);  
                 break;  
1382    
1383          case I_VOP:          coding_type = BitstreamReadHeaders(&bs, dec, &rounding, &reduced_resolution,
1384                  decoder_iframe(dec, &bs, quant, intra_dc_threshold);                          &quant, &fcode_forward, &fcode_backward, &intra_dc_threshold, &gmc_warp);
                 DEBUG1("I_VOP  Time=", dec->time);  
                 break;  
1385    
1386          case B_VOP:          DPRINTF(XVID_DEBUG_HEADER, "coding_type=%i,  packed=%i,  time=%lli,  time_pp=%i,  time_bp=%i\n",
1387  #ifdef BFRAMES_DEC                                                          coding_type,    dec->packed_mode, dec->time, dec->time_pp, dec->time_bp);
1388                  if (dec->time_pp > dec->time_bp) {  
1389                          DEBUG1("B_VOP  Time=", dec->time);          if (coding_type == -1) { /* nothing */
1390                          decoder_bframe(dec, &bs, quant, fcode_forward, fcode_backward);                  if (success) goto done;
1391                  } else {                  if (stats) stats->type = XVID_TYPE_NOTHING;
1392                          DEBUG("broken B-frame!");                  emms();
1393                    return BitstreamPos(&bs)/8;
1394                  }                  }
 #else  
                 image_copy(&dec->cur, &dec->refn[0], dec->edged_width, dec->height);  
 #endif  
                 break;  
1395    
1396          case N_VOP:                             // vop not coded          if (coding_type == -2 || coding_type == -3) {   /* vol and/or resize */
1397                  // when low_delay==0, N_VOP's should interpolate between the past and future frames  
1398                    if (coding_type == -3)
1399                            decoder_resize(dec);
1400    
1401                    if (stats) {
1402                            stats->type = XVID_TYPE_VOL;
1403                            stats->data.vol.general = 0;
1404                            /*XXX: if (dec->interlacing)
1405                                    stats->data.vol.general |= ++INTERLACING; */
1406                            stats->data.vol.width = dec->width;
1407                            stats->data.vol.height = dec->height;
1408                            stats->data.vol.par = dec->aspect_ratio;
1409                            stats->data.vol.par_width = dec->par_width;
1410                            stats->data.vol.par_height = dec->par_height;
1411                            emms();
1412                            return BitstreamPos(&bs)/8;     /* number of bytes consumed */
1413                    }
1414                    goto repeat;
1415            }
1416    
1417            dec->p_bmv.x = dec->p_bmv.y = dec->p_fmv.y = dec->p_fmv.y = 0;  /* init pred vector to 0 */
1418    
1419            /* packed_mode: special-N_VOP treament */
1420            if (dec->packed_mode && coding_type == N_VOP) {
1421                    if (dec->low_delay_default && dec->frames > 0) {
1422                            decoder_output(dec, &dec->refn[0], dec->last_mbs, frame, stats, dec->last_coding_type);
1423                            output = 1;
1424                    }
1425                    /* ignore otherwise */
1426            } else if (coding_type != B_VOP) {
1427                    switch(coding_type) {
1428                    case I_VOP :
1429                            decoder_iframe(dec, &bs, reduced_resolution, quant, intra_dc_threshold);
1430                            break;
1431                    case P_VOP :
1432                            decoder_pframe(dec, &bs, rounding, reduced_resolution, quant,
1433                                                    fcode_forward, intra_dc_threshold, NULL);
1434                            break;
1435                    case S_VOP :
1436                            decoder_pframe(dec, &bs, rounding, reduced_resolution, quant,
1437                                                    fcode_forward, intra_dc_threshold, &gmc_warp);
1438                            break;
1439                    case N_VOP :
1440                            /* XXX: not_coded vops are not used for forward prediction */
1441                            /* we should not swap(last_mbs,mbs) */
1442                  image_copy(&dec->cur, &dec->refn[0], dec->edged_width, dec->height);                  image_copy(&dec->cur, &dec->refn[0], dec->edged_width, dec->height);
1443                  break;                  break;
   
         default:  
                 return XVID_ERR_FAIL;  
1444          }          }
1445    
1446          frame->length = BitstreamPos(&bs) / 8;                  if (reduced_resolution) {
1447                            image_deblock_rrv(&dec->cur, dec->edged_width, dec->mbs,
1448                                    (dec->width + 31) / 32, (dec->height + 31) / 32, dec->mb_width,
1449                                    16, 0);
1450                    }
1451    
1452  #ifdef BFRAMES_DEC                  /* note: for packed_mode, output is performed when the special-N_VOP is decoded */
1453          // test if no B_VOP                  if (!(dec->low_delay_default && dec->packed_mode)) {
1454          if (dec->low_delay) {          if (dec->low_delay) {
1455  #endif                                  decoder_output(dec, &dec->cur, dec->mbs, frame, stats, coding_type);
1456                  image_output(&dec->cur, dec->width, dec->height, dec->edged_width,                                  output = 1;
1457                                           frame->image, frame->stride, frame->colorspace);                          } else if (dec->frames > 0)     { /* is the reference frame valid? */
1458  #ifdef BFRAMES_DEC                                  /* output the reference frame */
1459          } else {                                  decoder_output(dec, &dec->refn[0], dec->last_mbs, frame, stats, dec->last_coding_type);
1460                  if (dec->frames >= 1) {                                  output = 1;
                         start_timer();  
                         if ((vop_type == I_VOP || vop_type == P_VOP)) {  
                                 image_output(&dec->refn[0], dec->width, dec->height,  
                                                          dec->edged_width, frame->image, frame->stride,  
                                                          frame->colorspace);  
                         } else if (vop_type == B_VOP) {  
                                 image_output(&dec->cur, dec->width, dec->height,  
                                                          dec->edged_width, frame->image, frame->stride,  
                                                          frame->colorspace);  
1461                          }                          }
                         stop_conv_timer();  
1462                  }                  }
         }  
 #endif  
1463    
         if (vop_type == I_VOP || vop_type == P_VOP) {  
1464                  image_swap(&dec->refn[0], &dec->refn[1]);                  image_swap(&dec->refn[0], &dec->refn[1]);
1465                  image_swap(&dec->cur, &dec->refn[0]);                  image_swap(&dec->cur, &dec->refn[0]);
1466                  // swap MACROBLOCK                  SWAP(MACROBLOCK *, dec->mbs, dec->last_mbs);
1467                  if (dec->low_delay && vop_type == P_VOP)                  dec->last_reduced_resolution = reduced_resolution;
1468                          mb_swap(&dec->mbs, &dec->last_mbs);                  dec->last_coding_type = coding_type;
1469    
1470                    dec->frames++;
1471                    seen_something = 1;
1472    
1473            } else {        /* B_VOP */
1474    
1475                    if (dec->low_delay) {
1476                            DPRINTF(XVID_DEBUG_ERROR, "warning: bvop found in low_delay==1 stream\n");
1477                            dec->low_delay = 1;
1478          }          }
1479    
1480          emms();                  if (dec->frames < 2) {
1481                            /* attemping to decode a bvop without atleast 2 reference frames */
1482                            image_printf(&dec->cur, dec->edged_width, dec->height, 16, 16,
1483                                                    "broken b-frame, mising ref frames");
1484                    } else if (dec->time_pp <= dec->time_bp) {
1485                            /* this occurs when dx50_bvop_compatibility==0 sequences are
1486                            decoded in vfw. */
1487                            image_printf(&dec->cur, dec->edged_width, dec->height, 16, 16,
1488                                                    "broken b-frame, tpp=%i tbp=%i", dec->time_pp, dec->time_bp);
1489                    } else {
1490                            decoder_bframe(dec, &bs, quant, fcode_forward, fcode_backward);
1491                    }
1492    
1493                    decoder_output(dec, &dec->cur, dec->mbs, frame, stats, coding_type);
1494                    output = 1;
1495                    dec->frames++;
1496            }
1497    
1498            BitstreamByteAlign(&bs);
1499    
1500            /* low_delay_default mode: repeat in packed_mode */
1501            if (dec->low_delay_default && dec->packed_mode && output == 0 && success == 0) {
1502                    success = 1;
1503                    goto repeat;
1504            }
1505    
1506    done :
1507    
1508            /* low_delay_default mode: if we've gotten here without outputting anything,
1509               then output the recently decoded frame, or print an error message  */
1510            if (dec->low_delay_default && output == 0) {
1511                    if (dec->packed_mode && seen_something) {
1512                            /* output the recently decoded frame */
1513                            decoder_output(dec, &dec->refn[0], dec->last_mbs, frame, stats, dec->last_coding_type);
1514                    } else {
1515                            image_clear(&dec->cur, dec->width, dec->height, dec->edged_width, 0, 128, 128);
1516                            image_printf(&dec->cur, dec->edged_width, dec->height, 16, 16,
1517                                    "warning: nothing to output");
1518                            image_printf(&dec->cur, dec->edged_width, dec->height, 16, 64,
1519                                    "bframe decoder lag");
1520    
1521                            decoder_output(dec, &dec->cur, NULL, frame, stats, P_VOP);
1522                            if (stats) stats->type = XVID_TYPE_NOTHING;
1523                    }
1524            }
1525    
1526            emms();
1527          stop_global_timer();          stop_global_timer();
1528    
1529          return XVID_ERR_OK;          return BitstreamPos(&bs) / 8;   /* number of bytes consumed */
1530  }  }

Legend:
Removed from v.1.21  
changed lines
  Added in v.1.49.2.19

No admin address has been configured
ViewVC Help
Powered by ViewVC 1.0.4