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

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

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

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