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

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

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

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