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

Diff of /xvidcore/src/encoder.c

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

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