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