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

Legend:
Removed from v.78  
changed lines
  Added in v.1391

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