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

Diff of /xvidcore/src/encoder.c

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

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