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