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