mjpeg.c 46.7 KB
Newer Older
1 2
/*
 * MJPEG encoder and decoder
3
 * Copyright (c) 2000, 2001 Fabrice Bellard.
4
 *
5 6 7 8
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
9
 *
10
 * This library is distributed in the hope that it will be useful,
11
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 13
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
14
 *
15 16 17
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
18
 *
A
Alex Beregszaszi 已提交
19
 * Support for external huffman table, various fixes (AVID workaround),
20
 * aspecting, new decode_frame mechanism and apple mjpeg-b support
A
Alex Beregszaszi 已提交
21
 *                                  by Alex Beregszaszi <alex@naxine.org>
22
 */
M
Michael Niedermayer 已提交
23 24 25 26 27 28

/**
 * @file mjpeg.c
 * MJPEG encoder and decoder.
 */
 
A
10l  
Alex Beregszaszi 已提交
29
//#define DEBUG
30 31 32 33
#include "avcodec.h"
#include "dsputil.h"
#include "mpegvideo.h"

34
/* use two quantizer tables (one for luminance and one for chrominance) */
35 36 37
/* not yet working */
#undef TWOMATRIXES

38
typedef struct MJpegContext {
39 40 41 42 43 44 45 46 47
    uint8_t huff_size_dc_luminance[12];
    uint16_t huff_code_dc_luminance[12];
    uint8_t huff_size_dc_chrominance[12];
    uint16_t huff_code_dc_chrominance[12];

    uint8_t huff_size_ac_luminance[256];
    uint16_t huff_code_ac_luminance[256];
    uint8_t huff_size_ac_chrominance[256];
    uint16_t huff_code_ac_chrominance[256];
48 49
} MJpegContext;

50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130
/* JPEG marker codes */
typedef enum {
    /* start of frame */
    SOF0  = 0xc0,	/* baseline */
    SOF1  = 0xc1,	/* extended sequential, huffman */
    SOF2  = 0xc2,	/* progressive, huffman */
    SOF3  = 0xc3,	/* lossless, huffman */

    SOF5  = 0xc5,	/* differential sequential, huffman */
    SOF6  = 0xc6,	/* differential progressive, huffman */
    SOF7  = 0xc7,	/* differential lossless, huffman */
    JPG   = 0xc8,	/* reserved for JPEG extension */
    SOF9  = 0xc9,	/* extended sequential, arithmetic */
    SOF10 = 0xca,	/* progressive, arithmetic */
    SOF11 = 0xcb,	/* lossless, arithmetic */

    SOF13 = 0xcd,	/* differential sequential, arithmetic */
    SOF14 = 0xce,	/* differential progressive, arithmetic */
    SOF15 = 0xcf,	/* differential lossless, arithmetic */

    DHT   = 0xc4,	/* define huffman tables */

    DAC   = 0xcc,	/* define arithmetic-coding conditioning */

    /* restart with modulo 8 count "m" */
    RST0  = 0xd0,
    RST1  = 0xd1,
    RST2  = 0xd2,
    RST3  = 0xd3,
    RST4  = 0xd4,
    RST5  = 0xd5,
    RST6  = 0xd6,
    RST7  = 0xd7,

    SOI   = 0xd8,	/* start of image */
    EOI   = 0xd9,	/* end of image */
    SOS   = 0xda,	/* start of scan */
    DQT   = 0xdb,	/* define quantization tables */
    DNL   = 0xdc,	/* define number of lines */
    DRI   = 0xdd,	/* define restart interval */
    DHP   = 0xde,	/* define hierarchical progression */
    EXP   = 0xdf,	/* expand reference components */

    APP0  = 0xe0,
    APP1  = 0xe1,
    APP2  = 0xe2,
    APP3  = 0xe3,
    APP4  = 0xe4,
    APP5  = 0xe5,
    APP6  = 0xe6,
    APP7  = 0xe7,
    APP8  = 0xe8,
    APP9  = 0xe9,
    APP10 = 0xea,
    APP11 = 0xeb,
    APP12 = 0xec,
    APP13 = 0xed,
    APP14 = 0xee,
    APP15 = 0xef,

    JPG0  = 0xf0,
    JPG1  = 0xf1,
    JPG2  = 0xf2,
    JPG3  = 0xf3,
    JPG4  = 0xf4,
    JPG5  = 0xf5,
    JPG6  = 0xf6,
    JPG7  = 0xf7,
    JPG8  = 0xf8,
    JPG9  = 0xf9,
    JPG10 = 0xfa,
    JPG11 = 0xfb,
    JPG12 = 0xfc,
    JPG13 = 0xfd,

    COM   = 0xfe,	/* comment */

    TEM   = 0x01,	/* temporary private use for arithmetic coding */

    /* 0x02 -> 0xbf reserved */
} JPEG_MARKER;
131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160

#if 0
/* These are the sample quantization tables given in JPEG spec section K.1.
 * The spec says that the values given produce "good" quality, and
 * when divided by 2, "very good" quality.
 */
static const unsigned char std_luminance_quant_tbl[64] = {
    16,  11,  10,  16,  24,  40,  51,  61,
    12,  12,  14,  19,  26,  58,  60,  55,
    14,  13,  16,  24,  40,  57,  69,  56,
    14,  17,  22,  29,  51,  87,  80,  62,
    18,  22,  37,  56,  68, 109, 103,  77,
    24,  35,  55,  64,  81, 104, 113,  92,
    49,  64,  78,  87, 103, 121, 120, 101,
    72,  92,  95,  98, 112, 100, 103,  99
};
static const unsigned char std_chrominance_quant_tbl[64] = {
    17,  18,  24,  47,  99,  99,  99,  99,
    18,  21,  26,  66,  99,  99,  99,  99,
    24,  26,  56,  99,  99,  99,  99,  99,
    47,  66,  99,  99,  99,  99,  99,  99,
    99,  99,  99,  99,  99,  99,  99,  99,
    99,  99,  99,  99,  99,  99,  99,  99,
    99,  99,  99,  99,  99,  99,  99,  99,
    99,  99,  99,  99,  99,  99,  99,  99
};
#endif

/* Set up the standard Huffman tables (cf. JPEG standard section K.3) */
/* IMPORTANT: these are only valid for 8-bit data precision! */
161
static const uint8_t bits_dc_luminance[17] =
162
{ /* 0-base */ 0, 0, 1, 5, 1, 1, 1, 1, 1, 1, 0, 0, 0, 0, 0, 0, 0 };
163
static const uint8_t val_dc_luminance[] =
164 165
{ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11 };

166
static const uint8_t bits_dc_chrominance[17] =
167
{ /* 0-base */ 0, 0, 3, 1, 1, 1, 1, 1, 1, 1, 1, 1, 0, 0, 0, 0, 0 };
168
static const uint8_t val_dc_chrominance[] =
169 170
{ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11 };

171
static const uint8_t bits_ac_luminance[17] =
172
{ /* 0-base */ 0, 0, 2, 1, 3, 3, 2, 4, 3, 5, 5, 4, 4, 0, 0, 1, 0x7d };
173
static const uint8_t val_ac_luminance[] =
174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196
{ 0x01, 0x02, 0x03, 0x00, 0x04, 0x11, 0x05, 0x12,
  0x21, 0x31, 0x41, 0x06, 0x13, 0x51, 0x61, 0x07,
  0x22, 0x71, 0x14, 0x32, 0x81, 0x91, 0xa1, 0x08,
  0x23, 0x42, 0xb1, 0xc1, 0x15, 0x52, 0xd1, 0xf0,
  0x24, 0x33, 0x62, 0x72, 0x82, 0x09, 0x0a, 0x16,
  0x17, 0x18, 0x19, 0x1a, 0x25, 0x26, 0x27, 0x28,
  0x29, 0x2a, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39,
  0x3a, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49,
  0x4a, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58, 0x59,
  0x5a, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69,
  0x6a, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79,
  0x7a, 0x83, 0x84, 0x85, 0x86, 0x87, 0x88, 0x89,
  0x8a, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, 0x98,
  0x99, 0x9a, 0xa2, 0xa3, 0xa4, 0xa5, 0xa6, 0xa7,
  0xa8, 0xa9, 0xaa, 0xb2, 0xb3, 0xb4, 0xb5, 0xb6,
  0xb7, 0xb8, 0xb9, 0xba, 0xc2, 0xc3, 0xc4, 0xc5,
  0xc6, 0xc7, 0xc8, 0xc9, 0xca, 0xd2, 0xd3, 0xd4,
  0xd5, 0xd6, 0xd7, 0xd8, 0xd9, 0xda, 0xe1, 0xe2,
  0xe3, 0xe4, 0xe5, 0xe6, 0xe7, 0xe8, 0xe9, 0xea,
  0xf1, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7, 0xf8,
  0xf9, 0xfa 
};

197
static const uint8_t bits_ac_chrominance[17] =
198 199
{ /* 0-base */ 0, 0, 2, 1, 2, 4, 4, 3, 4, 7, 5, 4, 4, 0, 1, 2, 0x77 };

200
static const uint8_t val_ac_chrominance[] =
201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224
{ 0x00, 0x01, 0x02, 0x03, 0x11, 0x04, 0x05, 0x21,
  0x31, 0x06, 0x12, 0x41, 0x51, 0x07, 0x61, 0x71,
  0x13, 0x22, 0x32, 0x81, 0x08, 0x14, 0x42, 0x91,
  0xa1, 0xb1, 0xc1, 0x09, 0x23, 0x33, 0x52, 0xf0,
  0x15, 0x62, 0x72, 0xd1, 0x0a, 0x16, 0x24, 0x34,
  0xe1, 0x25, 0xf1, 0x17, 0x18, 0x19, 0x1a, 0x26,
  0x27, 0x28, 0x29, 0x2a, 0x35, 0x36, 0x37, 0x38,
  0x39, 0x3a, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48,
  0x49, 0x4a, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58,
  0x59, 0x5a, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68,
  0x69, 0x6a, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78,
  0x79, 0x7a, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87,
  0x88, 0x89, 0x8a, 0x92, 0x93, 0x94, 0x95, 0x96,
  0x97, 0x98, 0x99, 0x9a, 0xa2, 0xa3, 0xa4, 0xa5,
  0xa6, 0xa7, 0xa8, 0xa9, 0xaa, 0xb2, 0xb3, 0xb4,
  0xb5, 0xb6, 0xb7, 0xb8, 0xb9, 0xba, 0xc2, 0xc3,
  0xc4, 0xc5, 0xc6, 0xc7, 0xc8, 0xc9, 0xca, 0xd2,
  0xd3, 0xd4, 0xd5, 0xd6, 0xd7, 0xd8, 0xd9, 0xda,
  0xe2, 0xe3, 0xe4, 0xe5, 0xe6, 0xe7, 0xe8, 0xe9,
  0xea, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7, 0xf8,
  0xf9, 0xfa 
};

/* isn't this function nicer than the one in the libjpeg ? */
225 226
static void build_huffman_codes(uint8_t *huff_size, uint16_t *huff_code,
                                const uint8_t *bits_table, const uint8_t *val_table)
227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247
{
    int i, j, k,nb, code, sym;

    code = 0;
    k = 0;
    for(i=1;i<=16;i++) {
        nb = bits_table[i];
        for(j=0;j<nb;j++) {
            sym = val_table[k++];
            huff_size[sym] = i;
            huff_code[sym] = code;
            code++;
        }
        code <<= 1;
    }
}

int mjpeg_init(MpegEncContext *s)
{
    MJpegContext *m;
    
248
    m = av_malloc(sizeof(MJpegContext));
249 250
    if (!m)
        return -1;
251 252 253
    
    s->min_qcoeff=-1023;
    s->max_qcoeff= 1023;
254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278

    /* build all the huffman tables */
    build_huffman_codes(m->huff_size_dc_luminance,
                        m->huff_code_dc_luminance,
                        bits_dc_luminance,
                        val_dc_luminance);
    build_huffman_codes(m->huff_size_dc_chrominance,
                        m->huff_code_dc_chrominance,
                        bits_dc_chrominance,
                        val_dc_chrominance);
    build_huffman_codes(m->huff_size_ac_luminance,
                        m->huff_code_ac_luminance,
                        bits_ac_luminance,
                        val_ac_luminance);
    build_huffman_codes(m->huff_size_ac_chrominance,
                        m->huff_code_ac_chrominance,
                        bits_ac_chrominance,
                        val_ac_chrominance);
    
    s->mjpeg_ctx = m;
    return 0;
}

void mjpeg_close(MpegEncContext *s)
{
279
    av_free(s->mjpeg_ctx);
280 281 282 283 284 285 286 287 288 289
}

static inline void put_marker(PutBitContext *p, int code)
{
    put_bits(p, 8, 0xff);
    put_bits(p, 8, code);
}

/* table_class: 0 = DC coef, 1 = AC coefs */
static int put_huffman_table(MpegEncContext *s, int table_class, int table_id,
290
                             const uint8_t *bits_table, const uint8_t *value_table)
291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312
{
    PutBitContext *p = &s->pb;
    int n, i;

    put_bits(p, 4, table_class);
    put_bits(p, 4, table_id);

    n = 0;
    for(i=1;i<=16;i++) {
        n += bits_table[i];
        put_bits(p, 8, bits_table[i]);
    }

    for(i=0;i<n;i++)
        put_bits(p, 8, value_table[i]);

    return n + 17;
}

static void jpeg_table_header(MpegEncContext *s)
{
    PutBitContext *p = &s->pb;
313
    int i, j, size;
314
    uint8_t *ptr;
315 316 317

    /* quant matrixes */
    put_marker(p, DQT);
318 319 320
#ifdef TWOMATRIXES
    put_bits(p, 16, 2 + 2 * (1 + 64));
#else
321
    put_bits(p, 16, 2 + 1 * (1 + 64));
322
#endif
323 324 325
    put_bits(p, 4, 0); /* 8 bit precision */
    put_bits(p, 4, 0); /* table 0 */
    for(i=0;i<64;i++) {
326
        j = s->intra_scantable.permutated[i];
327
        put_bits(p, 8, s->intra_matrix[j]);
328
    }
329
#ifdef TWOMATRIXES
330 331 332
    put_bits(p, 4, 0); /* 8 bit precision */
    put_bits(p, 4, 1); /* table 1 */
    for(i=0;i<64;i++) {
333
        j = s->intra_scantable.permutated[i];
334
        put_bits(p, 8, s->chroma_intra_matrix[j]);
335 336 337 338 339 340
    }
#endif

    /* huffman table */
    put_marker(p, DHT);
    flush_put_bits(p);
341
    ptr = pbBufPtr(p);
342 343 344 345 346 347 348 349 350 351 352
    put_bits(p, 16, 0); /* patched later */
    size = 2;
    size += put_huffman_table(s, 0, 0, bits_dc_luminance, val_dc_luminance);
    size += put_huffman_table(s, 0, 1, bits_dc_chrominance, val_dc_chrominance);
    
    size += put_huffman_table(s, 1, 0, bits_ac_luminance, val_ac_luminance);
    size += put_huffman_table(s, 1, 1, bits_ac_chrominance, val_ac_chrominance);
    ptr[0] = size >> 8;
    ptr[1] = size;
}

353 354 355 356
static void jpeg_put_comments(MpegEncContext *s)
{
    PutBitContext *p = &s->pb;
    int size;
357
    uint8_t *ptr;
358

A
Alex Beregszaszi 已提交
359 360
    if (s->aspect_ratio_info)
    {
361 362 363 364
    /* JFIF header */
    put_marker(p, APP0);
    put_bits(p, 16, 16);
    put_string(p, "JFIF"); /* this puts the trailing zero-byte too */
A
Alex Beregszaszi 已提交
365
    put_bits(p, 16, 0x0201); /* v 1.02 */
366
    put_bits(p, 8, 0); /* units type: 0 - aspect ratio */
A
Alex Beregszaszi 已提交
367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388
    switch(s->aspect_ratio_info)
    {
	case FF_ASPECT_4_3_625:
	case FF_ASPECT_4_3_525:
	    put_bits(p, 16, 4); 
	    put_bits(p, 16, 3);
	    break;
	case FF_ASPECT_16_9_625:
	case FF_ASPECT_16_9_525:
	    put_bits(p, 16, 16); 
	    put_bits(p, 16, 9);
	    break;
	case FF_ASPECT_EXTENDED:
	    put_bits(p, 16, s->aspected_width);
	    put_bits(p, 16, s->aspected_height);
	    break;
	case FF_ASPECT_SQUARE:
	default:
	    put_bits(p, 16, 1); /* aspect: 1:1 */
	    put_bits(p, 16, 1);
	    break;
    }
389 390
    put_bits(p, 8, 0); /* thumbnail width */
    put_bits(p, 8, 0); /* thumbnail height */
A
Alex Beregszaszi 已提交
391
    }
392 393

    /* comment */
394
    if(!(s->flags & CODEC_FLAG_BITEXACT)){
395 396 397 398
        put_marker(p, COM);
        flush_put_bits(p);
        ptr = pbBufPtr(p);
        put_bits(p, 16, 0); /* patched later */
A
Alex Beregszaszi 已提交
399 400
        put_string(p, LIBAVCODEC_IDENT);
        size = strlen(LIBAVCODEC_IDENT)+3;
401 402 403
        ptr[0] = size >> 8;
        ptr[1] = size;
    }
404 405
}

406 407 408 409
void mjpeg_picture_header(MpegEncContext *s)
{
    put_marker(&s->pb, SOI);

410 411
    if (!s->mjpeg_data_only_frames)
    {
412 413
    jpeg_put_comments(s);    

A
Arpi 已提交
414
    if (s->mjpeg_write_tables) jpeg_table_header(s);
415 416 417 418 419 420 421 422 423 424 425

    put_marker(&s->pb, SOF0);

    put_bits(&s->pb, 16, 17);
    put_bits(&s->pb, 8, 8); /* 8 bits/component */
    put_bits(&s->pb, 16, s->height);
    put_bits(&s->pb, 16, s->width);
    put_bits(&s->pb, 8, 3); /* 3 components */
    
    /* Y component */
    put_bits(&s->pb, 8, 1); /* component number */
A
Arpi 已提交
426 427
    put_bits(&s->pb, 4, s->mjpeg_hsample[0]); /* H factor */
    put_bits(&s->pb, 4, s->mjpeg_vsample[0]); /* V factor */
428 429 430 431
    put_bits(&s->pb, 8, 0); /* select matrix */
    
    /* Cb component */
    put_bits(&s->pb, 8, 2); /* component number */
A
Arpi 已提交
432 433
    put_bits(&s->pb, 4, s->mjpeg_hsample[1]); /* H factor */
    put_bits(&s->pb, 4, s->mjpeg_vsample[1]); /* V factor */
434 435 436
#ifdef TWOMATRIXES
    put_bits(&s->pb, 8, 1); /* select matrix */
#else
437
    put_bits(&s->pb, 8, 0); /* select matrix */
438
#endif
439 440 441

    /* Cr component */
    put_bits(&s->pb, 8, 3); /* component number */
A
Arpi 已提交
442 443
    put_bits(&s->pb, 4, s->mjpeg_hsample[2]); /* H factor */
    put_bits(&s->pb, 4, s->mjpeg_vsample[2]); /* V factor */
444 445 446
#ifdef TWOMATRIXES
    put_bits(&s->pb, 8, 1); /* select matrix */
#else
447
    put_bits(&s->pb, 8, 0); /* select matrix */
448
#endif
449
    }
450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472

    /* scan header */
    put_marker(&s->pb, SOS);
    put_bits(&s->pb, 16, 12); /* length */
    put_bits(&s->pb, 8, 3); /* 3 components */
    
    /* Y component */
    put_bits(&s->pb, 8, 1); /* index */
    put_bits(&s->pb, 4, 0); /* DC huffman table index */
    put_bits(&s->pb, 4, 0); /* AC huffman table index */
    
    /* Cb component */
    put_bits(&s->pb, 8, 2); /* index */
    put_bits(&s->pb, 4, 1); /* DC huffman table index */
    put_bits(&s->pb, 4, 1); /* AC huffman table index */
    
    /* Cr component */
    put_bits(&s->pb, 8, 3); /* index */
    put_bits(&s->pb, 4, 1); /* DC huffman table index */
    put_bits(&s->pb, 4, 1); /* AC huffman table index */

    put_bits(&s->pb, 8, 0); /* Ss (not used) */
    put_bits(&s->pb, 8, 63); /* Se (not used) */
473
    put_bits(&s->pb, 8, 0); /* Ah/Al (not used) */
474 475
}

M
cleanup  
Michael Niedermayer 已提交
476
static void escape_FF(MpegEncContext *s, int start)
M
cleanup  
Michael Niedermayer 已提交
477
{
M
cleanup  
Michael Niedermayer 已提交
478
    int size= get_bit_count(&s->pb) - start*8;
M
cleanup  
Michael Niedermayer 已提交
479
    int i, ff_count;
M
cleanup  
Michael Niedermayer 已提交
480
    uint8_t *buf= s->pb.buf + start;
F
Falk Hüffner 已提交
481
    int align= (-(size_t)(buf))&3;
M
cleanup  
Michael Niedermayer 已提交
482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531
    
    assert((size&7) == 0);
    size >>= 3;
    
    ff_count=0;
    for(i=0; i<size && i<align; i++){
        if(buf[i]==0xFF) ff_count++;
    }
    for(; i<size-15; i+=16){
        int acc, v;

        v= *(uint32_t*)(&buf[i]);
        acc= (((v & (v>>4))&0x0F0F0F0F)+0x01010101)&0x10101010;
        v= *(uint32_t*)(&buf[i+4]);
        acc+=(((v & (v>>4))&0x0F0F0F0F)+0x01010101)&0x10101010;
        v= *(uint32_t*)(&buf[i+8]);
        acc+=(((v & (v>>4))&0x0F0F0F0F)+0x01010101)&0x10101010;
        v= *(uint32_t*)(&buf[i+12]);
        acc+=(((v & (v>>4))&0x0F0F0F0F)+0x01010101)&0x10101010;

        acc>>=4;
        acc+= (acc>>16);
        acc+= (acc>>8);
        ff_count+= acc&0xFF;
    }
    for(; i<size; i++){
        if(buf[i]==0xFF) ff_count++;
    }

    if(ff_count==0) return;
    
    /* skip put bits */
    for(i=0; i<ff_count-3; i+=4)
        put_bits(&s->pb, 32, 0);
    put_bits(&s->pb, (ff_count-i)*8, 0);
    flush_put_bits(&s->pb); 

    for(i=size-1; ff_count; i--){
        int v= buf[i];

        if(v==0xFF){
//printf("%d %d\n", i, ff_count);
            buf[i+ff_count]= 0;
            ff_count--;
        }

        buf[i+ff_count]= v;
    }
}

532 533
void mjpeg_picture_trailer(MpegEncContext *s)
{
M
cleanup  
Michael Niedermayer 已提交
534 535 536 537 538
    int pad= (-get_bit_count(&s->pb))&7;
    
    put_bits(&s->pb, pad,0xFF>>(8-pad));
    flush_put_bits(&s->pb);

M
cleanup  
Michael Niedermayer 已提交
539 540 541
    assert((s->header_bits&7)==0);
    
    escape_FF(s, s->header_bits>>3);
M
cleanup  
Michael Niedermayer 已提交
542

543 544 545
    put_marker(&s->pb, EOI);
}

546
static inline void mjpeg_encode_dc(MpegEncContext *s, int val,
547
				   uint8_t *huff_size, uint16_t *huff_code)
548 549 550 551
{
    int mant, nbits;

    if (val == 0) {
M
cleanup  
Michael Niedermayer 已提交
552
        put_bits(&s->pb, huff_size[0], huff_code[0]);
553 554 555 556 557 558 559
    } else {
        mant = val;
        if (val < 0) {
            val = -val;
            mant--;
        }
        
M
Michael Niedermayer 已提交
560
        nbits= av_log2(val) + 1;
561
            
M
cleanup  
Michael Niedermayer 已提交
562
        put_bits(&s->pb, huff_size[nbits], huff_code[nbits]);
563
        
M
cleanup  
Michael Niedermayer 已提交
564
        put_bits(&s->pb, nbits, mant & ((1 << nbits) - 1));
565 566 567 568 569 570 571 572
    }
}

static void encode_block(MpegEncContext *s, DCTELEM *block, int n)
{
    int mant, nbits, code, i, j;
    int component, dc, run, last_index, val;
    MJpegContext *m = s->mjpeg_ctx;
573 574
    uint8_t *huff_size_ac;
    uint16_t *huff_code_ac;
575 576 577 578 579 580
    
    /* DC coef */
    component = (n <= 3 ? 0 : n - 4 + 1);
    dc = block[0]; /* overflow is impossible */
    val = dc - s->last_dc[component];
    if (n < 4) {
581
        mjpeg_encode_dc(s, val, m->huff_size_dc_luminance, m->huff_code_dc_luminance);
582 583 584
        huff_size_ac = m->huff_size_ac_luminance;
        huff_code_ac = m->huff_code_ac_luminance;
    } else {
585
        mjpeg_encode_dc(s, val, m->huff_size_dc_chrominance, m->huff_code_dc_chrominance);
586 587 588 589 590 591 592 593 594 595
        huff_size_ac = m->huff_size_ac_chrominance;
        huff_code_ac = m->huff_code_ac_chrominance;
    }
    s->last_dc[component] = dc;
    
    /* AC coefs */
    
    run = 0;
    last_index = s->block_last_index[n];
    for(i=1;i<=last_index;i++) {
596
        j = s->intra_scantable.permutated[i];
597 598 599 600 601
        val = block[j];
        if (val == 0) {
            run++;
        } else {
            while (run >= 16) {
M
cleanup  
Michael Niedermayer 已提交
602
                put_bits(&s->pb, huff_size_ac[0xf0], huff_code_ac[0xf0]);
603 604 605 606 607 608 609 610
                run -= 16;
            }
            mant = val;
            if (val < 0) {
                val = -val;
                mant--;
            }
            
M
Michael Niedermayer 已提交
611
            nbits= av_log2(val) + 1;
612 613
            code = (run << 4) | nbits;

M
cleanup  
Michael Niedermayer 已提交
614
            put_bits(&s->pb, huff_size_ac[code], huff_code_ac[code]);
615
        
M
cleanup  
Michael Niedermayer 已提交
616
            put_bits(&s->pb, nbits, mant & ((1 << nbits) - 1));
617 618 619 620 621 622
            run = 0;
        }
    }

    /* output EOB only if not already 64 values */
    if (last_index < 63 || run != 0)
M
cleanup  
Michael Niedermayer 已提交
623
        put_bits(&s->pb, huff_size_ac[0], huff_code_ac[0]);
624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640
}

void mjpeg_encode_mb(MpegEncContext *s, 
                     DCTELEM block[6][64])
{
    int i;
    for(i=0;i<6;i++) {
        encode_block(s, block[i], i);
    }
}

/******************************************/
/* decoding */

#define MAX_COMPONENTS 4

typedef struct MJpegDecodeContext {
641
    AVCodecContext *avctx;
642
    GetBitContext gb;
643 644
    int mpeg_enc_ctx_allocated; /* true if decoding context allocated */

645 646
    int start_code; /* current start code */
    int buffer_size;
647
    uint8_t *buffer;
648

649
    int16_t quant_matrixes[4][64];
650
    VLC vlcs[2][4];
F
Fabrice Bellard 已提交
651 652 653 654 655 656

    int org_width, org_height;  /* size given at codec init */
    int first_picture;    /* true if decoding first picture */
    int interlaced;     /* true if interlaced */
    int bottom_field;   /* true if bottom field */

657
    int width, height;
658 659
    int nb_components;
    int component_id[MAX_COMPONENTS];
660 661 662 663 664
    int h_count[MAX_COMPONENTS]; /* horizontal and vertical count for each component */
    int v_count[MAX_COMPONENTS];
    int h_max, v_max; /* maximum h and v counts */
    int quant_index[4];   /* quant table index for each component */
    int last_dc[MAX_COMPONENTS]; /* last DEQUANTIZED dc (XXX: am I right to do that ?) */
665
    uint8_t *current_picture[MAX_COMPONENTS]; /* picture structure */
666 667
    int linesize[MAX_COMPONENTS];
    DCTELEM block[64] __align8;
668
    ScanTable scantable;
669
    void (*idct_put)(uint8_t *dest/*align 8*/, int line_size, DCTELEM *block/*align 16*/);
670

671 672
    int restart_interval;
    int restart_count;
673 674

    int buggy_avid;
675
    int interlace_polarity;
676 677
} MJpegDecodeContext;

678
static int mjpeg_decode_dht(MJpegDecodeContext *s);
J
Juanjo 已提交
679

680
static void build_vlc(VLC *vlc, const uint8_t *bits_table, const uint8_t *val_table, 
681 682
                      int nb_codes)
{
683 684
    uint8_t huff_size[256];
    uint16_t huff_code[256];
685 686 687 688 689 690 691

    memset(huff_size, 0, sizeof(huff_size));
    build_huffman_codes(huff_size, huff_code, bits_table, val_table);
    
    init_vlc(vlc, 9, nb_codes, huff_size, 1, 1, huff_code, 2, 2);
}

692 693 694
static int mjpeg_decode_init(AVCodecContext *avctx)
{
    MJpegDecodeContext *s = avctx->priv_data;
695
    MpegEncContext s2;
696

697 698
    s->avctx = avctx;

699
    /* ugly way to get the idct & scantable FIXME */
700 701 702 703 704 705 706 707 708
    memset(&s2, 0, sizeof(MpegEncContext));
    s2.flags= avctx->flags;
    s2.avctx= avctx;
//    s2->out_format = FMT_MJPEG;
    s2.width = 8;
    s2.height = 8;
    if (MPV_common_init(&s2) < 0)
       return -1;
    s->scantable= s2.intra_scantable;
709
    s->idct_put= s2.dsp.idct_put;
710 711
    MPV_common_end(&s2);

712
    s->mpeg_enc_ctx_allocated = 0;
713 714
    s->buffer_size = 102400; /* smaller buffer should be enough,
				but photojpg files could ahive bigger sizes */
715
    s->buffer = av_malloc(s->buffer_size);
716 717
    if (!s->buffer)
	return -1;
718
    s->start_code = -1;
F
Fabrice Bellard 已提交
719 720 721
    s->first_picture = 1;
    s->org_width = avctx->width;
    s->org_height = avctx->height;
722
    
723 724 725 726
    build_vlc(&s->vlcs[0][0], bits_dc_luminance, val_dc_luminance, 12);
    build_vlc(&s->vlcs[0][1], bits_dc_chrominance, val_dc_chrominance, 12);
    build_vlc(&s->vlcs[1][0], bits_ac_luminance, val_ac_luminance, 251);
    build_vlc(&s->vlcs[1][1], bits_ac_chrominance, val_ac_chrominance, 251);
727

728 729 730
    if (avctx->flags & CODEC_FLAG_EXTERN_HUFF)
    {
	printf("mjpeg: using external huffman table\n");
731
	init_get_bits(&s->gb, avctx->extradata, avctx->extradata_size*8);
732
	mjpeg_decode_dht(s);
733 734
	/* should check for error - but dunno */
    }
735

736 737 738 739
    return 0;
}

/* quantize tables */
740
static int mjpeg_decode_dqt(MJpegDecodeContext *s)
741
{
742
    int len, index, i, j;
743 744
    
    len = get_bits(&s->gb, 16) - 2;
745 746 747 748

    while (len >= 65) {
        /* only 8 bit precision handled */
        if (get_bits(&s->gb, 4) != 0)
749 750
	{
	    dprintf("dqt: 16bit precision\n");
751
            return -1;
752
	}
753 754 755 756 757
        index = get_bits(&s->gb, 4);
        if (index >= 4)
            return -1;
        dprintf("index=%d\n", index);
        /* read quant table */
758
        for(i=0;i<64;i++) {
759
            j = s->scantable.permutated[i];
760
	    s->quant_matrixes[index][j] = get_bits(&s->gb, 8);
761
        }
762 763
        len -= 65;
    }
764
    
765 766 767 768
    return 0;
}

/* decode huffman tables and build VLC decoders */
769
static int mjpeg_decode_dht(MJpegDecodeContext *s)
770 771
{
    int len, index, i, class, n, v, code_max;
772 773
    uint8_t bits_table[17];
    uint8_t val_table[256];
774
    
775
    len = get_bits(&s->gb, 16) - 2;
776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807

    while (len > 0) {
        if (len < 17)
            return -1;
        class = get_bits(&s->gb, 4);
        if (class >= 2)
            return -1;
        index = get_bits(&s->gb, 4);
        if (index >= 4)
            return -1;
        n = 0;
        for(i=1;i<=16;i++) {
            bits_table[i] = get_bits(&s->gb, 8);
            n += bits_table[i];
        }
        len -= 17;
        if (len < n || n > 256)
            return -1;

        code_max = 0;
        for(i=0;i<n;i++) {
            v = get_bits(&s->gb, 8);
            if (v > code_max)
                code_max = v;
            val_table[i] = v;
        }
        len -= n;

        /* build VLC and flush previous vlc if present */
        free_vlc(&s->vlcs[class][index]);
        dprintf("class=%d index=%d nb_codes=%d\n",
               class, index, code_max + 1);
808
        build_vlc(&s->vlcs[class][index], bits_table, val_table, code_max + 1);
809 810 811 812
    }
    return 0;
}

813
static int mjpeg_decode_sof0(MJpegDecodeContext *s)
814
{
815
    int len, nb_components, i, width, height;
816 817 818 819 820 821 822 823

    /* XXX: verify len field validity */
    len = get_bits(&s->gb, 16);
    /* only 8 bits/component accepted */
    if (get_bits(&s->gb, 8) != 8)
        return -1;
    height = get_bits(&s->gb, 16);
    width = get_bits(&s->gb, 16);
824
    dprintf("sof0: picture: %dx%d\n", width, height);
825 826 827 828 829

    nb_components = get_bits(&s->gb, 8);
    if (nb_components <= 0 ||
        nb_components > MAX_COMPONENTS)
        return -1;
830
    s->nb_components = nb_components;
831 832 833 834
    s->h_max = 1;
    s->v_max = 1;
    for(i=0;i<nb_components;i++) {
        /* component id */
835
        s->component_id[i] = get_bits(&s->gb, 8) - 1;
836 837 838 839 840 841 842 843 844 845
        s->h_count[i] = get_bits(&s->gb, 4);
        s->v_count[i] = get_bits(&s->gb, 4);
        /* compute hmax and vmax (only used in interleaved case) */
        if (s->h_count[i] > s->h_max)
            s->h_max = s->h_count[i];
        if (s->v_count[i] > s->v_max)
            s->v_max = s->v_count[i];
        s->quant_index[i] = get_bits(&s->gb, 8);
        if (s->quant_index[i] >= 4)
            return -1;
846 847
        dprintf("component %d %d:%d id: %d quant:%d\n", i, s->h_count[i],
	    s->v_count[i], s->component_id[i], s->quant_index[i]);
848 849 850 851 852
    }

    /* if different size, realloc/alloc picture */
    /* XXX: also check h_count and v_count */
    if (width != s->width || height != s->height) {
853 854
        for(i=0;i<MAX_COMPONENTS;i++)
            av_freep(&s->current_picture[i]);
855 856
        s->width = width;
        s->height = height;
F
Fabrice Bellard 已提交
857 858 859 860 861
        /* test interlaced mode */
        if (s->first_picture &&
            s->org_height != 0 &&
            s->height < ((s->org_height * 3) / 4)) {
            s->interlaced = 1;
862
//	    s->bottom_field = (s->interlace_polarity) ? 1 : 0;
863
	    s->bottom_field = 0;
F
Fabrice Bellard 已提交
864 865
        }

866
        for(i=0;i<nb_components;i++) {
867 868 869 870 871
            int w, h;
            w = (s->width  + 8 * s->h_max - 1) / (8 * s->h_max);
            h = (s->height + 8 * s->v_max - 1) / (8 * s->v_max);
            w = w * 8 * s->h_count[i];
            h = h * 8 * s->v_count[i];
F
Fabrice Bellard 已提交
872 873
            if (s->interlaced)
                w *= 2;
874 875
            s->linesize[i] = w;
            s->current_picture[i] = av_mallocz(w * h);
A
10l fix  
Alex Beregszaszi 已提交
876 877 878 879 880
	    if (!s->current_picture[i])
	    {
		dprintf("error: no picture buffers allocated\n");
		return -1;
	    }
881
        }
F
Fabrice Bellard 已提交
882
        s->first_picture = 0;
883
    }
884

885 886
    if (len != (8+(3*nb_components)))
    {
887
	dprintf("decode_sof0: error, len(%d) mismatch\n", len);
888
    }
F
Fabrice Bellard 已提交
889
    
890 891 892
    return 0;
}

893
static inline int mjpeg_decode_dc(MJpegDecodeContext *s, int dc_index)
894
{
M
Michael Niedermayer 已提交
895
    int code;
M
Michael Niedermayer 已提交
896
    code = get_vlc2(&s->gb, s->vlcs[0][dc_index].table, 9, 2);
897
    if (code < 0)
898
    {
899
	dprintf("mjpeg_decode_dc: bad vlc: %d:%d (%p)\n", 0, dc_index,
900
                &s->vlcs[0][dc_index]);
901
        return 0xffff;
902
    }
M
Michael Niedermayer 已提交
903 904 905 906 907

    if(code)
        return get_xbits(&s->gb, code);
    else
        return 0;
908 909 910 911 912 913
}

/* decode block and dequantize */
static int decode_block(MJpegDecodeContext *s, DCTELEM *block, 
                        int component, int dc_index, int ac_index, int quant_index)
{
M
Michael Niedermayer 已提交
914
    int code, i, j, level, val;
915
    VLC *ac_vlc;
916
    int16_t *quant_matrix;
917 918

    /* DC coef */
919
    val = mjpeg_decode_dc(s, dc_index);
920 921 922 923
    if (val == 0xffff) {
        dprintf("error dc\n");
        return -1;
    }
924
    quant_matrix = s->quant_matrixes[quant_index];
925 926 927 928 929 930 931
    val = val * quant_matrix[0] + s->last_dc[component];
    s->last_dc[component] = val;
    block[0] = val;
    /* AC coefs */
    ac_vlc = &s->vlcs[1][ac_index];
    i = 1;
    for(;;) {
M
Michael Niedermayer 已提交
932
	code = get_vlc2(&s->gb, s->vlcs[1][ac_index].table, 9, 2);
M
cleanup  
Michael Niedermayer 已提交
933

934 935 936 937 938 939 940 941 942 943
        if (code < 0) {
            dprintf("error ac\n");
            return -1;
        }
        /* EOB */
        if (code == 0)
            break;
        if (code == 0xf0) {
            i += 16;
        } else {
M
Michael Niedermayer 已提交
944 945
            level = get_xbits(&s->gb, code & 0xf);
            i += code >> 4;
946 947 948 949
            if (i >= 64) {
                dprintf("error count: %d\n", i);
                return -1;
            }
950
            j = s->scantable.permutated[i];
951 952
            block[j] = level * quant_matrix[j];
            i++;
953 954
            if (i >= 64)
                break;
955 956 957 958 959
        }
    }
    return 0;
}

960
static int mjpeg_decode_sos(MJpegDecodeContext *s)
961
{
962
    int len, nb_components, i, j, n, h, v, ret;
963
    int mb_width, mb_height, mb_x, mb_y, vmax, hmax, index, id;
964 965 966 967 968 969 970 971 972 973
    int comp_index[4];
    int dc_index[4];
    int ac_index[4];
    int nb_blocks[4];
    int h_count[4];
    int v_count[4];
    
    /* XXX: verify len field validity */
    len = get_bits(&s->gb, 16);
    nb_components = get_bits(&s->gb, 8);
974 975 976 977 978
    if (len != 6+2*nb_components)
    {
	dprintf("decode_sos: invalid len (%d)\n", len);
	return -1;
    }
979 980
    /* XXX: only interleaved scan accepted */
    if (nb_components != 3)
981 982
    {
	dprintf("decode_sos: components(%d) mismatch\n", nb_components);
983
        return -1;
984
    }
985 986 987
    vmax = 0;
    hmax = 0;
    for(i=0;i<nb_components;i++) {
988
        id = get_bits(&s->gb, 8) - 1;
989
	dprintf("component: %d\n", id);
990 991 992 993 994
        /* find component index */
        for(index=0;index<s->nb_components;index++)
            if (id == s->component_id[index])
                break;
        if (index == s->nb_components)
995
	{
996
	    dprintf("decode_sos: index(%d) out of components\n", index);
997
            return -1;
998
	}
999

1000 1001 1002 1003
        comp_index[i] = index;
        nb_blocks[i] = s->h_count[index] * s->v_count[index];
        h_count[i] = s->h_count[index];
        v_count[i] = s->v_count[index];
1004

1005 1006
        dc_index[i] = get_bits(&s->gb, 4);
        ac_index[i] = get_bits(&s->gb, 4);
1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026

	if (dc_index[i] < 0 || ac_index[i] < 0 ||
	    dc_index[i] >= 4 || ac_index[i] >= 4)
	    goto out_of_range;
	switch(s->start_code)
	{
	    case SOF0:
		if (dc_index[i] > 1 || ac_index[i] > 1)
		    goto out_of_range;
		break;
	    case SOF1:
	    case SOF2:
		if (dc_index[i] > 3 || ac_index[i] > 3)
		    goto out_of_range;
		break;
	    case SOF3:
		if (dc_index[i] > 3 || ac_index[i] != 0)
		    goto out_of_range;
		break;	
	}
1027
    }
1028 1029 1030
    skip_bits(&s->gb, 8); /* Ss */
    skip_bits(&s->gb, 8); /* Se */
    skip_bits(&s->gb, 8); /* Ah and Al (each are 4 bits) */
1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047

    for(i=0;i<nb_components;i++) 
        s->last_dc[i] = 1024;

    if (nb_components > 1) {
        /* interleaved stream */
        mb_width = (s->width + s->h_max * 8 - 1) / (s->h_max * 8);
        mb_height = (s->height + s->v_max * 8 - 1) / (s->v_max * 8);
    } else {
        h = s->h_max / s->h_count[comp_index[0]];
        v = s->v_max / s->v_count[comp_index[0]];
        mb_width = (s->width + h * 8 - 1) / (h * 8);
        mb_height = (s->height + v * 8 - 1) / (v * 8);
        nb_blocks[0] = 1;
        h_count[0] = 1;
        v_count[0] = 1;
    }
1048
    
1049 1050 1051
    for(mb_y = 0; mb_y < mb_height; mb_y++) {
        for(mb_x = 0; mb_x < mb_width; mb_x++) {
            for(i=0;i<nb_components;i++) {
1052
                uint8_t *ptr;
1053 1054 1055 1056 1057 1058 1059
                int x, y, c;
                n = nb_blocks[i];
                c = comp_index[i];
                h = h_count[i];
                v = v_count[i];
                x = 0;
                y = 0;
1060 1061
		if (s->restart_interval && !s->restart_count)
		    s->restart_count = s->restart_interval;
1062 1063 1064 1065 1066
                for(j=0;j<n;j++) {
                    memset(s->block, 0, sizeof(s->block));
                    if (decode_block(s, s->block, i, 
                                     dc_index[i], ac_index[i], 
                                     s->quant_index[c]) < 0) {
1067
                        dprintf("error y=%d x=%d\n", mb_y, mb_x);
1068 1069
                        ret = -1;
                        goto the_end;
1070
                    }
1071
//		    dprintf("mb: %d %d processed\n", mb_y, mb_x);
1072 1073 1074
                    ptr = s->current_picture[c] + 
                        (s->linesize[c] * (v * mb_y + y) * 8) + 
                        (h * mb_x + x) * 8;
F
Fabrice Bellard 已提交
1075 1076
                    if (s->interlaced && s->bottom_field)
                        ptr += s->linesize[c] >> 1;
1077
                    s->idct_put(ptr, s->linesize[c], s->block);
1078 1079 1080 1081 1082 1083
                    if (++x == h) {
                        x = 0;
                        y++;
                    }
                }
            }
1084
	    /* (< 1350) buggy workaround for Spectralfan.mov, should be fixed */
1085 1086
            if (s->restart_interval && (s->restart_interval < 1350) &&
		!--s->restart_count) {
1087 1088 1089 1090 1091
                align_get_bits(&s->gb);
                skip_bits(&s->gb, 16); /* skip RSTn */
                for (j=0; j<nb_components; j++) /* reset dc */
                    s->last_dc[j] = 1024;
            }
1092 1093
        }
    }
1094 1095
    ret = 0;
 the_end:
1096
    emms_c();
1097
    return ret;
1098 1099 1100
 out_of_range:
    dprintf("decode_sos: ac/dc index out of range\n");
    return -1;
1101 1102
}

1103
static int mjpeg_decode_dri(MJpegDecodeContext *s)
1104 1105 1106 1107
{
    if (get_bits(&s->gb, 16) != 4)
	return -1;
    s->restart_interval = get_bits(&s->gb, 16);
1108
    dprintf("restart interval: %d\n", s->restart_interval);
1109 1110 1111 1112

    return 0;
}

1113
static int mjpeg_decode_app(MJpegDecodeContext *s)
1114 1115 1116 1117
{
    int len, id;

    /* XXX: verify len field validity */
1118
    len = get_bits(&s->gb, 16);
1119 1120
    if (len < 5)
	return -1;
1121

A
Alex Beregszaszi 已提交
1122 1123
    id = (get_bits(&s->gb, 16) << 16) | get_bits(&s->gb, 16);
    id = be2me_32(id);
1124 1125 1126
    len -= 6;

    /* buggy AVID, it puts EOI only at every 10th frame */
1127 1128
    /* also this fourcc is used by non-avid files too, it holds some
       informations, but it's always present in AVID creates files */
1129
    if (id == ff_get_fourcc("AVI1"))
1130
    {
1131 1132 1133 1134 1135 1136 1137 1138
	/* structure:
	    4bytes	AVI1
	    1bytes	polarity
	    1bytes	always zero
	    4bytes	field_size
	    4bytes	field_size_less_padding
	*/
    	s->buggy_avid = 1;
1139 1140 1141
//	if (s->first_picture)
//	    printf("mjpeg: workarounding buggy AVID\n");
	s->interlace_polarity = get_bits(&s->gb, 8);
1142 1143 1144 1145 1146 1147
#if 0
	skip_bits(&s->gb, 8);
	skip_bits(&s->gb, 32);
	skip_bits(&s->gb, 32);
	len -= 10;
#endif
1148 1149
//	if (s->interlace_polarity)
//	    printf("mjpeg: interlace polarity: %d\n", s->interlace_polarity);
1150
	goto out;
1151 1152
    }
    
1153
//    len -= 2;
1154
    
1155
    if (id == ff_get_fourcc("JFIF"))
1156
    {
1157
	int t_w, t_h;
1158 1159 1160
	skip_bits(&s->gb, 8); /* the trailing zero-byte */
	printf("mjpeg: JFIF header found (version: %x.%x)\n",
	    get_bits(&s->gb, 8), get_bits(&s->gb, 8));
A
Alex Beregszaszi 已提交
1161 1162
	if (get_bits(&s->gb, 8) == 0)
	{
1163 1164 1165
	    int x_density, y_density; 
	    x_density = get_bits(&s->gb, 16);
	    y_density = get_bits(&s->gb, 16);
M
cleanup  
Michael Niedermayer 已提交
1166

1167 1168 1169
	    dprintf("x/y density: %d (%f), %d (%f)\n", x_density,
		(float)x_density, y_density, (float)y_density);
#if 0
M
cleanup  
Michael Niedermayer 已提交
1170
            //MN: needs to be checked
1171
            if(x_density)
1172 1173 1174
//                s->avctx->aspect_ratio= s->width*y_density/((float)s->height*x_density);
		s->avctx->aspect_ratio = (float)x_density/y_density;
		/* it's better, but every JFIF I have seen stores 1:1 */
1175 1176
            else
                s->avctx->aspect_ratio= 0.0;
1177
#endif
A
Alex Beregszaszi 已提交
1178 1179 1180 1181 1182 1183
	}
	else
	{
	    skip_bits(&s->gb, 16);
	    skip_bits(&s->gb, 16);
	}
1184

1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204
	t_w = get_bits(&s->gb, 8);
	t_h = get_bits(&s->gb, 8);
	if (t_w && t_h)
	{
	    /* skip thumbnail */
	    if (len-10-(t_w*t_h*3) > 0)
		len -= t_w*t_h*3;
	}
	len -= 10;
	goto out;
    }
    
    if (id == ff_get_fourcc("Adob") && (get_bits(&s->gb, 8) == 'e'))
    {
	printf("mjpeg: Adobe header found\n");
	skip_bits(&s->gb, 16); /* version */
	skip_bits(&s->gb, 16); /* flags0 */
	skip_bits(&s->gb, 16); /* flags1 */
	skip_bits(&s->gb, 8); /* transform */
	len -= 7;
1205 1206 1207 1208
	goto out;
    }
    
    /* Apple MJPEG-A */
1209
    if ((s->start_code == APP1) && (len > (0x28 - 8)))
1210
    {
A
Alex Beregszaszi 已提交
1211 1212
	id = (get_bits(&s->gb, 16) << 16) | get_bits(&s->gb, 16);
	id = be2me_32(id);
1213
	len -= 4;
1214
	if (id == ff_get_fourcc("mjpg")) /* Apple MJPEG-A */
1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229
	{
#if 0
	    skip_bits(&s->gb, 32); /* field size */
	    skip_bits(&s->gb, 32); /* pad field size */
	    skip_bits(&s->gb, 32); /* next off */
	    skip_bits(&s->gb, 32); /* quant off */
	    skip_bits(&s->gb, 32); /* huff off */
	    skip_bits(&s->gb, 32); /* image off */
	    skip_bits(&s->gb, 32); /* scan off */
	    skip_bits(&s->gb, 32); /* data off */
#endif
	    if (s->first_picture)
		printf("mjpeg: Apple MJPEG-A header found\n");
	}
    }
1230

1231
out:
1232 1233 1234 1235 1236 1237
    /* slow but needed for extreme adobe jpegs */
    if (len < 0)
	printf("mjpeg: error, decode_app parser read over the end\n");
    while(--len > 0)
	skip_bits(&s->gb, 8);

1238 1239 1240
    return 0;
}

1241
static int mjpeg_decode_com(MJpegDecodeContext *s)
1242 1243
{
    /* XXX: verify len field validity */
1244 1245 1246
    unsigned int len = get_bits(&s->gb, 16);
    if (len >= 2 && len < 32768) {
	/* XXX: any better upper bound */
1247
	uint8_t *cbuf = av_malloc(len - 1);
1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265
	if (cbuf) {
	    int i;
	    for (i = 0; i < len - 2; i++)
		cbuf[i] = get_bits(&s->gb, 8);
	    if (i > 0 && cbuf[i-1] == '\n')
		cbuf[i-1] = 0;
	    else
		cbuf[i] = 0;

	    printf("mjpeg comment: '%s'\n", cbuf);

	    /* buggy avid, it puts EOI only at every 10th frame */
	    if (!strcmp(cbuf, "AVID"))
	    {
		s->buggy_avid = 1;
		//	if (s->first_picture)
		//	    printf("mjpeg: workarounding buggy AVID\n");
	    }
1266

1267 1268
	    av_free(cbuf);
	}
1269 1270 1271 1272 1273
    }

    return 0;
}

1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296
#if 0
static int valid_marker_list[] =
{
        /* 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, a, b, c, d, e, f */
/* 0 */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* 1 */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* 2 */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* 3 */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* 4 */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* 5 */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* 6 */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* 7 */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* 8 */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* 9 */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* a */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* b */    0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
/* c */    1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
/* d */    1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
/* e */    1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
/* f */    1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 0,
}
#endif

1297 1298
/* return the 8 bit start code value and update the search
   state. Return -1 if no start code found */
1299
static int find_marker(uint8_t **pbuf_ptr, uint8_t *buf_end)
1300
{
1301
    uint8_t *buf_ptr;
1302
    unsigned int v, v2;
1303
    int val;
1304 1305 1306
#ifdef DEBUG
    int skipped=0;
#endif
1307 1308

    buf_ptr = *pbuf_ptr;
1309 1310 1311 1312 1313 1314
    while (buf_ptr < buf_end) {
        v = *buf_ptr++;
	v2 = *buf_ptr;
        if ((v == 0xff) && (v2 >= 0xc0) && (v2 <= 0xfe)) {
	    val = *buf_ptr++;
	    goto found;
1315
        }
1316 1317 1318
#ifdef DEBUG
	skipped++;
#endif
1319
    }
1320 1321 1322 1323 1324
    val = -1;
found:
#ifdef DEBUG
    dprintf("find_marker skipped %d bytes\n", skipped);
#endif
1325 1326 1327 1328 1329 1330
    *pbuf_ptr = buf_ptr;
    return val;
}

static int mjpeg_decode_frame(AVCodecContext *avctx, 
                              void *data, int *data_size,
1331
                              uint8_t *buf, int buf_size)
1332 1333
{
    MJpegDecodeContext *s = avctx->priv_data;
1334
    uint8_t *buf_end, *buf_ptr;
1335
    int i, start_code;
1336 1337
    AVPicture *picture = data;

F
Fabrice Bellard 已提交
1338 1339
    *data_size = 0;

1340
    /* no supplementary picture */
F
Fabrice Bellard 已提交
1341
    if (buf_size == 0)
1342 1343 1344 1345 1346 1347
        return 0;

    buf_ptr = buf;
    buf_end = buf + buf_size;
    while (buf_ptr < buf_end) {
        /* find start next marker */
1348 1349 1350 1351 1352
        start_code = find_marker(&buf_ptr, buf_end);
	{
	    /* EOF */
            if (start_code < 0) {
		goto the_end;
1353
            } else {
1354 1355 1356 1357 1358 1359 1360
                dprintf("marker=%x avail_size_in_buf=%d\n", start_code, buf_end - buf_ptr);
		
		if ((buf_end - buf_ptr) > s->buffer_size)
		{
		    av_free(s->buffer);
		    s->buffer_size = buf_end-buf_ptr;
		    s->buffer = av_malloc(s->buffer_size);
1361 1362
		    dprintf("buffer too small, expanding to %d bytes\n",
			s->buffer_size);
1363 1364 1365 1366 1367
		}
		
		/* unescape buffer of SOS */
		if (start_code == SOS)
		{
1368 1369
		    uint8_t *src = buf_ptr;
		    uint8_t *dst = s->buffer;
1370 1371 1372

		    while (src<buf_end)
		    {
1373
			uint8_t x = *(src++);
1374

1375 1376 1377
			*(dst++) = x;
			if (x == 0xff)
			{
M
cleanup  
Michael Niedermayer 已提交
1378 1379
			    while(*src == 0xff) src++;

1380 1381 1382 1383 1384 1385 1386
			    x = *(src++);
			    if (x >= 0xd0 && x <= 0xd7)
				*(dst++) = x;
			    else if (x)
				break;
			}
		    }
1387
		    init_get_bits(&s->gb, s->buffer, (dst - s->buffer)*8);
1388 1389 1390
		    
		    dprintf("escaping removed %d bytes\n",
			(buf_end - buf_ptr) - (dst - s->buffer));
1391 1392
		}
		else
1393
		    init_get_bits(&s->gb, buf_ptr, (buf_end - buf_ptr)*8);
1394 1395 1396 1397 1398 1399 1400 1401 1402
		
		s->start_code = start_code;

		/* process markers */
		if (start_code >= 0xd0 && start_code <= 0xd7) {
		    dprintf("restart marker: %d\n", start_code&0x0f);
		} else if (s->first_picture) {
		    /* APP fields */
		    if (start_code >= 0xe0 && start_code <= 0xef)
1403
			mjpeg_decode_app(s);
1404 1405 1406 1407 1408
		    /* Comment */
		    else if (start_code == COM)
			mjpeg_decode_com(s);
		}

1409 1410
                switch(start_code) {
                case SOI:
1411
		    s->restart_interval = 0;
1412 1413 1414
                    /* nothing to do on SOI */
                    break;
                case DQT:
1415
                    mjpeg_decode_dqt(s);
1416 1417
                    break;
                case DHT:
1418
                    mjpeg_decode_dht(s);
1419 1420
                    break;
                case SOF0:
A
10l fix  
Alex Beregszaszi 已提交
1421 1422
                    if (mjpeg_decode_sof0(s) < 0)
			return -1;
1423
                    break;
1424 1425 1426
		case EOI:
eoi_parser:
		    {
F
Fabrice Bellard 已提交
1427 1428 1429 1430
                        if (s->interlaced) {
                            s->bottom_field ^= 1;
                            /* if not bottom field, do not output image yet */
                            if (s->bottom_field)
1431
                                goto not_the_end;
F
Fabrice Bellard 已提交
1432
                        }
1433 1434
                        for(i=0;i<3;i++) {
                            picture->data[i] = s->current_picture[i];
1435 1436
			    picture->linesize[i] = (s->interlaced) ?
				s->linesize[i] >> 1 : s->linesize[i];
1437 1438 1439
                        }
                        *data_size = sizeof(AVPicture);
                        avctx->height = s->height;
F
Fabrice Bellard 已提交
1440 1441
                        if (s->interlaced)
                            avctx->height *= 2;
1442
                        avctx->width = s->width;
1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455
                        /* XXX: not complete test ! */
                        switch((s->h_count[0] << 4) | s->v_count[0]) {
                        case 0x11:
                            avctx->pix_fmt = PIX_FMT_YUV444P;
                            break;
                        case 0x21:
                            avctx->pix_fmt = PIX_FMT_YUV422P;
                            break;
                        default:
                        case 0x22:
                            avctx->pix_fmt = PIX_FMT_YUV420P;
                            break;
                        }
1456 1457
                        /* dummy quality */
                        /* XXX: infer it with matrix */
M
cleanup  
Michael Niedermayer 已提交
1458
//                    	avctx->quality = 3; 
1459 1460
                        goto the_end;
                    }
1461 1462 1463 1464 1465 1466 1467
		    break;
                case SOS:
                    mjpeg_decode_sos(s);
		    /* buggy avid puts EOI every 10-20th frame */
		    /* if restart period is over process EOI */
		    if ((s->buggy_avid && !s->interlaced) || s->restart_interval)
			goto eoi_parser;
1468
                    break;
1469
		case DRI:
1470
		    mjpeg_decode_dri(s);
1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485
		    break;
		case SOF1:
		case SOF2:
		case SOF3:
		case SOF5:
		case SOF6:
		case SOF7:
		case SOF9:
		case SOF10:
		case SOF11:
		case SOF13:
		case SOF14:
		case SOF15:
		case JPG:
		    printf("mjpeg: unsupported coding type (%x)\n", start_code);
1486 1487 1488 1489
		    break;
//		default:
//		    printf("mjpeg: unsupported marker (%x)\n", start_code);
//		    break;
1490
                }
1491 1492 1493 1494 1495 1496

not_the_end:
		/* eof process start code */
		buf_ptr += (get_bits_count(&s->gb)+7)/8;
		dprintf("marker parser used %d bytes (%d bits)\n",
		    (get_bits_count(&s->gb)+7)/8, get_bits_count(&s->gb));
1497 1498 1499
            }
        }
    }
1500 1501 1502
the_end:
    dprintf("mjpeg decode frame unused %d bytes\n", buf_end - buf_ptr);
//    return buf_end - buf_ptr;
1503 1504 1505
    return buf_ptr - buf;
}

1506 1507
static int mjpegb_decode_frame(AVCodecContext *avctx, 
                              void *data, int *data_size,
1508
                              uint8_t *buf, int buf_size)
1509 1510
{
    MJpegDecodeContext *s = avctx->priv_data;
1511
    uint8_t *buf_end, *buf_ptr;
1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530
    int i;
    AVPicture *picture = data;
    GetBitContext hgb; /* for the header */
    uint32_t dqt_offs, dht_offs, sof_offs, sos_offs, second_field_offs;
    uint32_t field_size;

    *data_size = 0;

    /* no supplementary picture */
    if (buf_size == 0)
        return 0;

    buf_ptr = buf;
    buf_end = buf + buf_size;
    
read_header:
    /* reset on every SOI */
    s->restart_interval = 0;

1531
    init_get_bits(&hgb, buf_ptr, /*buf_size*/(buf_end - buf_ptr)*8);
1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552

    skip_bits(&hgb, 32); /* reserved zeros */
    
    if (get_bits(&hgb, 32) != be2me_32(ff_get_fourcc("mjpg")))
    {
	dprintf("not mjpeg-b (bad fourcc)\n");
	return 0;
    }

    field_size = get_bits(&hgb, 32); /* field size */
    dprintf("field size: 0x%x\n", field_size);
    skip_bits(&hgb, 32); /* padded field size */
    second_field_offs = get_bits(&hgb, 32);
    dprintf("second field offs: 0x%x\n", second_field_offs);
    if (second_field_offs)
	s->interlaced = 1;

    dqt_offs = get_bits(&hgb, 32);
    dprintf("dqt offs: 0x%x\n", dqt_offs);
    if (dqt_offs)
    {
1553
	init_get_bits(&s->gb, buf+dqt_offs, (buf_end - (buf+dqt_offs))*8);
1554 1555 1556 1557 1558 1559 1560 1561
	s->start_code = DQT;
	mjpeg_decode_dqt(s);
    }
    
    dht_offs = get_bits(&hgb, 32);
    dprintf("dht offs: 0x%x\n", dht_offs);
    if (dht_offs)
    {
1562
	init_get_bits(&s->gb, buf+dht_offs, (buf_end - (buf+dht_offs))*8);
1563 1564 1565 1566 1567 1568 1569 1570
	s->start_code = DHT;
	mjpeg_decode_dht(s);
    }

    sof_offs = get_bits(&hgb, 32);
    dprintf("sof offs: 0x%x\n", sof_offs);
    if (sof_offs)
    {
1571
	init_get_bits(&s->gb, buf+sof_offs, (buf_end - (buf+sof_offs))*8);
1572
	s->start_code = SOF0;
A
10l fix  
Alex Beregszaszi 已提交
1573 1574
	if (mjpeg_decode_sof0(s) < 0)
	    return -1;
1575 1576 1577 1578 1579 1580
    }

    sos_offs = get_bits(&hgb, 32);
    dprintf("sos offs: 0x%x\n", sos_offs);
    if (sos_offs)
    {
1581 1582
//	init_get_bits(&s->gb, buf+sos_offs, (buf_end - (buf+sos_offs))*8);
	init_get_bits(&s->gb, buf+sos_offs, field_size*8);
1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624
	s->start_code = SOS;
	mjpeg_decode_sos(s);
    }

    skip_bits(&hgb, 32); /* start of data offset */

    if (s->interlaced) {
        s->bottom_field ^= 1;
        /* if not bottom field, do not output image yet */
        if (s->bottom_field && second_field_offs)
	{
	    buf_ptr = buf + second_field_offs;
	    second_field_offs = 0;
	    goto read_header;
    	}
    }

    for(i=0;i<3;i++) {
        picture->data[i] = s->current_picture[i];
        picture->linesize[i] = (s->interlaced) ?
    	    s->linesize[i] >> 1 : s->linesize[i];
    }
    *data_size = sizeof(AVPicture);
    avctx->height = s->height;
    if (s->interlaced)
        avctx->height *= 2;
    avctx->width = s->width;
    /* XXX: not complete test ! */
    switch((s->h_count[0] << 4) | s->v_count[0]) {
        case 0x11:
    	    avctx->pix_fmt = PIX_FMT_YUV444P;
            break;
        case 0x21:
            avctx->pix_fmt = PIX_FMT_YUV422P;
            break;
        default:
	case 0x22:
            avctx->pix_fmt = PIX_FMT_YUV420P;
            break;
    }
    /* dummy quality */
    /* XXX: infer it with matrix */
M
cleanup  
Michael Niedermayer 已提交
1625
//    avctx->quality = 3; 
1626 1627 1628 1629 1630

    return buf_ptr - buf;
}


1631 1632 1633 1634 1635
static int mjpeg_decode_end(AVCodecContext *avctx)
{
    MJpegDecodeContext *s = avctx->priv_data;
    int i, j;

1636
    av_free(s->buffer);
1637
    for(i=0;i<MAX_COMPONENTS;i++)
1638
        av_free(s->current_picture[i]);
1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654
    for(i=0;i<2;i++) {
        for(j=0;j<4;j++)
            free_vlc(&s->vlcs[i][j]);
    }
    return 0;
}

AVCodec mjpeg_decoder = {
    "mjpeg",
    CODEC_TYPE_VIDEO,
    CODEC_ID_MJPEG,
    sizeof(MJpegDecodeContext),
    mjpeg_decode_init,
    NULL,
    mjpeg_decode_end,
    mjpeg_decode_frame,
1655 1656
    0,
    NULL
1657
};
1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670

AVCodec mjpegb_decoder = {
    "mjpegb",
    CODEC_TYPE_VIDEO,
    CODEC_ID_MJPEGB,
    sizeof(MJpegDecodeContext),
    mjpeg_decode_init,
    NULL,
    mjpeg_decode_end,
    mjpegb_decode_frame,
    0,
    NULL
};