[svn] / branches / dev-api-4 / xvidcore / src / encoder.c Repository:
ViewVC logotype

Diff of /branches/dev-api-4/xvidcore/src/encoder.c

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

trunk/xvidcore/src/encoder.c revision 324, Sun Jul 21 03:49:47 2002 UTC branches/dev-api-4/xvidcore/src/encoder.c revision 999, Sun Apr 27 21:18:49 2003 UTC
# Line 26  Line 26 
26   *  along with this program; if not, write to the Free Software   *  along with this program; if not, write to the Free Software
27   *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA   *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
28   *   *
29   ****************************************************************************/   *  $Id: encoder.c,v 1.95.2.19 2003-04-27 21:18:49 edgomez Exp $
   
 /*****************************************************************************  
  *  
  *  History  
  *  
  *  10.07.2002  added BFRAMES_DEC_DEBUG support  
  *              MinChen <chenm001@163.com>  
  *  20.06.2002 bframe patch  
  *  08.05.2002 fix some problem in DEBUG mode;  
  *             MinChen <chenm001@163.com>  
  *  14.04.2002 added FrameCodeB()  
  *  
  *  $Id: encoder.c,v 1.60 2002-07-21 03:41:44 suxen_drol Exp $  
30   *   *
31   ****************************************************************************/   ****************************************************************************/
32    
# Line 53  Line 40 
40  #include "global.h"  #include "global.h"
41  #include "utils/timer.h"  #include "utils/timer.h"
42  #include "image/image.h"  #include "image/image.h"
 #ifdef BFRAMES  
43  #include "image/font.h"  #include "image/font.h"
44  #endif  #include "motion/sad.h"
45  #include "motion/motion.h"  #include "motion/motion.h"
46  #include "bitstream/cbp.h"  #include "bitstream/cbp.h"
47  #include "utils/mbfunctions.h"  #include "utils/mbfunctions.h"
48  #include "bitstream/bitstream.h"  #include "bitstream/bitstream.h"
49  #include "bitstream/mbcoding.h"  #include "bitstream/mbcoding.h"
 #include "utils/ratecontrol.h"  
50  #include "utils/emms.h"  #include "utils/emms.h"
51  #include "bitstream/mbcoding.h"  #include "bitstream/mbcoding.h"
52  #include "quant/adapt_quant.h"  #include "quant/adapt_quant.h"
53  #include "quant/quant_matrix.h"  #include "quant/quant_matrix.h"
54  #include "utils/mem_align.h"  #include "utils/mem_align.h"
55    
 #ifdef _SMP  
 #include "motion/smp_motion_est.h"  
 #endif  
 /*****************************************************************************  
  * Local macros  
  ****************************************************************************/  
   
 #define ENC_CHECK(X) if(!(X)) return XVID_ERR_FORMAT  
 #define SWAP(A,B)    { void * tmp = A; A = B; B = tmp; }  
   
56  /*****************************************************************************  /*****************************************************************************
57   * Local function prototypes   * Local function prototypes
58   ****************************************************************************/   ****************************************************************************/
59    
60  static int FrameCodeI(Encoder * pEnc,  static int FrameCodeI(Encoder * pEnc,
61                                            Bitstream * bs,                                            Bitstream * bs);
                                           uint32_t * pBits);  
62    
63  static int FrameCodeP(Encoder * pEnc,  static int FrameCodeP(Encoder * pEnc,
64                                            Bitstream * bs,                                            Bitstream * bs,
                                           uint32_t * pBits,  
65                                            bool force_inter,                                            bool force_inter,
66                                            bool vol_header);                                            bool vol_header);
67    
 #ifdef BFRAMES  
68  static void FrameCodeB(Encoder * pEnc,  static void FrameCodeB(Encoder * pEnc,
69                                             FRAMEINFO * frame,                                             FRAMEINFO * frame,
70                                             Bitstream * bs,                                             Bitstream * bs);
                                            uint32_t * pBits);  
 #endif  
   
 /*****************************************************************************  
  * Local data  
  ****************************************************************************/  
   
 static int DQtab[4] = {  
         -1, -2, 1, 2  
 };  
   
 static int iDQtab[5] = {  
         1, 0, NO_CHANGE, 2, 3  
 };  
   
   
 static void __inline  
 image_null(IMAGE * image)  
 {  
         image->y = image->u = image->v = NULL;  
 }  
71    
72    
73  /*****************************************************************************  /*****************************************************************************
# Line 130  Line 81 
81   * and cleaning code.   * and cleaning code.
82   *   *
83   * Returned values :   * Returned values :
84   *    - XVID_ERR_OK     - no errors   *    - 0                - no errors
85   *    - XVID_ERR_MEMORY - the libc could not allocate memory, the function   *    - XVID_ERR_MEMORY - the libc could not allocate memory, the function
86   *                        cleans the structure before exiting.   *                        cleans the structure before exiting.
87   *                        pParam->handle is also set to NULL.   *                        pParam->handle is also set to NULL.
88   *   *
89   ****************************************************************************/   ****************************************************************************/
90    
 int  
 encoder_create(XVID_ENC_PARAM * pParam)  
 {  
         Encoder *pEnc;  
         int i;  
   
         pParam->handle = NULL;  
   
         ENC_CHECK(pParam);  
   
         ENC_CHECK(pParam->width > 0 && pParam->width <= 1920);  
         ENC_CHECK(pParam->height > 0 && pParam->height <= 1280);  
         ENC_CHECK(!(pParam->width % 2));  
         ENC_CHECK(!(pParam->height % 2));  
   
         /* Fps */  
   
         if (pParam->fincr <= 0 || pParam->fbase <= 0) {  
                 pParam->fincr = 1;  
                 pParam->fbase = 25;  
         }  
   
91          /*          /*
92           * Simplify the "fincr/fbase" fraction           * Simplify the "fincr/fbase" fraction
          * (neccessary, since windows supplies us with huge numbers)  
93           */           */
94    static void
95          i = pParam->fincr;  simplify_time(int *inc, int *base)
96    {
97            /* common factor */
98            int i = *inc;
99          while (i > 1) {          while (i > 1) {
100                  if (pParam->fincr % i == 0 && pParam->fbase % i == 0) {                  if (*inc % i == 0 && *base % i == 0) {
101                          pParam->fincr /= i;                          *inc /= i;
102                          pParam->fbase /= i;                          *base /= i;
103                          i = pParam->fincr;                          i = *inc;
104                          continue;                          continue;
105                  }                  }
106                  i--;                  i--;
107          }          }
108    
109          if (pParam->fbase > 65535) {          /* if neccessary, round to 65535 accuracy */
110                  float div = (float) pParam->fbase / 65535;          if (*base > 65535) {
111                    float div = (float) *base / 65535;
112                  pParam->fbase = (int) (pParam->fbase / div);                  *base = (int) (*base / div);
113                  pParam->fincr = (int) (pParam->fincr / div);                  *inc = (int) (*inc / div);
114            }
115          }          }
116    
         /* Bitrate allocator defaults */  
   
         if (pParam->rc_bitrate <= 0)  
                 pParam->rc_bitrate = 900000;  
   
         if (pParam->rc_reaction_delay_factor <= 0)  
                 pParam->rc_reaction_delay_factor = 16;  
   
         if (pParam->rc_averaging_period <= 0)  
                 pParam->rc_averaging_period = 100;  
   
         if (pParam->rc_buffer <= 0)  
                 pParam->rc_buffer = 100;  
   
         /* Max and min quantizers */  
   
         if ((pParam->min_quantizer <= 0) || (pParam->min_quantizer > 31))  
                 pParam->min_quantizer = 1;  
117    
118          if ((pParam->max_quantizer <= 0) || (pParam->max_quantizer > 31))  int
119                  pParam->max_quantizer = 31;  enc_create(xvid_enc_create_t * create)
120    {
121            Encoder *pEnc;
122        int n;
123    
124          if (pParam->max_quantizer < pParam->min_quantizer)          if (XVID_MAJOR(create->version) != 1)   /* v1.x.x */
125                  pParam->max_quantizer = pParam->min_quantizer;                  return XVID_ERR_VERSION;
126    
127          /* 1 keyframe each 10 seconds */          if (create->width%2 || create->height%2)
128                    return XVID_ERR_FAIL;
129    
130          if (pParam->max_key_interval == 0)          /* allocate encoder struct */
                 pParam->max_key_interval = 10 * pParam->fincr / pParam->fbase;  
131    
132          pEnc = (Encoder *) xvid_malloc(sizeof(Encoder), CACHE_LINE);          pEnc = (Encoder *) xvid_malloc(sizeof(Encoder), CACHE_LINE);
133          if (pEnc == NULL)          if (pEnc == NULL)
134                  return XVID_ERR_MEMORY;                  return XVID_ERR_MEMORY;
   
         /* Zero the Encoder Structure */  
   
135          memset(pEnc, 0, sizeof(Encoder));          memset(pEnc, 0, sizeof(Encoder));
136    
137          /* Fill members of Encoder structure */          /* global flags */
138        pEnc->mbParam.global_flags = create->global;
         pEnc->mbParam.width = pParam->width;  
         pEnc->mbParam.height = pParam->height;  
139    
140        /* width, height */
141            pEnc->mbParam.width = create->width;
142            pEnc->mbParam.height = create->height;
143          pEnc->mbParam.mb_width = (pEnc->mbParam.width + 15) / 16;          pEnc->mbParam.mb_width = (pEnc->mbParam.width + 15) / 16;
144          pEnc->mbParam.mb_height = (pEnc->mbParam.height + 15) / 16;          pEnc->mbParam.mb_height = (pEnc->mbParam.height + 15) / 16;
   
145          pEnc->mbParam.edged_width = 16 * pEnc->mbParam.mb_width + 2 * EDGE_SIZE;          pEnc->mbParam.edged_width = 16 * pEnc->mbParam.mb_width + 2 * EDGE_SIZE;
146          pEnc->mbParam.edged_height = 16 * pEnc->mbParam.mb_height + 2 * EDGE_SIZE;          pEnc->mbParam.edged_height = 16 * pEnc->mbParam.mb_height + 2 * EDGE_SIZE;
147    
148          pEnc->mbParam.fbase = pParam->fbase;      /* framerate */
149          pEnc->mbParam.fincr = pParam->fincr;      pEnc->mbParam.fincr = MAX(create->fincr, 0);
150            pEnc->mbParam.fbase = create->fincr <= 0 ? 25 : create->fbase;
151        if (pEnc->mbParam.fincr>0)
152                simplify_time(&pEnc->mbParam.fincr, &pEnc->mbParam.fbase);
153    
154        /* plugins */
155        if(create->num_plugins > 0) {
156                    pEnc->num_plugins = create->num_plugins;
157                    pEnc->plugins = xvid_malloc(sizeof(xvid_enc_plugin_t) * pEnc->num_plugins, CACHE_LINE);
158                    if (pEnc->plugins == NULL)
159                            goto xvid_err_memory0;
160            } else {
161                    pEnc->num_plugins = 0;
162                    pEnc->plugins = NULL;
163            }
164    
165        for (n=0; n<pEnc->num_plugins;n++) {
166            xvid_plg_create_t pcreate;
167            xvid_plg_info_t pinfo;
168    
169          pEnc->mbParam.m_quant_type = H263_QUANT;          memset(&pinfo, 0, sizeof(xvid_plg_info_t));
170            pinfo.version = XVID_VERSION;
171            if (create->plugins[n].func(0, XVID_PLG_INFO, &pinfo, 0) >= 0) {
172                pEnc->mbParam.plugin_flags |= pinfo.flags;
173            }
174    
175  #ifdef _SMP          memset(&pcreate, 0, sizeof(xvid_plg_create_t));
176          pEnc->mbParam.num_threads = MIN(pParam->num_threads, MAXNUMTHREADS);          pcreate.version = XVID_VERSION;
177  #endif          pcreate.width = pEnc->mbParam.width;
178            pcreate.height = pEnc->mbParam.height;
179            pcreate.fincr = pEnc->mbParam.fincr;
180            pcreate.fbase = pEnc->mbParam.fbase;
181            pcreate.param = create->plugins[n].param;
182    
183          pEnc->sStat.fMvPrevSigma = -1;          pEnc->plugins[n].func = NULL;   /* disable plugins that fail */
184            if (create->plugins[n].func(0, XVID_PLG_CREATE, &pcreate, &pEnc->plugins[n].param) >= 0) {
185                pEnc->plugins[n].func = create->plugins[n].func;
186            }
187        }
188    
189          /* Fill rate control parameters */      if ((pEnc->mbParam.global_flags & XVID_GLOBAL_EXTRASTATS_ENABLE) ||
190            (pEnc->mbParam.plugin_flags & XVID_REQPSNR)) {
191            pEnc->mbParam.plugin_flags |= XVID_REQORIGINAL; /* psnr calculation requires the original */
192        }
193    
194          pEnc->bitrate = pParam->rc_bitrate;      /* temp dquants */
195        if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
196                pEnc->temp_dquants = (int *) xvid_malloc(pEnc->mbParam.mb_width *
197                                                pEnc->mbParam.mb_height * sizeof(int), CACHE_LINE);
198        }
199        /* XXX: error checking */
200    
201          pEnc->iFrameNum = 0;          /* bframes */
202          pEnc->iMaxKeyInterval = pParam->max_key_interval;          pEnc->mbParam.max_bframes = MAX(create->max_bframes, 0);
203            pEnc->mbParam.bquant_ratio = MAX(create->bquant_ratio, 0);
204            pEnc->mbParam.bquant_offset = create->bquant_offset;
205    
206          /* try to allocate frame memory */          /* frame drop ratio */
207            pEnc->mbParam.frame_drop_ratio = MAX(create->frame_drop_ratio, 0);
208    
209        /* max keyframe interval */
210        pEnc->mbParam.iMaxKeyInterval = create->max_key_interval <= 0 ?
211                    10 * pEnc->mbParam.fbase / pEnc->mbParam.fincr : create->max_key_interval;
212    
213            /* Bitrate allocator defaults
214    
215            if ((create->min_quantizer <= 0) || (create->min_quantizer > 31))
216                    create->min_quantizer = 1;
217    
218            if ((create->max_quantizer <= 0) || (create->max_quantizer > 31))
219                    create->max_quantizer = 31;
220    
221            if (create->max_quantizer < create->min_quantizer)
222                    create->max_quantizer = create->min_quantizer; */
223    
224    
225        /* allocate working frame-image memory */
226    
227          pEnc->current = xvid_malloc(sizeof(FRAMEINFO), CACHE_LINE);          pEnc->current = xvid_malloc(sizeof(FRAMEINFO), CACHE_LINE);
228          pEnc->reference = xvid_malloc(sizeof(FRAMEINFO), CACHE_LINE);          pEnc->reference = xvid_malloc(sizeof(FRAMEINFO), CACHE_LINE);
# Line 257  Line 230 
230          if (pEnc->current == NULL || pEnc->reference == NULL)          if (pEnc->current == NULL || pEnc->reference == NULL)
231                  goto xvid_err_memory1;                  goto xvid_err_memory1;
232    
233          /* try to allocate mb memory */          /* allocate macroblock memory */
234    
235          pEnc->current->mbs =          pEnc->current->mbs =
236                  xvid_malloc(sizeof(MACROBLOCK) * pEnc->mbParam.mb_width *                  xvid_malloc(sizeof(MACROBLOCK) * pEnc->mbParam.mb_width *
# Line 269  Line 242 
242          if (pEnc->current->mbs == NULL || pEnc->reference->mbs == NULL)          if (pEnc->current->mbs == NULL || pEnc->reference->mbs == NULL)
243                  goto xvid_err_memory2;                  goto xvid_err_memory2;
244    
245          /* try to allocate image memory */          /* allocate interpolation image memory */
246    
247  #ifdef _DEBUG_PSNR      if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
248          image_null(&pEnc->sOriginal);          image_null(&pEnc->sOriginal);
249  #endif          image_null(&pEnc->sOriginal2);
250  #ifdef BFRAMES      }
251    
252          image_null(&pEnc->f_refh);          image_null(&pEnc->f_refh);
253          image_null(&pEnc->f_refv);          image_null(&pEnc->f_refv);
254          image_null(&pEnc->f_refhv);          image_null(&pEnc->f_refhv);
255  #endif  
256          image_null(&pEnc->current->image);          image_null(&pEnc->current->image);
257          image_null(&pEnc->reference->image);          image_null(&pEnc->reference->image);
258          image_null(&pEnc->vInterH);          image_null(&pEnc->vInterH);
# Line 287  Line 261 
261          image_null(&pEnc->vInterHV);          image_null(&pEnc->vInterHV);
262          image_null(&pEnc->vInterHVf);          image_null(&pEnc->vInterHVf);
263    
264  #ifdef _DEBUG_PSNR          if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
265          if (image_create          if (image_create
266                  (&pEnc->sOriginal, pEnc->mbParam.edged_width,                  (&pEnc->sOriginal, pEnc->mbParam.edged_width,
267                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
268                  goto xvid_err_memory3;                  goto xvid_err_memory3;
269  #endif  
270  #ifdef BFRAMES          if (image_create
271                            (&pEnc->sOriginal2, pEnc->mbParam.edged_width,
272                             pEnc->mbParam.edged_height) < 0)
273                            goto xvid_err_memory3;
274            }
275    
276          if (image_create          if (image_create
277                  (&pEnc->f_refh, pEnc->mbParam.edged_width,                  (&pEnc->f_refh, pEnc->mbParam.edged_width,
278                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
# Line 306  Line 285 
285                  (&pEnc->f_refhv, pEnc->mbParam.edged_width,                  (&pEnc->f_refhv, pEnc->mbParam.edged_width,
286                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
287                  goto xvid_err_memory3;                  goto xvid_err_memory3;
288  #endif  
289          if (image_create          if (image_create
290                  (&pEnc->current->image, pEnc->mbParam.edged_width,                  (&pEnc->current->image, pEnc->mbParam.edged_width,
291                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
# Line 336  Line 315 
315                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
316                  goto xvid_err_memory3;                  goto xvid_err_memory3;
317    
318    /* Create full bitplane for GMC, this might be wasteful */
319            if (image_create
320                    (&pEnc->vGMC, pEnc->mbParam.edged_width,
321                     pEnc->mbParam.edged_height) < 0)
322                    goto xvid_err_memory3;
323    
324            /* init bframe image buffers */
325    
326            pEnc->bframenum_head = 0;
327            pEnc->bframenum_tail = 0;
328            pEnc->flush_bframes = 0;
329            pEnc->closed_bframenum = -1;
330    
331          /* B Frames specific init */          /* B Frames specific init */
 #ifdef BFRAMES  
   
         pEnc->global = pParam->global;  
         pEnc->mbParam.max_bframes = pParam->max_bframes;  
         pEnc->bquant_ratio = pParam->bquant_ratio;  
         pEnc->frame_drop_ratio = pParam->frame_drop_ratio;  
332          pEnc->bframes = NULL;          pEnc->bframes = NULL;
333    
334          if (pEnc->mbParam.max_bframes > 0) {          if (pEnc->mbParam.max_bframes > 0) {
                 int n;  
335    
336                  pEnc->bframes =                  pEnc->bframes =
337                          xvid_malloc(pEnc->mbParam.max_bframes * sizeof(FRAMEINFO *),                          xvid_malloc(pEnc->mbParam.max_bframes * sizeof(FRAMEINFO *),
# Line 384  Line 367 
367                  }                  }
368          }          }
369    
370          pEnc->bframenum_head = 0;      /* init incoming frame queue */
371          pEnc->bframenum_tail = 0;          pEnc->queue_head = 0;
372          pEnc->flush_bframes = 0;          pEnc->queue_tail = 0;
373          pEnc->bframenum_dx50bvop = -1;          pEnc->queue_size = 0;
   
         pEnc->queue = NULL;  
   
   
         if (pEnc->mbParam.max_bframes > 0) {  
                 int n;  
374    
375                  pEnc->queue =                  pEnc->queue =
376                          xvid_malloc(pEnc->mbParam.max_bframes * sizeof(IMAGE),                  xvid_malloc((pEnc->mbParam.max_bframes+1) * sizeof(QUEUEINFO),
377                                                  CACHE_LINE);                                                  CACHE_LINE);
378    
379                  if (pEnc->queue == NULL)                  if (pEnc->queue == NULL)
380                          goto xvid_err_memory4;                          goto xvid_err_memory4;
381    
382                  for (n = 0; n < pEnc->mbParam.max_bframes; n++)          for (n = 0; n < pEnc->mbParam.max_bframes+1; n++)
383                          image_null(&pEnc->queue[n]);                  image_null(&pEnc->queue[n].image);
384    
385                  for (n = 0; n < pEnc->mbParam.max_bframes; n++) {  
386            for (n = 0; n < pEnc->mbParam.max_bframes+1; n++)
387            {
388                          if (image_create                          if (image_create
389                                  (&pEnc->queue[n], pEnc->mbParam.edged_width,                          (&pEnc->queue[n].image, pEnc->mbParam.edged_width,
390                                   pEnc->mbParam.edged_height) < 0)                                   pEnc->mbParam.edged_height) < 0)
391                                  goto xvid_err_memory5;                                  goto xvid_err_memory5;
392    
393                  }                  }
         }  
394    
         pEnc->queue_head = 0;  
         pEnc->queue_tail = 0;  
         pEnc->queue_size = 0;  
395    
396            /* timestamp stuff */
397    
398          pEnc->mbParam.m_seconds = 0;          pEnc->mbParam.m_stamp = 0;
         pEnc->mbParam.m_ticks = 0;  
399          pEnc->m_framenum = 0;          pEnc->m_framenum = 0;
400          pEnc->last_pframe = 1;          pEnc->current->stamp = 0;
401  #endif          pEnc->reference->stamp = 0;
402    
403          pParam->handle = (void *) pEnc;          /* other stuff */
404    
405          if (pParam->rc_bitrate) {          pEnc->iFrameNum = 0;
406                  RateControlInit(&pEnc->rate_control, pParam->rc_bitrate,          pEnc->fMvPrevSigma = -1;
407                                                  pParam->rc_reaction_delay_factor,  
408                                                  pParam->rc_averaging_period, pParam->rc_buffer,      create->handle = (void *) pEnc;
                                                 pParam->fbase * 1000 / pParam->fincr,  
                                                 pParam->max_quantizer, pParam->min_quantizer);  
         }  
409    
410          init_timer();          init_timer();
411    
412          return XVID_ERR_OK;      return 0;   /* ok */
413    
414          /*          /*
415           * We handle all XVID_ERR_MEMORY here, this makes the code lighter           * We handle all XVID_ERR_MEMORY here, this makes the code lighter
416           */           */
 #ifdef BFRAMES  
   xvid_err_memory5:  
417    
418      xvid_err_memory5:
419    
420          if (pEnc->mbParam.max_bframes > 0) {          if (pEnc->mbParam.max_bframes > 0) {
421            int i;
422    
423                  for (i = 0; i < pEnc->mbParam.max_bframes; i++) {                  for (i = 0; i < pEnc->mbParam.max_bframes+1; i++) {
424                          image_destroy(&pEnc->queue[i], pEnc->mbParam.edged_width,                          image_destroy(&pEnc->queue[i].image, pEnc->mbParam.edged_width,
425                                                    pEnc->mbParam.edged_height);                                                    pEnc->mbParam.edged_height);
426                  }                  }
427                  xvid_free(pEnc->queue);                  xvid_free(pEnc->queue);
# Line 458  Line 430 
430    xvid_err_memory4:    xvid_err_memory4:
431    
432          if (pEnc->mbParam.max_bframes > 0) {          if (pEnc->mbParam.max_bframes > 0) {
433            int i;
434    
435                  for (i = 0; i < pEnc->mbParam.max_bframes; i++) {                  for (i = 0; i < pEnc->mbParam.max_bframes; i++) {
436    
# Line 476  Line 449 
449                  xvid_free(pEnc->bframes);                  xvid_free(pEnc->bframes);
450          }          }
451    
 #endif  
   
452    xvid_err_memory3:    xvid_err_memory3:
453  #ifdef _DEBUG_PSNR  
454            if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
455          image_destroy(&pEnc->sOriginal, pEnc->mbParam.edged_width,          image_destroy(&pEnc->sOriginal, pEnc->mbParam.edged_width,
456                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
457  #endif                  image_destroy(&pEnc->sOriginal2, pEnc->mbParam.edged_width,
458                                              pEnc->mbParam.edged_height);
459            }
460    
 #ifdef BFRAMES  
461          image_destroy(&pEnc->f_refh, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refh, pEnc->mbParam.edged_width,
462                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
463          image_destroy(&pEnc->f_refv, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refv, pEnc->mbParam.edged_width,
464                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
465          image_destroy(&pEnc->f_refhv, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refhv, pEnc->mbParam.edged_width,
466                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
 #endif  
467    
468          image_destroy(&pEnc->current->image, pEnc->mbParam.edged_width,          image_destroy(&pEnc->current->image, pEnc->mbParam.edged_width,
469                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
# Line 508  Line 480 
480          image_destroy(&pEnc->vInterHVf, pEnc->mbParam.edged_width,          image_destroy(&pEnc->vInterHVf, pEnc->mbParam.edged_width,
481                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
482    
483    /* destroy GMC image */
484            image_destroy(&pEnc->vGMC, pEnc->mbParam.edged_width,
485                                      pEnc->mbParam.edged_height);
486    
487    
488    xvid_err_memory2:    xvid_err_memory2:
489          xvid_free(pEnc->current->mbs);          xvid_free(pEnc->current->mbs);
490          xvid_free(pEnc->reference->mbs);          xvid_free(pEnc->reference->mbs);
# Line 515  Line 492 
492    xvid_err_memory1:    xvid_err_memory1:
493          xvid_free(pEnc->current);          xvid_free(pEnc->current);
494          xvid_free(pEnc->reference);          xvid_free(pEnc->reference);
495    
496        if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
497                xvid_free(pEnc->temp_dquants);
498        }
499    
500      xvid_err_memory0:
501        for (n=0; n<pEnc->num_plugins;n++) {
502            if (pEnc->plugins[n].func) {
503                pEnc->plugins[n].func(pEnc->plugins[n].param, XVID_PLG_DESTROY, 0, 0);
504            }
505        }
506        xvid_free(pEnc->plugins);
507    
508          xvid_free(pEnc);          xvid_free(pEnc);
509    
510          pParam->handle = NULL;          create->handle = NULL;
511    
512          return XVID_ERR_MEMORY;          return XVID_ERR_MEMORY;
513  }  }
# Line 526  Line 516 
516   * Encoder destruction   * Encoder destruction
517   *   *
518   * This function destroy the entire encoder structure created by a previous   * This function destroy the entire encoder structure created by a previous
519   * successful encoder_create call.   * successful enc_create call.
520   *   *
521   * Returned values (for now only one returned value) :   * Returned values (for now only one returned value) :
522   *    - XVID_ERR_OK     - no errors   *    - 0     - no errors
523   *   *
524   ****************************************************************************/   ****************************************************************************/
525    
526  int  int
527  encoder_destroy(Encoder * pEnc)  enc_destroy(Encoder * pEnc)
528  {  {
 #ifdef BFRAMES  
529          int i;          int i;
 #endif  
   
         ENC_CHECK(pEnc);  
530    
531          /* B Frames specific */          /* B Frames specific */
 #ifdef BFRAMES  
532          if (pEnc->mbParam.max_bframes > 0) {          if (pEnc->mbParam.max_bframes > 0) {
533    
534                  for (i = 0; i < pEnc->mbParam.max_bframes; i++) {                  for (i = 0; i < pEnc->mbParam.max_bframes+1; i++) {
535    
536                          image_destroy(&pEnc->queue[i], pEnc->mbParam.edged_width,                          image_destroy(&pEnc->queue[i].image, pEnc->mbParam.edged_width,
537                                            pEnc->mbParam.edged_height);                                            pEnc->mbParam.edged_height);
538                  }                  }
539                  xvid_free(pEnc->queue);                  xvid_free(pEnc->queue);
# Line 573  Line 558 
558                  xvid_free(pEnc->bframes);                  xvid_free(pEnc->bframes);
559    
560          }          }
 #endif  
561    
562          /* All images, reference, current etc ... */          /* All images, reference, current etc ... */
563    
# Line 591  Line 575 
575                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
576          image_destroy(&pEnc->vInterHVf, pEnc->mbParam.edged_width,          image_destroy(&pEnc->vInterHVf, pEnc->mbParam.edged_width,
577                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
578  #ifdef BFRAMES  
579          image_destroy(&pEnc->f_refh, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refh, pEnc->mbParam.edged_width,
580                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
581          image_destroy(&pEnc->f_refv, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refv, pEnc->mbParam.edged_width,
582                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
583          image_destroy(&pEnc->f_refhv, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refhv, pEnc->mbParam.edged_width,
584                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
585  #endif  
586  #ifdef _DEBUG_PSNR          if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
587          image_destroy(&pEnc->sOriginal, pEnc->mbParam.edged_width,          image_destroy(&pEnc->sOriginal, pEnc->mbParam.edged_width,
588                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
589  #endif                  image_destroy(&pEnc->sOriginal2, pEnc->mbParam.edged_width,
590                                              pEnc->mbParam.edged_height);
591            }
592    
593          /* Encoder structure */          /* Encoder structure */
594    
# Line 612  Line 598 
598          xvid_free(pEnc->reference->mbs);          xvid_free(pEnc->reference->mbs);
599          xvid_free(pEnc->reference);          xvid_free(pEnc->reference);
600    
601          xvid_free(pEnc);      if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
602            xvid_free(pEnc->temp_dquants);
         return XVID_ERR_OK;  
603  }  }
604    
605    
606  #ifdef BFRAMES      if (pEnc->num_plugins>0) {
607  void inc_frame_num(Encoder * pEnc)          xvid_plg_destroy_t pdestroy;
608  {          memset(&pdestroy, 0, sizeof(xvid_plg_destroy_t));
         pEnc->iFrameNum++;  
         pEnc->mbParam.m_ticks += pEnc->mbParam.fincr;  
   
         pEnc->mbParam.m_seconds = pEnc->mbParam.m_ticks / pEnc->mbParam.fbase;  
         pEnc->mbParam.m_ticks = pEnc->mbParam.m_ticks % pEnc->mbParam.fbase;  
 }  
 #endif  
609    
610            pdestroy.version = XVID_VERSION;
611            pdestroy.num_frames = pEnc->m_framenum;
612    
613  #ifdef BFRAMES          for (i=0; i<pEnc->num_plugins;i++) {
614  void queue_image(Encoder * pEnc, XVID_ENC_FRAME * pFrame)              if (pEnc->plugins[i].func) {
615  {                  pEnc->plugins[i].func(pEnc->plugins[i].param, XVID_PLG_DESTROY, &pdestroy, 0);
616          if (pEnc->queue_size >= pEnc->mbParam.max_bframes)              }
617          {          }
618                  DPRINTF(DPRINTF_DEBUG,"FATAL: QUEUE FULL");          xvid_free(pEnc->plugins);
                 return;  
619          }          }
620    
621          DPRINTF(DPRINTF_DEBUG,"*** QUEUE bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",          xvid_free(pEnc);
                                 pEnc->bframenum_head, pEnc->bframenum_tail,  
                                 pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);  
   
   
         start_timer();  
         if (image_input  
                 (&pEnc->queue[pEnc->queue_tail], pEnc->mbParam.width, pEnc->mbParam.height,  
                  pEnc->mbParam.edged_width, pFrame->image, pFrame->colorspace))  
                 return;  
         stop_conv_timer();  
622    
623          pEnc->queue_size++;          return 0;  /* ok */
         pEnc->queue_tail =  (pEnc->queue_tail + 1) % pEnc->mbParam.max_bframes;  
624  }  }
 #endif  
625    
626    
627  #ifdef BFRAMES  /*
628  /*****************************************************************************    call the plugins
629   * IPB frame encoder entry point    */
  *  
  * Returned values :  
  *    - XVID_ERR_OK     - no errors  
  *    - XVID_ERR_FORMAT - the image subsystem reported the image had a wrong  
  *                        format  
  ****************************************************************************/  
630    
631  int  static void call_plugins(Encoder * pEnc, FRAMEINFO * frame, IMAGE * original,
632  encoder_encode_bframes(Encoder * pEnc,                           int opt, int * type, int * quant, xvid_enc_stats_t * stats)
                            XVID_ENC_FRAME * pFrame,  
                            XVID_ENC_STATS * pResult)  
633  {  {
634          uint16_t x, y;      unsigned int i, j;
635          Bitstream bs;      xvid_plg_data_t data;
         uint32_t bits;  
   
         int input_valid = 1;  
636    
637  #ifdef _DEBUG_PSNR      /* set data struct */
         float psnr;  
         char temp[128];  
 #endif  
638    
639          ENC_CHECK(pEnc);      memset(&data, 0, sizeof(xvid_plg_data_t));
640          ENC_CHECK(pFrame);      data.version = XVID_VERSION;
641          ENC_CHECK(pFrame->image);  
642        data.width = pEnc->mbParam.width;
643        data.height = pEnc->mbParam.height;
644        data.mb_width = pEnc->mbParam.mb_width;
645        data.mb_height = pEnc->mbParam.mb_height;
646        data.fincr = frame->fincr;
647        data.fbase = pEnc->mbParam.fbase;
648    
649        data.reference.csp = XVID_CSP_USER;
650        data.reference.plane[0] = pEnc->reference->image.y;
651        data.reference.plane[1] = pEnc->reference->image.u;
652        data.reference.plane[2] = pEnc->reference->image.v;
653        data.reference.stride[0] = pEnc->mbParam.edged_width;
654        data.reference.stride[1] = pEnc->mbParam.edged_width/2;
655        data.reference.stride[2] = pEnc->mbParam.edged_width/2;
656    
657        data.current.csp = XVID_CSP_USER;
658        data.current.plane[0] = frame->image.y;
659        data.current.plane[1] = frame->image.u;
660        data.current.plane[2] = frame->image.v;
661        data.current.stride[0] = pEnc->mbParam.edged_width;
662        data.current.stride[1] = pEnc->mbParam.edged_width/2;
663        data.current.stride[2] = pEnc->mbParam.edged_width/2;
664    
665        data.frame_num = frame->frame_num;
666    
667        if (opt == XVID_PLG_BEFORE) {
668            data.type = XVID_TYPE_AUTO;
669            data.quant = 2;
670    
671                    if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
672                data.dquant = pEnc->temp_dquants;
673                data.dquant_stride = pEnc->mbParam.mb_width;
674                            memset(data.dquant, 0, data.mb_width*data.mb_height);
675            }
676    
677            /* todo: [vol,vop,motion]_flags*/
678    
679        } else { // XVID_PLG_AFTER
680            if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
681                data.original.csp = XVID_CSP_USER;
682                data.original.plane[0] = original->y;
683                data.original.plane[1] = original->u;
684                data.original.plane[2] = original->v;
685                data.original.stride[0] = pEnc->mbParam.edged_width;
686                data.original.stride[1] = pEnc->mbParam.edged_width/2;
687                data.original.stride[2] = pEnc->mbParam.edged_width/2;
688            }
689    
690          start_global_timer();          if ((frame->vol_flags & XVID_VOL_EXTRASTATS) ||
691                (pEnc->mbParam.plugin_flags & XVID_REQPSNR)) {
692    
693          BitstreamInit(&bs, pFrame->bitstream, 0);                          data.sse_y =
694                                plane_sse( original->y, frame->image.y,
695                                                   pEnc->mbParam.edged_width, pEnc->mbParam.width,
696                                                   pEnc->mbParam.height);
697    
698  ipvop_loop:              data.sse_u =
699                    plane_sse( original->u, frame->image.u,
700                                               pEnc->mbParam.edged_width/2, pEnc->mbParam.width/2,
701                                                   pEnc->mbParam.height/2);
702    
703          /*                          data.sse_v =
704           * bframe "flush" code                  plane_sse( original->v, frame->image.v,
705           */                                             pEnc->mbParam.edged_width/2, pEnc->mbParam.width/2,
706                                                   pEnc->mbParam.height/2);
707            }
708    
709          if ((pFrame->image == NULL || pEnc->flush_bframes)          data.type = coding2type(frame->coding_type);
710                  && (pEnc->bframenum_head < pEnc->bframenum_tail)) {          data.quant = frame->quant;
711    
712                  if (pEnc->flush_bframes == 0) {          if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
713                          /*              data.dquant = pEnc->temp_dquants;
714                           * we have reached the end of stream without getting              data.dquant_stride = pEnc->mbParam.mb_width;
                          * a future reference frame... so encode last final  
                          * frame as a pframe  
                          */  
715    
716                          DPRINTF(DPRINTF_DEBUG,"*** BFRAME (final frame) bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",              for (j=0; j<pEnc->mbParam.mb_height; j++)
717                                  pEnc->bframenum_head, pEnc->bframenum_tail,              for (i=0; i<pEnc->mbParam.mb_width; i++) {
718                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);                  data.dquant[j*data.dquant_stride + i] = frame->mbs[j*pEnc->mbParam.mb_width + i].dquant;;
719                }
720            }
721    
722                          pEnc->bframenum_tail--;          data.vol_flags = frame->vol_flags;
723                          SWAP(pEnc->current, pEnc->reference);          data.vop_flags = frame->vop_flags;
724            data.motion_flags = frame->motion_flags;
725    
726                          SWAP(pEnc->current, pEnc->bframes[pEnc->bframenum_tail]);          data.length = frame->length;
727            data.kblks = frame->sStat.kblks;
728            data.mblks = frame->sStat.mblks;
729            data.ublks = frame->sStat.ublks;
730    
731                          FrameCodeP(pEnc, &bs, &bits, 1, 0);          if (stats) {
732                    stats->type = coding2type(frame->coding_type);
733                    stats->quant = frame->quant;
734                    stats->vol_flags = frame->vol_flags;
735                    stats->vop_flags = frame->vop_flags;
736                    stats->length = frame->length;
737                    stats->hlength = frame->length - (frame->sStat.iTextBits / 8);
738                    stats->kblks = frame->sStat.kblks;
739                    stats->mblks = frame->sStat.mblks;
740                    stats->ublks = frame->sStat.ublks;
741                stats->sse_y = data.sse_y;
742                stats->sse_u = data.sse_u;
743                stats->sse_v = data.sse_v;
744            }
745        }
746    
747                          BitstreamPad(&bs);      /* call plugins */
748                          pFrame->length = BitstreamLength(&bs);      for (i=0; i<pEnc->num_plugins;i++) {
749                          pFrame->intra = 0;          emms();
750            if (pEnc->plugins[i].func) {
751                if (pEnc->plugins[i].func(pEnc->plugins[i].param, opt, &data, 0) < 0) {
752                    continue;
753                }
754            }
755        }
756        emms();
757    
758                          return XVID_ERR_OK;      /* copy modified values back into frame*/
759        if (opt == XVID_PLG_BEFORE) {
760            *type = data.type;
761            *quant = data.quant;
762    
763            if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
764                for (j=0; j<pEnc->mbParam.mb_height; j++)
765                for (i=0; i<pEnc->mbParam.mb_width; i++) {
766                    frame->mbs[j*pEnc->mbParam.mb_width + i].dquant = data.dquant[j*data.mb_width + i];
767                }
768            }else{
769                for (j=0; j<pEnc->mbParam.mb_height; j++)
770                for (i=0; i<pEnc->mbParam.mb_width; i++) {
771                    frame->mbs[j*pEnc->mbParam.mb_width + i].dquant = 0;
772                }
773            }
774            /* todo: [vol,vop,motion]_flags*/
775        }
776                  }                  }
777    
778    
                 DPRINTF(DPRINTF_DEBUG,"*** BFRAME (flush) bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",  
                                 pEnc->bframenum_head, pEnc->bframenum_tail,  
                                 pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);  
779    
                 FrameCodeB(pEnc, pEnc->bframes[pEnc->bframenum_head], &bs, &bits);  
                 pEnc->bframenum_head++;  
780    
781                  BitstreamPad(&bs);  static __inline void inc_frame_num(Encoder * pEnc)
782                  pFrame->length = BitstreamLength(&bs);  {
783                  pFrame->intra = 0;      pEnc->current->frame_num = pEnc->m_framenum;
784            pEnc->current->stamp = pEnc->mbParam.m_stamp;   /* first frame is zero */
785    
786                  if (input_valid)      pEnc->mbParam.m_stamp += pEnc->current->fincr;
787                          queue_image(pEnc, pFrame);      pEnc->m_framenum++; /* debug ticker */
788    }
789    
790                  return XVID_ERR_OK;  static __inline void dec_frame_num(Encoder * pEnc)
791    {
792        pEnc->mbParam.m_stamp -= pEnc->mbParam.fincr;
793        pEnc->m_framenum--; /* debug ticker */
794          }          }
795    
         if (pEnc->bframenum_head > 0) {  
                 pEnc->bframenum_head = pEnc->bframenum_tail = 0;  
796    
                 if ((pEnc->global & XVID_GLOBAL_PACKED)) {  
797    
798                          DPRINTF(DPRINTF_DEBUG,"*** EMPTY bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",  static __inline void
799                                  pEnc->bframenum_head, pEnc->bframenum_tail,  set_timecodes(FRAMEINFO* pCur,FRAMEINFO *pRef, int32_t time_base)
800                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);  {
801    
802                          BitstreamWriteVopHeader(&bs, &pEnc->mbParam, pEnc->current, 0);      pCur->ticks = (int32_t)pCur->stamp % time_base;
803                          BitstreamPad(&bs);                  pCur->seconds =  ((int32_t)pCur->stamp / time_base)     - ((int32_t)pRef->stamp / time_base) ;
                         BitstreamPutBits(&bs, 0x7f, 8);  
804    
805                          pFrame->length = BitstreamLength(&bs);                  /* HEAVY DEBUG OUTPUT remove when timecodes prove to be stable */
                         pFrame->intra = 0;  
806    
807                          if (input_valid)  /*              fprintf(stderr,"WriteVop:   %d - %d \n",
808                                  queue_image(pEnc, pFrame);                          ((int32_t)pCur->stamp / time_base), ((int32_t)pRef->stamp / time_base));
809                    fprintf(stderr,"set_timecodes: VOP %1d   stamp=%lld ref_stamp=%lld  base=%d\n",
810                            pCur->coding_type, pCur->stamp, pRef->stamp, time_base);
811                    fprintf(stderr,"set_timecodes: VOP %1d   seconds=%d   ticks=%d   (ref-sec=%d  ref-tick=%d)\n",
812                            pCur->coding_type, pCur->seconds, pCur->ticks, pRef->seconds, pRef->ticks);
813    
814                          return XVID_ERR_OK;  */
                 }  
815          }          }
816    
817    
 bvop_loop:  
818    
819          if (pEnc->bframenum_dx50bvop != -1)  /*****************************************************************************
820     * IPB frame encoder entry point
821     *
822     * Returned values :
823     *    - >0               - output bytes
824     *    - 0                - no output
825     *    - XVID_ERR_VERSION - wrong version passed to core
826     *    - XVID_ERR_END     - End of stream reached before end of coding
827     *    - XVID_ERR_FORMAT  - the image subsystem reported the image had a wrong
828     *                         format
829     ****************************************************************************/
830    
831    
832    int
833    enc_encode(Encoder * pEnc,
834                               xvid_enc_frame_t * xFrame,
835                               xvid_enc_stats_t * stats)
836          {          {
837            xvid_enc_frame_t * frame;
838            int type;
839            Bitstream bs;
840    
841                  SWAP(pEnc->current, pEnc->reference);          if (XVID_MAJOR(xFrame->version) != 1 || (stats && XVID_MAJOR(stats->version) != 1))     /* v1.x.x */
842                  SWAP(pEnc->current, pEnc->bframes[pEnc->bframenum_dx50bvop]);                  return XVID_ERR_VERSION;
843    
844                  if ((pEnc->global & XVID_GLOBAL_DEBUG)) {          xFrame->out_flags = 0;
                         image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 100, "DX50 IVOP");  
                 }  
845    
846                  if (input_valid)          start_global_timer();
847                  {          BitstreamInit(&bs, xFrame->bitstream, 0);
                         queue_image(pEnc, pFrame);  
                         input_valid = 0;  
                 }  
848    
         } else if (input_valid) {  
849    
850                  SWAP(pEnc->current, pEnc->reference);          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
851             * enqueue image to the encoding-queue
852             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
853    
854            if (xFrame->input.csp != XVID_CSP_NULL)
855            {
856                    QUEUEINFO * q = &pEnc->queue[pEnc->queue_tail];
857    
858                  start_timer();                  start_timer();
859                  if (image_input                  if (image_input
860                          (&pEnc->current->image, pEnc->mbParam.width, pEnc->mbParam.height,                          (&q->image, pEnc->mbParam.width, pEnc->mbParam.height,
861                          pEnc->mbParam.edged_width, pFrame->image, pFrame->colorspace))                          pEnc->mbParam.edged_width, (uint8_t**)xFrame->input.plane, xFrame->input.stride,
862                            xFrame->input.csp, xFrame->vol_flags & XVID_VOL_INTERLACING))
863                    {
864                            emms();
865                          return XVID_ERR_FORMAT;                          return XVID_ERR_FORMAT;
866                    }
867                  stop_conv_timer();                  stop_conv_timer();
868    
869                  // queue input frame, and dequue next image                  if ((xFrame->vop_flags & XVID_VOP_CHROMAOPT)) {
870                  if (pEnc->queue_size > 0)                          image_chroma_optimize(&q->image,
871                  {                                  pEnc->mbParam.width, pEnc->mbParam.height, pEnc->mbParam.edged_width);
                         image_swap(&pEnc->current->image, &pEnc->queue[pEnc->queue_tail]);  
                         if (pEnc->queue_head != pEnc->queue_tail)  
                         {  
                                 image_swap(&pEnc->current->image, &pEnc->queue[pEnc->queue_head]);  
                         }  
                         pEnc->queue_head =  (pEnc->queue_head + 1) % pEnc->mbParam.max_bframes;  
                         pEnc->queue_tail =  (pEnc->queue_tail + 1) % pEnc->mbParam.max_bframes;  
872                  }                  }
873    
874          } else if (pEnc->queue_size > 0) {                  q->frame = *xFrame;
875    
876                  SWAP(pEnc->current, pEnc->reference);                  if (xFrame->quant_intra_matrix)
877                    {
878                            memcpy(q->quant_intra_matrix, xFrame->quant_intra_matrix, sizeof(xFrame->quant_intra_matrix));
879                            q->frame.quant_intra_matrix = q->quant_intra_matrix;
880                    }
881    
882                  image_swap(&pEnc->current->image, &pEnc->queue[pEnc->queue_head]);                  if (xFrame->quant_inter_matrix)
883                  pEnc->queue_head =  (pEnc->queue_head + 1) % pEnc->mbParam.max_bframes;                  {
884                  pEnc->queue_size--;                          memcpy(q->quant_inter_matrix, xFrame->quant_inter_matrix, sizeof(xFrame->quant_inter_matrix));
885                            q->frame.quant_inter_matrix = q->quant_inter_matrix;
886                    }
887    
888          } else if (BitstreamPos(&bs) == 0) {                  pEnc->queue_tail = (pEnc->queue_tail + 1) % (pEnc->mbParam.max_bframes+1);
889                    pEnc->queue_size++;
890            }
891    
                 DPRINTF(DPRINTF_DEBUG,"*** SKIP bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",  
                                 pEnc->bframenum_head, pEnc->bframenum_tail,  
                                 pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);  
892    
893                  pFrame->intra = 0;          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
894             * bframe flush code
895             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
896    
897                  BitstreamPutBits(&bs, 0x7f, 8);  repeat:
                 BitstreamPad(&bs);  
                 pFrame->length = BitstreamLength(&bs);  
898    
899                  return XVID_ERR_OK;          if (pEnc->flush_bframes)
900            {
901                    if (pEnc->bframenum_head < pEnc->bframenum_tail) {
902    
903          } else {                          DPRINTF(DPRINTF_DEBUG,"*** BFRAME (flush) bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",
904                                            pEnc->bframenum_head, pEnc->bframenum_tail,
905                                            pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);
906    
907                  pFrame->length = BitstreamLength(&bs);              if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
908                  return XVID_ERR_OK;                                  image_copy(&pEnc->sOriginal2, &pEnc->bframes[pEnc->bframenum_head]->image,
909                                                       pEnc->mbParam.edged_width, pEnc->mbParam.height);
910          }          }
911    
912          pEnc->flush_bframes = 0;                          FrameCodeB(pEnc, pEnc->bframes[pEnc->bframenum_head], &bs);
913                call_plugins(pEnc, pEnc->bframes[pEnc->bframenum_head], &pEnc->sOriginal2, XVID_PLG_AFTER, 0, 0, stats);
914                            pEnc->bframenum_head++;
915    
916          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%                          goto done;
917           * Well there was a separation here so i put it in ANSI C                  }
          * comment style :-)  
          * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */  
918    
919          emms();                  /* write an empty marker to the bitstream.
920    
921          // only inc frame num, adapt quant, etc. if we havent seen it before                     for divx5 decoder compatibility, this marker must consist
922          if (pEnc->bframenum_dx50bvop < 0 )                     of a not-coded p-vop, with a time_base of zero, and time_increment
923          {                     indentical to the future-referece frame.
924                  if (pFrame->quant == 0)                  */
                         pEnc->current->quant = RateControlGetQ(&pEnc->rate_control, 0);  
                 else  
                         pEnc->current->quant = pFrame->quant;  
925    
926                  if (pEnc->current->quant < 1)                  if ((pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED && pEnc->bframenum_tail > 0)) {
927                          pEnc->current->quant = 1;                          int tmp;
928                            int bits;
929    
930                  if (pEnc->current->quant > 31)                          DPRINTF(DPRINTF_DEBUG,"*** EMPTY bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",
931                          pEnc->current->quant = 31;                                  pEnc->bframenum_head, pEnc->bframenum_tail,
932                                    pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);
933    
934                  pEnc->current->global_flags = pFrame->general;                          bits = BitstreamPos(&bs);
                 pEnc->current->motion_flags = pFrame->motion;  
935    
936                  /* ToDo : dynamic fcode (in both directions) */                          tmp = pEnc->current->seconds;
937                  pEnc->current->fcode = pEnc->mbParam.m_fcode;                          pEnc->current->seconds = 0; /* force time_base = 0 */
                 pEnc->current->bcode = pEnc->mbParam.m_fcode;  
938    
939                  pEnc->current->seconds = pEnc->mbParam.m_seconds;                          BitstreamWriteVopHeader(&bs, &pEnc->mbParam, pEnc->current, 0);
940                  pEnc->current->ticks = pEnc->mbParam.m_ticks;                          BitstreamPad(&bs);
941                            pEnc->current->seconds = tmp;
942    
943                  inc_frame_num(pEnc);                          /* add the not-coded length to the reference frame size */
944                            pEnc->current->length += (BitstreamPos(&bs) - bits) / 8;
945                call_plugins(pEnc, pEnc->current, &pEnc->sOriginal, XVID_PLG_AFTER, 0, 0, stats);
946    
947  #ifdef _DEBUG_PSNR              /* flush complete: reset counters */
948                  image_copy(&pEnc->sOriginal, &pEnc->current->image,                  pEnc->flush_bframes = 0;
949                             pEnc->mbParam.edged_width, pEnc->mbParam.height);                      pEnc->bframenum_head = pEnc->bframenum_tail = 0;
950  #endif                          goto done;
951    
952                  emms();                  }
953    
954                  if ((pEnc->global & XVID_GLOBAL_DEBUG)) {          /* flush complete: reset counters */
955                          image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 5,                  pEnc->flush_bframes = 0;
956                                  "%i  if:%i  st:%i:%i", pEnc->m_framenum++, pEnc->iFrameNum, pEnc->current->seconds, pEnc->current->ticks);                  pEnc->bframenum_head = pEnc->bframenum_tail = 0;
957                  }                  }
958    
959          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
960           * Luminance masking           * dequeue frame from the encoding queue
961           * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */           * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
962    
963                  if ((pEnc->current->global_flags & XVID_LUMIMASKING)) {          if (pEnc->queue_size == 0)              /* empty */
964                          int *temp_dquants =          {
965                                  (int *) xvid_malloc(pEnc->mbParam.mb_width *                  if (xFrame->input.csp == XVID_CSP_NULL) /* no futher input */
966                                                                  pEnc->mbParam.mb_height * sizeof(int),                  {
                                                                 CACHE_LINE);  
967    
968                          pEnc->current->quant =              if (!(pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) && pEnc->mbParam.max_bframes > 0) {
969                                  adaptive_quantization(pEnc->current->image.y,                  call_plugins(pEnc, pEnc->current, &pEnc->sOriginal, XVID_PLG_AFTER, 0, 0, stats);
970                                                                    pEnc->mbParam.edged_width, temp_dquants,              }
                                                                   pEnc->current->quant, pEnc->current->quant,  
                                                                   2 * pEnc->current->quant,  
                                                                   pEnc->mbParam.mb_width,  
                                                                   pEnc->mbParam.mb_height);  
971    
972                          for (y = 0; y < pEnc->mbParam.mb_height; y++) {              /* if the very last frame is to be b-vop, we must change it to a p-vop */
973                if (pEnc->bframenum_tail > 0)
974                            {
975    
976  #define OFFSET(x,y) ((x) + (y)*pEnc->mbParam.mb_width)                                  SWAP(FRAMEINFO*, pEnc->current, pEnc->reference);
977                                    pEnc->bframenum_tail--;
978                                    SWAP(FRAMEINFO*, pEnc->current, pEnc->bframes[pEnc->bframenum_tail]);
979    
980                                  for (x = 0; x < pEnc->mbParam.mb_width; x++) {                                  /* convert B-VOP to P-VOP */
981                                          MACROBLOCK *pMB = &pEnc->current->mbs[OFFSET(x, y)];                  pEnc->current->quant = ((pEnc->current->quant*100) - pEnc->mbParam.bquant_offset) / pEnc->mbParam.bquant_ratio;
982    
983                                          pMB->dquant = iDQtab[temp_dquants[OFFSET(x, y)] + 2];                  if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
984                                image_copy(&pEnc->sOriginal, &pEnc->current->image,
985                                       pEnc->mbParam.edged_width, pEnc->mbParam.height);
986                                  }                                  }
987    
988  #undef OFFSET                                  FrameCodeP(pEnc, &bs, 1, 0);
                         }  
989    
990                          xvid_free(temp_dquants);                                  goto done_flush;
991                  }                  }
992    
993                            emms();
994                            return XVID_ERR_END;    /* end of stream reached */
995          }          }
996                    goto done;      /* nothing to encode yet; encoder lag */
997            }
998    
999            // the current FRAME becomes the reference
1000            SWAP(FRAMEINFO*, pEnc->current, pEnc->reference);
1001    
1002            // remove frame from encoding-queue (head), and move it into the current
1003            image_swap(&pEnc->current->image, &pEnc->queue[pEnc->queue_head].image);
1004            frame = &pEnc->queue[pEnc->queue_head].frame;
1005            pEnc->queue_head = (pEnc->queue_head + 1) % (pEnc->mbParam.max_bframes+1);
1006            pEnc->queue_size--;
1007    
1008    
1009          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1010           * ivop/pvop/bvop selection           * init pEnc->current fields
1011           * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */           * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1012    
1013        pEnc->current->fincr = pEnc->mbParam.fincr>0 ? pEnc->mbParam.fincr : frame->fincr;
1014        inc_frame_num(pEnc);
1015        pEnc->current->vol_flags = pEnc->mbParam.vol_flags;
1016        pEnc->current->vop_flags = frame->vop_flags;
1017            pEnc->current->motion_flags = frame->motion;
1018            pEnc->current->fcode = pEnc->mbParam.m_fcode;
1019            pEnc->current->bcode = pEnc->mbParam.m_fcode;
1020    
         if (pEnc->iFrameNum == 0 || pFrame->intra == 1 || pEnc->bframenum_dx50bvop >= 0 ||  
                 (pFrame->intra < 0 && pEnc->iMaxKeyInterval > 0 &&  
                  pEnc->iFrameNum >= pEnc->iMaxKeyInterval)  
                 || image_mad(&pEnc->reference->image, &pEnc->current->image,  
                                          pEnc->mbParam.edged_width, pEnc->mbParam.width,  
                                          pEnc->mbParam.height) > 30) {  
                 /*  
                  * This will be coded as an Intra Frame  
                  */  
   
                 DPRINTF(DPRINTF_DEBUG,"*** IFRAME bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",  
                                 pEnc->bframenum_head, pEnc->bframenum_tail,  
                                 pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);  
1021    
1022                  if ((pEnc->global & XVID_GLOBAL_DEBUG)) {      if ((xFrame->vop_flags & XVID_VOP_CHROMAOPT)) {
1023                          image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "IVOP");              image_chroma_optimize(&pEnc->current->image,
1024                        pEnc->mbParam.width, pEnc->mbParam.height, pEnc->mbParam.edged_width);
1025                  }                  }
1026    
1027                  // when we reach an iframe in DX50BVOP mode, encode the last bframe as a pframe          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1028             * frame type & quant selection
1029             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1030    
1031                  if ((pEnc->global & XVID_GLOBAL_DX50BVOP) && pEnc->bframenum_tail > 0) {      call_plugins(pEnc, pEnc->current, NULL, XVID_PLG_BEFORE, &type, &pEnc->current->quant, stats);
1032    
1033                          pEnc->bframenum_tail--;      if (frame->type > 0)
1034                          pEnc->bframenum_dx50bvop = pEnc->bframenum_tail;                  type = frame->type;
   
                         SWAP(pEnc->current, pEnc->bframes[pEnc->bframenum_dx50bvop]);  
                         if ((pEnc->global & XVID_GLOBAL_DEBUG)) {  
                                 image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 100, "DX50 BVOP->PVOP");  
                         }  
                         FrameCodeP(pEnc, &bs, &bits, 1, 0);  
1035    
1036                          pFrame->intra = 0;      if (frame->quant > 0)
1037                    pEnc->current->quant = frame->quant;
1038    
1039        if (type > 0){      /* XVID_TYPE_?VOP */
1040                    type = type2coding(type);       /* convert XVID_TYPE_?VOP to bitstream coding type */
1041        } else{             /* XVID_TYPE_AUTO */
1042                    if (pEnc->iFrameNum == 0 || (pEnc->mbParam.iMaxKeyInterval > 0 && pEnc->iFrameNum >= pEnc->mbParam.iMaxKeyInterval)){
1043                            pEnc->iFrameNum = 0;
1044                            type = I_VOP;
1045                  } else {                  } else {
1046                            type = MEanalysis(&pEnc->reference->image, pEnc->current,
1047                                            &pEnc->mbParam, pEnc->mbParam.iMaxKeyInterval,
1048                                            pEnc->iFrameNum, pEnc->bframenum_tail, xFrame->bframe_threshold);
1049    
1050                          FrameCodeI(pEnc, &bs, &bits);              if (type == B_VOP && !(pEnc->current->vop_flags & XVID_VOP_DYNAMIC_BFRAMES)) {
1051                          pFrame->intra = 1;                  type = P_VOP;   /* disable dynamic bframes */
   
                         pEnc->bframenum_dx50bvop = -1;  
1052                  }                  }
   
                 pEnc->flush_bframes = 1;  
   
                 if ((pEnc->global & XVID_GLOBAL_PACKED) && pEnc->bframenum_tail > 0) {  
                         BitstreamPad(&bs);  
                         input_valid = 0;  
                         goto ipvop_loop;  
1053                  }                  }
   
                 /*  
                  * NB : sequences like "IIBB" decode fine with msfdam but,  
                  *      go screwy with divx 5.00  
                  */  
         } else if (pEnc->bframenum_tail >= pEnc->mbParam.max_bframes) {  
                 /*  
                  * This will be coded as a Predicted Frame  
                  */  
   
                 DPRINTF(DPRINTF_DEBUG,"*** PFRAME bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",  
                                 pEnc->bframenum_head, pEnc->bframenum_tail,  
                                 pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);  
   
                 if ((pEnc->global & XVID_GLOBAL_DEBUG)) {  
                         image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "PVOP");  
1054                  }                  }
1055    
1056                  FrameCodeP(pEnc, &bs, &bits, 1, 0);      /* bframes buffer overflow check */
1057                  pFrame->intra = 0;      if (type != I_VOP) {
1058                  pEnc->flush_bframes = 1;          if (pEnc->bframenum_tail >= pEnc->mbParam.max_bframes) {
1059                type = P_VOP;
1060                  if ((pEnc->global & XVID_GLOBAL_PACKED)) {          }else{
1061                          BitstreamPad(&bs);              type = B_VOP;
1062                          input_valid = 0;          }
                         goto ipvop_loop;  
1063                  }                  }
1064    
1065          } else {          pEnc->iFrameNum++;
                 /*  
                  * This will be coded as a Bidirectional Frame  
                  */  
1066    
1067                  DPRINTF(DPRINTF_DEBUG,"*** BFRAME (store) bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",          if ((pEnc->current->vop_flags & XVID_VOP_DEBUG)) {
1068                                  pEnc->bframenum_head, pEnc->bframenum_tail,                  image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 5,
1069                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);                          "%i  st:%i  if:%i", pEnc->current->frame_num, pEnc->current->stamp, pEnc->iFrameNum);
1070            }
1071    
1072                  if ((pEnc->global & XVID_GLOBAL_DEBUG)) {          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1073             * encode this frame as a b-vop
1074         * (we dont encode here, rather we store the frame in the bframes queue, to be encoded later)
1075             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1076            if (type == B_VOP) {
1077                    if ((pEnc->current->vop_flags & XVID_VOP_DEBUG)) {
1078                          image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "BVOP");                          image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "BVOP");
1079                  }                  }
1080    
1081                  if (pFrame->bquant < 1) {                  if (frame->quant < 1) {
1082                          pEnc->current->quant =                          pEnc->current->quant = ((((pEnc->reference->quant + pEnc->current->quant) *
1083                                  ((pEnc->reference->quant +                                  pEnc->mbParam.bquant_ratio) / 2) + pEnc->mbParam.bquant_offset)/100;
1084                                    pEnc->current->quant) * pEnc->bquant_ratio) / 200;  
1085                  } else {                  } else {
1086                          pEnc->current->quant = pFrame->bquant;                          pEnc->current->quant = frame->quant;
1087                  }                  }
1088    
1089                    if (pEnc->current->quant < 1)
1090                            pEnc->current->quant = 1;
1091                    else if (pEnc->current->quant > 31)
1092                pEnc->current->quant = 31;
1093    
1094                    DPRINTF(DPRINTF_DEBUG,"*** BFRAME (store) bf: head=%i tail=%i   queue: head=%i tail=%i size=%i  quant=%i",
1095                                    pEnc->bframenum_head, pEnc->bframenum_tail,
1096                                    pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size,pEnc->current->quant);
1097    
1098                  /* store frame into bframe buffer & swap ref back to current */                  /* store frame into bframe buffer & swap ref back to current */
1099                  SWAP(pEnc->current, pEnc->bframes[pEnc->bframenum_tail]);                  SWAP(FRAMEINFO*, pEnc->current, pEnc->bframes[pEnc->bframenum_tail]);
1100                  SWAP(pEnc->current, pEnc->reference);                  SWAP(FRAMEINFO*, pEnc->current, pEnc->reference);
1101    
1102                  pEnc->bframenum_tail++;                  pEnc->bframenum_tail++;
1103    
1104                  pFrame->intra = 0;                  goto repeat;
                 pFrame->length = 0;  
   
                 input_valid = 0;  
                 goto bvop_loop;  
1105          }          }
1106    
1107          BitstreamPad(&bs);      /* for unpacked bframes, output the stats for the last encoded frame */
1108          pFrame->length = BitstreamLength(&bs);      if (!(pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) && pEnc->bframenum_tail > 0)
1109        {
1110          if (pResult) {          if (pEnc->current->stamp > 0) {
1111                  pResult->quant = pEnc->current->quant;              call_plugins(pEnc, pEnc->reference, &pEnc->sOriginal, XVID_PLG_AFTER, 0, 0, stats);
1112                  pResult->hlength = pFrame->length - (pEnc->sStat.iTextBits / 8);          }
1113                  pResult->kblks = pEnc->sStat.kblks;                  else
1114                  pResult->mblks = pEnc->sStat.mblks;                          stats->type = XVID_TYPE_NOTHING;
                 pResult->ublks = pEnc->sStat.ublks;  
1115          }          }
1116    
1117          emms();          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1118             * closed-gop
1119         * if the frame prior to an iframe is scheduled as a bframe, we must change it to a pframe
1120         * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1121    
1122  #ifdef _DEBUG_PSNR      if (type == I_VOP && (pEnc->mbParam.global_flags & XVID_GLOBAL_CLOSED_GOP) && pEnc->bframenum_tail > 0) {
         psnr =  
                 image_psnr(&pEnc->sOriginal, &pEnc->current->image,  
                                    pEnc->mbParam.edged_width, pEnc->mbParam.width,  
                                    pEnc->mbParam.height);  
1123    
1124          snprintf(temp, 127, "PSNR: %f\n", psnr);                  // place this frame back on the encoding-queue (head)
1125          DEBUG(temp);                  // we will deal with it next time
1126  #endif          dec_frame_num(pEnc);
1127            pEnc->iFrameNum--;
1128    
1129          if (pFrame->quant == 0) {          pEnc->queue_head = (pEnc->queue_head + (pEnc->mbParam.max_bframes+1) - 1) % (pEnc->mbParam.max_bframes+1);
1130                  RateControlUpdate(&pEnc->rate_control, pEnc->current->quant,          pEnc->queue_size++;
1131                                                    pFrame->length, pFrame->intra);                  image_swap(&pEnc->current->image, &pEnc->queue[pEnc->queue_head].image);
         }  
1132    
1133                    // grab the last frame from the bframe-queue
1134    
1135          stop_global_timer();                  pEnc->bframenum_tail--;
1136          write_timer();                  SWAP(FRAMEINFO*, pEnc->current, pEnc->bframes[pEnc->bframenum_tail]);
1137    
1138          return XVID_ERR_OK;                  if ((pEnc->current->vop_flags & XVID_VOP_DEBUG)) {
1139                            image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 100, "DX50 BVOP->PVOP");
1140  }  }
1141    
1142  #endif                  /* convert B-VOP quant to P-VOP */
1143                    pEnc->current->quant = ((pEnc->current->quant*100) - pEnc->mbParam.bquant_offset) / pEnc->mbParam.bquant_ratio;
1144            type = P_VOP;
1145        }
1146    
 /*****************************************************************************  
  * "original" IP frame encoder entry point  
  *  
  * Returned values :  
  *    - XVID_ERR_OK     - no errors  
  *    - XVID_ERR_FORMAT - the image subsystem reported the image had a wrong  
  *                        format  
  ****************************************************************************/  
1147    
1148  int          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1149  encoder_encode(Encoder * pEnc,           * encode this frame as an i-vop
1150                             XVID_ENC_FRAME * pFrame,       * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
                            XVID_ENC_STATS * pResult)  
 {  
         uint16_t x, y;  
         Bitstream bs;  
         uint32_t bits;  
         uint16_t write_vol_header = 0;  
1151    
1152  #ifdef _DEBUG_PSNR          if (type == I_VOP) {
         float psnr;  
         uint8_t temp[128];  
 #endif  
1153    
1154          start_global_timer();                  DPRINTF(DPRINTF_DEBUG,"*** IFRAME bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",
1155                                    pEnc->bframenum_head, pEnc->bframenum_tail,
1156                                    pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);
1157    
1158          ENC_CHECK(pEnc);                  if ((pEnc->current->vop_flags & XVID_VOP_DEBUG)) {
1159          ENC_CHECK(pFrame);                          image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "IVOP");
1160          ENC_CHECK(pFrame->bitstream);                  }
         ENC_CHECK(pFrame->image);  
   
         SWAP(pEnc->current, pEnc->reference);  
   
         pEnc->current->global_flags = pFrame->general;  
         pEnc->current->motion_flags = pFrame->motion;  
 #ifdef BFRAMES  
         pEnc->current->seconds = pEnc->mbParam.m_seconds;  
         pEnc->current->ticks = pEnc->mbParam.m_ticks;  
 #endif  
         pEnc->mbParam.hint = &pFrame->hint;  
1161    
         start_timer();  
         if (image_input  
                 (&pEnc->current->image, pEnc->mbParam.width, pEnc->mbParam.height,  
                  pEnc->mbParam.edged_width, pFrame->image, pFrame->colorspace) < 0)  
                 return XVID_ERR_FORMAT;  
         stop_conv_timer();  
1162    
1163  #ifdef _DEBUG_PSNR                  /* ---- update vol flags at IVOP ----------- */
1164          image_copy(&pEnc->sOriginal, &pEnc->current->image,                  pEnc->current->vol_flags = pEnc->mbParam.vol_flags = frame->vol_flags;
                            pEnc->mbParam.edged_width, pEnc->mbParam.height);  
 #endif  
1165    
1166          emms();          if ((pEnc->mbParam.vol_flags & XVID_VOL_MPEGQUANT)) {
1167                            if (frame->quant_intra_matrix != NULL)
1168                                    set_intra_matrix(frame->quant_intra_matrix);
1169                            if (frame->quant_inter_matrix != NULL)
1170                                    set_inter_matrix(frame->quant_inter_matrix);
1171                    }
1172    
1173          BitstreamInit(&bs, pFrame->bitstream, 0);          /* prevent vol/vop misuse */
1174    
1175          if (pFrame->quant == 0) {          if (!(pEnc->current->vol_flags & XVID_VOL_REDUCED_ENABLE))
1176                  pEnc->current->quant = RateControlGetQ(&pEnc->rate_control, 0);              pEnc->current->vop_flags &= ~XVID_VOP_REDUCED;
         } else {  
                 pEnc->current->quant = pFrame->quant;  
         }  
1177    
1178          if ((pEnc->current->global_flags & XVID_LUMIMASKING)) {          if (!(pEnc->current->vol_flags & XVID_VOL_INTERLACING))
1179                  int *temp_dquants =              pEnc->current->vop_flags &= ~(XVID_VOP_TOPFIELDFIRST|XVID_VOP_ALTERNATESCAN);
                         (int *) xvid_malloc(pEnc->mbParam.mb_width *  
                                                                 pEnc->mbParam.mb_height * sizeof(int),  
                                                                 CACHE_LINE);  
1180    
1181                  pEnc->current->quant =                  /* ^^^------------------------ */
                         adaptive_quantization(pEnc->current->image.y,  
                                                                   pEnc->mbParam.edged_width, temp_dquants,  
                                                                   pEnc->current->quant, pEnc->current->quant,  
                                                                   2 * pEnc->current->quant,  
                                                                   pEnc->mbParam.mb_width,  
                                                                   pEnc->mbParam.mb_height);  
1182    
1183                  for (y = 0; y < pEnc->mbParam.mb_height; y++) {          if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
1184                        image_copy(&pEnc->sOriginal, &pEnc->current->image,
1185                               pEnc->mbParam.edged_width, pEnc->mbParam.height);
1186            }
1187    
1188  #define OFFSET(x,y) ((x) + (y)*pEnc->mbParam.mb_width)                  FrameCodeI(pEnc, &bs);
1189                    xFrame->out_flags |= XVID_KEYFRAME;
1190    
1191                          for (x = 0; x < pEnc->mbParam.mb_width; x++) {          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1192             * encode this frame as an p-vop
1193         * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1194    
1195        } else { // (type == P_VOP || type == S_VOP)
1196    
1197                                  MACROBLOCK *pMB = &pEnc->current->mbs[OFFSET(x, y)];                  DPRINTF(DPRINTF_DEBUG,"*** PFRAME bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",
1198                                    pEnc->bframenum_head, pEnc->bframenum_tail,
1199                                    pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);
1200    
1201                                  pMB->dquant = iDQtab[temp_dquants[OFFSET(x, y)] + 2];                  if ((pEnc->current->vop_flags & XVID_VOP_DEBUG)) {
1202                            image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "PVOP");
1203                          }                          }
1204    
1205  #undef OFFSET          if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
1206                        image_copy(&pEnc->sOriginal, &pEnc->current->image,
1207                               pEnc->mbParam.edged_width, pEnc->mbParam.height);
1208                  }                  }
1209    
1210                  xvid_free(temp_dquants);                  FrameCodeP(pEnc, &bs, 1, 0);
1211          }          }
1212    
         if (pEnc->current->global_flags & XVID_H263QUANT) {  
                 if (pEnc->mbParam.m_quant_type != H263_QUANT)  
                         write_vol_header = 1;  
                 pEnc->mbParam.m_quant_type = H263_QUANT;  
         } else if (pEnc->current->global_flags & XVID_MPEGQUANT) {  
                 int matrix1_changed, matrix2_changed;  
1213    
1214                  matrix1_changed = matrix2_changed = 0;      /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1215             * on next enc_encode call we must flush bframes
1216             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1217    
1218                  if (pEnc->mbParam.m_quant_type != MPEG4_QUANT)  done_flush:
                         write_vol_header = 1;  
1219    
1220                  pEnc->mbParam.m_quant_type = MPEG4_QUANT;      pEnc->flush_bframes = 1;
1221    
1222                  if ((pEnc->current->global_flags & XVID_CUSTOM_QMATRIX) > 0) {          /* packed & queued_bframes: dont bother outputting stats, we do so after the flush */
1223                          if (pFrame->quant_intra_matrix != NULL)          if ((pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) && pEnc->bframenum_tail > 0) {
1224                                  matrix1_changed = set_intra_matrix(pFrame->quant_intra_matrix);                  goto repeat;
                         if (pFrame->quant_inter_matrix != NULL)  
                                 matrix2_changed = set_inter_matrix(pFrame->quant_inter_matrix);  
                 } else {  
                         matrix1_changed = set_intra_matrix(get_default_intra_matrix());  
                         matrix2_changed = set_inter_matrix(get_default_inter_matrix());  
                 }  
                 if (write_vol_header == 0)  
                         write_vol_header = matrix1_changed | matrix2_changed;  
1225          }          }
1226    
1227          if (pFrame->intra < 0) {      /* packed or no-bframes: output stats */
1228                  if ((pEnc->iFrameNum == 0)      if ((pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) || pEnc->mbParam.max_bframes == 0) {
1229                          || ((pEnc->iMaxKeyInterval > 0)          call_plugins(pEnc, pEnc->current, &pEnc->sOriginal, XVID_PLG_AFTER, 0, 0, stats);
                                 && (pEnc->iFrameNum >= pEnc->iMaxKeyInterval))) {  
                         pFrame->intra = FrameCodeI(pEnc, &bs, &bits);  
                 } else {  
                         pFrame->intra = FrameCodeP(pEnc, &bs, &bits, 0, write_vol_header);  
                 }  
         } else {  
                 if (pFrame->intra == 1) {  
                         pFrame->intra = FrameCodeI(pEnc, &bs, &bits);  
                 } else {  
                         pFrame->intra = FrameCodeP(pEnc, &bs, &bits, 1, write_vol_header);  
1230                  }                  }
1231    
1232          }          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1233             * done; return number of bytes consumed
1234             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1235    
1236          BitstreamPutBits(&bs, 0xFFFF, 16);  done:
         BitstreamPutBits(&bs, 0xFFFF, 16);  
         BitstreamPad(&bs);  
         pFrame->length = BitstreamLength(&bs);  
1237    
1238          if (pResult) {          stop_global_timer();
1239                  pResult->quant = pEnc->current->quant;          write_timer();
                 pResult->hlength = pFrame->length - (pEnc->sStat.iTextBits / 8);  
                 pResult->kblks = pEnc->sStat.kblks;  
                 pResult->mblks = pEnc->sStat.mblks;  
                 pResult->ublks = pEnc->sStat.ublks;  
         }  
1240    
1241          emms();          emms();
1242            return BitstreamLength(&bs);
1243          if (pFrame->quant == 0) {  }
                 RateControlUpdate(&pEnc->rate_control, pEnc->current->quant,  
                                                   pFrame->length, pFrame->intra);  
         }  
 #ifdef _DEBUG_PSNR  
         psnr =  
                 image_psnr(&pEnc->sOriginal, &pEnc->current->image,  
                                    pEnc->mbParam.edged_width, pEnc->mbParam.width,  
                                    pEnc->mbParam.height);  
   
         snprintf(temp, 127, "PSNR: %f\n", psnr);  
         DEBUG(temp);  
 #endif  
   
 #ifdef BFRAMES  
         inc_frame_num(pEnc);  
 #else  
         pEnc->iFrameNum++;  
 #endif  
1244    
1245    
1246          stop_global_timer();  static void SetMacroblockQuants(MBParam * const pParam, FRAMEINFO * frame)
1247          write_timer();  {
1248        unsigned int i,j;
1249        int quant = frame->quant;
1250    
1251          return XVID_ERR_OK;      for (j=0; j<pParam->mb_height; j++)
1252        for (i=0; i<pParam->mb_width; i++) {
1253            MACROBLOCK * pMB = &frame->mbs[j*pParam->mb_width + i];
1254            quant += pMB->dquant;
1255            if (quant > 31)
1256                            quant = 31;
1257                    if (quant < 1)
1258                            quant = 1;
1259            pMB->quant = quant;
1260        }
1261  }  }
1262    
1263    
# Line 1268  Line 1274 
1274          pMB->sad8[0] = pMB->sad8[1] = pMB->sad8[2] = pMB->sad8[3] = 0;          pMB->sad8[0] = pMB->sad8[1] = pMB->sad8[2] = pMB->sad8[3] = 0;
1275          pMB->sad16 = 0;          pMB->sad16 = 0;
1276    
1277          if ((pEnc->current->global_flags & XVID_LUMIMASKING)) {          if (pMB->dquant != 0) {
                 if (pMB->dquant != NO_CHANGE) {  
1278                          pMB->mode = MODE_INTRA_Q;                          pMB->mode = MODE_INTRA_Q;
                         pEnc->current->quant += DQtab[pMB->dquant];  
   
                         if (pEnc->current->quant > 31)  
                                 pEnc->current->quant = 31;  
                         if (pEnc->current->quant < 1)  
                                 pEnc->current->quant = 1;  
1279                  }                  }
1280          }          }
1281    
         pMB->quant = pEnc->current->quant;  
 }  
   
   
 #define FCODEBITS       3  
 #define MODEBITS        5  
   
 void  
 HintedMESet(Encoder * pEnc,  
                         int *intra)  
 {  
         HINTINFO *hint;  
         Bitstream bs;  
         int length, high;  
         uint32_t x, y;  
   
         hint = pEnc->mbParam.hint;  
   
         if (hint->rawhints) {  
                 *intra = hint->mvhint.intra;  
         } else {  
                 BitstreamInit(&bs, hint->hintstream, hint->hintlength);  
                 *intra = BitstreamGetBit(&bs);  
         }  
   
         if (*intra) {  
                 return;  
         }  
   
         pEnc->current->fcode =  
                 (hint->rawhints) ? hint->mvhint.fcode : BitstreamGetBits(&bs,  
                                                                                                                                  FCODEBITS);  
   
         length = pEnc->current->fcode + 5;  
         high = 1 << (length - 1);  
   
         for (y = 0; y < pEnc->mbParam.mb_height; ++y) {  
                 for (x = 0; x < pEnc->mbParam.mb_width; ++x) {  
                         MACROBLOCK *pMB =  
                                 &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];  
                         MVBLOCKHINT *bhint =  
                                 &hint->mvhint.block[x + y * pEnc->mbParam.mb_width];  
                         VECTOR pred;  
                         VECTOR tmp;  
                         int vec;  
   
                         pMB->mode =  
                                 (hint->rawhints) ? bhint->mode : BitstreamGetBits(&bs,  
                                                                                                                                   MODEBITS);  
   
                         pMB->mode = (pMB->mode == MODE_INTER_Q) ? MODE_INTER : pMB->mode;  
                         pMB->mode = (pMB->mode == MODE_INTRA_Q) ? MODE_INTRA : pMB->mode;  
   
                         if (pMB->mode == MODE_INTER) {  
                                 tmp.x =  
                                         (hint->rawhints) ? bhint->mvs[0].x : BitstreamGetBits(&bs,  
                                                                                                                                                   length);  
                                 tmp.y =  
                                         (hint->rawhints) ? bhint->mvs[0].y : BitstreamGetBits(&bs,  
                                                                                                                                                   length);  
                                 tmp.x -= (tmp.x >= high) ? high * 2 : 0;  
                                 tmp.y -= (tmp.y >= high) ? high * 2 : 0;  
   
                                 pred = get_pmv2(pEnc->current->mbs,pEnc->mbParam.mb_width,0,x,y,0);  
   
                                 for (vec = 0; vec < 4; ++vec) {  
                                         pMB->mvs[vec].x = tmp.x;  
                                         pMB->mvs[vec].y = tmp.y;  
                                         pMB->pmvs[vec].x = pMB->mvs[0].x - pred.x;  
                                         pMB->pmvs[vec].y = pMB->mvs[0].y - pred.y;  
                                 }  
                         } else if (pMB->mode == MODE_INTER4V) {  
                                 for (vec = 0; vec < 4; ++vec) {  
                                         tmp.x =  
                                                 (hint->rawhints) ? bhint->mvs[vec].  
                                                 x : BitstreamGetBits(&bs, length);  
                                         tmp.y =  
                                                 (hint->rawhints) ? bhint->mvs[vec].  
                                                 y : BitstreamGetBits(&bs, length);  
                                         tmp.x -= (tmp.x >= high) ? high * 2 : 0;  
                                         tmp.y -= (tmp.y >= high) ? high * 2 : 0;  
   
                                         pred = get_pmv2(pEnc->current->mbs,pEnc->mbParam.mb_width,0,x,y,vec);  
   
                                         pMB->mvs[vec].x = tmp.x;  
                                         pMB->mvs[vec].y = tmp.y;  
                                         pMB->pmvs[vec].x = pMB->mvs[vec].x - pred.x;  
                                         pMB->pmvs[vec].y = pMB->mvs[vec].y - pred.y;  
                                 }  
                         } else                          // intra / stuffing / not_coded  
                         {  
                                 for (vec = 0; vec < 4; ++vec) {  
                                         pMB->mvs[vec].x = pMB->mvs[vec].y = 0;  
                                 }  
                         }  
   
                         if (pMB->mode == MODE_INTER4V &&  
                                 (pEnc->current->global_flags & XVID_LUMIMASKING)  
                                 && pMB->dquant != NO_CHANGE) {  
                                 pMB->mode = MODE_INTRA;  
   
                                 for (vec = 0; vec < 4; ++vec) {  
                                         pMB->mvs[vec].x = pMB->mvs[vec].y = 0;  
                                 }  
                         }  
                 }  
         }  
 }  
   
   
 void  
 HintedMEGet(Encoder * pEnc,  
                         int intra)  
 {  
         HINTINFO *hint;  
         Bitstream bs;  
         uint32_t x, y;  
         int length, high;  
   
         hint = pEnc->mbParam.hint;  
   
         if (hint->rawhints) {  
                 hint->mvhint.intra = intra;  
         } else {  
                 BitstreamInit(&bs, hint->hintstream, 0);  
                 BitstreamPutBit(&bs, intra);  
         }  
   
         if (intra) {  
                 if (!hint->rawhints) {  
                         BitstreamPad(&bs);  
                         hint->hintlength = BitstreamLength(&bs);  
                 }  
                 return;  
         }  
   
         length = pEnc->current->fcode + 5;  
         high = 1 << (length - 1);  
   
         if (hint->rawhints) {  
                 hint->mvhint.fcode = pEnc->current->fcode;  
         } else {  
                 BitstreamPutBits(&bs, pEnc->current->fcode, FCODEBITS);  
         }  
   
         for (y = 0; y < pEnc->mbParam.mb_height; ++y) {  
                 for (x = 0; x < pEnc->mbParam.mb_width; ++x) {  
                         MACROBLOCK *pMB =  
                                 &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];  
                         MVBLOCKHINT *bhint =  
                                 &hint->mvhint.block[x + y * pEnc->mbParam.mb_width];  
                         VECTOR tmp;  
   
                         if (hint->rawhints) {  
                                 bhint->mode = pMB->mode;  
                         } else {  
                                 BitstreamPutBits(&bs, pMB->mode, MODEBITS);  
                         }  
   
                         if (pMB->mode == MODE_INTER || pMB->mode == MODE_INTER_Q) {  
                                 tmp.x = pMB->mvs[0].x;  
                                 tmp.y = pMB->mvs[0].y;  
                                 tmp.x += (tmp.x < 0) ? high * 2 : 0;  
                                 tmp.y += (tmp.y < 0) ? high * 2 : 0;  
   
                                 if (hint->rawhints) {  
                                         bhint->mvs[0].x = tmp.x;  
                                         bhint->mvs[0].y = tmp.y;  
                                 } else {  
                                         BitstreamPutBits(&bs, tmp.x, length);  
                                         BitstreamPutBits(&bs, tmp.y, length);  
                                 }  
                         } else if (pMB->mode == MODE_INTER4V) {  
                                 int vec;  
   
                                 for (vec = 0; vec < 4; ++vec) {  
                                         tmp.x = pMB->mvs[vec].x;  
                                         tmp.y = pMB->mvs[vec].y;  
                                         tmp.x += (tmp.x < 0) ? high * 2 : 0;  
                                         tmp.y += (tmp.y < 0) ? high * 2 : 0;  
   
                                         if (hint->rawhints) {  
                                                 bhint->mvs[vec].x = tmp.x;  
                                                 bhint->mvs[vec].y = tmp.y;  
                                         } else {  
                                                 BitstreamPutBits(&bs, tmp.x, length);  
                                                 BitstreamPutBits(&bs, tmp.y, length);  
                                         }  
                                 }  
                         }  
                 }  
         }  
   
         if (!hint->rawhints) {  
                 BitstreamPad(&bs);  
                 hint->hintlength = BitstreamLength(&bs);  
         }  
 }  
1282    
1283    
1284  static int  static int
1285  FrameCodeI(Encoder * pEnc,  FrameCodeI(Encoder * pEnc,
1286                     Bitstream * bs,                     Bitstream * bs)
                    uint32_t * pBits)  
1287  {  {
1288        int bits = BitstreamPos(bs);
1289            int mb_width = pEnc->mbParam.mb_width;
1290            int mb_height = pEnc->mbParam.mb_height;
1291    
1292          DECLARE_ALIGNED_MATRIX(dct_codes, 6, 64, int16_t, CACHE_LINE);          DECLARE_ALIGNED_MATRIX(dct_codes, 6, 64, int16_t, CACHE_LINE);
1293          DECLARE_ALIGNED_MATRIX(qcoeff, 6, 64, int16_t, CACHE_LINE);          DECLARE_ALIGNED_MATRIX(qcoeff, 6, 64, int16_t, CACHE_LINE);
1294    
1295          uint16_t x, y;          uint16_t x, y;
1296    
1297          pEnc->iFrameNum = 0;          if ((pEnc->current->vol_flags & XVID_VOL_REDUCED_ENABLE))
1298            {
1299                    mb_width = (pEnc->mbParam.width + 31) / 32;
1300                    mb_height = (pEnc->mbParam.height + 31) / 32;
1301    
1302                    /* 16x16->8x8 downsample requires 1 additional edge pixel*/
1303                    /* XXX: setedges is overkill */
1304                    start_timer();
1305                    image_setedges(&pEnc->current->image,
1306                            pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,
1307                            pEnc->mbParam.width, pEnc->mbParam.height);
1308                    stop_edges_timer();
1309            }
1310    
1311          pEnc->mbParam.m_rounding_type = 1;          pEnc->mbParam.m_rounding_type = 1;
1312          pEnc->current->rounding_type = pEnc->mbParam.m_rounding_type;          pEnc->current->rounding_type = pEnc->mbParam.m_rounding_type;
1313          pEnc->current->coding_type = I_VOP;          pEnc->current->coding_type = I_VOP;
1314    
1315          BitstreamWriteVolHeader(bs, &pEnc->mbParam, pEnc->current);      SetMacroblockQuants(&pEnc->mbParam, pEnc->current);
 #ifdef BFRAMES  
 #define DIVX501B481P "DivX501b481p"  
         if ((pEnc->global & XVID_GLOBAL_PACKED)) {  
                 BitstreamWriteUserData(bs, DIVX501B481P, strlen(DIVX501B481P));  
         }  
 #endif  
         BitstreamWriteVopHeader(bs, &pEnc->mbParam, pEnc->current, 1);  
1316    
1317          *pBits = BitstreamPos(bs);          BitstreamWriteVolHeader(bs, &pEnc->mbParam);
1318    
1319          pEnc->sStat.iTextBits = 0;          set_timecodes(pEnc->current,pEnc->reference,pEnc->mbParam.fbase);
         pEnc->sStat.kblks = pEnc->mbParam.mb_width * pEnc->mbParam.mb_height;  
         pEnc->sStat.mblks = pEnc->sStat.ublks = 0;  
1320    
1321          for (y = 0; y < pEnc->mbParam.mb_height; y++)          BitstreamPadAlways(bs);
1322                  for (x = 0; x < pEnc->mbParam.mb_width; x++) {          BitstreamWriteVopHeader(bs, &pEnc->mbParam, pEnc->current, 1);
1323    
1324            pEnc->current->sStat.iTextBits = 0;
1325            pEnc->current->sStat.kblks = mb_width * mb_height;
1326            pEnc->current->sStat.mblks = pEnc->current->sStat.ublks = 0;
1327    
1328            for (y = 0; y < mb_height; y++)
1329                    for (x = 0; x < mb_width; x++) {
1330                          MACROBLOCK *pMB =                          MACROBLOCK *pMB =
1331                                  &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];                                  &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];
1332    
# Line 1526  Line 1340 
1340                          stop_prediction_timer();                          stop_prediction_timer();
1341    
1342                          start_timer();                          start_timer();
1343                          MBCoding(pEnc->current, pMB, qcoeff, bs, &pEnc->sStat);                          if (pEnc->current->vop_flags & XVID_VOP_GREYSCALE)
1344                            {       pMB->cbp &= 0x3C;               /* keep only bits 5-2 */
1345                                    qcoeff[4*64+0]=0;               /* zero, because for INTRA MBs DC value is saved */
1346                                    qcoeff[5*64+0]=0;
1347                            }
1348                            MBCoding(pEnc->current, pMB, qcoeff, bs, &pEnc->current->sStat);
1349                          stop_coding_timer();                          stop_coding_timer();
1350                  }                  }
1351    
1352            if ((pEnc->current->vop_flags & XVID_VOP_REDUCED))
1353            {
1354                    image_deblock_rrv(&pEnc->current->image, pEnc->mbParam.edged_width,
1355                            pEnc->current->mbs, mb_width, mb_height, pEnc->mbParam.mb_width,
1356                            16, 0);
1357            }
1358          emms();          emms();
1359    
1360          *pBits = BitstreamPos(bs) - *pBits;  /* XXX: Remove the two #if 0 blocks when we are sure we must always pad the stream */
1361          pEnc->sStat.fMvPrevSigma = -1;  #if 0
1362          pEnc->sStat.iMvSum = 0;          /* for divx5 compatibility, we must always pad between the packed p and b frames */
1363          pEnc->sStat.iMvCount = 0;          if ((pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) && pEnc->bframenum_tail > 0)
1364    #endif
1365                    BitstreamPadAlways(bs);
1366    #if 0
1367            else
1368                    BitstreamPad(bs);
1369    #endif
1370        pEnc->current->length = (BitstreamPos(bs) - bits) / 8;
1371    
1372            pEnc->fMvPrevSigma = -1;
1373          pEnc->mbParam.m_fcode = 2;          pEnc->mbParam.m_fcode = 2;
1374    
1375        /* XXX: hinted me
1376          if (pEnc->current->global_flags & XVID_HINTEDME_GET) {          if (pEnc->current->global_flags & XVID_HINTEDME_GET) {
1377                  HintedMEGet(pEnc, 1);                  HintedMEGet(pEnc, 1);
1378          }          }*/
1379    
1380          return 1;                                       // intra          return 1;                                       /* intra */
1381  }  }
1382    
1383    
1384  #define INTRA_THRESHOLD 0.5  #define INTRA_THRESHOLD 0.5
1385    #define BFRAME_SKIP_THRESHHOLD 30
1386    
1387    
1388    /* FrameCodeP also handles S(GMC)-VOPs */
1389  static int  static int
1390  FrameCodeP(Encoder * pEnc,  FrameCodeP(Encoder * pEnc,
1391                     Bitstream * bs,                     Bitstream * bs,
                    uint32_t * pBits,  
1392                     bool force_inter,                     bool force_inter,
1393                     bool vol_header)                     bool vol_header)
1394  {  {
1395          float fSigma;          float fSigma;
1396        int bits = BitstreamPos(bs);
1397    
1398          DECLARE_ALIGNED_MATRIX(dct_codes, 6, 64, int16_t, CACHE_LINE);          DECLARE_ALIGNED_MATRIX(dct_codes, 6, 64, int16_t, CACHE_LINE);
1399          DECLARE_ALIGNED_MATRIX(qcoeff, 6, 64, int16_t, CACHE_LINE);          DECLARE_ALIGNED_MATRIX(qcoeff, 6, 64, int16_t, CACHE_LINE);
1400    
1401            int mb_width = pEnc->mbParam.mb_width;
1402            int mb_height = pEnc->mbParam.mb_height;
1403    
1404          int iLimit;          int iLimit;
1405          uint32_t x, y;          int x, y, k;
1406          int iSearchRange;          int iSearchRange;
1407          int bIntra;          int bIntra, skip_possible;
1408    
1409          /* IMAGE *pCurrent = &pEnc->current->image; */          /* IMAGE *pCurrent = &pEnc->current->image; */
1410          IMAGE *pRef = &pEnc->reference->image;          IMAGE *pRef = &pEnc->reference->image;
1411    
1412            if ((pEnc->current->vop_flags & XVID_VOP_REDUCED))
1413            {
1414                    mb_width = (pEnc->mbParam.width + 31) / 32;
1415                    mb_height = (pEnc->mbParam.height + 31) / 32;
1416            }
1417    
1418    
1419          start_timer();          start_timer();
1420          image_setedges(pRef, pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,          image_setedges(pRef, pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,
1421                                     pEnc->mbParam.width, pEnc->mbParam.height,                                     pEnc->mbParam.width, pEnc->mbParam.height);
                                    pEnc->current->global_flags & XVID_INTERLACING);  
1422          stop_edges_timer();          stop_edges_timer();
1423    
1424          pEnc->mbParam.m_rounding_type = 1 - pEnc->mbParam.m_rounding_type;          pEnc->mbParam.m_rounding_type = 1 - pEnc->mbParam.m_rounding_type;
1425          pEnc->current->rounding_type = pEnc->mbParam.m_rounding_type;          pEnc->current->rounding_type = pEnc->mbParam.m_rounding_type;
1426            //pEnc->current->quarterpel =  pEnc->mbParam.m_quarterpel;
1427          pEnc->current->fcode = pEnc->mbParam.m_fcode;          pEnc->current->fcode = pEnc->mbParam.m_fcode;
1428    
1429          if (!force_inter)          if (!force_inter)
1430                  iLimit =                  iLimit = (int)(mb_width * mb_height *  INTRA_THRESHOLD);
                         (int) (pEnc->mbParam.mb_width * pEnc->mbParam.mb_height *  
                                    INTRA_THRESHOLD);  
1431          else          else
1432                  iLimit = pEnc->mbParam.mb_width * pEnc->mbParam.mb_height + 1;                  iLimit = mb_width * mb_height + 1;
1433    
1434          if ((pEnc->current->global_flags & XVID_HALFPEL)) {          if ((pEnc->current->vop_flags & XVID_VOP_HALFPEL)) {
1435                  start_timer();                  start_timer();
1436                  image_interpolate(pRef, &pEnc->vInterH, &pEnc->vInterV,                  image_interpolate(pRef, &pEnc->vInterH, &pEnc->vInterV,
1437                                                    &pEnc->vInterHV, pEnc->mbParam.edged_width,                                                    &pEnc->vInterHV, pEnc->mbParam.edged_width,
1438                                                    pEnc->mbParam.edged_height,                                                    pEnc->mbParam.edged_height,
1439                                                      (pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL),
1440                                                    pEnc->current->rounding_type);                                                    pEnc->current->rounding_type);
1441                  stop_inter_timer();                  stop_inter_timer();
1442          }          }
1443    
1444            pEnc->current->coding_type = P_VOP;
1445    
1446    
1447        SetMacroblockQuants(&pEnc->mbParam, pEnc->current);
1448    
1449          start_timer();          start_timer();
1450          if (pEnc->current->global_flags & XVID_HINTEDME_SET) {          /*if (pEnc->current->global_flags & XVID_HINTEDME_SET)
1451                  HintedMESet(pEnc, &bIntra);                  HintedMESet(pEnc, &bIntra);
1452          } else {          else*/
   
 #ifdef _SMP  
         if (pEnc->mbParam.num_threads > 1)  
                 bIntra =  
                         SMP_MotionEstimation(&pEnc->mbParam, pEnc->current, pEnc->reference,  
                                                  &pEnc->vInterH, &pEnc->vInterV, &pEnc->vInterHV,  
                                                  iLimit);  
         else  
 #endif  
1453                  bIntra =                  bIntra =
1454                          MotionEstimation(&pEnc->mbParam, pEnc->current, pEnc->reference,                          MotionEstimation(&pEnc->mbParam, pEnc->current, pEnc->reference,
1455                           &pEnc->vInterH, &pEnc->vInterV, &pEnc->vInterHV,                           &pEnc->vInterH, &pEnc->vInterV, &pEnc->vInterHV,
1456                           iLimit);                           iLimit);
1457    
         }  
1458          stop_motion_timer();          stop_motion_timer();
1459    
1460          if (bIntra == 1) {          if (bIntra == 1) return FrameCodeI(pEnc, bs);
                 return FrameCodeI(pEnc, bs, pBits);  
         }  
1461    
1462          pEnc->current->coding_type = P_VOP;          if ( ( pEnc->current->vol_flags & XVID_VOL_GMC )
1463                    && ( (pEnc->current->warp.duv[1].x != 0) || (pEnc->current->warp.duv[1].y != 0) ) )
1464            {
1465                    pEnc->current->coding_type = S_VOP;
1466    
1467                    generate_GMCparameters( 2, 16, &pEnc->current->warp,
1468                                            pEnc->mbParam.width, pEnc->mbParam.height,
1469                                            &pEnc->current->gmc_data);
1470    
1471                    generate_GMCimage(&pEnc->current->gmc_data, &pEnc->reference->image,
1472                                    pEnc->mbParam.mb_width, pEnc->mbParam.mb_height,
1473                                    pEnc->mbParam.edged_width, pEnc->mbParam.edged_width/2,
1474                                    pEnc->mbParam.m_fcode, (pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL), 0,
1475                                    pEnc->current->rounding_type, pEnc->current->mbs, &pEnc->vGMC);
1476    
1477            }
1478    
1479            set_timecodes(pEnc->current,pEnc->reference,pEnc->mbParam.fbase);
1480          if (vol_header)          if (vol_header)
1481                  BitstreamWriteVolHeader(bs, &pEnc->mbParam, pEnc->current);          {       BitstreamWriteVolHeader(bs, &pEnc->mbParam);
1482                    BitstreamPadAlways(bs);
1483            }
1484    
1485          BitstreamWriteVopHeader(bs, &pEnc->mbParam, pEnc->current, 1);          BitstreamWriteVopHeader(bs, &pEnc->mbParam, pEnc->current, 1);
1486    
1487          *pBits = BitstreamPos(bs);          pEnc->current->sStat.iTextBits = pEnc->current->sStat.iMvSum = pEnc->current->sStat.iMvCount =
1488                    pEnc->current->sStat.kblks = pEnc->current->sStat.mblks = pEnc->current->sStat.ublks = 0;
1489    
         pEnc->sStat.iTextBits = 0;  
         pEnc->sStat.iMvSum = 0;  
         pEnc->sStat.iMvCount = 0;  
         pEnc->sStat.kblks = pEnc->sStat.mblks = pEnc->sStat.ublks = 0;  
1490    
1491          for (y = 0; y < pEnc->mbParam.mb_height; y++) {          for (y = 0; y < mb_height; y++) {
1492                  for (x = 0; x < pEnc->mbParam.mb_width; x++) {                  for (x = 0; x < mb_width; x++) {
1493                          MACROBLOCK *pMB =                          MACROBLOCK *pMB =
1494                                  &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];                                  &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];
1495    
1496    /* Mode decision: Check, if the block should be INTRA / INTER or GMC-coded */
1497    /* For a start, leave INTRA decision as is, only choose only between INTER/GMC  - gruel, 9.1.2002 */
1498    
1499                          bIntra = (pMB->mode == MODE_INTRA) || (pMB->mode == MODE_INTRA_Q);                          bIntra = (pMB->mode == MODE_INTRA) || (pMB->mode == MODE_INTRA_Q);
1500    
1501                          if (!bIntra) {                          if (bIntra) {
1502                                    CodeIntraMB(pEnc, pMB);
1503                                    MBTransQuantIntra(&pEnc->mbParam, pEnc->current, pMB, x, y,
1504                                                                      dct_codes, qcoeff);
1505    
1506                                    start_timer();
1507                                    MBPrediction(pEnc->current, x, y, pEnc->mbParam.mb_width, qcoeff);
1508                                    stop_prediction_timer();
1509    
1510                                    pEnc->current->sStat.kblks++;
1511    
1512                                    MBCoding(pEnc->current, pMB, qcoeff, bs, &pEnc->current->sStat);
1513                                    stop_coding_timer();
1514                                    continue;
1515                            }
1516    
1517                            if (pEnc->current->coding_type == S_VOP) {
1518    
1519                                    int32_t iSAD = sad16(pEnc->current->image.y + 16*y*pEnc->mbParam.edged_width + 16*x,
1520                                            pEnc->vGMC.y + 16*y*pEnc->mbParam.edged_width + 16*x,
1521                                            pEnc->mbParam.edged_width, 65536);
1522    
1523                                    if (pEnc->current->motion_flags & XVID_ME_CHROMA16) {
1524                                            iSAD += sad8(pEnc->current->image.u + 8*y*(pEnc->mbParam.edged_width/2) + 8*x,
1525                                            pEnc->vGMC.u + 8*y*(pEnc->mbParam.edged_width/2) + 8*x, pEnc->mbParam.edged_width/2);
1526    
1527                                            iSAD += sad8(pEnc->current->image.v + 8*y*(pEnc->mbParam.edged_width/2) + 8*x,
1528                                            pEnc->vGMC.v + 8*y*(pEnc->mbParam.edged_width/2) + 8*x, pEnc->mbParam.edged_width/2);
1529                                    }
1530    
1531                                    if (iSAD <= pMB->sad16) {               /* mode decision GMC */
1532    
1533                                            if ((pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL))
1534                                                    pMB->qmvs[0] = pMB->qmvs[1] = pMB->qmvs[2] = pMB->qmvs[3] = pMB->amv;
1535                                            else
1536                                                    pMB->mvs[0] = pMB->mvs[1] = pMB->mvs[2] = pMB->mvs[3] = pMB->amv;
1537    
1538                                            pMB->mode = MODE_INTER;
1539                                            pMB->mcsel = 1;
1540                                            pMB->sad16 = iSAD;
1541                                    } else {
1542                                            pMB->mcsel = 0;
1543                                    }
1544                            } else {
1545                                    pMB->mcsel = 0; /* just a precaution */
1546                            }
1547    
1548                                  start_timer();                                  start_timer();
1549                                  MBMotionCompensation(pMB, x, y, &pEnc->reference->image,                                  MBMotionCompensation(pMB, x, y, &pEnc->reference->image,
1550                                                                           &pEnc->vInterH, &pEnc->vInterV,                                                                           &pEnc->vInterH, &pEnc->vInterV,
1551                                                                           &pEnc->vInterHV, &pEnc->current->image,                                                                   &pEnc->vInterHV, &pEnc->vGMC,
1552                                                                     &pEnc->current->image,
1553                                                                           dct_codes, pEnc->mbParam.width,                                                                           dct_codes, pEnc->mbParam.width,
1554                                                                           pEnc->mbParam.height,                                                                           pEnc->mbParam.height,
1555                                                                           pEnc->mbParam.edged_width,                                                                           pEnc->mbParam.edged_width,
1556                                                                     (pEnc->current->vol_flags & XVID_VOL_QUARTERPEL),
1557                                                                     (pEnc->current->vop_flags & XVID_VOP_REDUCED),
1558                                                                           pEnc->current->rounding_type);                                                                           pEnc->current->rounding_type);
1559    
1560                                  stop_comp_timer();                                  stop_comp_timer();
1561    
1562                                  if ((pEnc->current->global_flags & XVID_LUMIMASKING)) {                          if (pMB->dquant != 0) {
                                         if (pMB->dquant != NO_CHANGE) {  
1563                                                  pMB->mode = MODE_INTER_Q;                                                  pMB->mode = MODE_INTER_Q;
                                                 pEnc->current->quant += DQtab[pMB->dquant];  
                                                 if (pEnc->current->quant > 31)  
                                                         pEnc->current->quant = 31;  
                                                 else if (pEnc->current->quant < 1)  
                                                         pEnc->current->quant = 1;  
                                         }  
1564                                  }                                  }
                                 pMB->quant = pEnc->current->quant;  
1565    
1566                                  pMB->field_pred = 0;                                  pMB->field_pred = 0;
1567    
1568                                  pMB->cbp =                          if (pMB->mode != MODE_NOT_CODED)
1569                            {       pMB->cbp =
1570                                          MBTransQuantInter(&pEnc->mbParam, pEnc->current, pMB, x, y,                                          MBTransQuantInter(&pEnc->mbParam, pEnc->current, pMB, x, y,
1571                                                                            dct_codes, qcoeff);                                                                            dct_codes, qcoeff);
                         } else {  
                                 CodeIntraMB(pEnc, pMB);  
                                 MBTransQuantIntra(&pEnc->mbParam, pEnc->current, pMB, x, y,  
                                                                   dct_codes, qcoeff);  
1572                          }                          }
1573    
1574                          start_timer();                          if (pMB->cbp || pMB->mvs[0].x || pMB->mvs[0].y ||
                         MBPrediction(pEnc->current, x, y, pEnc->mbParam.mb_width, qcoeff);  
                         stop_prediction_timer();  
   
                         if (pMB->mode == MODE_INTRA || pMB->mode == MODE_INTRA_Q) {  
                                 pEnc->sStat.kblks++;  
                         } else if (pMB->cbp || pMB->mvs[0].x || pMB->mvs[0].y ||  
1575                                             pMB->mvs[1].x || pMB->mvs[1].y || pMB->mvs[2].x ||                                             pMB->mvs[1].x || pMB->mvs[1].y || pMB->mvs[2].x ||
1576                                             pMB->mvs[2].y || pMB->mvs[3].x || pMB->mvs[3].y) {                                             pMB->mvs[2].y || pMB->mvs[3].x || pMB->mvs[3].y) {
1577                                  pEnc->sStat.mblks++;                                  pEnc->current->sStat.mblks++;
1578                          } else {                          } else {
1579                                  pEnc->sStat.ublks++;                                  pEnc->current->sStat.ublks++;
1580                          }                          }
1581    
1582                          start_timer();                          start_timer();
1583                          MBCoding(pEnc->current, pMB, qcoeff, bs, &pEnc->sStat);  
1584                            /* Finished processing the MB, now check if to CODE or SKIP */
1585    
1586                            skip_possible = (pMB->cbp == 0) && (pMB->mode == MODE_INTER) &&
1587                                                            (pMB->dquant == 0);
1588    
1589                            if (pEnc->current->coding_type == S_VOP)
1590                                    skip_possible &= (pMB->mcsel == 1);
1591                            else if (pEnc->current->coding_type == P_VOP) {
1592                                    if ((pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL))
1593                                            skip_possible &= ( (pMB->qmvs[0].x == 0) && (pMB->qmvs[0].y == 0) );
1594                                    else
1595                                            skip_possible &= ( (pMB->mvs[0].x == 0) && (pMB->mvs[0].y == 0) );
1596                            }
1597    
1598                            if ( (pMB->mode == MODE_NOT_CODED) || (skip_possible)) {
1599    
1600    /* This is a candidate for SKIPping, but for P-VOPs check intermediate B-frames first */
1601    
1602                                    if (pEnc->current->coding_type == P_VOP)        /* special rule for P-VOP's SKIP */
1603                                    {
1604                                            int bSkip = 1;
1605    
1606                                            for (k=pEnc->bframenum_head; k< pEnc->bframenum_tail; k++)
1607                                            {
1608                                                    int iSAD;
1609                                                    iSAD = sad16(pEnc->reference->image.y + 16*y*pEnc->mbParam.edged_width + 16*x,
1610                                                                            pEnc->bframes[k]->image.y + 16*y*pEnc->mbParam.edged_width + 16*x,
1611                                                                    pEnc->mbParam.edged_width,BFRAME_SKIP_THRESHHOLD);
1612                                                    if (iSAD >= BFRAME_SKIP_THRESHHOLD * pMB->quant)
1613                                                    {       bSkip = 0;
1614                                                            break;
1615                                                    }
1616                                            }
1617    
1618                                            if (!bSkip) {   /* no SKIP, but trivial block */
1619                                                    if((pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL)) {
1620                                                            VECTOR predMV = get_qpmv2(pEnc->current->mbs, pEnc->mbParam.mb_width, 0, x, y, 0);
1621                                                            pMB->pmvs[0].x = - predMV.x;
1622                                                            pMB->pmvs[0].y = - predMV.y;
1623                                                    }
1624                                                    else {
1625                                                            VECTOR predMV = get_pmv2(pEnc->current->mbs, pEnc->mbParam.mb_width, 0, x, y, 0);
1626                                                            pMB->pmvs[0].x = - predMV.x;
1627                                                            pMB->pmvs[0].y = - predMV.y;
1628                                                    }
1629                                                    pMB->mode = MODE_INTER;
1630                                                    pMB->cbp = 0;
1631                                                    MBCoding(pEnc->current, pMB, qcoeff, bs, &pEnc->current->sStat);
1632                                                    stop_coding_timer();
1633    
1634                                                    continue;       /* next MB */
1635                                            }
1636                                    }
1637                                    /* do SKIP */
1638    
1639                                    pMB->mode = MODE_NOT_CODED;
1640                                    MBSkip(bs);
1641                          stop_coding_timer();                          stop_coding_timer();
1642                                    continue;       /* next MB */
1643                  }                  }
1644                            /* ordinary case: normal coded INTER/INTER4V block */
1645    
1646                            if ((pEnc->current->vop_flags & XVID_VOP_GREYSCALE))
1647                            {       pMB->cbp &= 0x3C;               /* keep only bits 5-2 */
1648                                    qcoeff[4*64+0]=0;               /* zero, because DC for INTRA MBs DC value is saved */
1649                                    qcoeff[5*64+0]=0;
1650                            }
1651    
1652                            if((pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL)) {
1653                                    VECTOR predMV = get_qpmv2(pEnc->current->mbs, pEnc->mbParam.mb_width, 0, x, y, 0);
1654                                    pMB->pmvs[0].x = pMB->qmvs[0].x - predMV.x;
1655                                    pMB->pmvs[0].y = pMB->qmvs[0].y - predMV.y;
1656                                    DPRINTF(DPRINTF_MV,"mv_diff (%i,%i) pred (%i,%i) result (%i,%i)", pMB->pmvs[0].x, pMB->pmvs[0].y, predMV.x, predMV.y, pMB->mvs[0].x, pMB->mvs[0].y);
1657                            } else {
1658                                    VECTOR predMV = get_pmv2(pEnc->current->mbs, pEnc->mbParam.mb_width, 0, x, y, 0);
1659                                    pMB->pmvs[0].x = pMB->mvs[0].x - predMV.x;
1660                                    pMB->pmvs[0].y = pMB->mvs[0].y - predMV.y;
1661                                    DPRINTF(DPRINTF_MV,"mv_diff (%i,%i) pred (%i,%i) result (%i,%i)", pMB->pmvs[0].x, pMB->pmvs[0].y, predMV.x, predMV.y, pMB->mvs[0].x, pMB->mvs[0].y);
1662                            }
1663    
1664    
1665                            if (pMB->mode == MODE_INTER4V)
1666                            {       int k;
1667                                    for (k=1;k<4;k++)
1668                                    {
1669                                            if((pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL)) {
1670                                                    VECTOR predMV = get_qpmv2(pEnc->current->mbs, pEnc->mbParam.mb_width, 0, x, y, k);
1671                                                    pMB->pmvs[k].x = pMB->qmvs[k].x - predMV.x;
1672                                                    pMB->pmvs[k].y = pMB->qmvs[k].y - predMV.y;
1673                                    DPRINTF(DPRINTF_MV,"mv_diff (%i,%i) pred (%i,%i) result (%i,%i)", pMB->pmvs[k].x, pMB->pmvs[k].y, predMV.x, predMV.y, pMB->mvs[k].x, pMB->mvs[k].y);
1674                                            } else {
1675                                                    VECTOR predMV = get_pmv2(pEnc->current->mbs, pEnc->mbParam.mb_width, 0, x, y, k);
1676                                                    pMB->pmvs[k].x = pMB->mvs[k].x - predMV.x;
1677                                                    pMB->pmvs[k].y = pMB->mvs[k].y - predMV.y;
1678                                    DPRINTF(DPRINTF_MV,"mv_diff (%i,%i) pred (%i,%i) result (%i,%i)", pMB->pmvs[k].x, pMB->pmvs[k].y, predMV.x, predMV.y, pMB->mvs[k].x, pMB->mvs[k].y);
1679                                            }
1680    
1681                                    }
1682                            }
1683    
1684                            MBCoding(pEnc->current, pMB, qcoeff, bs, &pEnc->current->sStat);
1685                            stop_coding_timer();
1686    
1687                    }
1688            }
1689    
1690            if ((pEnc->current->vop_flags & XVID_VOP_REDUCED))
1691            {
1692                    image_deblock_rrv(&pEnc->current->image, pEnc->mbParam.edged_width,
1693                            pEnc->current->mbs, mb_width, mb_height, pEnc->mbParam.mb_width,
1694                            16, 0);
1695          }          }
1696    
1697          emms();          emms();
1698    
1699        /* XXX: hinted me
1700          if (pEnc->current->global_flags & XVID_HINTEDME_GET) {          if (pEnc->current->global_flags & XVID_HINTEDME_GET) {
1701                  HintedMEGet(pEnc, 0);                  HintedMEGet(pEnc, 0);
1702          }          }*/
1703    
1704          if (pEnc->sStat.iMvCount == 0)          if (pEnc->current->sStat.iMvCount == 0)
1705                  pEnc->sStat.iMvCount = 1;                  pEnc->current->sStat.iMvCount = 1;
1706    
1707          fSigma = (float) sqrt((float) pEnc->sStat.iMvSum / pEnc->sStat.iMvCount);          fSigma = (float) sqrt((float) pEnc->current->sStat.iMvSum / pEnc->current->sStat.iMvCount);
1708    
1709          iSearchRange = 1 << (3 + pEnc->mbParam.m_fcode);          iSearchRange = 1 << (3 + pEnc->mbParam.m_fcode);
1710    
1711          if ((fSigma > iSearchRange / 3)          if ((fSigma > iSearchRange / 3)
1712                  && (pEnc->mbParam.m_fcode <= 3))        // maximum search range 128          && (pEnc->mbParam.m_fcode <= (3 +  (pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL?1:0)  )))     /* maximum search range 128 */
1713          {          {
1714                  pEnc->mbParam.m_fcode++;                  pEnc->mbParam.m_fcode++;
1715                  iSearchRange *= 2;                  iSearchRange *= 2;
1716          } else if ((fSigma < iSearchRange / 6)          } else if ((fSigma < iSearchRange / 6)
1717                             && (pEnc->sStat.fMvPrevSigma >= 0)                             && (pEnc->fMvPrevSigma >= 0)
1718                             && (pEnc->sStat.fMvPrevSigma < iSearchRange / 6)                             && (pEnc->fMvPrevSigma < iSearchRange / 6)
1719                             && (pEnc->mbParam.m_fcode >= 2))     // minimum search range 16                             && (pEnc->mbParam.m_fcode >= (2 + (pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL?1:0) )))    /* minimum search range 16 */
1720          {          {
1721                  pEnc->mbParam.m_fcode--;                  pEnc->mbParam.m_fcode--;
1722                  iSearchRange /= 2;                  iSearchRange /= 2;
1723          }          }
1724    
1725          pEnc->sStat.fMvPrevSigma = fSigma;          pEnc->fMvPrevSigma = fSigma;
1726    
 #ifdef BFRAMES  
1727          /* frame drop code */          /* frame drop code */
1728          // DPRINTF(DPRINTF_DEBUG, "kmu %i %i %i", pEnc->sStat.kblks, pEnc->sStat.mblks, pEnc->sStat.ublks);          DPRINTF(DPRINTF_DEBUG, "kmu %i %i %i", pEnc->current->sStat.kblks, pEnc->current->sStat.mblks, pEnc->current->sStat.ublks);
1729          if (pEnc->sStat.kblks + pEnc->sStat.mblks <=          if (pEnc->current->sStat.kblks + pEnc->current->sStat.mblks <
1730                  (pEnc->frame_drop_ratio * pEnc->mbParam.mb_width * pEnc->mbParam.mb_height) / 100)                  (pEnc->mbParam.frame_drop_ratio * mb_width * mb_height) / 100)
1731          {          {
1732                  pEnc->sStat.kblks = pEnc->sStat.mblks = 0;                  pEnc->current->sStat.kblks = pEnc->current->sStat.mblks = 0;
1733                  pEnc->sStat.ublks = pEnc->mbParam.mb_width * pEnc->mbParam.mb_height;                  pEnc->current->sStat.ublks = mb_width * mb_height;
1734    
1735                  BitstreamReset(bs);                  BitstreamReset(bs);
1736    
1737                    set_timecodes(pEnc->current,pEnc->reference,pEnc->mbParam.fbase);
1738                  BitstreamWriteVopHeader(bs, &pEnc->mbParam, pEnc->current, 0);                  BitstreamWriteVopHeader(bs, &pEnc->mbParam, pEnc->current, 0);
1739    
1740                  // copy reference frame details into the current frame                  /* copy reference frame details into the current frame */
1741                  pEnc->current->quant = pEnc->reference->quant;                  pEnc->current->quant = pEnc->reference->quant;
1742                  pEnc->current->motion_flags = pEnc->reference->motion_flags;                  pEnc->current->motion_flags = pEnc->reference->motion_flags;
1743                  pEnc->current->rounding_type = pEnc->reference->rounding_type;                  pEnc->current->rounding_type = pEnc->reference->rounding_type;
1744                    //pEnc->current->quarterpel =  pEnc->reference->quarterpel;
1745                  pEnc->current->fcode = pEnc->reference->fcode;                  pEnc->current->fcode = pEnc->reference->fcode;
1746                  pEnc->current->bcode = pEnc->reference->bcode;                  pEnc->current->bcode = pEnc->reference->bcode;
1747                  image_copy(&pEnc->current->image, &pEnc->reference->image, pEnc->mbParam.edged_width, pEnc->mbParam.height);                  image_copy(&pEnc->current->image, &pEnc->reference->image, pEnc->mbParam.edged_width, pEnc->mbParam.height);
1748                  memcpy(pEnc->current->mbs, pEnc->reference->mbs, sizeof(MACROBLOCK) * pEnc->mbParam.mb_width * pEnc->mbParam.mb_height);                  memcpy(pEnc->current->mbs, pEnc->reference->mbs, sizeof(MACROBLOCK) * mb_width * mb_height);
   
1749          }          }
 #endif  
1750    
1751          *pBits = BitstreamPos(bs) - *pBits;          /* XXX: debug
1752            {
1753                    char s[100];
1754                    sprintf(s, "\\%05i_cur.pgm", pEnc->m_framenum);
1755                    image_dump_yuvpgm(&pEnc->current->image,
1756                            pEnc->mbParam.edged_width,
1757                            pEnc->mbParam.width, pEnc->mbParam.height, s);
1758    
1759  #ifdef BFRAMES                  sprintf(s, "\\%05i_ref.pgm", pEnc->m_framenum);
1760          pEnc->time_pp = ((int32_t)pEnc->mbParam.fbase - (int32_t)pEnc->last_pframe + (int32_t)pEnc->mbParam.m_ticks) % (int32_t)pEnc->mbParam.fbase;                  image_dump_yuvpgm(&pEnc->reference->image,
1761                            pEnc->mbParam.edged_width,
1762                            pEnc->mbParam.width, pEnc->mbParam.height, s);
1763            }
1764            */
1765    
1766          pEnc->last_pframe = pEnc->mbParam.m_ticks;  /* XXX: Remove the two #if 0 blocks when we are sure we must always pad the stream */
1767    #if 0
1768            /* for divx5 compatibility, we must always pad between the packed p and b frames */
1769            if ((pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) && pEnc->bframenum_tail > 0)
1770    #endif
1771                    BitstreamPadAlways(bs);
1772    #if 0
1773            else
1774                    BitstreamPad(bs);
1775  #endif  #endif
1776          return 0;                                       // inter  
1777        pEnc->current->length = (BitstreamPos(bs) - bits) / 8;
1778    
1779            return 0;                                       /* inter */
1780  }  }
1781    
1782    
 #ifdef BFRAMES  
1783  static void  static void
1784  FrameCodeB(Encoder * pEnc,  FrameCodeB(Encoder * pEnc,
1785                     FRAMEINFO * frame,                     FRAMEINFO * frame,
1786                     Bitstream * bs,                     Bitstream * bs)
                    uint32_t * pBits)  
1787  {  {
1788          int16_t dct_codes[6 * 64];      int bits = BitstreamPos(bs);
1789          int16_t qcoeff[6 * 64];          DECLARE_ALIGNED_MATRIX(dct_codes, 6, 64, int16_t, CACHE_LINE);
1790            DECLARE_ALIGNED_MATRIX(qcoeff, 6, 64, int16_t, CACHE_LINE);
1791          uint32_t x, y;          uint32_t x, y;
         VECTOR forward;  
         VECTOR backward;  
1792    
1793          IMAGE *f_ref = &pEnc->reference->image;          IMAGE *f_ref = &pEnc->reference->image;
1794          IMAGE *b_ref = &pEnc->current->image;          IMAGE *b_ref = &pEnc->current->image;
# Line 1781  Line 1800 
1800                  fprintf(fp,"Y=%3d   X=%3d   MB=%2d   CBP=%02X\n",y,x,mb->mode,mb->cbp); \                  fprintf(fp,"Y=%3d   X=%3d   MB=%2d   CBP=%02X\n",y,x,mb->mode,mb->cbp); \
1801          }          }
1802    
1803            /* XXX: pEnc->current->global_flags &= ~XVID_VOP_REDUCED;  reduced resoltion not yet supported */
1804    
1805          if (!first){          if (!first){
1806                  fp=fopen("C:\\XVIDDBGE.TXT","w");                  fp=fopen("C:\\XVIDDBGE.TXT","w");
1807          }          }
1808  #endif  #endif
1809    
1810          // forward          //frame->quarterpel =  pEnc->mbParam.m_quarterpel;
1811    
1812            /* forward  */
1813          image_setedges(f_ref, pEnc->mbParam.edged_width,          image_setedges(f_ref, pEnc->mbParam.edged_width,
1814                                     pEnc->mbParam.edged_height, pEnc->mbParam.width,                                     pEnc->mbParam.edged_height, pEnc->mbParam.width,
1815                                     pEnc->mbParam.height,                                     pEnc->mbParam.height);
                                    frame->global_flags & XVID_INTERLACING);  
1816          start_timer();          start_timer();
1817          image_interpolate(f_ref, &pEnc->f_refh, &pEnc->f_refv, &pEnc->f_refhv,          image_interpolate(f_ref, &pEnc->f_refh, &pEnc->f_refv, &pEnc->f_refhv,
1818                                            pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,                                            pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,
1819                                            0);                                            (pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL), 0);
1820          stop_inter_timer();          stop_inter_timer();
1821    
1822          // backward          /* backward */
1823          image_setedges(b_ref, pEnc->mbParam.edged_width,          image_setedges(b_ref, pEnc->mbParam.edged_width,
1824                                     pEnc->mbParam.edged_height, pEnc->mbParam.width,                                     pEnc->mbParam.edged_height, pEnc->mbParam.width,
1825                                     pEnc->mbParam.height,                                     pEnc->mbParam.height);
                                    frame->global_flags & XVID_INTERLACING);  
1826          start_timer();          start_timer();
1827          image_interpolate(b_ref, &pEnc->vInterH, &pEnc->vInterV, &pEnc->vInterHV,          image_interpolate(b_ref, &pEnc->vInterH, &pEnc->vInterV, &pEnc->vInterHV,
1828                                            pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,                                            pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,
1829                                            0);                                            (pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL), 0);
1830          stop_inter_timer();          stop_inter_timer();
1831    
1832          start_timer();          start_timer();
1833    
1834          MotionEstimationBVOP(&pEnc->mbParam, frame,          MotionEstimationBVOP(&pEnc->mbParam, frame,
1835            ((int32_t)pEnc->mbParam.fbase + (int32_t)pEnc->mbParam.m_ticks + 1 - (int32_t)pEnc->last_pframe) % pEnc->mbParam.fbase,                                                   ((int32_t)(pEnc->current->stamp - frame->stamp)),                              /* time_bp */
1836                                                  pEnc->time_pp,                                                   ((int32_t)(pEnc->current->stamp - pEnc->reference->stamp)),    /* time_pp */
1837                                                  pEnc->reference->mbs, f_ref,                                                  pEnc->reference->mbs, f_ref,
1838                                                   &pEnc->f_refh, &pEnc->f_refv, &pEnc->f_refhv,                                                   &pEnc->f_refh, &pEnc->f_refv, &pEnc->f_refhv,
1839                                                   pEnc->current->mbs, b_ref, &pEnc->vInterH,                                                   pEnc->current, b_ref, &pEnc->vInterH,
1840                                                   &pEnc->vInterV, &pEnc->vInterHV);                                                   &pEnc->vInterV, &pEnc->vInterHV);
1841    
1842    
1843          stop_motion_timer();          stop_motion_timer();
1844    
1845          /*if (test_quant_type(&pEnc->mbParam, pEnc->current))          /*
1846             {          if (test_quant_type(&pEnc->mbParam, pEnc->current)) {
1847             BitstreamWriteVolHeader(bs, pEnc->mbParam.width, pEnc->mbParam.height, pEnc->mbParam.quant_type);             BitstreamWriteVolHeader(bs, pEnc->mbParam.width, pEnc->mbParam.height, pEnc->mbParam.quant_type);
1848             } */          }
1849            */
1850    
1851          frame->coding_type = B_VOP;          frame->coding_type = B_VOP;
         BitstreamWriteVopHeader(bs, &pEnc->mbParam, frame, 1);  
   
         *pBits = BitstreamPos(bs);  
1852    
1853          pEnc->sStat.iTextBits = 0;          set_timecodes(frame, pEnc->reference,pEnc->mbParam.fbase);
1854          pEnc->sStat.iMvSum = 0;          BitstreamWriteVopHeader(bs, &pEnc->mbParam, frame, 1);
         pEnc->sStat.iMvCount = 0;  
         pEnc->sStat.kblks = pEnc->sStat.mblks = pEnc->sStat.ublks = 0;  
1855    
1856            frame->sStat.iTextBits = 0;
1857            frame->sStat.iMvSum = 0;
1858            frame->sStat.iMvCount = 0;
1859            frame->sStat.kblks = frame->sStat.mblks = frame->sStat.ublks = 0;
1860            frame->sStat.mblks = pEnc->mbParam.mb_width * pEnc->mbParam.mb_height;
1861            frame->sStat.kblks = frame->sStat.ublks = 0;
1862    
1863          for (y = 0; y < pEnc->mbParam.mb_height; y++) {          for (y = 0; y < pEnc->mbParam.mb_height; y++) {
                 // reset prediction  
   
                 forward.x = 0;  
                 forward.y = 0;  
                 backward.x = 0;  
                 backward.y = 0;  
   
1864                  for (x = 0; x < pEnc->mbParam.mb_width; x++) {                  for (x = 0; x < pEnc->mbParam.mb_width; x++) {
1865                          MACROBLOCK *f_mb =                          MACROBLOCK * const mb = &frame->mbs[x + y * pEnc->mbParam.mb_width];
1866                                  &pEnc->reference->mbs[x + y * pEnc->mbParam.mb_width];                          int direction = frame->vop_flags & XVID_VOP_ALTERNATESCAN ? 2 : 0;
                         MACROBLOCK *b_mb =  
                                 &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];  
                         MACROBLOCK *mb = &frame->mbs[x + y * pEnc->mbParam.mb_width];  
1867    
1868                          // decoder ignores mb when refence block is INTER(0,0), CBP=0                          /* decoder ignores mb when refence block is INTER(0,0), CBP=0 */
1869                          if (mb->mode == MODE_NOT_CODED) {                          if (mb->mode == MODE_NOT_CODED) {
1870                                  mb->mvs[0].x = 0;                                  /* mb->mvs[0].x = mb->mvs[0].y = mb->cbp = 0; */
                                 mb->mvs[0].y = 0;  
   
                                 mb->cbp = 0;  
 #ifdef BFRAMES_DEC_DEBUG  
         BFRAME_DEBUG  
 #endif  
1871                                  continue;                                  continue;
1872                          }                          }
1873    
1874                            if (mb->mode != MODE_DIRECT_NONE_MV || pEnc->mbParam.plugin_flags & XVID_REQORIGINAL) {
1875                          MBMotionCompensationBVOP(&pEnc->mbParam, mb, x, y, &frame->image,                          MBMotionCompensationBVOP(&pEnc->mbParam, mb, x, y, &frame->image,
1876                                                                           f_ref, &pEnc->f_refh, &pEnc->f_refv,                                                                           f_ref, &pEnc->f_refh, &pEnc->f_refv,
1877                                                                           &pEnc->f_refhv, b_ref, &pEnc->vInterH,                                                                           &pEnc->f_refhv, b_ref, &pEnc->vInterH,
1878                                                                           &pEnc->vInterV, &pEnc->vInterHV,                                                                           &pEnc->vInterV, &pEnc->vInterHV,
1879                                                                           dct_codes);                                                                           dct_codes);
1880    
1881                                    if (mb->mode == MODE_DIRECT_NO4V) mb->mode = MODE_DIRECT;
1882                          mb->quant = frame->quant;                          mb->quant = frame->quant;
                         mb->cbp =  
                                 MBTransQuantInter(&pEnc->mbParam, frame, mb, x, y, dct_codes,  
                                                                   qcoeff);  
                         //mb->cbp = MBTransQuantBVOP(&pEnc->mbParam, x, y, dct_codes, qcoeff, &frame->image, frame->quant);  
1883    
1884                                    if (mb->mode != MODE_DIRECT_NONE_MV)
1885                                            mb->cbp = MBTransQuantInterBVOP(&pEnc->mbParam, frame, mb, x, y,  dct_codes, qcoeff);
1886    
1887                          if ((mb->mode == MODE_INTERPOLATE || mb->mode == MODE_DIRECT)                                  if ( (mb->mode == MODE_DIRECT) && (mb->cbp == 0)
1888                                  && mb->cbp == 0 && mb->mvs[0].x == 0 && mb->mvs[0].y == 0) {                                          && (mb->pmvs[3].x == 0) && (mb->pmvs[3].y == 0) ) {
1889                                  mb->mode = MODE_DIRECT_NONE_MV; // skipped                                          mb->mode = MODE_DIRECT_NONE_MV; /* skipped */
1890                          }                          }
   
                         if (mb->mode == MODE_INTERPOLATE || mb->mode == MODE_FORWARD) {  
                                 mb->pmvs[0].x = mb->mvs[0].x - forward.x;  
                                 mb->pmvs[0].y = mb->mvs[0].y - forward.y;  
                                 forward.x = mb->mvs[0].x;  
                                 forward.y = mb->mvs[0].y;  
1891                          }                          }
1892    
                         if (mb->mode == MODE_INTERPOLATE || mb->mode == MODE_BACKWARD) {  
                                 mb->b_pmvs[0].x = mb->b_mvs[0].x - backward.x;  
                                 mb->b_pmvs[0].y = mb->b_mvs[0].y - backward.y;  
                                 backward.x = mb->b_mvs[0].x;  
                                 backward.y = mb->b_mvs[0].y;  
                         }  
 //                      DPRINTF("%05i : [%i %i] M=%i CBP=%i MVS=%i,%i forward=%i,%i", pEnc->m_framenum, x, y, mb->mode, mb->cbp, mb->mvs[0].x, mb->mvs[0].y, forward.x, forward.y);  
   
1893  #ifdef BFRAMES_DEC_DEBUG  #ifdef BFRAMES_DEC_DEBUG
1894          BFRAME_DEBUG          BFRAME_DEBUG
1895  #endif  #endif
1896                          start_timer();                          start_timer();
1897                          MBCodingBVOP(mb, qcoeff, frame->fcode, frame->bcode, bs,                          MBCodingBVOP(mb, qcoeff, frame->fcode, frame->bcode, bs,
1898                                                   &pEnc->sStat);                                                   &frame->sStat, direction);
1899                          stop_coding_timer();                          stop_coding_timer();
1900                  }                  }
1901          }          }
1902    
1903          emms();          emms();
1904    
1905          // TODO: dynamic fcode/bcode ???          /* TODO: dynamic fcode/bcode ??? */
1906    
1907          *pBits = BitstreamPos(bs) - *pBits;      BitstreamPadAlways(bs);
1908            frame->length = (BitstreamPos(bs) - bits) / 8;
1909    
1910  #ifdef BFRAMES_DEC_DEBUG  #ifdef BFRAMES_DEC_DEBUG
1911          if (!first){          if (!first){
# Line 1920  Line 1915 
1915          }          }
1916  #endif  #endif
1917  }  }
 #endif  
Legend:
Removed from v.324  
changed lines
  Added in v.999
No admin address has been configured
 ViewVC Help
Powered by ViewVC 1.0.4