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