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

Diff of /xvidcore/src/encoder.c

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

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

Legend:
Removed from v.1.20  
changed lines
  Added in v.1.119

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