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