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

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

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

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

Legend:
Removed from v.168  
changed lines
  Added in v.1574

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