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

Diff of /xvidcore/src/encoder.c

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

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