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

Diff of /trunk/xvidcore/src/encoder.c

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

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

Legend:
Removed from v.100  
changed lines
  Added in v.1501

No admin address has been configured
ViewVC Help
Powered by ViewVC 1.0.4