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

Diff of /xvidcore/src/encoder.c

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

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

Legend:
Removed from v.1.37  
changed lines
  Added in v.1.120.2.1

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