[svn] / trunk / xvidcore / src / encoder.c Repository:
ViewVC logotype

Diff of /trunk/xvidcore/src/encoder.c

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

revision 295, Fri Jul 12 12:26:55 2002 UTC revision 1693, Fri Mar 3 11:54:58 2006 UTC
# Line 3  Line 3 
3   *  XVID MPEG-4 VIDEO CODEC   *  XVID MPEG-4 VIDEO CODEC
4   *  -  Encoder main module  -   *  -  Encoder main module  -
5   *   *
6   *  This program is an implementation of a part of one or more MPEG-4   *  Copyright(C) 2002     Michael Militzer <isibaar@xvid.org>
7   *  Video tools as specified in ISO/IEC 14496-2 standard.  Those intending   *                         2002-2003 Peter Ross <pross@xvid.org>
8   *  to use this software module in hardware or software products are   *                         2002   Daniel Smith <danielsmith@astroboymail.com>
  *  advised that its use may infringe existing patents or copyrights, and  
  *  any such use would be at such party's own risk.  The original  
  *  developer of this software module and his/her company, and subsequent  
  *  editors and their companies, will have no liability for use of this  
  *  software or modifications or derivatives thereof.  
9   *   *
10   *  This program is free software; you can redistribute it and/or modify   *  This program is free software; you can redistribute it and/or modify
11   *  it under the terms of the GNU General Public License as published by   *  it under the terms of the GNU General Public License as published by
# Line 26  Line 21 
21   *  along with this program; if not, write to the Free Software   *  along with this program; if not, write to the Free Software
22   *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA   *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
23   *   *
24   ****************************************************************************/   * $Id: encoder.c,v 1.128 2006-03-03 11:54:58 syskin 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.55 2002-07-12 12:26:23 suxen_drol Exp $  
25   *   *
26   ****************************************************************************/   ****************************************************************************/
27    
# Line 53  Line 35 
35  #include "global.h"  #include "global.h"
36  #include "utils/timer.h"  #include "utils/timer.h"
37  #include "image/image.h"  #include "image/image.h"
 #ifdef BFRAMES  
38  #include "image/font.h"  #include "image/font.h"
39  #endif  #include "motion/sad.h"
40  #include "motion/motion.h"  #include "motion/motion.h"
41    #include "motion/gmc.h"
42    
43  #include "bitstream/cbp.h"  #include "bitstream/cbp.h"
44  #include "utils/mbfunctions.h"  #include "utils/mbfunctions.h"
45  #include "bitstream/bitstream.h"  #include "bitstream/bitstream.h"
46  #include "bitstream/mbcoding.h"  #include "bitstream/mbcoding.h"
 #include "utils/ratecontrol.h"  
47  #include "utils/emms.h"  #include "utils/emms.h"
48  #include "bitstream/mbcoding.h"  #include "bitstream/mbcoding.h"
 #include "quant/adapt_quant.h"  
49  #include "quant/quant_matrix.h"  #include "quant/quant_matrix.h"
50  #include "utils/mem_align.h"  #include "utils/mem_align.h"
51    
52  #ifdef _SMP  # include "motion/motion_smp.h"
 #include "motion/smp_motion_est.h"  
 #endif  
 /*****************************************************************************  
  * Local macros  
  ****************************************************************************/  
53    
 #define ENC_CHECK(X) if(!(X)) return XVID_ERR_FORMAT  
 #define SWAP(A,B)    { void * tmp = A; A = B; B = tmp; }  
54    
55  /*****************************************************************************  /*****************************************************************************
56   * Local function prototypes   * Local function prototypes
57   ****************************************************************************/   ****************************************************************************/
58    
59  static int FrameCodeI(Encoder * pEnc,  static int FrameCodeI(Encoder * pEnc,
60                                            Bitstream * bs,                                            Bitstream * bs);
                                           uint32_t * pBits);  
61    
62  static int FrameCodeP(Encoder * pEnc,  static int FrameCodeP(Encoder * pEnc,
63                                            Bitstream * bs,                                            Bitstream * bs);
                                           uint32_t * pBits,  
                                           bool force_inter,  
                                           bool vol_header);  
64    
 #ifdef BFRAMES  
65  static void FrameCodeB(Encoder * pEnc,  static void FrameCodeB(Encoder * pEnc,
66                                             FRAMEINFO * frame,                                             FRAMEINFO * frame,
67                                             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;  
 }  
68    
69    
70  /*****************************************************************************  /*****************************************************************************
# Line 130  Line 78 
78   * and cleaning code.   * and cleaning code.
79   *   *
80   * Returned values :   * Returned values :
81   *    - XVID_ERR_OK     - no errors   *      - 0                             - no errors
82   *    - XVID_ERR_MEMORY - the libc could not allocate memory, the function   *    - XVID_ERR_MEMORY - the libc could not allocate memory, the function
83   *                        cleans the structure before exiting.   *                        cleans the structure before exiting.
84   *                        pParam->handle is also set to NULL.   *                        pParam->handle is also set to NULL.
85   *   *
86   ****************************************************************************/   ****************************************************************************/
87    
 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;  
         }  
   
88          /*          /*
89           * Simplify the "fincr/fbase" fraction           * Simplify the "fincr/fbase" fraction
          * (neccessary, since windows supplies us with huge numbers)  
90           */           */
91    static int
92    gcd(int a, int b)
93    {
94            int r ;
95    
96          i = pParam->fincr;          if (b > a) {
97          while (i > 1) {                  r = a;
98                  if (pParam->fincr % i == 0 && pParam->fbase % i == 0) {                  a = b;
99                          pParam->fincr /= i;                  b = r;
                         pParam->fbase /= i;  
                         i = pParam->fincr;  
                         continue;  
                 }  
                 i--;  
100          }          }
101    
102          if (pParam->fbase > 65535) {          while ((r = a % b)) {
103                  float div = (float) pParam->fbase / 65535;                  a = b;
104                    b = r;
105                  pParam->fbase = (int) (pParam->fbase / div);          }
106                  pParam->fincr = (int) (pParam->fincr / div);          return b;
107          }          }
108    
109          /* Bitrate allocator defaults */  static void
110    simplify_time(int *inc, int *base)
111          if (pParam->rc_bitrate <= 0)  {
112                  pParam->rc_bitrate = 900000;          /* common factor */
113            const int s = gcd(*inc, *base);
114          if (pParam->rc_reaction_delay_factor <= 0)    *inc  /= s;
115                  pParam->rc_reaction_delay_factor = 16;    *base /= s;
116    
117          if (pParam->rc_averaging_period <= 0)          if (*base > 65535 || *inc > 65535) {
118                  pParam->rc_averaging_period = 100;                  int *biggest;
119                    int *other;
120                    float div;
121    
122                    if (*base > *inc) {
123                            biggest = base;
124                            other = inc;
125                    } else {
126                            biggest = inc;
127                            other = base;
128                    }
129    
130          if (pParam->rc_buffer <= 0)                  div = ((float)*biggest)/((float)65535);
131                  pParam->rc_buffer = 100;                  *biggest = (unsigned int)(((float)*biggest)/div);
132                    *other = (unsigned int)(((float)*other)/div);
133            }
134    }
135    
         /* Max and min quantizers */  
136    
137          if ((pParam->min_quantizer <= 0) || (pParam->min_quantizer > 31))  int
138                  pParam->min_quantizer = 1;  enc_create(xvid_enc_create_t * create)
139    {
140            Encoder *pEnc;
141            int n;
142    
143          if ((pParam->max_quantizer <= 0) || (pParam->max_quantizer > 31))          if (XVID_VERSION_MAJOR(create->version) != 1) /* v1.x.x */
144                  pParam->max_quantizer = 31;                  return XVID_ERR_VERSION;
145    
146          if (pParam->max_quantizer < pParam->min_quantizer)          if (create->width%2 || create->height%2)
147                  pParam->max_quantizer = pParam->min_quantizer;                  return XVID_ERR_FAIL;
148    
149          /* 1 keyframe each 10 seconds */          if (create->width<=0 || create->height<=0)
150                    return XVID_ERR_FAIL;
151    
152          if (pParam->max_key_interval == 0)          /* allocate encoder struct */
                 pParam->max_key_interval = 10 * pParam->fincr / pParam->fbase;  
153    
154          pEnc = (Encoder *) xvid_malloc(sizeof(Encoder), CACHE_LINE);          pEnc = (Encoder *) xvid_malloc(sizeof(Encoder), CACHE_LINE);
155          if (pEnc == NULL)          if (pEnc == NULL)
156                  return XVID_ERR_MEMORY;                  return XVID_ERR_MEMORY;
   
         /* Zero the Encoder Structure */  
   
157          memset(pEnc, 0, sizeof(Encoder));          memset(pEnc, 0, sizeof(Encoder));
158    
159          /* Fill members of Encoder structure */          pEnc->mbParam.profile = create->profile;
   
         pEnc->mbParam.width = pParam->width;  
         pEnc->mbParam.height = pParam->height;  
160    
161            /* global flags */
162            pEnc->mbParam.global_flags = create->global;
163      if ((pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED))
164        pEnc->mbParam.global_flags |= XVID_GLOBAL_DIVX5_USERDATA;
165    
166            /* width, height */
167            pEnc->mbParam.width = create->width;
168            pEnc->mbParam.height = create->height;
169          pEnc->mbParam.mb_width = (pEnc->mbParam.width + 15) / 16;          pEnc->mbParam.mb_width = (pEnc->mbParam.width + 15) / 16;
170          pEnc->mbParam.mb_height = (pEnc->mbParam.height + 15) / 16;          pEnc->mbParam.mb_height = (pEnc->mbParam.height + 15) / 16;
   
171          pEnc->mbParam.edged_width = 16 * pEnc->mbParam.mb_width + 2 * EDGE_SIZE;          pEnc->mbParam.edged_width = 16 * pEnc->mbParam.mb_width + 2 * EDGE_SIZE;
172          pEnc->mbParam.edged_height = 16 * pEnc->mbParam.mb_height + 2 * EDGE_SIZE;          pEnc->mbParam.edged_height = 16 * pEnc->mbParam.mb_height + 2 * EDGE_SIZE;
173    
174          pEnc->mbParam.fbase = pParam->fbase;          /* framerate */
175          pEnc->mbParam.fincr = pParam->fincr;          pEnc->mbParam.fincr = MAX(create->fincr, 0);
176            pEnc->mbParam.fbase = create->fincr <= 0 ? 25 : create->fbase;
177            if (pEnc->mbParam.fincr>0)
178                    simplify_time((int*)&pEnc->mbParam.fincr, (int*)&pEnc->mbParam.fbase);
179    
180            /* zones */
181            if(create->num_zones > 0) {
182                    pEnc->num_zones = create->num_zones;
183                    pEnc->zones = xvid_malloc(sizeof(xvid_enc_zone_t) * pEnc->num_zones, CACHE_LINE);
184                    if (pEnc->zones == NULL)
185                            goto xvid_err_memory0;
186                    memcpy(pEnc->zones, create->zones, sizeof(xvid_enc_zone_t) * pEnc->num_zones);
187            } else {
188                    pEnc->num_zones = 0;
189                    pEnc->zones = NULL;
190            }
191    
192          pEnc->mbParam.m_quant_type = H263_QUANT;          /* plugins */
193            if(create->num_plugins > 0) {
194                    pEnc->num_plugins = create->num_plugins;
195                    pEnc->plugins = xvid_malloc(sizeof(xvid_enc_plugin_t) * pEnc->num_plugins, CACHE_LINE);
196                    if (pEnc->plugins == NULL)
197                            goto xvid_err_memory0;
198            } else {
199                    pEnc->num_plugins = 0;
200                    pEnc->plugins = NULL;
201            }
202    
203  #ifdef _SMP          for (n=0; n<pEnc->num_plugins;n++) {
204          pEnc->mbParam.num_threads = MIN(pParam->num_threads, MAXNUMTHREADS);                  xvid_plg_create_t pcreate;
205  #endif                  xvid_plg_info_t pinfo;
206    
207          pEnc->sStat.fMvPrevSigma = -1;                  memset(&pinfo, 0, sizeof(xvid_plg_info_t));
208                    pinfo.version = XVID_VERSION;
209                    if (create->plugins[n].func(NULL, XVID_PLG_INFO, &pinfo, NULL) >= 0) {
210                            pEnc->mbParam.plugin_flags |= pinfo.flags;
211                    }
212    
213          /* Fill rate control parameters */                  memset(&pcreate, 0, sizeof(xvid_plg_create_t));
214                    pcreate.version = XVID_VERSION;
215                    pcreate.num_zones = pEnc->num_zones;
216                    pcreate.zones = pEnc->zones;
217                    pcreate.width = pEnc->mbParam.width;
218                    pcreate.height = pEnc->mbParam.height;
219                    pcreate.mb_width = pEnc->mbParam.mb_width;
220                    pcreate.mb_height = pEnc->mbParam.mb_height;
221                    pcreate.fincr = pEnc->mbParam.fincr;
222                    pcreate.fbase = pEnc->mbParam.fbase;
223                    pcreate.param = create->plugins[n].param;
224    
225          pEnc->bitrate = pParam->rc_bitrate;                  pEnc->plugins[n].func = NULL;   /* disable plugins that fail */
226                    if (create->plugins[n].func(NULL, XVID_PLG_CREATE, &pcreate, &pEnc->plugins[n].param) >= 0) {
227                            pEnc->plugins[n].func = create->plugins[n].func;
228                    }
229            }
230    
231          pEnc->iFrameNum = 0;          if ((pEnc->mbParam.global_flags & XVID_GLOBAL_EXTRASTATS_ENABLE) ||
232          pEnc->iMaxKeyInterval = pParam->max_key_interval;                  (pEnc->mbParam.plugin_flags & XVID_REQPSNR)) {
233                    pEnc->mbParam.plugin_flags |= XVID_REQORIGINAL; /* psnr calculation requires the original */
234            }
235    
236            /* temp dquants */
237            if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
238                    pEnc->temp_dquants = (int *) xvid_malloc(pEnc->mbParam.mb_width *
239                                                    pEnc->mbParam.mb_height * sizeof(int), CACHE_LINE);
240                    if (pEnc->temp_dquants==NULL)
241                            goto xvid_err_memory1a;
242            }
243    
244            /* temp lambdas */
245            if (pEnc->mbParam.plugin_flags & XVID_REQLAMBDA) {
246                    pEnc->temp_lambda = (float *) xvid_malloc(pEnc->mbParam.mb_width *
247                                                    pEnc->mbParam.mb_height * 6 * sizeof(float), CACHE_LINE);
248                    if (pEnc->temp_lambda == NULL)
249                            goto xvid_err_memory1a;
250            }
251    
252            /* bframes */
253            pEnc->mbParam.max_bframes = MAX(create->max_bframes, 0);
254            pEnc->mbParam.bquant_ratio = MAX(create->bquant_ratio, 0);
255            pEnc->mbParam.bquant_offset = create->bquant_offset;
256    
257            /* min/max quant */
258            for (n=0; n<3; n++) {
259                    pEnc->mbParam.min_quant[n] = create->min_quant[n] > 0 ? create->min_quant[n] : 2;
260                    pEnc->mbParam.max_quant[n] = create->max_quant[n] > 0 ? create->max_quant[n] : 31;
261            }
262    
263          /* try to allocate frame memory */          /* frame drop ratio */
264            pEnc->mbParam.frame_drop_ratio = MAX(create->frame_drop_ratio, 0);
265    
266            /* max keyframe interval */
267            pEnc->mbParam.iMaxKeyInterval = create->max_key_interval <= 0 ? (10 * (int)pEnc->mbParam.fbase) / (int)pEnc->mbParam.fincr : create->max_key_interval;
268    
269            /* allocate working frame-image memory */
270    
271          pEnc->current = xvid_malloc(sizeof(FRAMEINFO), CACHE_LINE);          pEnc->current = xvid_malloc(sizeof(FRAMEINFO), CACHE_LINE);
272          pEnc->reference = xvid_malloc(sizeof(FRAMEINFO), CACHE_LINE);          pEnc->reference = xvid_malloc(sizeof(FRAMEINFO), CACHE_LINE);
# Line 257  Line 274 
274          if (pEnc->current == NULL || pEnc->reference == NULL)          if (pEnc->current == NULL || pEnc->reference == NULL)
275                  goto xvid_err_memory1;                  goto xvid_err_memory1;
276    
277          /* try to allocate mb memory */          /* allocate macroblock memory */
278    
279          pEnc->current->mbs =          pEnc->current->mbs =
280                  xvid_malloc(sizeof(MACROBLOCK) * pEnc->mbParam.mb_width *                  xvid_malloc(sizeof(MACROBLOCK) * pEnc->mbParam.mb_width *
# Line 269  Line 286 
286          if (pEnc->current->mbs == NULL || pEnc->reference->mbs == NULL)          if (pEnc->current->mbs == NULL || pEnc->reference->mbs == NULL)
287                  goto xvid_err_memory2;                  goto xvid_err_memory2;
288    
289          /* try to allocate image memory */          /* allocate quant matrix memory */
290    
291            pEnc->mbParam.mpeg_quant_matrices =
292                    xvid_malloc(sizeof(uint16_t) * 64 * 8, CACHE_LINE);
293    
294            if (pEnc->mbParam.mpeg_quant_matrices == NULL)
295                    goto xvid_err_memory2a;
296    
297  #ifdef _DEBUG_PSNR          /* allocate interpolation image memory */
298    
299            if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
300          image_null(&pEnc->sOriginal);          image_null(&pEnc->sOriginal);
301  #endif                  image_null(&pEnc->sOriginal2);
302  #ifdef BFRAMES          }
303    
304          image_null(&pEnc->f_refh);          image_null(&pEnc->f_refh);
305          image_null(&pEnc->f_refv);          image_null(&pEnc->f_refv);
306          image_null(&pEnc->f_refhv);          image_null(&pEnc->f_refhv);
307  #endif  
308          image_null(&pEnc->current->image);          image_null(&pEnc->current->image);
309          image_null(&pEnc->reference->image);          image_null(&pEnc->reference->image);
310          image_null(&pEnc->vInterH);          image_null(&pEnc->vInterH);
311          image_null(&pEnc->vInterV);          image_null(&pEnc->vInterV);
         image_null(&pEnc->vInterVf);  
312          image_null(&pEnc->vInterHV);          image_null(&pEnc->vInterHV);
         image_null(&pEnc->vInterHVf);  
313    
314  #ifdef _DEBUG_PSNR          if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
315          if (image_create          if (image_create
316                  (&pEnc->sOriginal, pEnc->mbParam.edged_width,                  (&pEnc->sOriginal, pEnc->mbParam.edged_width,
317                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
318                  goto xvid_err_memory3;                  goto xvid_err_memory3;
319  #endif  
320  #ifdef BFRAMES                  if (image_create
321                            (&pEnc->sOriginal2, pEnc->mbParam.edged_width,
322                             pEnc->mbParam.edged_height) < 0)
323                            goto xvid_err_memory3;
324            }
325    
326          if (image_create          if (image_create
327                  (&pEnc->f_refh, pEnc->mbParam.edged_width,                  (&pEnc->f_refh, pEnc->mbParam.edged_width,
328                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
# Line 306  Line 335 
335                  (&pEnc->f_refhv, pEnc->mbParam.edged_width,                  (&pEnc->f_refhv, pEnc->mbParam.edged_width,
336                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
337                  goto xvid_err_memory3;                  goto xvid_err_memory3;
338  #endif  
339          if (image_create          if (image_create
340                  (&pEnc->current->image, pEnc->mbParam.edged_width,                  (&pEnc->current->image, pEnc->mbParam.edged_width,
341                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
# Line 324  Line 353 
353                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
354                  goto xvid_err_memory3;                  goto xvid_err_memory3;
355          if (image_create          if (image_create
                 (&pEnc->vInterVf, pEnc->mbParam.edged_width,  
                  pEnc->mbParam.edged_height) < 0)  
                 goto xvid_err_memory3;  
         if (image_create  
356                  (&pEnc->vInterHV, pEnc->mbParam.edged_width,                  (&pEnc->vInterHV, pEnc->mbParam.edged_width,
357                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
358                  goto xvid_err_memory3;                  goto xvid_err_memory3;
359    
360    /* Create full bitplane for GMC, this might be wasteful */
361          if (image_create          if (image_create
362                  (&pEnc->vInterHVf, pEnc->mbParam.edged_width,                  (&pEnc->vGMC, pEnc->mbParam.edged_width,
363                   pEnc->mbParam.edged_height) < 0)                   pEnc->mbParam.edged_height) < 0)
364                  goto xvid_err_memory3;                  goto xvid_err_memory3;
365    
366            /* init bframe image buffers */
367    
368            pEnc->bframenum_head = 0;
369            pEnc->bframenum_tail = 0;
370            pEnc->flush_bframes = 0;
371            pEnc->closed_bframenum = -1;
372    
373          /* 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;  
374          pEnc->bframes = NULL;          pEnc->bframes = NULL;
375    
376          if (pEnc->mbParam.max_bframes > 0) {          if (pEnc->mbParam.max_bframes > 0) {
                 int n;  
377    
378                  pEnc->bframes =                  pEnc->bframes =
379                          xvid_malloc(pEnc->mbParam.max_bframes * sizeof(FRAMEINFO *),                          xvid_malloc(pEnc->mbParam.max_bframes * sizeof(FRAMEINFO *),
# Line 383  Line 409 
409                  }                  }
410          }          }
411    
412          pEnc->bframenum_head = 0;          /* init incoming frame queue */
413          pEnc->bframenum_tail = 0;          pEnc->queue_head = 0;
414          pEnc->flush_bframes = 0;          pEnc->queue_tail = 0;
415          pEnc->bframenum_dx50bvop = -1;          pEnc->queue_size = 0;
   
         pEnc->queue = NULL;  
   
   
         if (pEnc->mbParam.max_bframes > 0) {  
                 int n;  
416    
417                  pEnc->queue =                  pEnc->queue =
418                          xvid_malloc(pEnc->mbParam.max_bframes * sizeof(IMAGE),                  xvid_malloc((pEnc->mbParam.max_bframes+1) * sizeof(QUEUEINFO),
419                                                  CACHE_LINE);                                                  CACHE_LINE);
420    
421                  if (pEnc->queue == NULL)                  if (pEnc->queue == NULL)
422                          goto xvid_err_memory4;                          goto xvid_err_memory4;
423    
424                  for (n = 0; n < pEnc->mbParam.max_bframes; n++)          for (n = 0; n < pEnc->mbParam.max_bframes+1; n++)
425                          image_null(&pEnc->queue[n]);                  image_null(&pEnc->queue[n].image);
426    
427                  for (n = 0; n < pEnc->mbParam.max_bframes; n++) {  
428            for (n = 0; n < pEnc->mbParam.max_bframes+1; n++) {
429                          if (image_create                          if (image_create
430                                  (&pEnc->queue[n], pEnc->mbParam.edged_width,                          (&pEnc->queue[n].image, pEnc->mbParam.edged_width,
431                                   pEnc->mbParam.edged_height) < 0)                                   pEnc->mbParam.edged_height) < 0)
432                                  goto xvid_err_memory5;                                  goto xvid_err_memory5;
   
                 }  
433          }          }
434    
435          pEnc->queue_head = 0;          /* timestamp stuff */
         pEnc->queue_tail = 0;  
         pEnc->queue_size = 0;  
   
436    
437          pEnc->mbParam.m_seconds = 0;          pEnc->mbParam.m_stamp = 0;
         pEnc->mbParam.m_ticks = 0;  
438          pEnc->m_framenum = 0;          pEnc->m_framenum = 0;
439  #endif          pEnc->current->stamp = 0;
440            pEnc->reference->stamp = 0;
441    
442            /* other stuff */
443    
444            pEnc->iFrameNum = 0;
445            pEnc->fMvPrevSigma = -1;
446    
447          pParam->handle = (void *) pEnc;          /* multithreaded stuff */
448            if (create->num_threads > 0) {
449                    int t = create->num_threads;
450                    int rows_per_thread = (pEnc->mbParam.mb_height+t-1)/t;
451                    pEnc->num_threads = t;
452                    pEnc->motionData = xvid_malloc(t*sizeof(SMPmotionData), CACHE_LINE);
453                    if (!pEnc->motionData)
454                            goto xvid_err_nosmp;
455    
456                    for (n = 0; n < t; n++) {
457                            pEnc->motionData[n].complete_count_self =
458                                    xvid_malloc(rows_per_thread * sizeof(int), CACHE_LINE);
459    
460                            if (!pEnc->motionData[n].complete_count_self)
461                                    goto xvid_err_nosmp;
462    
463                            if (n != 0)
464                                    pEnc->motionData[n].complete_count_above =
465                                            pEnc->motionData[n-1].complete_count_self;
466                    }
467                    pEnc->motionData[0].complete_count_above =
468                            pEnc->motionData[t-1].complete_count_self - 1;
469    
470          if (pParam->rc_bitrate) {          } else {
471                  RateControlInit(&pEnc->rate_control, pParam->rc_bitrate,    xvid_err_nosmp:
472                                                  pParam->rc_reaction_delay_factor,                  /* no SMP */
473                                                  pParam->rc_averaging_period, pParam->rc_buffer,                  create->num_threads = 0;
474                                                  pParam->fbase * 1000 / pParam->fincr,                  pEnc->motionData = NULL;
                                                 pParam->max_quantizer, pParam->min_quantizer);  
475          }          }
476    
477            create->handle = (void *) pEnc;
478    
479          init_timer();          init_timer();
480            init_mpeg_matrix(pEnc->mbParam.mpeg_quant_matrices);
481    
482          return XVID_ERR_OK;          return 0;   /* ok */
483    
484          /*          /*
485           * We handle all XVID_ERR_MEMORY here, this makes the code lighter           * We handle all XVID_ERR_MEMORY here, this makes the code lighter
486           */           */
 #ifdef BFRAMES  
   xvid_err_memory5:  
487    
488      xvid_err_memory5:
489    
490          if (pEnc->mbParam.max_bframes > 0) {          for (n = 0; n < pEnc->mbParam.max_bframes+1; n++) {
491                            image_destroy(&pEnc->queue[n].image, pEnc->mbParam.edged_width,
                 for (i = 0; i < pEnc->mbParam.max_bframes; i++) {  
                         image_destroy(&pEnc->queue[i], pEnc->mbParam.edged_width,  
492                                                    pEnc->mbParam.edged_height);                                                    pEnc->mbParam.edged_height);
493                  }                  }
494    
495                  xvid_free(pEnc->queue);                  xvid_free(pEnc->queue);
         }  
496    
497    xvid_err_memory4:    xvid_err_memory4:
498    
499          if (pEnc->mbParam.max_bframes > 0) {          if (pEnc->mbParam.max_bframes > 0) {
500                    int i;
501    
502                  for (i = 0; i < pEnc->mbParam.max_bframes; i++) {                  for (i = 0; i < pEnc->mbParam.max_bframes; i++) {
503    
# Line 464  Line 506 
506    
507                          image_destroy(&pEnc->bframes[i]->image, pEnc->mbParam.edged_width,                          image_destroy(&pEnc->bframes[i]->image, pEnc->mbParam.edged_width,
508                                                    pEnc->mbParam.edged_height);                                                    pEnc->mbParam.edged_height);
   
509                          xvid_free(pEnc->bframes[i]->mbs);                          xvid_free(pEnc->bframes[i]->mbs);
   
510                          xvid_free(pEnc->bframes[i]);                          xvid_free(pEnc->bframes[i]);
   
511                  }                  }
512    
513                  xvid_free(pEnc->bframes);                  xvid_free(pEnc->bframes);
514          }          }
515    
 #endif  
   
516    xvid_err_memory3:    xvid_err_memory3:
517  #ifdef _DEBUG_PSNR  
518            if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
519          image_destroy(&pEnc->sOriginal, pEnc->mbParam.edged_width,          image_destroy(&pEnc->sOriginal, pEnc->mbParam.edged_width,
520                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
521  #endif                  image_destroy(&pEnc->sOriginal2, pEnc->mbParam.edged_width,
522                                              pEnc->mbParam.edged_height);
523            }
524    
 #ifdef BFRAMES  
525          image_destroy(&pEnc->f_refh, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refh, pEnc->mbParam.edged_width,
526                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
527          image_destroy(&pEnc->f_refv, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refv, pEnc->mbParam.edged_width,
528                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
529          image_destroy(&pEnc->f_refhv, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refhv, pEnc->mbParam.edged_width,
530                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
 #endif  
531    
532          image_destroy(&pEnc->current->image, pEnc->mbParam.edged_width,          image_destroy(&pEnc->current->image, pEnc->mbParam.edged_width,
533                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
# Line 499  Line 537 
537                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
538          image_destroy(&pEnc->vInterV, pEnc->mbParam.edged_width,          image_destroy(&pEnc->vInterV, pEnc->mbParam.edged_width,
539                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
         image_destroy(&pEnc->vInterVf, pEnc->mbParam.edged_width,  
                                   pEnc->mbParam.edged_height);  
540          image_destroy(&pEnc->vInterHV, pEnc->mbParam.edged_width,          image_destroy(&pEnc->vInterHV, pEnc->mbParam.edged_width,
541                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
542          image_destroy(&pEnc->vInterHVf, pEnc->mbParam.edged_width,  
543    /* destroy GMC image */
544            image_destroy(&pEnc->vGMC, pEnc->mbParam.edged_width,
545                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
546    
547      xvid_err_memory2a:
548            xvid_free(pEnc->mbParam.mpeg_quant_matrices);
549    
550    xvid_err_memory2:    xvid_err_memory2:
551          xvid_free(pEnc->current->mbs);          xvid_free(pEnc->current->mbs);
552          xvid_free(pEnc->reference->mbs);          xvid_free(pEnc->reference->mbs);
# Line 513  Line 554 
554    xvid_err_memory1:    xvid_err_memory1:
555          xvid_free(pEnc->current);          xvid_free(pEnc->current);
556          xvid_free(pEnc->reference);          xvid_free(pEnc->reference);
557    
558      xvid_err_memory1a:
559            if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
560                    xvid_free(pEnc->temp_dquants);
561            }
562    
563            if(pEnc->mbParam.plugin_flags & XVID_REQLAMBDA) {
564                    xvid_free(pEnc->temp_lambda);
565            }
566    
567      xvid_err_memory0:
568            for (n=0; n<pEnc->num_plugins;n++) {
569                    if (pEnc->plugins[n].func) {
570                            pEnc->plugins[n].func(pEnc->plugins[n].param, XVID_PLG_DESTROY, NULL, NULL);
571                    }
572            }
573            xvid_free(pEnc->plugins);
574    
575            xvid_free(pEnc->zones);
576    
577          xvid_free(pEnc);          xvid_free(pEnc);
578    
579          pParam->handle = NULL;          create->handle = NULL;
580    
581          return XVID_ERR_MEMORY;          return XVID_ERR_MEMORY;
582  }  }
# Line 524  Line 585 
585   * Encoder destruction   * Encoder destruction
586   *   *
587   * This function destroy the entire encoder structure created by a previous   * This function destroy the entire encoder structure created by a previous
588   * successful encoder_create call.   * successful enc_create call.
589   *   *
590   * Returned values (for now only one returned value) :   * Returned values (for now only one returned value) :
591   *    - XVID_ERR_OK     - no errors   *      - 0      - no errors
592   *   *
593   ****************************************************************************/   ****************************************************************************/
594    
595  int  int
596  encoder_destroy(Encoder * pEnc)  enc_destroy(Encoder * pEnc)
597  {  {
 #ifdef BFRAMES  
598          int i;          int i;
 #endif  
   
         ENC_CHECK(pEnc);  
599    
600          /* B Frames specific */          /* B Frames specific */
601  #ifdef BFRAMES          for (i = 0; i < pEnc->mbParam.max_bframes+1; i++) {
602          if (pEnc->mbParam.max_bframes > 0) {                  image_destroy(&pEnc->queue[i].image, pEnc->mbParam.edged_width,
   
                 for (i = 0; i < pEnc->mbParam.max_bframes; i++) {  
   
                         image_destroy(&pEnc->queue[i], pEnc->mbParam.edged_width,  
603                                            pEnc->mbParam.edged_height);                                            pEnc->mbParam.edged_height);
604                  }                  }
                 xvid_free(pEnc->queue);  
         }  
605    
606            xvid_free(pEnc->queue);
607    
608          if (pEnc->mbParam.max_bframes > 0) {          if (pEnc->mbParam.max_bframes > 0) {
609    
# Line 562  Line 614 
614    
615                          image_destroy(&pEnc->bframes[i]->image, pEnc->mbParam.edged_width,                          image_destroy(&pEnc->bframes[i]->image, pEnc->mbParam.edged_width,
616                                            pEnc->mbParam.edged_height);                                            pEnc->mbParam.edged_height);
   
617                          xvid_free(pEnc->bframes[i]->mbs);                          xvid_free(pEnc->bframes[i]->mbs);
   
618                          xvid_free(pEnc->bframes[i]);                          xvid_free(pEnc->bframes[i]);
619                  }                  }
620    
621                  xvid_free(pEnc->bframes);                  xvid_free(pEnc->bframes);
622    
623          }          }
 #endif  
624    
625          /* All images, reference, current etc ... */          /* All images, reference, current etc ... */
626    
# Line 583  Line 632 
632                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
633          image_destroy(&pEnc->vInterV, pEnc->mbParam.edged_width,          image_destroy(&pEnc->vInterV, pEnc->mbParam.edged_width,
634                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
         image_destroy(&pEnc->vInterVf, pEnc->mbParam.edged_width,  
                                   pEnc->mbParam.edged_height);  
635          image_destroy(&pEnc->vInterHV, pEnc->mbParam.edged_width,          image_destroy(&pEnc->vInterHV, pEnc->mbParam.edged_width,
636                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
         image_destroy(&pEnc->vInterHVf, pEnc->mbParam.edged_width,  
                                   pEnc->mbParam.edged_height);  
 #ifdef BFRAMES  
637          image_destroy(&pEnc->f_refh, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refh, pEnc->mbParam.edged_width,
638                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
639          image_destroy(&pEnc->f_refv, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refv, pEnc->mbParam.edged_width,
640                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
641          image_destroy(&pEnc->f_refhv, pEnc->mbParam.edged_width,          image_destroy(&pEnc->f_refhv, pEnc->mbParam.edged_width,
642                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
643  #endif          image_destroy(&pEnc->vGMC, pEnc->mbParam.edged_width,
644  #ifdef _DEBUG_PSNR                                    pEnc->mbParam.edged_height);
645    
646            if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
647          image_destroy(&pEnc->sOriginal, pEnc->mbParam.edged_width,          image_destroy(&pEnc->sOriginal, pEnc->mbParam.edged_width,
648                                    pEnc->mbParam.edged_height);                                    pEnc->mbParam.edged_height);
649  #endif                  image_destroy(&pEnc->sOriginal2, pEnc->mbParam.edged_width,
650                                              pEnc->mbParam.edged_height);
651            }
652    
653          /* Encoder structure */          /* Encoder structure */
654    
# Line 610  Line 658 
658          xvid_free(pEnc->reference->mbs);          xvid_free(pEnc->reference->mbs);
659          xvid_free(pEnc->reference);          xvid_free(pEnc->reference);
660    
661          xvid_free(pEnc);          if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
662                    xvid_free(pEnc->temp_dquants);
663            }
664    
665          return XVID_ERR_OK;          if ((pEnc->mbParam.plugin_flags & XVID_REQLAMBDA)) {
666                    xvid_free(pEnc->temp_lambda);
667  }  }
668    
669            if (pEnc->num_plugins>0) {
670                    xvid_plg_destroy_t pdestroy;
671                    memset(&pdestroy, 0, sizeof(xvid_plg_destroy_t));
672    
673  #ifdef BFRAMES                  pdestroy.version = XVID_VERSION;
674  void inc_frame_num(Encoder * pEnc)                  pdestroy.num_frames = pEnc->m_framenum;
 {  
         pEnc->iFrameNum++;  
         pEnc->mbParam.m_ticks += pEnc->mbParam.fincr;  
675    
676          pEnc->mbParam.m_seconds = pEnc->mbParam.m_ticks / pEnc->mbParam.fbase;                  for (i=0; i<pEnc->num_plugins;i++) {
677          pEnc->mbParam.m_ticks = pEnc->mbParam.m_ticks % pEnc->mbParam.fbase;                          if (pEnc->plugins[i].func) {
678                                    pEnc->plugins[i].func(pEnc->plugins[i].param, XVID_PLG_DESTROY, &pdestroy, NULL);
679  }  }
 #endif  
   
   
 #ifdef BFRAMES  
 void queue_image(Encoder * pEnc, XVID_ENC_FRAME * pFrame)  
 {  
         if (pEnc->queue_size >= pEnc->mbParam.max_bframes)  
         {  
                 DPRINTF(DPRINTF_DEBUG,"FATAL: QUEUE FULL");  
                 return;  
680          }          }
681                    xvid_free(pEnc->plugins);
         DPRINTF(DPRINTF_DEBUG,"*** QUEUE 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);  
   
   
         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();  
   
         pEnc->queue_size++;  
         pEnc->queue_tail =  (pEnc->queue_tail + 1) % pEnc->mbParam.max_bframes;  
682  }  }
 #endif  
   
   
 #ifdef BFRAMES  
 /*****************************************************************************  
  * 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  
  ****************************************************************************/  
683    
684  int          xvid_free(pEnc->mbParam.mpeg_quant_matrices);
 encoder_encode_bframes(Encoder * pEnc,  
                            XVID_ENC_FRAME * pFrame,  
                            XVID_ENC_STATS * pResult)  
 {  
         uint16_t x, y;  
         Bitstream bs;  
         uint32_t bits;  
685    
686          int input_valid = 1;          if (pEnc->num_zones > 0)
687                    xvid_free(pEnc->zones);
688    
689  #ifdef _DEBUG_PSNR          if (pEnc->num_threads > 0) {
690          float psnr;                  for (i = 0; i < pEnc->num_threads; i++)
691          char temp[128];                          xvid_free(pEnc->motionData[i].complete_count_self);
 #endif  
   
         ENC_CHECK(pEnc);  
         ENC_CHECK(pFrame);  
         ENC_CHECK(pFrame->image);  
   
         start_global_timer();  
692    
693          BitstreamInit(&bs, pFrame->bitstream, 0);                  xvid_free(pEnc->motionData);
694            }
695    
696  ipvop_loop:          xvid_free(pEnc);
697    
698          /*          return 0;  /* ok */
699           * bframe "flush" code  }
          */  
700    
         if ((pFrame->image == NULL || pEnc->flush_bframes)  
                 && (pEnc->bframenum_head < pEnc->bframenum_tail)) {  
701    
                 if (pEnc->flush_bframes == 0) {  
702                          /*                          /*
703                           * we have reached the end of stream without getting    call the plugins
                          * a future reference frame... so encode last final  
                          * frame as a pframe  
704                           */                           */
705    
706                          DPRINTF(DPRINTF_DEBUG,"*** BFRAME (final frame) bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",  static void call_plugins(Encoder * pEnc, FRAMEINFO * frame, IMAGE * original,
707                                  pEnc->bframenum_head, pEnc->bframenum_tail,                                                   int opt, int * type, int * quant, xvid_enc_stats_t * stats)
708                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);  {
709            unsigned int i, j, k;
710            xvid_plg_data_t data;
711    
712                          pEnc->bframenum_tail--;          /* set data struct */
                         SWAP(pEnc->current, pEnc->reference);  
713    
714                          SWAP(pEnc->current, pEnc->bframes[pEnc->bframenum_tail]);          memset(&data, 0, sizeof(xvid_plg_data_t));
715            data.version = XVID_VERSION;
716    
717            /* find zone */
718            for(i=0; i<pEnc->num_zones && pEnc->zones[i].frame<=frame->frame_num; i++) ;
719            data.zone = i>0 ? &pEnc->zones[i-1] : NULL;
720    
721            data.width = pEnc->mbParam.width;
722            data.height = pEnc->mbParam.height;
723            data.mb_width = pEnc->mbParam.mb_width;
724            data.mb_height = pEnc->mbParam.mb_height;
725            data.fincr = frame->fincr;
726            data.fbase = pEnc->mbParam.fbase;
727            data.bquant_ratio = pEnc->mbParam.bquant_ratio;
728            data.bquant_offset = pEnc->mbParam.bquant_offset;
729    
730            for (i=0; i<3; i++) {
731                    data.min_quant[i] = pEnc->mbParam.min_quant[i];
732                    data.max_quant[i] = pEnc->mbParam.max_quant[i];
733            }
734    
735            data.reference.csp = XVID_CSP_PLANAR;
736            data.reference.plane[0] = pEnc->reference->image.y;
737            data.reference.plane[1] = pEnc->reference->image.u;
738            data.reference.plane[2] = pEnc->reference->image.v;
739            data.reference.stride[0] = pEnc->mbParam.edged_width;
740            data.reference.stride[1] = pEnc->mbParam.edged_width/2;
741            data.reference.stride[2] = pEnc->mbParam.edged_width/2;
742    
743            data.current.csp = XVID_CSP_PLANAR;
744            data.current.plane[0] = frame->image.y;
745            data.current.plane[1] = frame->image.u;
746            data.current.plane[2] = frame->image.v;
747            data.current.stride[0] = pEnc->mbParam.edged_width;
748            data.current.stride[1] = pEnc->mbParam.edged_width/2;
749            data.current.stride[2] = pEnc->mbParam.edged_width/2;
750    
751            data.frame_num = frame->frame_num;
752    
753            if (opt == XVID_PLG_BEFORE) {
754                    data.type = *type;
755                    data.quant = *quant;
756    
757                    data.vol_flags = frame->vol_flags;
758                    data.vop_flags = frame->vop_flags;
759                    data.motion_flags = frame->motion_flags;
760    
761            } else if (opt == XVID_PLG_FRAME) {
762                    data.type = coding2type(frame->coding_type);
763                    data.quant = frame->quant;
764    
765                    if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
766                            data.dquant = pEnc->temp_dquants;
767                            data.dquant_stride = pEnc->mbParam.mb_width;
768                            memset(data.dquant, 0, data.mb_width*data.mb_height*sizeof(int));
769                    }
770    
771                    if(pEnc->mbParam.plugin_flags & XVID_REQLAMBDA) {
772                            int block = 0;
773                            data.lambda = pEnc->temp_lambda;
774                            for(i = 0;i < pEnc->mbParam.mb_height; i++)
775                                    for(j = 0;j < pEnc->mbParam.mb_width; j++)
776                                            for (k = 0; k < 6; k++)
777                                                    data.lambda[block++] = 1.0f;
778                    }
779    
780            } else { /* XVID_PLG_AFTER */
781                    if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
782                            data.original.csp = XVID_CSP_PLANAR;
783                            data.original.plane[0] = original->y;
784                            data.original.plane[1] = original->u;
785                            data.original.plane[2] = original->v;
786                            data.original.stride[0] = pEnc->mbParam.edged_width;
787                            data.original.stride[1] = pEnc->mbParam.edged_width/2;
788                            data.original.stride[2] = pEnc->mbParam.edged_width/2;
789                    }
790    
791                          FrameCodeP(pEnc, &bs, &bits, 1, 0);                  if ((frame->vol_flags & XVID_VOL_EXTRASTATS) ||
792                            (pEnc->mbParam.plugin_flags & XVID_REQPSNR)) {
793    
794                          BitstreamPad(&bs);                          data.sse_y =
795                          pFrame->length = BitstreamLength(&bs);                                  plane_sse( original->y, frame->image.y,
796                          pFrame->intra = 0;                                                     pEnc->mbParam.edged_width, pEnc->mbParam.width,
797                                                       pEnc->mbParam.height);
798    
799                          return XVID_ERR_OK;                          data.sse_u =
800                                    plane_sse( original->u, frame->image.u,
801                                                       pEnc->mbParam.edged_width/2, pEnc->mbParam.width/2,
802                                                       pEnc->mbParam.height/2);
803    
804                            data.sse_v =
805                                    plane_sse( original->v, frame->image.v,
806                                                       pEnc->mbParam.edged_width/2, pEnc->mbParam.width/2,
807                                                       pEnc->mbParam.height/2);
808                    }
809    
810                    data.type = coding2type(frame->coding_type);
811                    data.quant = frame->quant;
812    
813                    if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
814                            data.dquant = pEnc->temp_dquants;
815                            data.dquant_stride = pEnc->mbParam.mb_width;
816    
817                            for (j=0; j<pEnc->mbParam.mb_height; j++)
818                            for (i=0; i<pEnc->mbParam.mb_width; i++) {
819                                    data.dquant[j*data.dquant_stride + i] = frame->mbs[j*pEnc->mbParam.mb_width + i].dquant;
820                            }
821                  }                  }
822    
823                    data.vol_flags = frame->vol_flags;
824                    data.vop_flags = frame->vop_flags;
825                    data.motion_flags = frame->motion_flags;
826    
827                    data.length = frame->length;
828                    data.kblks = frame->sStat.kblks;
829                    data.mblks = frame->sStat.mblks;
830                    data.ublks = frame->sStat.ublks;
831    
832                    /* New code */
833                    data.stats.type      = coding2type(frame->coding_type);
834                    data.stats.quant     = frame->quant;
835                    data.stats.vol_flags = frame->vol_flags;
836                    data.stats.vop_flags = frame->vop_flags;
837                    data.stats.length    = frame->length;
838                    data.stats.hlength   = frame->length - (frame->sStat.iTextBits / 8);
839                    data.stats.kblks     = frame->sStat.kblks;
840                    data.stats.mblks     = frame->sStat.mblks;
841                    data.stats.ublks     = frame->sStat.ublks;
842                    data.stats.sse_y     = data.sse_y;
843                    data.stats.sse_u     = data.sse_u;
844                    data.stats.sse_v     = data.sse_v;
845    
846                  DPRINTF(DPRINTF_DEBUG,"*** BFRAME (flush) bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",                  if (stats)
847                                  pEnc->bframenum_head, pEnc->bframenum_tail,                          *stats = data.stats;
848                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);          }
   
                 FrameCodeB(pEnc, pEnc->bframes[pEnc->bframenum_head], &bs, &bits);  
                 pEnc->bframenum_head++;  
849    
850                  BitstreamPad(&bs);          /* call plugins */
851                  pFrame->length = BitstreamLength(&bs);          for (i=0; i<(unsigned int)pEnc->num_plugins;i++) {
852                  pFrame->intra = 0;                  emms();
853                    if (pEnc->plugins[i].func) {
854                            if (pEnc->plugins[i].func(pEnc->plugins[i].param, opt, &data, NULL) < 0) {
855                                    continue;
856                            }
857                    }
858            }
859            emms();
860    
861                  if (input_valid)          /* copy modified values back into frame*/
862                          queue_image(pEnc, pFrame);          if (opt == XVID_PLG_BEFORE) {
863                    *type = data.type;
864                    *quant = data.quant > 0 ? data.quant : 2;   /* default */
865    
866                    frame->vol_flags = data.vol_flags;
867                    frame->vop_flags = data.vop_flags;
868                    frame->motion_flags = data.motion_flags;
869    
870            } else if (opt == XVID_PLG_FRAME) {
871    
872                    if ((pEnc->mbParam.plugin_flags & XVID_REQDQUANTS)) {
873                            for (j=0; j<pEnc->mbParam.mb_height; j++)
874                            for (i=0; i<pEnc->mbParam.mb_width; i++) {
875                                    frame->mbs[j*pEnc->mbParam.mb_width + i].dquant = data.dquant[j*data.mb_width + i];
876                            }
877                    } else {
878                            for (j=0; j<pEnc->mbParam.mb_height; j++)
879                            for (i=0; i<pEnc->mbParam.mb_width; i++) {
880                                    frame->mbs[j*pEnc->mbParam.mb_width + i].dquant = 0;
881                            }
882                    }
883    
884                  return XVID_ERR_OK;                  if (pEnc->mbParam.plugin_flags & XVID_REQLAMBDA) {
885                            for (j = 0; j < pEnc->mbParam.mb_height; j++)
886                                    for (i = 0; i < pEnc->mbParam.mb_width; i++)
887                                            for (k = 0; k < 6; k++) {
888                                                    frame->mbs[j*pEnc->mbParam.mb_width + i].lambda[k] =
889                                                            (int) ((float)(1<<LAMBDA_EXP) * data.lambda[6 * (j * data.mb_width + i) + k]);
890                            }
891                    } else {
892                            for (j = 0; j<pEnc->mbParam.mb_height; j++)
893                                    for (i = 0; i<pEnc->mbParam.mb_width; i++)
894                                            for (k = 0; k < 6; k++) {
895                                                    frame->mbs[j*pEnc->mbParam.mb_width + i].lambda[k] = 1<<LAMBDA_EXP;
896                            }
897          }          }
898    
         if (pEnc->bframenum_head > 0) {  
                 pEnc->bframenum_head = pEnc->bframenum_tail = 0;  
899    
900                  if ((pEnc->global & XVID_GLOBAL_PACKED)) {                  frame->mbs[0].quant = data.quant; /* FRAME will not affect the quant in stats */
901            }
902    
                         DPRINTF(DPRINTF_DEBUG,"*** EMPTY 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);  
903    
904                          BitstreamWriteVopHeader(&bs, &pEnc->mbParam, pEnc->current, 0);  }
                         BitstreamPad(&bs);  
                         BitstreamPutBits(&bs, 0x7f, 8);  
905    
                         pFrame->length = BitstreamLength(&bs);  
                         pFrame->intra = 0;  
906    
907                          if (input_valid)  static __inline void inc_frame_num(Encoder * pEnc)
908                                  queue_image(pEnc, pFrame);  {
909            pEnc->current->frame_num = pEnc->m_framenum;
910            pEnc->current->stamp = pEnc->mbParam.m_stamp;   /* first frame is zero */
911    
912                          return XVID_ERR_OK;          pEnc->mbParam.m_stamp += pEnc->current->fincr;
913            pEnc->m_framenum++;     /* debug ticker */
914                  }                  }
         }  
   
915    
916  bvop_loop:  static __inline void dec_frame_num(Encoder * pEnc)
   
         if (pEnc->bframenum_dx50bvop != -1)  
917          {          {
918            pEnc->mbParam.m_stamp -= pEnc->mbParam.fincr;
919                  SWAP(pEnc->current, pEnc->reference);          pEnc->m_framenum--;     /* debug ticker */
                 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 IVOP");  
920                  }                  }
921    
922                  if (input_valid)  static __inline void
923    MBSetDquant(MACROBLOCK * pMB, int x, int y, MBParam * mbParam)
924                  {                  {
925                          queue_image(pEnc, pFrame);          if (pMB->cbp == 0) {
926                          input_valid = 0;                  /* we want to code dquant but the quantizer value will not be used yet
927                            let's find out if we can postpone dquant to next MB
928                    */
929                    if (x == mbParam->mb_width-1 && y == mbParam->mb_height-1) {
930                            pMB->dquant = 0; /* it's the last MB of all, the easiest case */
931                            return;
932                    } else {
933                            MACROBLOCK * next = pMB + 1;
934                            const MACROBLOCK * prev = pMB - 1;
935                            if (next->mode != MODE_INTER4V && next->mode != MODE_NOT_CODED)
936                                    /* mode allows dquant change in the future */
937                                    if (abs(next->quant - prev->quant) <= 2) {
938                                            /* quant change is not out of range */
939                                            pMB->quant = prev->quant;
940                                            pMB->dquant = 0;
941                                            next->dquant = next->quant - prev->quant;
942                                            return;
943                  }                  }
   
         } else if (input_valid) {  
   
                 SWAP(pEnc->current, pEnc->reference);  
   
                 start_timer();  
                 if (image_input  
                         (&pEnc->current->image, pEnc->mbParam.width, pEnc->mbParam.height,  
                         pEnc->mbParam.edged_width, pFrame->image, pFrame->colorspace))  
                         return XVID_ERR_FORMAT;  
                 stop_conv_timer();  
   
                 // queue input frame, and dequue next image  
                 if (pEnc->queue_size > 0)  
                 {  
                         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]);  
944                          }                          }
945                          pEnc->queue_head =  (pEnc->queue_head + 1) % pEnc->mbParam.max_bframes;          }
946                          pEnc->queue_tail =  (pEnc->queue_tail + 1) % pEnc->mbParam.max_bframes;          /* couldn't skip this dquant */
947            pMB->mode = MODE_INTER_Q;
948                  }                  }
949    
         } else if (pEnc->queue_size > 0) {  
950    
                 SWAP(pEnc->current, pEnc->reference);  
951    
952                  image_swap(&pEnc->current->image, &pEnc->queue[pEnc->queue_head]);  static __inline void
953                  pEnc->queue_head =  (pEnc->queue_head + 1) % pEnc->mbParam.max_bframes;  set_timecodes(FRAMEINFO* pCur,FRAMEINFO *pRef, int32_t time_base)
954                  pEnc->queue_size--;  {
955    
956          } else if (BitstreamPos(&bs) == 0) {          pCur->ticks = (int32_t)pCur->stamp % time_base;
957            pCur->seconds =  ((int32_t)pCur->stamp / time_base)     - ((int32_t)pRef->stamp / time_base) ;
958    
959                  DPRINTF(DPRINTF_DEBUG,"*** SKIP bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",  #if 0   /* HEAVY DEBUG OUTPUT */
960                                  pEnc->bframenum_head, pEnc->bframenum_tail,          fprintf(stderr,"WriteVop:   %d - %d \n",
961                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);                          ((int32_t)pCur->stamp / time_base), ((int32_t)pRef->stamp / time_base));
962            fprintf(stderr,"set_timecodes: VOP %1d   stamp=%lld ref_stamp=%lld  base=%d\n",
963                            pCur->coding_type, pCur->stamp, pRef->stamp, time_base);
964            fprintf(stderr,"set_timecodes: VOP %1d   seconds=%d   ticks=%d   (ref-sec=%d  ref-tick=%d)\n",
965                            pCur->coding_type, pCur->seconds, pCur->ticks, pRef->seconds, pRef->ticks);
966    #endif
967    }
968    
969                  pFrame->intra = 0;  static void
970    simplify_par(int *par_width, int *par_height)
971    {
972    
973                  BitstreamPutBits(&bs, 0x7f, 8);          int _par_width  = (!*par_width)  ? 1 : (*par_width<0)  ? -*par_width:  *par_width;
974                  BitstreamPad(&bs);          int _par_height = (!*par_height) ? 1 : (*par_height<0) ? -*par_height: *par_height;
975                  pFrame->length = BitstreamLength(&bs);          int divisor = gcd(_par_width, _par_height);
976    
977                  return XVID_ERR_OK;          _par_width  /= divisor;
978            _par_height /= divisor;
979    
980          } else {          /* 2^8 precision maximum */
981            if (_par_width>255 || _par_height>255) {
982                    float div;
983                    emms();
984                    if (_par_width>_par_height)
985                            div = (float)_par_width/255;
986                    else
987                            div = (float)_par_height/255;
988    
989                  pFrame->length = BitstreamLength(&bs);                  _par_width  = (int)((float)_par_width/div);
990                  return XVID_ERR_OK;                  _par_height = (int)((float)_par_height/div);
991          }          }
992    
993          pEnc->flush_bframes = 0;          *par_width = _par_width;
994            *par_height = _par_height;
         /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%  
          * Well there was a separation here so i put it in ANSI C  
          * comment style :-)  
          * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */  
995    
996          emms();          return;
997    }
         // only inc frame num, adapt quant, etc. if we havent seen it before  
         if (pEnc->bframenum_dx50bvop < 0 )  
         {  
                 if (pFrame->quant == 0)  
                         pEnc->current->quant = RateControlGetQ(&pEnc->rate_control, 0);  
                 else  
                         pEnc->current->quant = pFrame->quant;  
998    
                 if (pEnc->current->quant < 1)  
                         pEnc->current->quant = 1;  
999    
1000                  if (pEnc->current->quant > 31)  /*****************************************************************************
1001                          pEnc->current->quant = 31;   * IPB frame encoder entry point
1002     *
1003     * Returned values :
1004     *      - >0                       - output bytes
1005     *      - 0                             - no output
1006     *      - XVID_ERR_VERSION - wrong version passed to core
1007     *      - XVID_ERR_END   - End of stream reached before end of coding
1008     *      - XVID_ERR_FORMAT  - the image subsystem reported the image had a wrong
1009     *                                               format
1010     ****************************************************************************/
1011    
                 pEnc->current->global_flags = pFrame->general;  
                 pEnc->current->motion_flags = pFrame->motion;  
1012    
1013                  /* ToDo : dynamic fcode (in both directions) */  int
1014                  pEnc->current->fcode = pEnc->mbParam.m_fcode;  enc_encode(Encoder * pEnc,
1015                  pEnc->current->bcode = pEnc->mbParam.m_fcode;                             xvid_enc_frame_t * xFrame,
1016                               xvid_enc_stats_t * stats)
1017    {
1018            xvid_enc_frame_t * frame;
1019            int type;
1020            Bitstream bs;
1021    
1022                  pEnc->current->seconds = pEnc->mbParam.m_seconds;          if (XVID_VERSION_MAJOR(xFrame->version) != 1 || (stats && XVID_VERSION_MAJOR(stats->version) != 1))     /* v1.x.x */
1023                  pEnc->current->ticks = pEnc->mbParam.m_ticks;                  return XVID_ERR_VERSION;
1024    
1025                  inc_frame_num(pEnc);          xFrame->out_flags = 0;
1026    
1027  #ifdef _DEBUG_PSNR          start_global_timer();
1028                  image_copy(&pEnc->sOriginal, &pEnc->current->image,          BitstreamInit(&bs, xFrame->bitstream, 0);
                            pEnc->mbParam.edged_width, pEnc->mbParam.height);  
 #endif  
   
                 emms();  
1029    
                 if ((pEnc->global & XVID_GLOBAL_DEBUG)) {  
                         image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 5,  
                                 "%i  if:%i  st:%i:%i", pEnc->m_framenum++, pEnc->iFrameNum, pEnc->current->seconds, pEnc->current->ticks);  
                 }  
1030    
1031          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1032           * Luminance masking           * enqueue image to the encoding-queue
1033           * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */           * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1034    
1035                  if ((pEnc->current->global_flags & XVID_LUMIMASKING)) {          if (xFrame->input.csp != XVID_CSP_NULL)
1036                          int *temp_dquants =          {
1037                                  (int *) xvid_malloc(pEnc->mbParam.mb_width *                  QUEUEINFO * q = &pEnc->queue[pEnc->queue_tail];
                                                                 pEnc->mbParam.mb_height * sizeof(int),  
                                                                 CACHE_LINE);  
   
                         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);  
1038    
1039                          for (y = 0; y < pEnc->mbParam.mb_height; y++) {                  start_timer();
1040                    if (image_input
1041                            (&q->image, pEnc->mbParam.width, pEnc->mbParam.height,
1042                            pEnc->mbParam.edged_width, (uint8_t**)xFrame->input.plane, xFrame->input.stride,
1043                            xFrame->input.csp, xFrame->vol_flags & XVID_VOL_INTERLACING))
1044                    {
1045                            emms();
1046                            return XVID_ERR_FORMAT;
1047                    }
1048                    stop_conv_timer();
1049    
1050  #define OFFSET(x,y) ((x) + (y)*pEnc->mbParam.mb_width)                  if ((xFrame->vop_flags & XVID_VOP_CHROMAOPT)) {
1051                            image_chroma_optimize(&q->image,
1052                                    pEnc->mbParam.width, pEnc->mbParam.height, pEnc->mbParam.edged_width);
1053                    }
1054    
1055                                  for (x = 0; x < pEnc->mbParam.mb_width; x++) {                  q->frame = *xFrame;
                                         MACROBLOCK *pMB = &pEnc->current->mbs[OFFSET(x, y)];  
1056    
1057                                          pMB->dquant = iDQtab[temp_dquants[OFFSET(x, y)] + 2];                  if (xFrame->quant_intra_matrix)
1058                    {
1059                            memcpy(q->quant_intra_matrix, xFrame->quant_intra_matrix, 64*sizeof(unsigned char));
1060                            q->frame.quant_intra_matrix = q->quant_intra_matrix;
1061                                  }                                  }
1062    
1063  #undef OFFSET                  if (xFrame->quant_inter_matrix)
1064                    {
1065                            memcpy(q->quant_inter_matrix, xFrame->quant_inter_matrix, 64*sizeof(unsigned char));
1066                            q->frame.quant_inter_matrix = q->quant_inter_matrix;
1067                          }                          }
1068    
1069                          xvid_free(temp_dquants);                  pEnc->queue_tail = (pEnc->queue_tail + 1) % (pEnc->mbParam.max_bframes+1);
1070                    pEnc->queue_size++;
1071                  }                  }
1072    
         }  
1073    
1074          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1075           * ivop/pvop/bvop selection           * bframe flush code
1076           * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */           * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1077    
1078    repeat:
1079    
1080          if (pEnc->iFrameNum == 0 || pFrame->intra == 1 || pEnc->bframenum_dx50bvop >= 0 ||          if (pEnc->flush_bframes)
1081                  (pFrame->intra < 0 && pEnc->iMaxKeyInterval > 0 &&          {
1082                   pEnc->iFrameNum >= pEnc->iMaxKeyInterval)                  if (pEnc->bframenum_head < pEnc->bframenum_tail) {
                 || 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  
                  */  
1083    
1084                  DPRINTF(DPRINTF_DEBUG,"*** IFRAME bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",                          DPRINTF(XVID_DEBUG_DEBUG,"*** BFRAME (flush) bf: head=%i tail=%i   queue: head=%i tail=%i size=%i\n",
1085                                  pEnc->bframenum_head, pEnc->bframenum_tail,                                  pEnc->bframenum_head, pEnc->bframenum_tail,
1086                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);
1087    
1088                  if ((pEnc->global & XVID_GLOBAL_DEBUG)) {                          if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
1089                          image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "IVOP");                                  image_copy(&pEnc->sOriginal2, &pEnc->bframes[pEnc->bframenum_head]->image,
1090                                                       pEnc->mbParam.edged_width, pEnc->mbParam.height);
1091                  }                  }
1092    
1093                  // when we reach an iframe in DX50BVOP mode, encode the last bframe as a pframe                          FrameCodeB(pEnc, pEnc->bframes[pEnc->bframenum_head], &bs);
1094                            call_plugins(pEnc, pEnc->bframes[pEnc->bframenum_head], &pEnc->sOriginal2, XVID_PLG_AFTER, NULL, NULL, stats);
1095                  if ((pEnc->global & XVID_GLOBAL_DX50BVOP) && pEnc->bframenum_tail > 0) {                          pEnc->bframenum_head++;
   
                         pEnc->bframenum_tail--;  
                         pEnc->bframenum_dx50bvop = pEnc->bframenum_tail;  
1096    
1097                          SWAP(pEnc->current, pEnc->bframes[pEnc->bframenum_dx50bvop]);                          goto done;
                         if ((pEnc->global & XVID_GLOBAL_DEBUG)) {  
                                 image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 100, "DX50 BVOP->PVOP");  
1098                          }                          }
                         FrameCodeP(pEnc, &bs, &bits, 1, 0);  
1099    
1100                          pFrame->intra = 0;                  /* write an empty marker to the bitstream.
1101    
1102                  } else {                     for divx5 decoder compatibility, this marker must consist
1103                       of a not-coded p-vop, with a time_base of zero, and time_increment
1104                       indentical to the future-referece frame.
1105                    */
1106    
1107                          FrameCodeI(pEnc, &bs, &bits);                  if ((pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED && pEnc->bframenum_tail > 0)) {
1108                          pFrame->intra = 1;                          int tmp;
1109                            int bits;
1110    
1111                          pEnc->bframenum_dx50bvop = -1;                          DPRINTF(XVID_DEBUG_DEBUG,"*** EMPTY bf: head=%i tail=%i   queue: head=%i tail=%i size=%i\n",
1112                  }                                  pEnc->bframenum_head, pEnc->bframenum_tail,
1113                                    pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);
1114    
1115                  pEnc->flush_bframes = 1;                          bits = BitstreamPos(&bs);
1116    
1117                            tmp = pEnc->current->seconds;
1118                            pEnc->current->seconds = 0; /* force time_base = 0 */
1119    
1120                  if ((pEnc->global & XVID_GLOBAL_PACKED) && pEnc->bframenum_tail > 0) {                          BitstreamWriteVopHeader(&bs, &pEnc->mbParam, pEnc->current, 0, pEnc->current->quant);
1121                          BitstreamPad(&bs);                          BitstreamPad(&bs);
1122                          input_valid = 0;                          pEnc->current->seconds = tmp;
                         goto ipvop_loop;  
                 }  
1123    
1124                  /*                          /* add the not-coded length to the reference frame size */
1125                   * NB : sequences like "IIBB" decode fine with msfdam but,                          pEnc->current->length += (BitstreamPos(&bs) - bits) / 8;
1126                   *      go screwy with divx 5.00                          call_plugins(pEnc, pEnc->current, &pEnc->sOriginal, XVID_PLG_AFTER, NULL, NULL, stats);
                  */  
         } else if (pEnc->bframenum_tail >= pEnc->mbParam.max_bframes) {  
                 /*  
                  * This will be coded as a Predicted Frame  
                  */  
1127    
1128                  DPRINTF(DPRINTF_DEBUG,"*** PFRAME bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",                          /* flush complete: reset counters */
1129                                  pEnc->bframenum_head, pEnc->bframenum_tail,                          pEnc->flush_bframes = 0;
1130                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);                          pEnc->bframenum_head = pEnc->bframenum_tail = 0;
1131                            goto done;
1132    
                 if ((pEnc->global & XVID_GLOBAL_DEBUG)) {  
                         image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "PVOP");  
1133                  }                  }
1134    
1135                  FrameCodeP(pEnc, &bs, &bits, 1, 0);                  /* flush complete: reset counters */
1136                  pFrame->intra = 0;                  pEnc->flush_bframes = 0;
1137                  pEnc->flush_bframes = 1;                  pEnc->bframenum_head = pEnc->bframenum_tail = 0;
   
                 if ((pEnc->global & XVID_GLOBAL_PACKED)) {  
                         BitstreamPad(&bs);  
                         input_valid = 0;  
                         goto ipvop_loop;  
1138                  }                  }
1139    
1140          } else {          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1141                  /*           * dequeue frame from the encoding queue
1142                   * This will be coded as a Bidirectional Frame           * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1143                   */  
1144            if (pEnc->queue_size == 0)              /* empty */
1145            {
1146                    if (xFrame->input.csp == XVID_CSP_NULL) /* no futher input */
1147                    {
1148    
1149                  DPRINTF(DPRINTF_DEBUG,"*** BFRAME (store) bf: head=%i tail=%i   queue: head=%i tail=%i size=%i",                          DPRINTF(XVID_DEBUG_DEBUG,"*** FINISH bf: head=%i tail=%i   queue: head=%i tail=%i size=%i\n",
1150                                  pEnc->bframenum_head, pEnc->bframenum_tail,                                  pEnc->bframenum_head, pEnc->bframenum_tail,
1151                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);
1152    
1153                  if ((pEnc->global & XVID_GLOBAL_DEBUG)) {                          if (!(pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) && pEnc->mbParam.max_bframes > 0) {
1154                          image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "BVOP");                                  call_plugins(pEnc, pEnc->current, &pEnc->sOriginal, XVID_PLG_AFTER, NULL, NULL, stats);
1155                  }                  }
1156    
1157                  if (pFrame->bquant < 1) {                          /* if the very last frame is to be b-vop, we must change it to a p-vop */
1158                          pEnc->current->quant =                          if (pEnc->bframenum_tail > 0) {
                                 ((pEnc->reference->quant +  
                                   pEnc->current->quant) * pEnc->bquant_ratio) / 200;  
                 } else {  
                         pEnc->current->quant = pFrame->bquant;  
                 }  
1159    
1160                  /* store frame into bframe buffer & swap ref back to current */                                  SWAP(FRAMEINFO*, pEnc->current, pEnc->reference);
1161                  SWAP(pEnc->current, pEnc->bframes[pEnc->bframenum_tail]);                                  pEnc->bframenum_tail--;
1162                  SWAP(pEnc->current, pEnc->reference);                                  SWAP(FRAMEINFO*, pEnc->current, pEnc->bframes[pEnc->bframenum_tail]);
   
                 pEnc->bframenum_tail++;  
1163    
1164                  pFrame->intra = 0;                                  /* convert B-VOP to P-VOP */
1165                  pFrame->length = 0;                                  pEnc->current->quant  = 100*pEnc->current->quant - pEnc->mbParam.bquant_offset;
1166                                    pEnc->current->quant += pEnc->mbParam.bquant_ratio - 1; /* to avoid rouding issues */
1167                                    pEnc->current->quant /= pEnc->mbParam.bquant_ratio;
1168    
1169                  input_valid = 0;                                  if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
1170                  goto bvop_loop;                                          image_copy(&pEnc->sOriginal, &pEnc->current->image,
1171                                                       pEnc->mbParam.edged_width, pEnc->mbParam.height);
1172          }          }
1173    
1174          BitstreamPad(&bs);                                  DPRINTF(XVID_DEBUG_DEBUG,"*** PFRAME bf: head=%i tail=%i   queue: head=%i tail=%i size=%i\n",
1175          pFrame->length = BitstreamLength(&bs);                                  pEnc->bframenum_head, pEnc->bframenum_tail,
1176                                    pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);
1177                                    pEnc->mbParam.frame_drop_ratio = -1; /* it must be a coded vop */
1178    
1179                                    FrameCodeP(pEnc, &bs);
1180    
1181    
1182          if (pResult) {                                  if ((pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) && pEnc->bframenum_tail==0) {
1183                  pResult->quant = pEnc->current->quant;                                          call_plugins(pEnc, pEnc->current, &pEnc->sOriginal, XVID_PLG_AFTER, NULL, NULL, stats);
1184                  pResult->hlength = pFrame->length - (pEnc->sStat.iTextBits / 8);                                  }else{
1185                  pResult->kblks = pEnc->sStat.kblks;                                          pEnc->flush_bframes = 1;
1186                  pResult->mblks = pEnc->sStat.mblks;                                          goto done;
                 pResult->ublks = pEnc->sStat.ublks;  
1187          }          }
1188                            }
1189                            DPRINTF(XVID_DEBUG_DEBUG, "*** END\n");
1190    
1191          emms();          emms();
1192                            return XVID_ERR_END;    /* end of stream reached */
1193                    }
1194                    goto done;      /* nothing to encode yet; encoder lag */
1195            }
1196    
1197  #ifdef _DEBUG_PSNR          /* the current FRAME becomes the reference */
1198          psnr =          SWAP(FRAMEINFO*, pEnc->current, pEnc->reference);
                 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  
1199    
1200          if (pFrame->quant == 0) {          /* remove frame from encoding-queue (head), and move it into the current */
1201                  RateControlUpdate(&pEnc->rate_control, pEnc->current->quant,          image_swap(&pEnc->current->image, &pEnc->queue[pEnc->queue_head].image);
1202                                                    pFrame->length, pFrame->intra);          frame = &pEnc->queue[pEnc->queue_head].frame;
1203          }          pEnc->queue_head = (pEnc->queue_head + 1) % (pEnc->mbParam.max_bframes+1);
1204            pEnc->queue_size--;
1205    
1206    
1207          stop_global_timer();          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1208          write_timer();           * init pEnc->current fields
1209             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1210    
1211          return XVID_ERR_OK;          pEnc->current->fincr = pEnc->mbParam.fincr>0 ? pEnc->mbParam.fincr : frame->fincr;
1212  }          inc_frame_num(pEnc);
1213            pEnc->current->vol_flags = frame->vol_flags;
1214            pEnc->current->vop_flags = frame->vop_flags;
1215            pEnc->current->motion_flags = frame->motion;
1216            pEnc->current->fcode = pEnc->mbParam.m_fcode;
1217            pEnc->current->bcode = pEnc->mbParam.m_fcode;
1218    
 #endif  
1219    
1220            if ((xFrame->vop_flags & XVID_VOP_CHROMAOPT)) {
1221                    image_chroma_optimize(&pEnc->current->image,
1222                            pEnc->mbParam.width, pEnc->mbParam.height, pEnc->mbParam.edged_width);
1223            }
1224    
1225            /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1226             * frame type & quant selection
1227             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1228    
1229  /*****************************************************************************          type = frame->type;
1230   * "original" IP frame encoder entry point          pEnc->current->quant = frame->quant;
  *  
  * Returned values :  
  *    - XVID_ERR_OK     - no errors  
  *    - XVID_ERR_FORMAT - the image subsystem reported the image had a wrong  
  *                        format  
  ****************************************************************************/  
1231    
1232  int          call_plugins(pEnc, pEnc->current, NULL, XVID_PLG_BEFORE, &type, (int*)&pEnc->current->quant, stats);
 encoder_encode(Encoder * pEnc,  
                            XVID_ENC_FRAME * pFrame,  
                            XVID_ENC_STATS * pResult)  
 {  
         uint16_t x, y;  
         Bitstream bs;  
         uint32_t bits;  
         uint16_t write_vol_header = 0;  
1233    
1234  #ifdef _DEBUG_PSNR          if (type > 0){  /* XVID_TYPE_?VOP */
1235          float psnr;                  type = type2coding(type);       /* convert XVID_TYPE_?VOP to bitstream coding type */
1236          uint8_t temp[128];          } else{         /* XVID_TYPE_AUTO */
1237  #endif                  if (pEnc->iFrameNum == 0 || (pEnc->mbParam.iMaxKeyInterval > 0 && pEnc->iFrameNum >= pEnc->mbParam.iMaxKeyInterval)){
1238                            pEnc->iFrameNum = 0;
1239                            type = I_VOP;
1240                    }else{
1241                            type = MEanalysis(&pEnc->reference->image, pEnc->current,
1242                                                              &pEnc->mbParam, pEnc->mbParam.iMaxKeyInterval,
1243                                                              pEnc->iFrameNum, pEnc->bframenum_tail, xFrame->bframe_threshold,
1244                                                              (pEnc->bframes) ? pEnc->bframes[pEnc->bframenum_head]->mbs: NULL);
1245                    }
1246            }
1247    
1248          start_global_timer();          if (type != I_VOP)
1249                    pEnc->current->vol_flags = pEnc->mbParam.vol_flags; /* don't allow VOL changes here */
1250    
1251          ENC_CHECK(pEnc);          /* bframes buffer overflow check */
1252          ENC_CHECK(pFrame);          if (type == B_VOP && pEnc->bframenum_tail >= pEnc->mbParam.max_bframes) {
1253          ENC_CHECK(pFrame->bitstream);                  type = P_VOP;
1254          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;  
1255    
1256          start_timer();          pEnc->iFrameNum++;
         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();  
1257    
1258  #ifdef _DEBUG_PSNR          if ((pEnc->current->vop_flags & XVID_VOP_DEBUG)) {
1259          image_copy(&pEnc->sOriginal, &pEnc->current->image,                  image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 5,
1260                             pEnc->mbParam.edged_width, pEnc->mbParam.height);                          "%d  st:%lld  if:%d", pEnc->current->frame_num, pEnc->current->stamp, pEnc->iFrameNum);
1261  #endif          }
1262    
1263          emms();          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1264             * encode this frame as a b-vop
1265             * (we dont encode here, rather we store the frame in the bframes queue, to be encoded later)
1266             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1267            if (type == B_VOP) {
1268                    if ((pEnc->current->vop_flags & XVID_VOP_DEBUG)) {
1269                            image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "BVOP");
1270                    }
1271    
1272          BitstreamInit(&bs, pFrame->bitstream, 0);                  if (frame->quant < 1) {
1273                            pEnc->current->quant = ((((pEnc->reference->quant + pEnc->current->quant) *
1274                                    pEnc->mbParam.bquant_ratio) / 2) + pEnc->mbParam.bquant_offset)/100;
1275    
         if (pFrame->quant == 0) {  
                 pEnc->current->quant = RateControlGetQ(&pEnc->rate_control, 0);  
1276          } else {          } else {
1277                  pEnc->current->quant = pFrame->quant;                          pEnc->current->quant = frame->quant;
1278          }          }
1279    
1280          if ((pEnc->current->global_flags & XVID_LUMIMASKING)) {                  if (pEnc->current->quant < 1)
1281                  int *temp_dquants =                          pEnc->current->quant = 1;
1282                          (int *) xvid_malloc(pEnc->mbParam.mb_width *                  else if (pEnc->current->quant > 31)
1283                                                                  pEnc->mbParam.mb_height * sizeof(int),                          pEnc->current->quant = 31;
                                                                 CACHE_LINE);  
1284    
1285                  pEnc->current->quant =                  DPRINTF(XVID_DEBUG_DEBUG,"*** BFRAME (store) bf: head=%i tail=%i   queue: head=%i tail=%i size=%i  quant=%i\n",
1286                          adaptive_quantization(pEnc->current->image.y,                                  pEnc->bframenum_head, pEnc->bframenum_tail,
1287                                                                    pEnc->mbParam.edged_width, temp_dquants,                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size,pEnc->current->quant);
                                                                   pEnc->current->quant, pEnc->current->quant,  
                                                                   2 * pEnc->current->quant,  
                                                                   pEnc->mbParam.mb_width,  
                                                                   pEnc->mbParam.mb_height);  
1288    
1289                  for (y = 0; y < pEnc->mbParam.mb_height; y++) {                  /* store frame into bframe buffer & swap ref back to current */
1290                    SWAP(FRAMEINFO*, pEnc->current, pEnc->bframes[pEnc->bframenum_tail]);
1291                    SWAP(FRAMEINFO*, pEnc->current, pEnc->reference);
1292    
1293  #define OFFSET(x,y) ((x) + (y)*pEnc->mbParam.mb_width)                  pEnc->bframenum_tail++;
1294    
1295                          for (x = 0; x < pEnc->mbParam.mb_width; x++) {                  goto repeat;
1296            }
1297    
1298    
1299                                  MACROBLOCK *pMB = &pEnc->current->mbs[OFFSET(x, y)];                  DPRINTF(XVID_DEBUG_DEBUG,"*** XXXXXX bf: head=%i tail=%i   queue: head=%i tail=%i size=%i\n",
1300                                    pEnc->bframenum_head, pEnc->bframenum_tail,
1301                                    pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);
1302    
1303                                  pMB->dquant = iDQtab[temp_dquants[OFFSET(x, y)] + 2];          /* for unpacked bframes, output the stats for the last encoded frame */
1304            if (!(pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) && pEnc->mbParam.max_bframes > 0)
1305            {
1306                    if (pEnc->current->stamp > 0) {
1307                            call_plugins(pEnc, pEnc->reference, &pEnc->sOriginal, XVID_PLG_AFTER, NULL, NULL, stats);
1308                          }                          }
1309                    else
1310  #undef OFFSET                          stats->type = XVID_TYPE_NOTHING;
1311                  }                  }
1312    
1313                  xvid_free(temp_dquants);          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1314          }           * closed-gop
1315             * if the frame prior to an iframe is scheduled as a bframe, we must change it to a pframe
1316             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1317    
1318          if (pEnc->current->global_flags & XVID_H263QUANT) {          if (type == I_VOP && (pEnc->mbParam.global_flags & XVID_GLOBAL_CLOSED_GOP) && pEnc->bframenum_tail > 0) {
                 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;  
1319    
1320                  matrix1_changed = matrix2_changed = 0;                  /* place this frame back on the encoding-queue (head) */
1321                    /* we will deal with it next time */
1322                    dec_frame_num(pEnc);
1323                    pEnc->iFrameNum--;
1324    
1325                  if (pEnc->mbParam.m_quant_type != MPEG4_QUANT)                  pEnc->queue_head = (pEnc->queue_head + (pEnc->mbParam.max_bframes+1) - 1) % (pEnc->mbParam.max_bframes+1);
1326                          write_vol_header = 1;                  pEnc->queue_size++;
1327                    image_swap(&pEnc->current->image, &pEnc->queue[pEnc->queue_head].image);
1328    
1329                  pEnc->mbParam.m_quant_type = MPEG4_QUANT;                  /* grab the last frame from the bframe-queue */
1330    
1331                  if ((pEnc->current->global_flags & XVID_CUSTOM_QMATRIX) > 0) {                  pEnc->bframenum_tail--;
1332                          if (pFrame->quant_intra_matrix != NULL)                  SWAP(FRAMEINFO*, pEnc->current, pEnc->bframes[pEnc->bframenum_tail]);
                                 matrix1_changed = set_intra_matrix(pFrame->quant_intra_matrix);  
                         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;  
         }  
1333    
1334          if (pFrame->intra < 0) {                  if ((pEnc->current->vop_flags & XVID_VOP_DEBUG)) {
1335                  if ((pEnc->iFrameNum == 0)                          image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 100, "CLOSED GOP BVOP->PVOP");
                         || ((pEnc->iMaxKeyInterval > 0)  
                                 && (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);  
1336                  }                  }
1337    
1338                    /* convert B-VOP quant to P-VOP */
1339                    pEnc->current->quant  = 100*pEnc->current->quant - pEnc->mbParam.bquant_offset;
1340                    pEnc->current->quant += pEnc->mbParam.bquant_ratio - 1; /* to avoid rouding issues */
1341                    pEnc->current->quant /= pEnc->mbParam.bquant_ratio;
1342                    type = P_VOP;
1343          }          }
1344    
         BitstreamPutBits(&bs, 0xFFFF, 16);  
         BitstreamPutBits(&bs, 0xFFFF, 16);  
         BitstreamPad(&bs);  
         pFrame->length = BitstreamLength(&bs);  
   
         if (pResult) {  
                 pResult->quant = pEnc->current->quant;  
                 pResult->hlength = pFrame->length - (pEnc->sStat.iTextBits / 8);  
                 pResult->kblks = pEnc->sStat.kblks;  
                 pResult->mblks = pEnc->sStat.mblks;  
                 pResult->ublks = pEnc->sStat.ublks;  
         }  
1345    
1346          emms();          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1347             * encode this frame as an i-vop
1348             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1349    
1350          if (pFrame->quant == 0) {          if (type == I_VOP) {
                 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);  
1351    
1352          snprintf(temp, 127, "PSNR: %f\n", psnr);                  DPRINTF(XVID_DEBUG_DEBUG,"*** IFRAME bf: head=%i tail=%i   queue: head=%i tail=%i size=%i\n",
1353          DEBUG(temp);                                  pEnc->bframenum_head, pEnc->bframenum_tail,
1354  #endif                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);
1355    
1356  #ifdef BFRAMES                  if ((pEnc->current->vop_flags & XVID_VOP_DEBUG)) {
1357          inc_frame_num(pEnc);                          image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "IVOP");
1358  #else                  }
         pEnc->iFrameNum++;  
 #endif  
1359    
1360                    pEnc->iFrameNum = 1;
1361    
1362          stop_global_timer();                  /* ---- update vol flags at IVOP ----------- */
1363          write_timer();                  pEnc->mbParam.vol_flags = pEnc->current->vol_flags;
1364    
1365          return XVID_ERR_OK;                  /* Aspect ratio */
1366                    switch(frame->par) {
1367                    case XVID_PAR_11_VGA:
1368                    case XVID_PAR_43_PAL:
1369                    case XVID_PAR_43_NTSC:
1370                    case XVID_PAR_169_PAL:
1371                    case XVID_PAR_169_NTSC:
1372                    case XVID_PAR_EXT:
1373                            pEnc->mbParam.par = frame->par;
1374                            break;
1375                    default:
1376                            pEnc->mbParam.par = XVID_PAR_11_VGA;
1377                            break;
1378  }  }
1379    
1380                    /* For extended PAR only, we try to sanityse/simplify par values */
1381                    if (pEnc->mbParam.par == XVID_PAR_EXT) {
1382                            pEnc->mbParam.par_width  = frame->par_width;
1383                            pEnc->mbParam.par_height = frame->par_height;
1384                            simplify_par(&pEnc->mbParam.par_width, &pEnc->mbParam.par_height);
1385                    }
1386    
1387  static __inline void                  if ((pEnc->mbParam.vol_flags & XVID_VOL_MPEGQUANT)) {
1388  CodeIntraMB(Encoder * pEnc,                          if (frame->quant_intra_matrix != NULL)
1389                          MACROBLOCK * pMB)                                  set_intra_matrix(pEnc->mbParam.mpeg_quant_matrices, frame->quant_intra_matrix);
1390  {                          if (frame->quant_inter_matrix != NULL)
1391                                    set_inter_matrix(pEnc->mbParam.mpeg_quant_matrices, frame->quant_inter_matrix);
1392                    }
1393    
1394          pMB->mode = MODE_INTRA;                  /* prevent vol/vop misuse */
1395    
1396          /* zero mv statistics */                  if (!(pEnc->current->vol_flags & XVID_VOL_INTERLACING))
1397          pMB->mvs[0].x = pMB->mvs[1].x = pMB->mvs[2].x = pMB->mvs[3].x = 0;                          pEnc->current->vop_flags &= ~(XVID_VOP_TOPFIELDFIRST|XVID_VOP_ALTERNATESCAN);
         pMB->mvs[0].y = pMB->mvs[1].y = pMB->mvs[2].y = pMB->mvs[3].y = 0;  
         pMB->sad8[0] = pMB->sad8[1] = pMB->sad8[2] = pMB->sad8[3] = 0;  
         pMB->sad16 = 0;  
1398    
1399          if ((pEnc->current->global_flags & XVID_LUMIMASKING)) {                  /* ^^^------------------------ */
                 if (pMB->dquant != NO_CHANGE) {  
                         pMB->mode = MODE_INTRA_Q;  
                         pEnc->current->quant += DQtab[pMB->dquant];  
1400    
1401                          if (pEnc->current->quant > 31)                  if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
1402                                  pEnc->current->quant = 31;                          image_copy(&pEnc->sOriginal, &pEnc->current->image,
1403                          if (pEnc->current->quant < 1)                                     pEnc->mbParam.edged_width, pEnc->mbParam.height);
                                 pEnc->current->quant = 1;  
                 }  
1404          }          }
1405    
1406          pMB->quant = pEnc->current->quant;                  FrameCodeI(pEnc, &bs);
1407  }                  xFrame->out_flags |= XVID_KEYFRAME;
1408    
1409            /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1410             * encode this frame as an p-vop
1411             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1412    
1413  #define FCODEBITS       3          } else { /* (type == P_VOP || type == S_VOP) */
 #define MODEBITS        5  
1414    
1415  void                  DPRINTF(XVID_DEBUG_DEBUG,"*** PFRAME bf: head=%i tail=%i   queue: head=%i tail=%i size=%i\n",
1416  HintedMESet(Encoder * pEnc,                                  pEnc->bframenum_head, pEnc->bframenum_tail,
1417                          int *intra)                                  pEnc->queue_head, pEnc->queue_tail, pEnc->queue_size);
 {  
         HINTINFO *hint;  
         Bitstream bs;  
         int length, high;  
         uint32_t x, y;  
1418    
1419          hint = pEnc->mbParam.hint;                  if ((pEnc->current->vop_flags & XVID_VOP_DEBUG)) {
1420                            image_printf(&pEnc->current->image, pEnc->mbParam.edged_width, pEnc->mbParam.height, 5, 200, "PVOP");
1421                    }
1422    
1423          if (hint->rawhints) {                  if ((pEnc->mbParam.plugin_flags & XVID_REQORIGINAL)) {
1424                  *intra = hint->mvhint.intra;                          image_copy(&pEnc->sOriginal, &pEnc->current->image,
1425          } else {                                     pEnc->mbParam.edged_width, pEnc->mbParam.height);
                 BitstreamInit(&bs, hint->hintstream, hint->hintlength);  
                 *intra = BitstreamGetBit(&bs);  
1426          }          }
1427    
1428          if (*intra) {                  if ( FrameCodeP(pEnc, &bs) == 0 ) {
1429                  return;                          /* N-VOP, we mustn't code b-frames yet */
1430                            if ((pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) ||
1431                                     pEnc->mbParam.max_bframes == 0)
1432                                    call_plugins(pEnc, pEnc->current, &pEnc->sOriginal, XVID_PLG_AFTER, NULL, NULL, stats);
1433                            goto done;
1434                    }
1435          }          }
1436    
         pEnc->current->fcode =  
                 (hint->rawhints) ? hint->mvhint.fcode : BitstreamGetBits(&bs,  
                                                                                                                                  FCODEBITS);  
1437    
1438          length = pEnc->current->fcode + 5;          /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1439          high = 1 << (length - 1);           * on next enc_encode call we must flush bframes
1440             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1441    
1442          for (y = 0; y < pEnc->mbParam.mb_height; ++y) {  /*done_flush:*/
                 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;  
                                 }  
                         }  
1443    
1444                          if (pMB->mode == MODE_INTER4V &&          pEnc->flush_bframes = 1;
                                 (pEnc->current->global_flags & XVID_LUMIMASKING)  
                                 && pMB->dquant != NO_CHANGE) {  
                                 pMB->mode = MODE_INTRA;  
1445    
1446                                  for (vec = 0; vec < 4; ++vec) {          /* packed & queued_bframes: dont bother outputting stats here, we do so after the flush */
1447                                          pMB->mvs[vec].x = pMB->mvs[vec].y = 0;          if ((pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) && pEnc->bframenum_tail > 0) {
1448                                  }                  goto repeat;
                         }  
                 }  
1449          }          }
1450    
1451            /* packed or no-bframes or no-bframes-queued: output stats */
1452            if ((pEnc->mbParam.global_flags & XVID_GLOBAL_PACKED) || pEnc->mbParam.max_bframes == 0 ) {
1453                    call_plugins(pEnc, pEnc->current, &pEnc->sOriginal, XVID_PLG_AFTER, NULL, NULL, stats);
1454  }  }
1455    
1456            /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
1457             * done; return number of bytes consumed
1458             * %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */
1459    
1460  void  done:
 HintedMEGet(Encoder * pEnc,  
                         int intra)  
 {  
         HINTINFO *hint;  
         Bitstream bs;  
         uint32_t x, y;  
         int length, high;  
1461    
1462          hint = pEnc->mbParam.hint;          stop_global_timer();
1463            write_timer();
1464    
1465          if (hint->rawhints) {          emms();
1466                  hint->mvhint.intra = intra;          return BitstreamLength(&bs);
         } else {  
                 BitstreamInit(&bs, hint->hintstream, 0);  
                 BitstreamPutBit(&bs, intra);  
1467          }          }
1468    
1469          if (intra) {  
1470                  if (!hint->rawhints) {  static void SetMacroblockQuants(MBParam * const pParam, FRAMEINFO * frame)
1471                          BitstreamPad(&bs);  {
1472                          hint->hintlength = BitstreamLength(&bs);          unsigned int i;
1473            MACROBLOCK * pMB = frame->mbs;
1474            int quant = frame->mbs[0].quant; /* set by XVID_PLG_FRAME */
1475            if (quant > 31)
1476                    frame->quant = quant = 31;
1477            else if (quant < 1)
1478                    frame->quant = quant = 1;
1479    
1480            for (i = 0; i < pParam->mb_height * pParam->mb_width; i++) {
1481                    quant += pMB->dquant;
1482                    if (quant > 31)
1483                            quant = 31;
1484                    else if (quant < 1)
1485                            quant = 1;
1486                    pMB->quant = quant;
1487                    pMB++;
1488                  }                  }
                 return;  
1489          }          }
1490    
         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);  
         }  
1491    
1492          for (y = 0; y < pEnc->mbParam.mb_height; ++y) {  static __inline void
1493                  for (x = 0; x < pEnc->mbParam.mb_width; ++x) {  CodeIntraMB(Encoder * pEnc,
1494                          MACROBLOCK *pMB =                          MACROBLOCK * pMB)
1495                                  &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];  {
                         MVBLOCKHINT *bhint =  
                                 &hint->mvhint.block[x + y * pEnc->mbParam.mb_width];  
                         VECTOR tmp;  
1496    
1497                          if (hint->rawhints) {          pMB->mode = MODE_INTRA;
                                 bhint->mode = pMB->mode;  
                         } else {  
                                 BitstreamPutBits(&bs, pMB->mode, MODEBITS);  
                         }  
1498    
1499                          if (pMB->mode == MODE_INTER || pMB->mode == MODE_INTER_Q) {          /* zero mv statistics */
1500                                  tmp.x = pMB->mvs[0].x;          pMB->mvs[0].x = pMB->mvs[1].x = pMB->mvs[2].x = pMB->mvs[3].x = 0;
1501                                  tmp.y = pMB->mvs[0].y;          pMB->mvs[0].y = pMB->mvs[1].y = pMB->mvs[2].y = pMB->mvs[3].y = 0;
1502                                  tmp.x += (tmp.x < 0) ? high * 2 : 0;          pMB->sad8[0] = pMB->sad8[1] = pMB->sad8[2] = pMB->sad8[3] = 0;
1503                                  tmp.y += (tmp.y < 0) ? high * 2 : 0;          pMB->sad16 = 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;  
1504    
1505                                  for (vec = 0; vec < 4; ++vec) {          if (pMB->dquant != 0) {
1506                                          tmp.x = pMB->mvs[vec].x;                  pMB->mode = MODE_INTRA_Q;
                                         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);  
                                         }  
                                 }  
                         }  
1507                  }                  }
1508          }          }
1509    
         if (!hint->rawhints) {  
                 BitstreamPad(&bs);  
                 hint->hintlength = BitstreamLength(&bs);  
         }  
 }  
1510    
1511    
1512  static int  static int
1513  FrameCodeI(Encoder * pEnc,  FrameCodeI(Encoder * pEnc,
1514                     Bitstream * bs,                     Bitstream * bs)
                    uint32_t * pBits)  
1515  {  {
1516            int bits = BitstreamPos(bs);
1517            int mb_width = pEnc->mbParam.mb_width;
1518            int mb_height = pEnc->mbParam.mb_height;
1519    
1520          DECLARE_ALIGNED_MATRIX(dct_codes, 6, 64, int16_t, CACHE_LINE);          DECLARE_ALIGNED_MATRIX(dct_codes, 6, 64, int16_t, CACHE_LINE);
1521          DECLARE_ALIGNED_MATRIX(qcoeff, 6, 64, int16_t, CACHE_LINE);          DECLARE_ALIGNED_MATRIX(qcoeff, 6, 64, int16_t, CACHE_LINE);
1522    
1523          uint16_t x, y;          uint16_t x, y;
1524    
         pEnc->iFrameNum = 0;  
1525          pEnc->mbParam.m_rounding_type = 1;          pEnc->mbParam.m_rounding_type = 1;
1526          pEnc->current->rounding_type = pEnc->mbParam.m_rounding_type;          pEnc->current->rounding_type = pEnc->mbParam.m_rounding_type;
1527          pEnc->current->coding_type = I_VOP;          pEnc->current->coding_type = I_VOP;
1528    
1529            call_plugins(pEnc, pEnc->current, NULL, XVID_PLG_FRAME, NULL, NULL, NULL);
1530    
1531            SetMacroblockQuants(&pEnc->mbParam, pEnc->current);
1532    
1533          BitstreamWriteVolHeader(bs, &pEnc->mbParam, pEnc->current);          BitstreamWriteVolHeader(bs, &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);  
1534    
1535          *pBits = BitstreamPos(bs);          set_timecodes(pEnc->current,pEnc->reference,pEnc->mbParam.fbase);
1536    
1537          pEnc->sStat.iTextBits = 0;          BitstreamPad(bs);
         pEnc->sStat.kblks = pEnc->mbParam.mb_width * pEnc->mbParam.mb_height;  
         pEnc->sStat.mblks = pEnc->sStat.ublks = 0;  
1538    
1539          for (y = 0; y < pEnc->mbParam.mb_height; y++)          BitstreamWriteVopHeader(bs, &pEnc->mbParam, pEnc->current, 1, pEnc->current->mbs[0].quant);
1540                  for (x = 0; x < pEnc->mbParam.mb_width; x++) {  
1541            pEnc->current->sStat.iTextBits = 0;
1542            pEnc->current->sStat.iMVBits = 0;
1543            pEnc->current->sStat.kblks = mb_width * mb_height;
1544            pEnc->current->sStat.mblks = pEnc->current->sStat.ublks = 0;
1545    
1546            for (y = 0; y < mb_height; y++)
1547                    for (x = 0; x < mb_width; x++) {
1548                          MACROBLOCK *pMB =                          MACROBLOCK *pMB =
1549                                  &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];                                  &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];
1550    
# Line 1524  Line 1558 
1558                          stop_prediction_timer();                          stop_prediction_timer();
1559    
1560                          start_timer();                          start_timer();
1561                          MBCoding(pEnc->current, pMB, qcoeff, bs, &pEnc->sStat);                          MBCoding(pEnc->current, pMB, qcoeff, bs, &pEnc->current->sStat);
1562                          stop_coding_timer();                          stop_coding_timer();
1563                  }                  }
1564    
1565          emms();          emms();
1566    
1567          *pBits = BitstreamPos(bs) - *pBits;          BitstreamPadAlways(bs); /* next_start_code() at the end of VideoObjectPlane() */
1568          pEnc->sStat.fMvPrevSigma = -1;  
1569          pEnc->sStat.iMvSum = 0;          pEnc->current->length = (BitstreamPos(bs) - bits) / 8;
1570          pEnc->sStat.iMvCount = 0;  
1571            pEnc->fMvPrevSigma = -1;
1572          pEnc->mbParam.m_fcode = 2;          pEnc->mbParam.m_fcode = 2;
1573    
1574          if (pEnc->current->global_flags & XVID_HINTEDME_GET) {          pEnc->current->is_edged = 0; /* not edged */
1575                  HintedMEGet(pEnc, 1);          pEnc->current->is_interpolated = -1; /* not interpolated (fake rounding -1) */
         }  
1576    
1577          return 1;                                       // intra          return 1;                                       /* intra */
1578  }  }
1579    
1580    static __inline void
1581    updateFcode(Statistics * sStat, Encoder * pEnc)
1582    {
1583            float fSigma;
1584            int iSearchRange;
1585    
1586            if (sStat->iMvCount == 0)
1587                    sStat->iMvCount = 1;
1588    
1589            fSigma = (float) sqrt((float) sStat->iMvSum / sStat->iMvCount);
1590    
1591            iSearchRange = 16 << pEnc->mbParam.m_fcode;
1592    
1593            if ((3.0 * fSigma > iSearchRange) && (pEnc->mbParam.m_fcode <= 5) )
1594                    pEnc->mbParam.m_fcode++;
1595    
1596            else if ((5.0 * fSigma < iSearchRange)
1597                               && (4.0 * pEnc->fMvPrevSigma < iSearchRange)
1598                               && (pEnc->mbParam.m_fcode >= 2) )
1599                    pEnc->mbParam.m_fcode--;
1600    
1601            pEnc->fMvPrevSigma = fSigma;
1602    }
1603    
1604  #define INTRA_THRESHOLD 0.5  #define BFRAME_SKIP_THRESHHOLD 30
1605    
1606    /* FrameCodeP also handles S(GMC)-VOPs */
1607  static int  static int
1608  FrameCodeP(Encoder * pEnc,  FrameCodeP(Encoder * pEnc,
1609                     Bitstream * bs,                     Bitstream * bs)
                    uint32_t * pBits,  
                    bool force_inter,  
                    bool vol_header)  
1610  {  {
1611          float fSigma;          int bits = BitstreamPos(bs);
1612    
1613          DECLARE_ALIGNED_MATRIX(dct_codes, 6, 64, int16_t, CACHE_LINE);          DECLARE_ALIGNED_MATRIX(dct_codes, 6, 64, int16_t, CACHE_LINE);
1614          DECLARE_ALIGNED_MATRIX(qcoeff, 6, 64, int16_t, CACHE_LINE);          DECLARE_ALIGNED_MATRIX(qcoeff, 6, 64, int16_t, CACHE_LINE);
1615    
1616          int iLimit;          int x, y, k;
1617          uint32_t x, y;          FRAMEINFO *const current = pEnc->current;
1618          int iSearchRange;          FRAMEINFO *const reference = pEnc->reference;
1619          int bIntra;          MBParam * const pParam = &pEnc->mbParam;
1620            int mb_width = pParam->mb_width;
1621            int mb_height = pParam->mb_height;
1622            int coded = 1;
1623    
1624          /* IMAGE *pCurrent = &pEnc->current->image; */          IMAGE *pRef = &reference->image;
         IMAGE *pRef = &pEnc->reference->image;  
1625    
1626            if (!reference->is_edged) {
1627          start_timer();          start_timer();
1628          image_setedges(pRef, pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,                  image_setedges(pRef, pParam->edged_width, pParam->edged_height,
1629                                     pEnc->mbParam.width, pEnc->mbParam.height,                                             pParam->width, pParam->height, 0);
                                    pEnc->current->global_flags & XVID_INTERLACING);  
1630          stop_edges_timer();          stop_edges_timer();
1631                    reference->is_edged = 1;
1632            }
1633    
1634          pEnc->mbParam.m_rounding_type = 1 - pEnc->mbParam.m_rounding_type;          pParam->m_rounding_type = 1 - pParam->m_rounding_type;
1635          pEnc->current->rounding_type = pEnc->mbParam.m_rounding_type;          current->rounding_type = pParam->m_rounding_type;
1636          pEnc->current->fcode = pEnc->mbParam.m_fcode;          current->fcode = pParam->m_fcode;
1637    
1638          if (!force_inter)          if ((current->vop_flags & XVID_VOP_HALFPEL)) {
1639                  iLimit =                  if (reference->is_interpolated != current->rounding_type) {
                         (int) (pEnc->mbParam.mb_width * pEnc->mbParam.mb_height *  
                                    INTRA_THRESHOLD);  
         else  
                 iLimit = pEnc->mbParam.mb_width * pEnc->mbParam.mb_height + 1;  
   
         if ((pEnc->current->global_flags & XVID_HALFPEL)) {  
1640                  start_timer();                  start_timer();
1641                  image_interpolate(pRef, &pEnc->vInterH, &pEnc->vInterV,                          image_interpolate(pRef->y, pEnc->vInterH.y, pEnc->vInterV.y,
1642                                                    &pEnc->vInterHV, pEnc->mbParam.edged_width,                                                            pEnc->vInterHV.y, pParam->edged_width,
1643                                                    pEnc->mbParam.edged_height,                                                            pParam->edged_height,
1644                                                    pEnc->current->rounding_type);                                                            (pParam->vol_flags & XVID_VOL_QUARTERPEL),
1645                                                              current->rounding_type);
1646                  stop_inter_timer();                  stop_inter_timer();
1647                            reference->is_interpolated = current->rounding_type;
1648                    }
1649          }          }
1650    
1651            current->sStat.iTextBits = current->sStat.iMvSum = current->sStat.iMvCount =
1652                    current->sStat.kblks = current->sStat.mblks = current->sStat.ublks =
1653                    current->sStat.iMVBits = 0;
1654    
1655            current->coding_type = P_VOP;
1656    
1657            call_plugins(pEnc, pEnc->current, NULL, XVID_PLG_FRAME, NULL, NULL, NULL);
1658    
1659            SetMacroblockQuants(&pEnc->mbParam, current);
1660    
1661          start_timer();          start_timer();
1662          if (pEnc->current->global_flags & XVID_HINTEDME_SET) {          if (current->vol_flags & XVID_VOL_GMC ) /* GMC only for S(GMC)-VOPs */
1663                  HintedMESet(pEnc, &bIntra);          {       int gmcval;
1664                    current->warp = GlobalMotionEst( current->mbs, pParam, current, reference,
1665                                                                     &pEnc->vInterH, &pEnc->vInterV, &pEnc->vInterHV);
1666    
1667                    if (current->motion_flags & XVID_ME_GME_REFINE) {
1668                            gmcval = GlobalMotionEstRefine(&current->warp,
1669                                                                                       current->mbs, pParam,
1670                                                                                       current, reference,
1671                                                                                       &current->image,
1672                                                                                       &reference->image,
1673                                                                                       &pEnc->vInterH,
1674                                                                                       &pEnc->vInterV,
1675                                                                                       &pEnc->vInterHV);
1676          } else {          } else {
1677                            gmcval = globalSAD(&current->warp, pParam, current->mbs,
1678                                                               current,
1679                                                               &reference->image,
1680                                                               &current->image,
1681                                                               pEnc->vGMC.y);
1682                    }
1683    
1684                    gmcval += /*current->quant*/ 2 * (int)(pParam->mb_width*pParam->mb_height);
1685    
1686                    /* 1st '3': 3 warpoints, 2nd '3': 16th pel res (2<<3) */
1687                    generate_GMCparameters( 3, 3, &current->warp,
1688                                    pParam->width, pParam->height,
1689                                    &current->new_gmc_data);
1690    
1691                    if ( (gmcval<0) && ( (current->warp.duv[1].x != 0) || (current->warp.duv[1].y != 0) ||
1692                             (current->warp.duv[2].x != 0) || (current->warp.duv[2].y != 0) ) )
1693                    {
1694                            current->coding_type = S_VOP;
1695    
1696                            generate_GMCimage(&current->new_gmc_data, &reference->image,
1697                                    pParam->mb_width, pParam->mb_height,
1698                                    pParam->edged_width, pParam->edged_width/2,
1699                                    pParam->m_fcode, ((pParam->vol_flags & XVID_VOL_QUARTERPEL)?1:0), 0,
1700                                    current->rounding_type, current->mbs, &pEnc->vGMC);
1701    
1702  #ifdef _SMP                  } else {
         if (pEnc->mbParam.num_threads > 1)  
                 bIntra =  
                         SMP_MotionEstimation(&pEnc->mbParam, pEnc->current, pEnc->reference,  
                                                  &pEnc->vInterH, &pEnc->vInterV, &pEnc->vInterHV,  
                                                  iLimit);  
         else  
 #endif  
                 bIntra =  
                         MotionEstimation(&pEnc->mbParam, pEnc->current, pEnc->reference,  
                          &pEnc->vInterH, &pEnc->vInterV, &pEnc->vInterHV,  
                          iLimit);  
1703    
1704                            generate_GMCimage(&current->new_gmc_data, &reference->image,
1705                                    pParam->mb_width, pParam->mb_height,
1706                                    pParam->edged_width, pParam->edged_width/2,
1707                                    pParam->m_fcode, ((pParam->vol_flags & XVID_VOL_QUARTERPEL)?1:0), 0,
1708                                    current->rounding_type, current->mbs, NULL);    /* no warping, just AMV */
1709          }          }
1710          stop_motion_timer();          }
1711    
1712    
1713            if (pEnc->num_threads > 0) {
1714                    /* multithreaded motion estimation - dispatch threads */
1715    
1716          if (bIntra == 1) {                  void * status;
1717                  return FrameCodeI(pEnc, bs, pBits);                  int rows_per_thread = (pParam->mb_height + pEnc->num_threads - 1)/pEnc->num_threads;
1718    
1719                    for (k = 0; k < pEnc->num_threads; k++) {
1720                            memset(pEnc->motionData[k].complete_count_self, 0, rows_per_thread * sizeof(int));
1721                            pEnc->motionData[k].pParam = &pEnc->mbParam;
1722                            pEnc->motionData[k].current = current;
1723                            pEnc->motionData[k].reference = reference;
1724                            pEnc->motionData[k].pRefH = &pEnc->vInterH;
1725                            pEnc->motionData[k].pRefV = &pEnc->vInterV;
1726                            pEnc->motionData[k].pRefHV = &pEnc->vInterHV;
1727                            pEnc->motionData[k].pGMC = &pEnc->vGMC;
1728                            pEnc->motionData[k].y_step = pEnc->num_threads;
1729                            pEnc->motionData[k].start_y = k;
1730                            /* todo: sort out temp space once and for all */
1731                            pEnc->motionData[k].RefQ = pEnc->vInterH.u + 16*k*pParam->edged_width;
1732          }          }
1733    
1734          pEnc->current->coding_type = P_VOP;                  for (k = 1; k < pEnc->num_threads; k++) {
1735                            pthread_create(&pEnc->motionData[k].handle, NULL,
1736                                    (void*)MotionEstimateSMP, (void*)&pEnc->motionData[k]);
1737                    }
1738    
1739          if (vol_header)                  MotionEstimateSMP(&pEnc->motionData[0]);
                 BitstreamWriteVolHeader(bs, &pEnc->mbParam, pEnc->current);  
1740    
1741          BitstreamWriteVopHeader(bs, &pEnc->mbParam, pEnc->current, 1);                  for (k = 1; k < pEnc->num_threads; k++) {
1742                            pthread_join(pEnc->motionData[k].handle, &status);
1743                    }
1744    
1745          *pBits = BitstreamPos(bs);                  current->fcode = 0;
1746                    for (k = 0; k < pEnc->num_threads; k++) {
1747                            current->sStat.iMvSum += pEnc->motionData[k].mvSum;
1748                            current->sStat.iMvCount += pEnc->motionData[k].mvCount;
1749                            if (pEnc->motionData[k].minfcode > current->fcode)
1750                                    current->fcode = pEnc->motionData[k].minfcode;
1751                    }
1752    
1753          pEnc->sStat.iTextBits = 0;          } else {
1754          pEnc->sStat.iMvSum = 0;                  /* regular ME */
         pEnc->sStat.iMvCount = 0;  
         pEnc->sStat.kblks = pEnc->sStat.mblks = pEnc->sStat.ublks = 0;  
1755    
1756          for (y = 0; y < pEnc->mbParam.mb_height; y++) {                  MotionEstimation(&pEnc->mbParam, current, reference,
1757                  for (x = 0; x < pEnc->mbParam.mb_width; x++) {                                                   &pEnc->vInterH, &pEnc->vInterV, &pEnc->vInterHV,
1758                          MACROBLOCK *pMB =                                                   &pEnc->vGMC, 256*4096);
1759                                  &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];          }
1760    
1761            stop_motion_timer();
1762    
1763            set_timecodes(current,reference,pParam->fbase);
1764    
1765            BitstreamWriteVopHeader(bs, &pEnc->mbParam, current, 1, current->mbs[0].quant);
1766    
1767            for (y = 0; y < mb_height; y++) {
1768                    for (x = 0; x < mb_width; x++) {
1769                            MACROBLOCK *pMB = &current->mbs[x + y * pParam->mb_width];
1770                            int skip_possible;
1771    
1772                            if (pMB->mode == MODE_INTRA || pMB->mode == MODE_INTRA_Q) {
1773                                    CodeIntraMB(pEnc, pMB);
1774                                    MBTransQuantIntra(&pEnc->mbParam, current, pMB, x, y,
1775                                                                      dct_codes, qcoeff);
1776    
1777                                    start_timer();
1778                                    MBPrediction(current, x, y, pParam->mb_width, qcoeff);
1779                                    stop_prediction_timer();
1780    
1781                          bIntra = (pMB->mode == MODE_INTRA) || (pMB->mode == MODE_INTRA_Q);                                  current->sStat.kblks++;
1782    
1783                                    MBCoding(current, pMB, qcoeff, bs, &current->sStat);
1784                                    stop_coding_timer();
1785                                    continue;
1786                            }
1787    
                         if (!bIntra) {  
1788                                  start_timer();                                  start_timer();
1789                                  MBMotionCompensation(pMB, x, y, &pEnc->reference->image,                          MBMotionCompensation(pMB, x, y, &reference->image,
1790                                                                           &pEnc->vInterH, &pEnc->vInterV,                                                                           &pEnc->vInterH, &pEnc->vInterV,
1791                                                                           &pEnc->vInterHV, &pEnc->current->image,                                                                   &pEnc->vInterHV, &pEnc->vGMC,
1792                                                                           dct_codes, pEnc->mbParam.width,                                                                   &current->image,
1793                                                                           pEnc->mbParam.height,                                                                   dct_codes, pParam->width,
1794                                                                           pEnc->mbParam.edged_width,                                                                   pParam->height,
1795                                                                           pEnc->current->rounding_type);                                                                   pParam->edged_width,
1796                                  stop_comp_timer();                                                                   (current->vol_flags & XVID_VOL_QUARTERPEL),
1797                                                                     current->rounding_type);
1798    
1799                                  if ((pEnc->current->global_flags & XVID_LUMIMASKING)) {                          stop_comp_timer();
                                         if (pMB->dquant != NO_CHANGE) {  
                                                 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;  
                                         }  
                                 }  
                                 pMB->quant = pEnc->current->quant;  
1800    
1801                                  pMB->field_pred = 0;                                  pMB->field_pred = 0;
1802    
1803                                  pMB->cbp =                          if (pMB->cbp != 0) {
1804                                          MBTransQuantInter(&pEnc->mbParam, pEnc->current, pMB, x, y,                                  pMB->cbp = MBTransQuantInter(&pEnc->mbParam, current, pMB, x, y,
                                                                           dct_codes, qcoeff);  
                         } else {  
                                 CodeIntraMB(pEnc, pMB);  
                                 MBTransQuantIntra(&pEnc->mbParam, pEnc->current, pMB, x, y,  
1805                                                                    dct_codes, qcoeff);                                                                    dct_codes, qcoeff);
1806                          }                          }
1807    
1808                          start_timer();                          if (pMB->dquant != 0)
1809                          MBPrediction(pEnc->current, x, y, pEnc->mbParam.mb_width, qcoeff);                                  MBSetDquant(pMB, x, y, &pEnc->mbParam);
                         stop_prediction_timer();  
1810    
1811                          if (pMB->mode == MODE_INTRA || pMB->mode == MODE_INTRA_Q) {  
1812                                  pEnc->sStat.kblks++;                          if (pMB->cbp || pMB->mvs[0].x || pMB->mvs[0].y ||
                         } else if (pMB->cbp || pMB->mvs[0].x || pMB->mvs[0].y ||  
1813                                             pMB->mvs[1].x || pMB->mvs[1].y || pMB->mvs[2].x ||                                             pMB->mvs[1].x || pMB->mvs[1].y || pMB->mvs[2].x ||
1814                                             pMB->mvs[2].y || pMB->mvs[3].x || pMB->mvs[3].y) {                                             pMB->mvs[2].y || pMB->mvs[3].x || pMB->mvs[3].y) {
1815                                  pEnc->sStat.mblks++;                                  current->sStat.mblks++;
1816                          } else {                          } else {
1817                                  pEnc->sStat.ublks++;                                  current->sStat.ublks++;
1818                          }                          }
1819    
1820                          start_timer();                          start_timer();
1821                          MBCoding(pEnc->current, pMB, qcoeff, bs, &pEnc->sStat);  
1822                            /* Finished processing the MB, now check if to CODE or SKIP */
1823    
1824                            skip_possible = (pMB->cbp == 0) && (pMB->mode == MODE_INTER);
1825    
1826                            if (current->coding_type == S_VOP)
1827                                    skip_possible &= (pMB->mcsel == 1);
1828                            else { /* PVOP */
1829                                    const VECTOR * const mv = (pParam->vol_flags & XVID_VOL_QUARTERPEL) ?
1830                                                                                    pMB->qmvs : pMB->mvs;
1831                                    skip_possible &= ((mv->x|mv->y) == 0);
1832                            }
1833    
1834                            if ((pMB->mode == MODE_NOT_CODED) || (skip_possible)) {
1835                                    /* This is a candidate for SKIPping, but for P-VOPs check intermediate B-frames first */
1836                                    int bSkip = 1;
1837    
1838                                    if (current->coding_type == P_VOP) {    /* special rule for P-VOP's SKIP */
1839    
1840                                            for (k = pEnc->bframenum_head; k < pEnc->bframenum_tail; k++) {
1841                                                    int iSAD;
1842                                                    iSAD = sad16(reference->image.y + 16*y*pParam->edged_width + 16*x,
1843                                                                                    pEnc->bframes[k]->image.y + 16*y*pParam->edged_width + 16*x,
1844                                                                                    pParam->edged_width, BFRAME_SKIP_THRESHHOLD * pMB->quant);
1845                                                    if (iSAD >= BFRAME_SKIP_THRESHHOLD * pMB->quant) {
1846                                                            bSkip = 0; /* could not SKIP */
1847                                                            if (pParam->vol_flags & XVID_VOL_QUARTERPEL) {
1848                                                                    VECTOR predMV = get_qpmv2(current->mbs, pParam->mb_width, 0, x, y, 0);
1849                                                                    pMB->pmvs[0].x = - predMV.x;
1850                                                                    pMB->pmvs[0].y = - predMV.y;
1851                                                            } else {
1852                                                                    VECTOR predMV = get_pmv2(current->mbs, pParam->mb_width, 0, x, y, 0);
1853                                                                    pMB->pmvs[0].x = - predMV.x;
1854                                                                    pMB->pmvs[0].y = - predMV.y;
1855                                                            }
1856                                                            pMB->mode = MODE_INTER;
1857                                                            pMB->cbp = 0;
1858                                                            break;
1859                                                    }
1860                                            }
1861                                    }
1862    
1863                                    if (bSkip) {
1864                                            /* do SKIP */
1865                                            pMB->mode = MODE_NOT_CODED;
1866                                            MBSkip(bs);
1867                                            stop_coding_timer();
1868                                            continue;       /* next MB */
1869                                    }
1870                            }
1871    
1872                            /* ordinary case: normal coded INTER/INTER4V block */
1873                            MBCoding(current, pMB, qcoeff, bs, &pEnc->current->sStat);
1874                          stop_coding_timer();                          stop_coding_timer();
1875                  }                  }
1876          }          }
1877    
1878          emms();          emms();
1879            updateFcode(&current->sStat, pEnc);
1880    
1881          if (pEnc->current->global_flags & XVID_HINTEDME_GET) {          /* frame drop code */
1882                  HintedMEGet(pEnc, 0);  #if 0
1883          }          DPRINTF(XVID_DEBUG_DEBUG, "kmu %i %i %i\n", current->sStat.kblks, current->sStat.mblks, current->sStat.ublks);
1884    #endif
1885            if (current->sStat.kblks + current->sStat.mblks <=
1886                    (pParam->frame_drop_ratio * mb_width * mb_height) / 100 &&
1887                    ( (pEnc->bframenum_head >= pEnc->bframenum_tail) || !(pEnc->mbParam.global_flags & XVID_GLOBAL_CLOSED_GOP)) )
1888            {
1889                    current->sStat.kblks = current->sStat.mblks = current->sStat.iTextBits = 0;
1890                    current->sStat.ublks = mb_width * mb_height;
1891    
1892                    BitstreamReset(bs);
1893    
1894                    set_timecodes(current,reference,pParam->fbase);
1895                    BitstreamWriteVopHeader(bs, &pEnc->mbParam, current, 0, current->mbs[0].quant);
1896    
1897                    /* copy reference frame details into the current frame */
1898                    current->quant = reference->quant;
1899                    current->motion_flags = reference->motion_flags;
1900                    current->rounding_type = reference->rounding_type;
1901                    current->fcode = reference->fcode;
1902                    current->bcode = reference->bcode;
1903                    current->stamp = reference->stamp;
1904                    image_copy(&current->image, &reference->image, pParam->edged_width, pParam->height);
1905                    memcpy(current->mbs, reference->mbs, sizeof(MACROBLOCK) * mb_width * mb_height);
1906                    coded = 0;
1907    
1908          if (pEnc->sStat.iMvCount == 0)          } else {
                 pEnc->sStat.iMvCount = 1;  
1909    
1910          fSigma = (float) sqrt((float) pEnc->sStat.iMvSum / pEnc->sStat.iMvCount);                  pEnc->current->is_edged = 0; /* not edged */
1911                    pEnc->current->is_interpolated = -1; /* not interpolated (fake rounding -1) */
1912    
1913          iSearchRange = 1 << (3 + pEnc->mbParam.m_fcode);                  /* what was this frame's interpolated reference will become
1914                            forward (past) reference in b-frame coding */
1915    
1916          if ((fSigma > iSearchRange / 3)                  image_swap(&pEnc->vInterH, &pEnc->f_refh);
1917                  && (pEnc->mbParam.m_fcode <= 3))        // maximum search range 128                  image_swap(&pEnc->vInterV, &pEnc->f_refv);
1918          {                  image_swap(&pEnc->vInterHV, &pEnc->f_refhv);
1919                  pEnc->mbParam.m_fcode++;          }
1920                  iSearchRange *= 2;  
1921          } else if ((fSigma < iSearchRange / 6)          /* XXX: debug
                            && (pEnc->sStat.fMvPrevSigma >= 0)  
                            && (pEnc->sStat.fMvPrevSigma < iSearchRange / 6)  
                            && (pEnc->mbParam.m_fcode >= 2))     // minimum search range 16  
1922          {          {
1923                  pEnc->mbParam.m_fcode--;                  char s[100];
1924                  iSearchRange /= 2;                  sprintf(s, "\\%05i_cur.pgm", pEnc->m_framenum);
1925                    image_dump_yuvpgm(&current->image,
1926                            pParam->edged_width,
1927                            pParam->width, pParam->height, s);
1928    
1929                    sprintf(s, "\\%05i_ref.pgm", pEnc->m_framenum);
1930                    image_dump_yuvpgm(&reference->image,
1931                            pParam->edged_width,
1932                            pParam->width, pParam->height, s);
1933          }          }
1934            */
1935    
1936          pEnc->sStat.fMvPrevSigma = fSigma;          BitstreamPadAlways(bs); /* next_start_code() at the end of VideoObjectPlane() */
1937    
1938          *pBits = BitstreamPos(bs) - *pBits;          current->length = (BitstreamPos(bs) - bits) / 8;
1939    
1940          return 0;                                       // inter          return coded;
1941  }  }
1942    
1943    
 #ifdef BFRAMES  
1944  static void  static void
1945  FrameCodeB(Encoder * pEnc,  FrameCodeB(Encoder * pEnc,
1946                     FRAMEINFO * frame,                     FRAMEINFO * frame,
1947                     Bitstream * bs,                     Bitstream * bs)
                    uint32_t * pBits)  
1948  {  {
1949          int16_t dct_codes[6 * 64];          int bits = BitstreamPos(bs);
1950          int16_t qcoeff[6 * 64];          DECLARE_ALIGNED_MATRIX(dct_codes, 6, 64, int16_t, CACHE_LINE);
1951            DECLARE_ALIGNED_MATRIX(qcoeff, 6, 64, int16_t, CACHE_LINE);
1952          uint32_t x, y;          uint32_t x, y;
         VECTOR forward;  
         VECTOR backward;  
1953    
1954          IMAGE *f_ref = &pEnc->reference->image;          IMAGE *f_ref = &pEnc->reference->image;
1955          IMAGE *b_ref = &pEnc->current->image;          IMAGE *b_ref = &pEnc->current->image;
# Line 1755  Line 1966 
1966          }          }
1967  #endif  #endif
1968    
1969          // forward          /* forward  */
1970            if (!pEnc->reference->is_edged) {
1971          image_setedges(f_ref, pEnc->mbParam.edged_width,          image_setedges(f_ref, pEnc->mbParam.edged_width,
1972                                     pEnc->mbParam.edged_height, pEnc->mbParam.width,                                     pEnc->mbParam.edged_height, pEnc->mbParam.width,
1973                                     pEnc->mbParam.height,                                             pEnc->mbParam.height, 0);
1974                                     frame->global_flags & XVID_INTERLACING);                  pEnc->current->is_edged = 1;
1975            }
1976    
1977            if (pEnc->reference->is_interpolated != 0) {
1978          start_timer();          start_timer();
1979          image_interpolate(f_ref, &pEnc->f_refh, &pEnc->f_refv, &pEnc->f_refhv,                  image_interpolate(f_ref->y, pEnc->f_refh.y, pEnc->f_refv.y, pEnc->f_refhv.y,
1980                                            pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,                                            pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,
1981                                            0);                                                    (pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL), 0);
1982          stop_inter_timer();          stop_inter_timer();
1983                    pEnc->reference->is_interpolated = 0;
1984            }
1985    
1986          // backward          /* backward */
1987            if (!pEnc->current->is_edged) {
1988          image_setedges(b_ref, pEnc->mbParam.edged_width,          image_setedges(b_ref, pEnc->mbParam.edged_width,
1989                                     pEnc->mbParam.edged_height, pEnc->mbParam.width,                                     pEnc->mbParam.edged_height, pEnc->mbParam.width,
1990                                     pEnc->mbParam.height,                                             pEnc->mbParam.height, 0);
1991                                     frame->global_flags & XVID_INTERLACING);                  pEnc->current->is_edged = 1;
1992            }
1993    
1994            if (pEnc->current->is_interpolated != 0) {
1995          start_timer();          start_timer();
1996          image_interpolate(b_ref, &pEnc->vInterH, &pEnc->vInterV, &pEnc->vInterHV,                  image_interpolate(b_ref->y, pEnc->vInterH.y, pEnc->vInterV.y, pEnc->vInterHV.y,
1997                                            pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,                                            pEnc->mbParam.edged_width, pEnc->mbParam.edged_height,
1998                                            0);                                                  (pEnc->mbParam.vol_flags & XVID_VOL_QUARTERPEL), 0);
1999          stop_inter_timer();          stop_inter_timer();
2000                    pEnc->current->is_interpolated = 0;
2001            }
2002    
2003            frame->coding_type = B_VOP;
2004            call_plugins(pEnc, frame, NULL, XVID_PLG_FRAME, NULL, NULL, NULL);
2005    
2006            frame->fcode = frame->bcode = pEnc->current->fcode;
2007    
2008          start_timer();          start_timer();
2009          MotionEstimationBVOP(&pEnc->mbParam, frame, pEnc->reference->mbs, f_ref,          if (pEnc->num_threads > 0) {
2010                    void * status;
2011                    int k;
2012                    /* multithreaded motion estimation - dispatch threads */
2013                    int rows_per_thread = (pEnc->mbParam.mb_height + pEnc->num_threads - 1)/pEnc->num_threads;
2014    
2015                    for (k = 0; k < pEnc->num_threads; k++) {
2016                            memset(pEnc->motionData[k].complete_count_self, 0, rows_per_thread * sizeof(int));
2017                            pEnc->motionData[k].pParam = &pEnc->mbParam;
2018                            pEnc->motionData[k].current = frame;
2019                            pEnc->motionData[k].reference = pEnc->current;
2020                            pEnc->motionData[k].fRef = f_ref;
2021                            pEnc->motionData[k].fRefH = &pEnc->f_refh;
2022                            pEnc->motionData[k].fRefV = &pEnc->f_refv;
2023                            pEnc->motionData[k].fRefHV = &pEnc->f_refhv;
2024                            pEnc->motionData[k].pRef = b_ref;
2025                            pEnc->motionData[k].pRefH = &pEnc->vInterH;
2026                            pEnc->motionData[k].pRefV = &pEnc->vInterV;
2027                            pEnc->motionData[k].pRefHV = &pEnc->vInterHV;
2028                            pEnc->motionData[k].time_bp = (int32_t)(pEnc->current->stamp - frame->stamp);
2029                            pEnc->motionData[k].time_pp = (int32_t)(pEnc->current->stamp - pEnc->reference->stamp);
2030                            pEnc->motionData[k].y_step = pEnc->num_threads;
2031                            pEnc->motionData[k].start_y = k;
2032                            /* todo: sort out temp space once and for all */
2033                            pEnc->motionData[k].RefQ = pEnc->vInterH.u + 16*k*pEnc->mbParam.edged_width;
2034                    }
2035    
2036                    for (k = 1; k < pEnc->num_threads; k++) {
2037                            pthread_create(&pEnc->motionData[k].handle, NULL,
2038                                    (void*)SMPMotionEstimationBVOP, (void*)&pEnc->motionData[k]);
2039                    }
2040    
2041                    SMPMotionEstimationBVOP(&pEnc->motionData[0]);
2042    
2043                    for (k = 1; k < pEnc->num_threads; k++) {
2044                            pthread_join(pEnc->motionData[k].handle, &status);
2045                    }
2046    
2047                    frame->fcode = frame->bcode = 0;
2048                    for (k = 0; k < pEnc->num_threads; k++) {
2049                            if (pEnc->motionData[k].minfcode > frame->fcode)
2050                                    frame->fcode = pEnc->motionData[k].minfcode;
2051                            if (pEnc->motionData[k].minbcode > frame->bcode)
2052                                    frame->bcode = pEnc->motionData[k].minbcode;
2053                    }
2054            } else {
2055                    MotionEstimationBVOP(&pEnc->mbParam, frame,
2056                                                             ((int32_t)(pEnc->current->stamp - frame->stamp)),                              /* time_bp */
2057                                                             ((int32_t)(pEnc->current->stamp - pEnc->reference->stamp)),    /* time_pp */
2058                                                             pEnc->reference->mbs, f_ref,
2059                                                   &pEnc->f_refh, &pEnc->f_refv, &pEnc->f_refhv,                                                   &pEnc->f_refh, &pEnc->f_refv, &pEnc->f_refhv,
2060                                                   pEnc->current->mbs, b_ref, &pEnc->vInterH,                                                           pEnc->current, b_ref, &pEnc->vInterH,
2061                                                   &pEnc->vInterV, &pEnc->vInterHV);                                                   &pEnc->vInterV, &pEnc->vInterHV);
2062            }
   
2063          stop_motion_timer();          stop_motion_timer();
2064    
2065          /*if (test_quant_type(&pEnc->mbParam, pEnc->current))          set_timecodes(frame, pEnc->reference,pEnc->mbParam.fbase);
2066             {          BitstreamWriteVopHeader(bs, &pEnc->mbParam, frame, 1, frame->quant);
            BitstreamWriteVolHeader(bs, pEnc->mbParam.width, pEnc->mbParam.height, pEnc->mbParam.quant_type);  
            } */  
   
         frame->coding_type = B_VOP;  
         BitstreamWriteVopHeader(bs, &pEnc->mbParam, frame, 1);  
   
         *pBits = BitstreamPos(bs);  
   
         pEnc->sStat.iTextBits = 0;  
         pEnc->sStat.iMvSum = 0;  
         pEnc->sStat.iMvCount = 0;  
         pEnc->sStat.kblks = pEnc->sStat.mblks = pEnc->sStat.ublks = 0;  
2067    
2068            frame->sStat.iTextBits = 0;
2069            frame->sStat.iMVBits = 0;
2070            frame->sStat.iMvSum = 0;
2071            frame->sStat.iMvCount = 0;
2072            frame->sStat.kblks = frame->sStat.mblks = frame->sStat.ublks = 0;
2073            frame->sStat.mblks = pEnc->mbParam.mb_width * pEnc->mbParam.mb_height;
2074            frame->sStat.kblks = frame->sStat.ublks = 0;
2075    
2076          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;  
   
2077                  for (x = 0; x < pEnc->mbParam.mb_width; x++) {                  for (x = 0; x < pEnc->mbParam.mb_width; x++) {
2078                          MACROBLOCK *f_mb =                          MACROBLOCK * const mb = &frame->mbs[x + y * pEnc->mbParam.mb_width];
                                 &pEnc->reference->mbs[x + y * pEnc->mbParam.mb_width];  
                         MACROBLOCK *b_mb =  
                                 &pEnc->current->mbs[x + y * pEnc->mbParam.mb_width];  
                         MACROBLOCK *mb = &frame->mbs[x + y * pEnc->mbParam.mb_width];  
2079    
2080                          // decoder ignores mb when refence block is INTER(0,0), CBP=0                          /* decoder ignores mb when refence block is INTER(0,0), CBP=0 */
2081                          if (mb->mode == MODE_NOT_CODED) {                          if (mb->mode == MODE_NOT_CODED) {
2082                                  mb->mvs[0].x = 0;                                  if (pEnc->mbParam.plugin_flags & XVID_REQORIGINAL) {
2083                                  mb->mvs[0].y = 0;                                          MBMotionCompensation(mb, x, y, f_ref, NULL, f_ref, NULL, NULL, &frame->image,
2084                                                                                            NULL, 0, 0, pEnc->mbParam.edged_width, 0, 0);
2085                                  mb->cbp = 0;                                  }
 #ifdef BFRAMES_DEC_DEBUG  
         BFRAME_DEBUG  
 #endif  
2086                                  continue;                                  continue;
2087                          }                          }
2088    
2089                            mb->quant = frame->quant;
2090    
2091                            if (mb->cbp != 0 || pEnc->mbParam.plugin_flags & XVID_REQORIGINAL) {
2092                                    /* we have to motion-compensate, transfer etc,
2093                                            because there might be blocks to code */
2094    
2095                          MBMotionCompensationBVOP(&pEnc->mbParam, mb, x, y, &frame->image,                          MBMotionCompensationBVOP(&pEnc->mbParam, mb, x, y, &frame->image,
2096                                                                           f_ref, &pEnc->f_refh, &pEnc->f_refv,                                                                           f_ref, &pEnc->f_refh, &pEnc->f_refv,
2097                                                                           &pEnc->f_refhv, b_ref, &pEnc->vInterH,                                                                           &pEnc->f_refhv, b_ref, &pEnc->vInterH,
2098                                                                           &pEnc->vInterV, &pEnc->vInterHV,                                                                           &pEnc->vInterV, &pEnc->vInterHV,
2099                                                                           dct_codes);                                                                           dct_codes);
2100    
2101                          mb->quant = frame->quant;                                  mb->cbp = MBTransQuantInterBVOP(&pEnc->mbParam, frame, mb, x, y,  dct_codes, qcoeff);
                         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);  
   
   
                         if ((mb->mode == MODE_INTERPOLATE || mb->mode == MODE_DIRECT)  
                                 && mb->cbp == 0 && mb->mvs[0].x == 0 && mb->mvs[0].y == 0) {  
                                 mb->mode = 5;   // skipped  
2102                          }                          }
2103    
2104                          if (mb->mode == MODE_INTERPOLATE || mb->mode == MODE_FORWARD) {                          if (mb->mode == MODE_DIRECT_NO4V)
2105                                  mb->pmvs[0].x = mb->mvs[0].x - forward.x;                                  mb->mode = MODE_DIRECT;
                                 mb->pmvs[0].y = mb->mvs[0].y - forward.y;  
                                 forward.x = mb->mvs[0].x;  
                                 forward.y = mb->mvs[0].y;  
                         }  
2106    
2107                          if (mb->mode == MODE_INTERPOLATE || mb->mode == MODE_BACKWARD) {                          if (mb->mode == MODE_DIRECT && (mb->cbp | mb->pmvs[3].x | mb->pmvs[3].y) == 0)
2108                                  mb->b_pmvs[0].x = mb->b_mvs[0].x - backward.x;                                  mb->mode = MODE_DIRECT_NONE_MV; /* skipped */
2109                                  mb->b_pmvs[0].y = mb->b_mvs[0].y - backward.y;                          else
2110                                  backward.x = mb->b_mvs[0].x;                                  if (frame->vop_flags & XVID_VOP_GREYSCALE)
2111                                  backward.y = mb->b_mvs[0].y;                                          /* keep only bits 5-2 -- Chroma blocks will just be skipped by MBCodingBVOP */
2112                          }                                          mb->cbp &= 0x3C;
 //                      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);  
2113    
 #ifdef BFRAMES_DEC_DEBUG  
         BFRAME_DEBUG  
 #endif  
2114                          start_timer();                          start_timer();
2115                          MBCodingBVOP(mb, qcoeff, frame->fcode, frame->bcode, bs,                          MBCodingBVOP(frame, mb, qcoeff, frame->fcode, frame->bcode, bs,
2116                                                   &pEnc->sStat);                                                   &frame->sStat);
2117                          stop_coding_timer();                          stop_coding_timer();
2118                  }                  }
2119          }          }
   
2120          emms();          emms();
2121    
2122          // TODO: dynamic fcode/bcode ???          BitstreamPadAlways(bs); /* next_start_code() at the end of VideoObjectPlane() */
2123            frame->length = (BitstreamPos(bs) - bits) / 8;
         *pBits = BitstreamPos(bs) - *pBits;  
2124    
2125  #ifdef BFRAMES_DEC_DEBUG  #ifdef BFRAMES_DEC_DEBUG
2126          if (!first){          if (!first){
# Line 1886  Line 2130 
2130          }          }
2131  #endif  #endif
2132  }  }
 #endif  

Legend:
Removed from v.295  
changed lines
  Added in v.1693

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