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

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

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

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