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