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

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

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

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