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

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

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

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