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