[svn] / branches / dev-api-4 / xvidcore / src / encoder.c Repository:
ViewVC logotype

Diff of /branches/dev-api-4/xvidcore/src/encoder.c

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

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