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

Diff of /xvidcore/src/encoder.c

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

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

Legend:
Removed from v.1.32  
changed lines
  Added in v.1.95.2.24

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