git.sesse.net Git - ffmpeg/blob - libavcodec/mjpegdec.c

   1 /*
   2  * MJPEG decoder
   3  * Copyright (c) 2000, 2001 Fabrice Bellard
   4  * Copyright (c) 2003 Alex Beregszaszi
   5  * Copyright (c) 2003-2004 Michael Niedermayer
   6  *
   7  * Support for external huffman table, various fixes (AVID workaround),
   8  * aspecting, new decode_frame mechanism and apple mjpeg-b support
   9  *                                  by Alex Beregszaszi
  10  *
  11  * This file is part of FFmpeg.
  12  *
  13  * FFmpeg is free software; you can redistribute it and/or
  14  * modify it under the terms of the GNU Lesser General Public
  15  * License as published by the Free Software Foundation; either
  16  * version 2.1 of the License, or (at your option) any later version.
  17  *
  18  * FFmpeg is distributed in the hope that it will be useful,
  19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  21  * Lesser General Public License for more details.
  22  *
  23  * You should have received a copy of the GNU Lesser General Public
  24  * License along with FFmpeg; if not, write to the Free Software
  25  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  26  */
  27
  28 /**
  29  * @file
  30  * MJPEG decoder.
  31  */
  32
  33 #include "libavutil/imgutils.h"
  34 #include "libavutil/avassert.h"
  35 #include "libavutil/opt.h"
  36 #include "avcodec.h"
  37 #include "copy_block.h"
  38 #include "internal.h"
  39 #include "mjpeg.h"
  40 #include "mjpegdec.h"
  41 #include "jpeglsdec.h"
  42 #include "tiff.h"
  43 #include "exif.h"
  44 #include "bytestream.h"
  45
  46
  47 static int build_vlc(VLC *vlc, const uint8_t *bits_table,
  48                      const uint8_t *val_table, int nb_codes,
  49                      int use_static, int is_ac)
  50 {
  51     uint8_t huff_size[256] = { 0 };
  52     uint16_t huff_code[256];
  53     uint16_t huff_sym[256];
  54     int i;
  55
  56     av_assert0(nb_codes <= 256);
  57
  58     ff_mjpeg_build_huffman_codes(huff_size, huff_code, bits_table, val_table);
  59
  60     for (i = 0; i < 256; i++)
  61         huff_sym[i] = i + 16 * is_ac;
  62
  63     if (is_ac)
  64         huff_sym[0] = 16 * 256;
  65
  66     return ff_init_vlc_sparse(vlc, 9, nb_codes, huff_size, 1, 1,
  67                               huff_code, 2, 2, huff_sym, 2, 2, use_static);
  68 }
  69
  70 static void build_basic_mjpeg_vlc(MJpegDecodeContext *s)
  71 {
  72     build_vlc(&s->vlcs[0][0], avpriv_mjpeg_bits_dc_luminance,
  73               avpriv_mjpeg_val_dc, 12, 0, 0);
  74     build_vlc(&s->vlcs[0][1], avpriv_mjpeg_bits_dc_chrominance,
  75               avpriv_mjpeg_val_dc, 12, 0, 0);
  76     build_vlc(&s->vlcs[1][0], avpriv_mjpeg_bits_ac_luminance,
  77               avpriv_mjpeg_val_ac_luminance, 251, 0, 1);
  78     build_vlc(&s->vlcs[1][1], avpriv_mjpeg_bits_ac_chrominance,
  79               avpriv_mjpeg_val_ac_chrominance, 251, 0, 1);
  80     build_vlc(&s->vlcs[2][0], avpriv_mjpeg_bits_ac_luminance,
  81               avpriv_mjpeg_val_ac_luminance, 251, 0, 0);
  82     build_vlc(&s->vlcs[2][1], avpriv_mjpeg_bits_ac_chrominance,
  83               avpriv_mjpeg_val_ac_chrominance, 251, 0, 0);
  84 }
  85
  86 av_cold int ff_mjpeg_decode_init(AVCodecContext *avctx)
  87 {
  88     MJpegDecodeContext *s = avctx->priv_data;
  89
  90     if (!s->picture_ptr)
  91         s->picture_ptr = &s->picture;
  92     avcodec_get_frame_defaults(&s->picture);
  93
  94     s->avctx = avctx;
  95     ff_hpeldsp_init(&s->hdsp, avctx->flags);
  96     ff_dsputil_init(&s->dsp, avctx);
  97     ff_init_scantable(s->dsp.idct_permutation, &s->scantable, ff_zigzag_direct);
  98     s->buffer_size   = 0;
  99     s->buffer        = NULL;
 100     s->start_code    = -1;
 101     s->first_picture = 1;
 102     s->got_picture   = 0;
 103     s->org_height    = avctx->coded_height;
 104     avctx->chroma_sample_location = AVCHROMA_LOC_CENTER;
 105
 106     build_basic_mjpeg_vlc(s);
 107
 108     if (s->extern_huff) {
 109         av_log(avctx, AV_LOG_INFO, "using external huffman table\n");
 110         init_get_bits(&s->gb, avctx->extradata, avctx->extradata_size * 8);
 111         if (ff_mjpeg_decode_dht(s)) {
 112             av_log(avctx, AV_LOG_ERROR,
 113                    "error using external huffman table, switching back to internal\n");
 114             build_basic_mjpeg_vlc(s);
 115         }
 116     }
 117     if (avctx->field_order == AV_FIELD_BB) { /* quicktime icefloe 019 */
 118         s->interlace_polarity = 1;           /* bottom field first */
 119         av_log(avctx, AV_LOG_DEBUG, "bottom field first\n");
 120     }
 121     if (avctx->codec->id == AV_CODEC_ID_AMV)
 122         s->flipped = 1;
 123
 124     return 0;
 125 }
 126
 127
 128 /* quantize tables */
 129 int ff_mjpeg_decode_dqt(MJpegDecodeContext *s)
 130 {
 131     int len, index, i, j;
 132
 133     len = get_bits(&s->gb, 16) - 2;
 134
 135     while (len >= 65) {
 136         int pr = get_bits(&s->gb, 4);
 137         if (pr > 1) {
 138             av_log(s->avctx, AV_LOG_ERROR, "dqt: invalid precision\n");
 139             return AVERROR_INVALIDDATA;
 140         }
 141         index = get_bits(&s->gb, 4);
 142         if (index >= 4)
 143             return -1;
 144         av_log(s->avctx, AV_LOG_DEBUG, "index=%d\n", index);
 145         /* read quant table */
 146         for (i = 0; i < 64; i++) {
 147             j = s->scantable.permutated[i];
 148             s->quant_matrixes[index][j] = get_bits(&s->gb, pr ? 16 : 8);
 149         }
 150
 151         // XXX FIXME finetune, and perhaps add dc too
 152         s->qscale[index] = FFMAX(s->quant_matrixes[index][s->scantable.permutated[1]],
 153                                  s->quant_matrixes[index][s->scantable.permutated[8]]) >> 1;
 154         av_log(s->avctx, AV_LOG_DEBUG, "qscale[%d]: %d\n",
 155                index, s->qscale[index]);
 156         len -= 65;
 157     }
 158     return 0;
 159 }
 160
 161 /* decode huffman tables and build VLC decoders */
 162 int ff_mjpeg_decode_dht(MJpegDecodeContext *s)
 163 {
 164     int len, index, i, class, n, v, code_max;
 165     uint8_t bits_table[17];
 166     uint8_t val_table[256];
 167     int ret = 0;
 168
 169     len = get_bits(&s->gb, 16) - 2;
 170
 171     while (len > 0) {
 172         if (len < 17)
 173             return AVERROR_INVALIDDATA;
 174         class = get_bits(&s->gb, 4);
 175         if (class >= 2)
 176             return AVERROR_INVALIDDATA;
 177         index = get_bits(&s->gb, 4);
 178         if (index >= 4)
 179             return AVERROR_INVALIDDATA;
 180         n = 0;
 181         for (i = 1; i <= 16; i++) {
 182             bits_table[i] = get_bits(&s->gb, 8);
 183             n += bits_table[i];
 184         }
 185         len -= 17;
 186         if (len < n || n > 256)
 187             return AVERROR_INVALIDDATA;
 188
 189         code_max = 0;
 190         for (i = 0; i < n; i++) {
 191             v = get_bits(&s->gb, 8);
 192             if (v > code_max)
 193                 code_max = v;
 194             val_table[i] = v;
 195         }
 196         len -= n;
 197
 198         /* build VLC and flush previous vlc if present */
 199         ff_free_vlc(&s->vlcs[class][index]);
 200         av_log(s->avctx, AV_LOG_DEBUG, "class=%d index=%d nb_codes=%d\n",
 201                class, index, code_max + 1);
 202         if ((ret = build_vlc(&s->vlcs[class][index], bits_table, val_table,
 203                              code_max + 1, 0, class > 0)) < 0)
 204             return ret;
 205
 206         if (class > 0) {
 207             ff_free_vlc(&s->vlcs[2][index]);
 208             if ((ret = build_vlc(&s->vlcs[2][index], bits_table, val_table,
 209                                  code_max + 1, 0, 0)) < 0)
 210                 return ret;
 211         }
 212     }
 213     return 0;
 214 }
 215
 216 int ff_mjpeg_decode_sof(MJpegDecodeContext *s)
 217 {
 218     int len, nb_components, i, width, height, pix_fmt_id;
 219     int h_count[MAX_COMPONENTS];
 220     int v_count[MAX_COMPONENTS];
 221
 222     s->cur_scan = 0;
 223     s->upscale_h = s->upscale_v = 0;
 224
 225     /* XXX: verify len field validity */
 226     len     = get_bits(&s->gb, 16);
 227     s->avctx->bits_per_raw_sample =
 228     s->bits = get_bits(&s->gb, 8);
 229
 230     if (s->pegasus_rct)
 231         s->bits = 9;
 232     if (s->bits == 9 && !s->pegasus_rct)
 233         s->rct  = 1;    // FIXME ugly
 234
 235     if(s->lossless && s->avctx->lowres){
 236         av_log(s->avctx, AV_LOG_ERROR, "lowres is not possible with lossless jpeg\n");
 237         return -1;
 238     }
 239
 240     height = get_bits(&s->gb, 16);
 241     width  = get_bits(&s->gb, 16);
 242
 243     // HACK for odd_height.mov
 244     if (s->interlaced && s->width == width && s->height == height + 1)
 245         height= s->height;
 246
 247     av_log(s->avctx, AV_LOG_DEBUG, "sof0: picture: %dx%d\n", width, height);
 248     if (av_image_check_size(width, height, 0, s->avctx))
 249         return AVERROR_INVALIDDATA;
 250
 251     nb_components = get_bits(&s->gb, 8);
 252     if (nb_components <= 0 ||
 253         nb_components > MAX_COMPONENTS)
 254         return -1;
 255     if (s->interlaced && (s->bottom_field == !s->interlace_polarity)) {
 256         if (nb_components != s->nb_components) {
 257             av_log(s->avctx, AV_LOG_ERROR,
 258                    "nb_components changing in interlaced picture\n");
 259             return AVERROR_INVALIDDATA;
 260         }
 261     }
 262     if (s->ls && !(s->bits <= 8 || nb_components == 1)) {
 263         avpriv_report_missing_feature(s->avctx,
 264                                       "JPEG-LS that is not <= 8 "
 265                                       "bits/component or 16-bit gray");
 266         return AVERROR_PATCHWELCOME;
 267     }
 268     if (!s->lossless && !(s->bits <= 8 || nb_components == 1)) {
 269         avpriv_report_missing_feature(s->avctx,
 270                                       "lossy that is not <= 8 "
 271                                       "bits/component or 16-bit gray");
 272         return AVERROR_PATCHWELCOME;
 273     }
 274     s->nb_components = nb_components;
 275     s->h_max         = 1;
 276     s->v_max         = 1;
 277     memset(h_count, 0, sizeof(h_count));
 278     memset(v_count, 0, sizeof(v_count));
 279     for (i = 0; i < nb_components; i++) {
 280         /* component id */
 281         s->component_id[i] = get_bits(&s->gb, 8) - 1;
 282         h_count[i]         = get_bits(&s->gb, 4);
 283         v_count[i]         = get_bits(&s->gb, 4);
 284         /* compute hmax and vmax (only used in interleaved case) */
 285         if (h_count[i] > s->h_max)
 286             s->h_max = h_count[i];
 287         if (v_count[i] > s->v_max)
 288             s->v_max = v_count[i];
 289         s->quant_index[i] = get_bits(&s->gb, 8);
 290         if (s->quant_index[i] >= 4) {
 291             av_log(s->avctx, AV_LOG_ERROR, "quant_index is invalid\n");
 292             return AVERROR_INVALIDDATA;
 293         }
 294         if (!h_count[i] || !v_count[i]) {
 295             av_log(s->avctx, AV_LOG_ERROR,
 296                    "Invalid sampling factor in component %d %d:%d\n",
 297                    i, h_count[i], v_count[i]);
 298             return AVERROR_INVALIDDATA;
 299         }
 300
 301         av_log(s->avctx, AV_LOG_DEBUG, "component %d %d:%d id: %d quant:%d\n",
 302                i, h_count[i], v_count[i],
 303                s->component_id[i], s->quant_index[i]);
 304     }
 305
 306     if (s->ls && (s->h_max > 1 || s->v_max > 1)) {
 307         avpriv_report_missing_feature(s->avctx, "Subsampling in JPEG-LS");
 308         return AVERROR_PATCHWELCOME;
 309     }
 310
 311
 312     /* if different size, realloc/alloc picture */
 313     if (   width != s->width || height != s->height
 314         || memcmp(s->h_count, h_count, sizeof(h_count))
 315         || memcmp(s->v_count, v_count, sizeof(v_count))) {
 316
 317         s->width      = width;
 318         s->height     = height;
 319         memcpy(s->h_count, h_count, sizeof(h_count));
 320         memcpy(s->v_count, v_count, sizeof(v_count));
 321         s->interlaced = 0;
 322         s->got_picture = 0;
 323
 324         /* test interlaced mode */
 325         if (s->first_picture   &&
 326             s->org_height != 0 &&
 327             s->height < ((s->org_height * 3) / 4)) {
 328             s->interlaced                    = 1;
 329             s->bottom_field                  = s->interlace_polarity;
 330             s->picture_ptr->interlaced_frame = 1;
 331             s->picture_ptr->top_field_first  = !s->interlace_polarity;
 332             height *= 2;
 333         }
 334
 335         avcodec_set_dimensions(s->avctx, width, height);
 336
 337         s->first_picture = 0;
 338     }
 339
 340     if (s->interlaced && (s->bottom_field == !s->interlace_polarity)) {
 341         if (s->progressive) {
 342             avpriv_request_sample(s->avctx, "progressively coded interlaced picture");
 343             return AVERROR_INVALIDDATA;
 344         }
 345     } else{
 346         if (s->v_max == 1 && s->h_max == 1 && s->lossless==1 && (nb_components==3 || nb_components==4))
 347             s->rgb = 1;
 348         else if (!s->lossless)
 349             s->rgb = 0;
 350     /* XXX: not complete test ! */
 351     pix_fmt_id = (s->h_count[0] << 28) | (s->v_count[0] << 24) |
 352                  (s->h_count[1] << 20) | (s->v_count[1] << 16) |
 353                  (s->h_count[2] << 12) | (s->v_count[2] <<  8) |
 354                  (s->h_count[3] <<  4) |  s->v_count[3];
 355     av_log(s->avctx, AV_LOG_DEBUG, "pix fmt id %x\n", pix_fmt_id);
 356     /* NOTE we do not allocate pictures large enough for the possible
 357      * padding of h/v_count being 4 */
 358     if (!(pix_fmt_id & 0xD0D0D0D0))
 359         pix_fmt_id -= (pix_fmt_id & 0xF0F0F0F0) >> 1;
 360     if (!(pix_fmt_id & 0x0D0D0D0D))
 361         pix_fmt_id -= (pix_fmt_id & 0x0F0F0F0F) >> 1;
 362
 363     switch (pix_fmt_id) {
 364     case 0x11111100:
 365         if (s->rgb)
 366             s->avctx->pix_fmt = AV_PIX_FMT_BGR24;
 367         else {
 368             if (s->component_id[0] == 'Q' && s->component_id[1] == 'F' && s->component_id[2] == 'A') {
 369                 s->avctx->pix_fmt = AV_PIX_FMT_GBR24P;
 370             } else {
 371             s->avctx->pix_fmt = s->cs_itu601 ? AV_PIX_FMT_YUV444P : AV_PIX_FMT_YUVJ444P;
 372             s->avctx->color_range = s->cs_itu601 ? AVCOL_RANGE_MPEG : AVCOL_RANGE_JPEG;
 373             }
 374         }
 375         av_assert0(s->nb_components == 3);
 376         break;
 377     case 0x11111111:
 378         if (s->rgb)
 379             s->avctx->pix_fmt = AV_PIX_FMT_ABGR;
 380         else {
 381             s->avctx->pix_fmt = /*s->cs_itu601 ?*/ AV_PIX_FMT_YUVA444P/* : AV_PIX_FMT_YUVJA444P*/;
 382             s->avctx->color_range = s->cs_itu601 ? AVCOL_RANGE_MPEG : AVCOL_RANGE_JPEG;
 383         }
 384         av_assert0(s->nb_components == 4);
 385         break;
 386     case 0x12121100:
 387     case 0x22122100:
 388         s->avctx->pix_fmt = s->cs_itu601 ? AV_PIX_FMT_YUV444P : AV_PIX_FMT_YUVJ444P;
 389         s->avctx->color_range = s->cs_itu601 ? AVCOL_RANGE_MPEG : AVCOL_RANGE_JPEG;
 390         s->upscale_v = 2;
 391         s->upscale_h = (pix_fmt_id == 0x22122100);
 392         s->chroma_height = s->height;
 393         break;
 394     case 0x21211100:
 395     case 0x22211200:
 396         s->avctx->pix_fmt = s->cs_itu601 ? AV_PIX_FMT_YUV444P : AV_PIX_FMT_YUVJ444P;
 397         s->avctx->color_range = s->cs_itu601 ? AVCOL_RANGE_MPEG : AVCOL_RANGE_JPEG;
 398         s->upscale_v = (pix_fmt_id == 0x22211200);
 399         s->upscale_h = 2;
 400         s->chroma_height = s->height;
 401         break;
 402     case 0x22221100:
 403         s->avctx->pix_fmt = s->cs_itu601 ? AV_PIX_FMT_YUV444P : AV_PIX_FMT_YUVJ444P;
 404         s->avctx->color_range = s->cs_itu601 ? AVCOL_RANGE_MPEG : AVCOL_RANGE_JPEG;
 405         s->upscale_v = 2;
 406         s->upscale_h = 2;
 407         s->chroma_height = s->height / 2;
 408         break;
 409     case 0x11000000:
 410     case 0x13000000:
 411     case 0x14000000:
 412     case 0x31000000:
 413     case 0x33000000:
 414     case 0x34000000:
 415     case 0x41000000:
 416     case 0x43000000:
 417     case 0x44000000:
 418         if(s->bits <= 8)
 419             s->avctx->pix_fmt = AV_PIX_FMT_GRAY8;
 420         else
 421             s->avctx->pix_fmt = AV_PIX_FMT_GRAY16;
 422         break;
 423     case 0x12111100:
 424     case 0x22211100:
 425     case 0x22112100:
 426         s->avctx->pix_fmt = s->cs_itu601 ? AV_PIX_FMT_YUV440P : AV_PIX_FMT_YUVJ440P;
 427         s->avctx->color_range = s->cs_itu601 ? AVCOL_RANGE_MPEG : AVCOL_RANGE_JPEG;
 428         s->upscale_h = (pix_fmt_id == 0x22211100) * 2 + (pix_fmt_id == 0x22112100);
 429         s->chroma_height = s->height / 2;
 430         break;
 431     case 0x21111100:
 432         s->avctx->pix_fmt = s->cs_itu601 ? AV_PIX_FMT_YUV422P : AV_PIX_FMT_YUVJ422P;
 433         s->avctx->color_range = s->cs_itu601 ? AVCOL_RANGE_MPEG : AVCOL_RANGE_JPEG;
 434         break;
 435     case 0x22121100:
 436     case 0x22111200:
 437         s->avctx->pix_fmt = s->cs_itu601 ? AV_PIX_FMT_YUV422P : AV_PIX_FMT_YUVJ422P;
 438         s->avctx->color_range = s->cs_itu601 ? AVCOL_RANGE_MPEG : AVCOL_RANGE_JPEG;
 439         s->upscale_v = (pix_fmt_id == 0x22121100) + 1;
 440         break;
 441     case 0x22111100:
 442         s->avctx->pix_fmt = s->cs_itu601 ? AV_PIX_FMT_YUV420P : AV_PIX_FMT_YUVJ420P;
 443         s->avctx->color_range = s->cs_itu601 ? AVCOL_RANGE_MPEG : AVCOL_RANGE_JPEG;
 444         break;
 445     case 0x41111100:
 446         s->avctx->pix_fmt = s->cs_itu601 ? AV_PIX_FMT_YUV411P : AV_PIX_FMT_YUVJ411P;
 447         s->avctx->color_range = s->cs_itu601 ? AVCOL_RANGE_MPEG : AVCOL_RANGE_JPEG;
 448         break;
 449     default:
 450         av_log(s->avctx, AV_LOG_ERROR, "Unhandled pixel format 0x%x\n", pix_fmt_id);
 451         return AVERROR_PATCHWELCOME;
 452     }
 453     if ((s->upscale_h || s->upscale_v) && s->avctx->lowres) {
 454         av_log(s->avctx, AV_LOG_ERROR, "lowres not supported for weird subsampling\n");
 455         return AVERROR_PATCHWELCOME;
 456     }
 457     if (s->ls) {
 458         s->upscale_h = s->upscale_v = 0;
 459         if (s->nb_components > 1)
 460             s->avctx->pix_fmt = AV_PIX_FMT_RGB24;
 461         else if (s->bits <= 8)
 462             s->avctx->pix_fmt = AV_PIX_FMT_GRAY8;
 463         else
 464             s->avctx->pix_fmt = AV_PIX_FMT_GRAY16;
 465     }
 466
 467     av_frame_unref(s->picture_ptr);
 468     if (ff_get_buffer(s->avctx, s->picture_ptr, AV_GET_BUFFER_FLAG_REF) < 0)
 469         return -1;
 470     s->picture_ptr->pict_type = AV_PICTURE_TYPE_I;
 471     s->picture_ptr->key_frame = 1;
 472     s->got_picture            = 1;
 473
 474     for (i = 0; i < 3; i++)
 475         s->linesize[i] = s->picture_ptr->linesize[i] << s->interlaced;
 476
 477     av_dlog(s->avctx, "%d %d %d %d %d %d\n",
 478             s->width, s->height, s->linesize[0], s->linesize[1],
 479             s->interlaced, s->avctx->height);
 480
 481     if (len != (8 + (3 * nb_components)))
 482         av_log(s->avctx, AV_LOG_DEBUG, "decode_sof0: error, len(%d) mismatch\n", len);
 483     }
 484
 485     if (s->rgb && !s->lossless && !s->ls) {
 486         av_log(s->avctx, AV_LOG_ERROR, "Unsupported coding and pixel format combination\n");
 487         return AVERROR_PATCHWELCOME;
 488     }
 489
 490     /* totally blank picture as progressive JPEG will only add details to it */
 491     if (s->progressive) {
 492         int bw = (width  + s->h_max * 8 - 1) / (s->h_max * 8);
 493         int bh = (height + s->v_max * 8 - 1) / (s->v_max * 8);
 494         for (i = 0; i < s->nb_components; i++) {
 495             int size = bw * bh * s->h_count[i] * s->v_count[i];
 496             av_freep(&s->blocks[i]);
 497             av_freep(&s->last_nnz[i]);
 498             s->blocks[i]       = av_malloc(size * sizeof(**s->blocks));
 499             s->last_nnz[i]     = av_mallocz(size * sizeof(**s->last_nnz));
 500             s->block_stride[i] = bw * s->h_count[i];
 501         }
 502         memset(s->coefs_finished, 0, sizeof(s->coefs_finished));
 503     }
 504     return 0;
 505 }
 506
 507 static inline int mjpeg_decode_dc(MJpegDecodeContext *s, int dc_index)
 508 {
 509     int code;
 510     code = get_vlc2(&s->gb, s->vlcs[0][dc_index].table, 9, 2);
 511     if (code < 0 || code > 16) {
 512         av_log(s->avctx, AV_LOG_WARNING,
 513                "mjpeg_decode_dc: bad vlc: %d:%d (%p)\n",
 514                0, dc_index, &s->vlcs[0][dc_index]);
 515         return 0xffff;
 516     }
 517
 518     if (code)
 519         return get_xbits(&s->gb, code);
 520     else
 521         return 0;
 522 }
 523
 524 /* decode block and dequantize */
 525 static int decode_block(MJpegDecodeContext *s, int16_t *block, int component,
 526                         int dc_index, int ac_index, int16_t *quant_matrix)
 527 {
 528     int code, i, j, level, val;
 529
 530     /* DC coef */
 531     val = mjpeg_decode_dc(s, dc_index);
 532     if (val == 0xffff) {
 533         av_log(s->avctx, AV_LOG_ERROR, "error dc\n");
 534         return AVERROR_INVALIDDATA;
 535     }
 536     val = val * quant_matrix[0] + s->last_dc[component];
 537     s->last_dc[component] = val;
 538     block[0] = val;
 539     /* AC coefs */
 540     i = 0;
 541     {OPEN_READER(re, &s->gb);
 542     do {
 543         UPDATE_CACHE(re, &s->gb);
 544         GET_VLC(code, re, &s->gb, s->vlcs[1][ac_index].table, 9, 2);
 545
 546         i += ((unsigned)code) >> 4;
 547             code &= 0xf;
 548         if (code) {
 549             if (code > MIN_CACHE_BITS - 16)
 550                 UPDATE_CACHE(re, &s->gb);
 551
 552             {
 553                 int cache = GET_CACHE(re, &s->gb);
 554                 int sign  = (~cache) >> 31;
 555                 level     = (NEG_USR32(sign ^ cache,code) ^ sign) - sign;
 556             }
 557
 558             LAST_SKIP_BITS(re, &s->gb, code);
 559
 560             if (i > 63) {
 561                 av_log(s->avctx, AV_LOG_ERROR, "error count: %d\n", i);
 562                 return AVERROR_INVALIDDATA;
 563             }
 564             j        = s->scantable.permutated[i];
 565             block[j] = level * quant_matrix[j];
 566         }
 567     } while (i < 63);
 568     CLOSE_READER(re, &s->gb);}
 569
 570     return 0;
 571 }
 572
 573 static int decode_dc_progressive(MJpegDecodeContext *s, int16_t *block,
 574                                  int component, int dc_index,
 575                                  int16_t *quant_matrix, int Al)
 576 {
 577     int val;
 578     s->dsp.clear_block(block);
 579     val = mjpeg_decode_dc(s, dc_index);
 580     if (val == 0xffff) {
 581         av_log(s->avctx, AV_LOG_ERROR, "error dc\n");
 582         return AVERROR_INVALIDDATA;
 583     }
 584     val = (val * quant_matrix[0] << Al) + s->last_dc[component];
 585     s->last_dc[component] = val;
 586     block[0] = val;
 587     return 0;
 588 }
 589
 590 /* decode block and dequantize - progressive JPEG version */
 591 static int decode_block_progressive(MJpegDecodeContext *s, int16_t *block,
 592                                     uint8_t *last_nnz, int ac_index,
 593                                     int16_t *quant_matrix,
 594                                     int ss, int se, int Al, int *EOBRUN)
 595 {
 596     int code, i, j, level, val, run;
 597
 598     if (*EOBRUN) {
 599         (*EOBRUN)--;
 600         return 0;
 601     }
 602
 603     {
 604         OPEN_READER(re, &s->gb);
 605         for (i = ss; ; i++) {
 606             UPDATE_CACHE(re, &s->gb);
 607             GET_VLC(code, re, &s->gb, s->vlcs[2][ac_index].table, 9, 2);
 608
 609             run = ((unsigned) code) >> 4;
 610             code &= 0xF;
 611             if (code) {
 612                 i += run;
 613                 if (code > MIN_CACHE_BITS - 16)
 614                     UPDATE_CACHE(re, &s->gb);
 615
 616                 {
 617                     int cache = GET_CACHE(re, &s->gb);
 618                     int sign  = (~cache) >> 31;
 619                     level     = (NEG_USR32(sign ^ cache,code) ^ sign) - sign;
 620                 }
 621
 622                 LAST_SKIP_BITS(re, &s->gb, code);
 623
 624                 if (i >= se) {
 625                     if (i == se) {
 626                         j = s->scantable.permutated[se];
 627                         block[j] = level * quant_matrix[j] << Al;
 628                         break;
 629                     }
 630                     av_log(s->avctx, AV_LOG_ERROR, "error count: %d\n", i);
 631                     return AVERROR_INVALIDDATA;
 632                 }
 633                 j = s->scantable.permutated[i];
 634                 block[j] = level * quant_matrix[j] << Al;
 635             } else {
 636                 if (run == 0xF) {// ZRL - skip 15 coefficients
 637                     i += 15;
 638                     if (i >= se) {
 639                         av_log(s->avctx, AV_LOG_ERROR, "ZRL overflow: %d\n", i);
 640                         return AVERROR_INVALIDDATA;
 641                     }
 642                 } else {
 643                     val = (1 << run);
 644                     if (run) {
 645                         UPDATE_CACHE(re, &s->gb);
 646                         val += NEG_USR32(GET_CACHE(re, &s->gb), run);
 647                         LAST_SKIP_BITS(re, &s->gb, run);
 648                     }
 649                     *EOBRUN = val - 1;
 650                     break;
 651                 }
 652             }
 653         }
 654         CLOSE_READER(re, &s->gb);
 655     }
 656
 657     if (i > *last_nnz)
 658         *last_nnz = i;
 659
 660     return 0;
 661 }
 662
 663 #define REFINE_BIT(j) {                                             \
 664     UPDATE_CACHE(re, &s->gb);                                       \
 665     sign = block[j] >> 15;                                          \
 666     block[j] += SHOW_UBITS(re, &s->gb, 1) *                         \
 667                 ((quant_matrix[j] ^ sign) - sign) << Al;            \
 668     LAST_SKIP_BITS(re, &s->gb, 1);                                  \
 669 }
 670
 671 #define ZERO_RUN                                                    \
 672 for (; ; i++) {                                                     \
 673     if (i > last) {                                                 \
 674         i += run;                                                   \
 675         if (i > se) {                                               \
 676             av_log(s->avctx, AV_LOG_ERROR, "error count: %d\n", i); \
 677             return -1;                                              \
 678         }                                                           \
 679         break;                                                      \
 680     }                                                               \
 681     j = s->scantable.permutated[i];                                 \
 682     if (block[j])                                                   \
 683         REFINE_BIT(j)                                               \
 684     else if (run-- == 0)                                            \
 685         break;                                                      \
 686 }
 687
 688 /* decode block and dequantize - progressive JPEG refinement pass */
 689 static int decode_block_refinement(MJpegDecodeContext *s, int16_t *block,
 690                                    uint8_t *last_nnz,
 691                                    int ac_index, int16_t *quant_matrix,
 692                                    int ss, int se, int Al, int *EOBRUN)
 693 {
 694     int code, i = ss, j, sign, val, run;
 695     int last    = FFMIN(se, *last_nnz);
 696
 697     OPEN_READER(re, &s->gb);
 698     if (*EOBRUN) {
 699         (*EOBRUN)--;
 700     } else {
 701         for (; ; i++) {
 702             UPDATE_CACHE(re, &s->gb);
 703             GET_VLC(code, re, &s->gb, s->vlcs[2][ac_index].table, 9, 2);
 704
 705             if (code & 0xF) {
 706                 run = ((unsigned) code) >> 4;
 707                 UPDATE_CACHE(re, &s->gb);
 708                 val = SHOW_UBITS(re, &s->gb, 1);
 709                 LAST_SKIP_BITS(re, &s->gb, 1);
 710                 ZERO_RUN;
 711                 j = s->scantable.permutated[i];
 712                 val--;
 713                 block[j] = ((quant_matrix[j]^val) - val) << Al;
 714                 if (i == se) {
 715                     if (i > *last_nnz)
 716                         *last_nnz = i;
 717                     CLOSE_READER(re, &s->gb);
 718                     return 0;
 719                 }
 720             } else {
 721                 run = ((unsigned) code) >> 4;
 722                 if (run == 0xF) {
 723                     ZERO_RUN;
 724                 } else {
 725                     val = run;
 726                     run = (1 << run);
 727                     if (val) {
 728                         UPDATE_CACHE(re, &s->gb);
 729                         run += SHOW_UBITS(re, &s->gb, val);
 730                         LAST_SKIP_BITS(re, &s->gb, val);
 731                     }
 732                     *EOBRUN = run - 1;
 733                     break;
 734                 }
 735             }
 736         }
 737
 738         if (i > *last_nnz)
 739             *last_nnz = i;
 740     }
 741
 742     for (; i <= last; i++) {
 743         j = s->scantable.permutated[i];
 744         if (block[j])
 745             REFINE_BIT(j)
 746     }
 747     CLOSE_READER(re, &s->gb);
 748
 749     return 0;
 750 }
 751 #undef REFINE_BIT
 752 #undef ZERO_RUN
 753
 754 static int handle_rstn(MJpegDecodeContext *s, int nb_components)
 755 {
 756     int i;
 757     int reset = 0;
 758
 759     if (s->restart_interval) {
 760         s->restart_count--;
 761         if(s->restart_count == 0 && s->avctx->codec_id == AV_CODEC_ID_THP){
 762             align_get_bits(&s->gb);
 763             for (i = 0; i < nb_components; i++) /* reset dc */
 764                 s->last_dc[i] = (4 << s->bits);
 765         }
 766
 767         i = 8 + ((-get_bits_count(&s->gb)) & 7);
 768         /* skip RSTn */
 769         if (s->restart_count == 0) {
 770             if(   show_bits(&s->gb, i) == (1 << i) - 1
 771                || show_bits(&s->gb, i) == 0xFF) {
 772                 int pos = get_bits_count(&s->gb);
 773                 align_get_bits(&s->gb);
 774                 while (get_bits_left(&s->gb) >= 8 && show_bits(&s->gb, 8) == 0xFF)
 775                     skip_bits(&s->gb, 8);
 776                 if (get_bits_left(&s->gb) >= 8 && (get_bits(&s->gb, 8) & 0xF8) == 0xD0) {
 777                     for (i = 0; i < nb_components; i++) /* reset dc */
 778                         s->last_dc[i] = (4 << s->bits);
 779                     reset = 1;
 780                 } else
 781                     skip_bits_long(&s->gb, pos - get_bits_count(&s->gb));
 782             }
 783         }
 784     }
 785     return reset;
 786 }
 787
 788 static int ljpeg_decode_rgb_scan(MJpegDecodeContext *s, int nb_components, int predictor, int point_transform)
 789 {
 790     int i, mb_x, mb_y;
 791     uint16_t (*buffer)[4];
 792     int left[4], top[4], topleft[4];
 793     const int linesize = s->linesize[0];
 794     const int mask     = ((1 << s->bits) - 1) << point_transform;
 795     int resync_mb_y = 0;
 796     int resync_mb_x = 0;
 797
 798     if (s->nb_components != 3 && s->nb_components != 4)
 799         return AVERROR_INVALIDDATA;
 800     if (s->v_max != 1 || s->h_max != 1 || !s->lossless)
 801         return AVERROR_INVALIDDATA;
 802
 803
 804     s->restart_count = s->restart_interval;
 805
 806     av_fast_malloc(&s->ljpeg_buffer, &s->ljpeg_buffer_size,
 807                    (unsigned)s->mb_width * 4 * sizeof(s->ljpeg_buffer[0][0]));
 808     buffer = s->ljpeg_buffer;
 809
 810     for (i = 0; i < 4; i++)
 811         buffer[0][i] = 1 << (s->bits - 1);
 812
 813     for (mb_y = 0; mb_y < s->mb_height; mb_y++) {
 814         uint8_t *ptr = s->picture.data[0] + (linesize * mb_y);
 815
 816         if (s->interlaced && s->bottom_field)
 817             ptr += linesize >> 1;
 818
 819         for (i = 0; i < 4; i++)
 820             top[i] = left[i] = topleft[i] = buffer[0][i];
 821
 822         for (mb_x = 0; mb_x < s->mb_width; mb_x++) {
 823             int modified_predictor = predictor;
 824
 825             if (s->restart_interval && !s->restart_count){
 826                 s->restart_count = s->restart_interval;
 827                 resync_mb_x = mb_x;
 828                 resync_mb_y = mb_y;
 829                 for(i=0; i<4; i++)
 830                     top[i] = left[i]= topleft[i]= 1 << (s->bits - 1);
 831             }
 832             if (mb_y == resync_mb_y || mb_y == resync_mb_y+1 && mb_x < resync_mb_x || !mb_x)
 833                 modified_predictor = 1;
 834
 835             for (i=0;i<nb_components;i++) {
 836                 int pred, dc;
 837
 838                 topleft[i] = top[i];
 839                 top[i]     = buffer[mb_x][i];
 840
 841                 PREDICT(pred, topleft[i], top[i], left[i], modified_predictor);
 842
 843                 dc = mjpeg_decode_dc(s, s->dc_index[i]);
 844                 if(dc == 0xFFFF)
 845                     return -1;
 846
 847                 left[i] = buffer[mb_x][i] =
 848                     mask & (pred + (dc << point_transform));
 849             }
 850
 851             if (s->restart_interval && !--s->restart_count) {
 852                 align_get_bits(&s->gb);
 853                 skip_bits(&s->gb, 16); /* skip RSTn */
 854             }
 855         }
 856         if (s->nb_components == 4) {
 857             for(i=0; i<nb_components; i++) {
 858                 int c= s->comp_index[i];
 859                 for(mb_x = 0; mb_x < s->mb_width; mb_x++) {
 860                     ptr[4*mb_x+3-c] = buffer[mb_x][i];
 861                 }
 862             }
 863         } else if (s->rct) {
 864             for (mb_x = 0; mb_x < s->mb_width; mb_x++) {
 865                 ptr[3*mb_x + 1] = buffer[mb_x][0] - ((buffer[mb_x][1] + buffer[mb_x][2] - 0x200) >> 2);
 866                 ptr[3*mb_x + 0] = buffer[mb_x][1] + ptr[3*mb_x + 1];
 867                 ptr[3*mb_x + 2] = buffer[mb_x][2] + ptr[3*mb_x + 1];
 868             }
 869         } else if (s->pegasus_rct) {
 870             for (mb_x = 0; mb_x < s->mb_width; mb_x++) {
 871                 ptr[3*mb_x + 1] = buffer[mb_x][0] - ((buffer[mb_x][1] + buffer[mb_x][2]) >> 2);
 872                 ptr[3*mb_x + 0] = buffer[mb_x][1] + ptr[3*mb_x + 1];
 873                 ptr[3*mb_x + 2] = buffer[mb_x][2] + ptr[3*mb_x + 1];
 874             }
 875         } else {
 876             for(i=0; i<nb_components; i++) {
 877                 int c= s->comp_index[i];
 878                 for(mb_x = 0; mb_x < s->mb_width; mb_x++) {
 879                     ptr[3*mb_x+2-c] = buffer[mb_x][i];
 880                 }
 881             }
 882         }
 883     }
 884     return 0;
 885 }
 886
 887 static int ljpeg_decode_yuv_scan(MJpegDecodeContext *s, int predictor,
 888                                  int point_transform, int nb_components)
 889 {
 890     int i, mb_x, mb_y, mask;
 891     int bits= (s->bits+7)&~7;
 892     int resync_mb_y = 0;
 893     int resync_mb_x = 0;
 894
 895     point_transform += bits - s->bits;
 896     mask = ((1 << s->bits) - 1) << point_transform;
 897
 898     av_assert0(nb_components>=1 && nb_components<=4);
 899
 900     for (mb_y = 0; mb_y < s->mb_height; mb_y++) {
 901         for (mb_x = 0; mb_x < s->mb_width; mb_x++) {
 902             if (s->restart_interval && !s->restart_count){
 903                 s->restart_count = s->restart_interval;
 904                 resync_mb_x = mb_x;
 905                 resync_mb_y = mb_y;
 906             }
 907
 908             if(!mb_x || mb_y == resync_mb_y || mb_y == resync_mb_y+1 && mb_x < resync_mb_x || s->interlaced){
 909                 int toprow  = mb_y == resync_mb_y || mb_y == resync_mb_y+1 && mb_x < resync_mb_x;
 910                 int leftcol = !mb_x || mb_y == resync_mb_y && mb_x == resync_mb_x;
 911                 for (i = 0; i < nb_components; i++) {
 912                     uint8_t *ptr;
 913                     uint16_t *ptr16;
 914                     int n, h, v, x, y, c, j, linesize;
 915                     n = s->nb_blocks[i];
 916                     c = s->comp_index[i];
 917                     h = s->h_scount[i];
 918                     v = s->v_scount[i];
 919                     x = 0;
 920                     y = 0;
 921                     linesize= s->linesize[c];
 922
 923                     if(bits>8) linesize /= 2;
 924
 925                     for(j=0; j<n; j++) {
 926                         int pred, dc;
 927
 928                         dc = mjpeg_decode_dc(s, s->dc_index[i]);
 929                         if(dc == 0xFFFF)
 930                             return -1;
 931                         if(bits<=8){
 932                         ptr = s->picture.data[c] + (linesize * (v * mb_y + y)) + (h * mb_x + x); //FIXME optimize this crap
 933                         if(y==0 && toprow){
 934                             if(x==0 && leftcol){
 935                                 pred= 1 << (bits - 1);
 936                             }else{
 937                                 pred= ptr[-1];
 938                             }
 939                         }else{
 940                             if(x==0 && leftcol){
 941                                 pred= ptr[-linesize];
 942                             }else{
 943                                 PREDICT(pred, ptr[-linesize-1], ptr[-linesize], ptr[-1], predictor);
 944                             }
 945                         }
 946
 947                         if (s->interlaced && s->bottom_field)
 948                             ptr += linesize >> 1;
 949                         pred &= mask;
 950                         *ptr= pred + (dc << point_transform);
 951                         }else{
 952                             ptr16 = (uint16_t*)(s->picture.data[c] + 2*(linesize * (v * mb_y + y)) + 2*(h * mb_x + x)); //FIXME optimize this crap
 953                             if(y==0 && toprow){
 954                                 if(x==0 && leftcol){
 955                                     pred= 1 << (bits - 1);
 956                                 }else{
 957                                     pred= ptr16[-1];
 958                                 }
 959                             }else{
 960                                 if(x==0 && leftcol){
 961                                     pred= ptr16[-linesize];
 962                                 }else{
 963                                     PREDICT(pred, ptr16[-linesize-1], ptr16[-linesize], ptr16[-1], predictor);
 964                                 }
 965                             }
 966
 967                             if (s->interlaced && s->bottom_field)
 968                                 ptr16 += linesize >> 1;
 969                             pred &= mask;
 970                             *ptr16= pred + (dc << point_transform);
 971                         }
 972                         if (++x == h) {
 973                             x = 0;
 974                             y++;
 975                         }
 976                     }
 977                 }
 978             } else {
 979                 for (i = 0; i < nb_components; i++) {
 980                     uint8_t *ptr;
 981                     uint16_t *ptr16;
 982                     int n, h, v, x, y, c, j, linesize, dc;
 983                     n        = s->nb_blocks[i];
 984                     c        = s->comp_index[i];
 985                     h        = s->h_scount[i];
 986                     v        = s->v_scount[i];
 987                     x        = 0;
 988                     y        = 0;
 989                     linesize = s->linesize[c];
 990
 991                     if(bits>8) linesize /= 2;
 992
 993                     for (j = 0; j < n; j++) {
 994                         int pred;
 995
 996                         dc = mjpeg_decode_dc(s, s->dc_index[i]);
 997                         if(dc == 0xFFFF)
 998                             return -1;
 999                         if(bits<=8){
1000                             ptr = s->picture.data[c] +
1001                               (linesize * (v * mb_y + y)) +
1002                               (h * mb_x + x); //FIXME optimize this crap
1003                             PREDICT(pred, ptr[-linesize-1], ptr[-linesize], ptr[-1], predictor);
1004
1005                             pred &= mask;
1006                             *ptr = pred + (dc << point_transform);
1007                         }else{
1008                             ptr16 = (uint16_t*)(s->picture.data[c] + 2*(linesize * (v * mb_y + y)) + 2*(h * mb_x + x)); //FIXME optimize this crap
1009                             PREDICT(pred, ptr16[-linesize-1], ptr16[-linesize], ptr16[-1], predictor);
1010
1011                             pred &= mask;
1012                             *ptr16= pred + (dc << point_transform);
1013                         }
1014
1015                         if (++x == h) {
1016                             x = 0;
1017                             y++;
1018                         }
1019                     }
1020                 }
1021             }
1022             if (s->restart_interval && !--s->restart_count) {
1023                 align_get_bits(&s->gb);
1024                 skip_bits(&s->gb, 16); /* skip RSTn */
1025             }
1026         }
1027     }
1028     return 0;
1029 }
1030
1031 static av_always_inline void mjpeg_copy_block(MJpegDecodeContext *s,
1032                                               uint8_t *dst, const uint8_t *src,
1033                                               int linesize, int lowres)
1034 {
1035     switch (lowres) {
1036     case 0: s->hdsp.put_pixels_tab[1][0](dst, src, linesize, 8);
1037         break;
1038     case 1: copy_block4(dst, src, linesize, linesize, 4);
1039         break;
1040     case 2: copy_block2(dst, src, linesize, linesize, 2);
1041         break;
1042     case 3: *dst = *src;
1043         break;
1044     }
1045 }
1046
1047 static void shift_output(MJpegDecodeContext *s, uint8_t *ptr, int linesize)
1048 {
1049     int block_x, block_y;
1050     if (s->bits > 8) {
1051         for (block_y=0; block_y<8; block_y++)
1052             for (block_x=0; block_x<8; block_x++)
1053                 *(uint16_t*)(ptr + 2*block_x + block_y*linesize) <<= 16 - s->bits;
1054     } else {
1055         for (block_y=0; block_y<8; block_y++)
1056             for (block_x=0; block_x<8; block_x++)
1057                 *(ptr + block_x + block_y*linesize) <<= 8 - s->bits;
1058     }
1059 }
1060
1061 static int mjpeg_decode_scan(MJpegDecodeContext *s, int nb_components, int Ah,
1062                              int Al, const uint8_t *mb_bitmask,
1063                              const AVFrame *reference)
1064 {
1065     int i, mb_x, mb_y;
1066     uint8_t *data[MAX_COMPONENTS];
1067     const uint8_t *reference_data[MAX_COMPONENTS];
1068     int linesize[MAX_COMPONENTS];
1069     GetBitContext mb_bitmask_gb;
1070     int bytes_per_pixel = 1 + (s->bits > 8);
1071
1072     if (mb_bitmask)
1073         init_get_bits(&mb_bitmask_gb, mb_bitmask, s->mb_width * s->mb_height);
1074
1075     if (s->flipped && s->avctx->lowres) {
1076         av_log(s->avctx, AV_LOG_ERROR, "Can not flip image with lowres\n");
1077         s->flipped = 0;
1078     }
1079     s->restart_count = 0;
1080     for (i = 0; i < nb_components; i++) {
1081         int c   = s->comp_index[i];
1082         data[c] = s->picture_ptr->data[c];
1083         reference_data[c] = reference ? reference->data[c] : NULL;
1084         linesize[c] = s->linesize[c];
1085         s->coefs_finished[c] |= 1;
1086         if (s->flipped && !(s->avctx->flags & CODEC_FLAG_EMU_EDGE)) {
1087             // picture should be flipped upside-down for this codec
1088             int offset = (linesize[c] * (s->v_scount[i] *
1089                          (8 * s->mb_height - ((s->height / s->v_max) & 7)) - 1));
1090             data[c]           += offset;
1091             reference_data[c] += offset;
1092             linesize[c]       *= -1;
1093         }
1094     }
1095
1096     for (mb_y = 0; mb_y < s->mb_height; mb_y++) {
1097         for (mb_x = 0; mb_x < s->mb_width; mb_x++) {
1098             const int copy_mb = mb_bitmask && !get_bits1(&mb_bitmask_gb);
1099
1100             if (s->restart_interval && !s->restart_count)
1101                 s->restart_count = s->restart_interval;
1102
1103             if (get_bits_left(&s->gb) < 0) {
1104                 av_log(s->avctx, AV_LOG_ERROR, "overread %d\n",
1105                        -get_bits_left(&s->gb));
1106                 return AVERROR_INVALIDDATA;
1107             }
1108             for (i = 0; i < nb_components; i++) {
1109                 uint8_t *ptr;
1110                 int n, h, v, x, y, c, j;
1111                 int block_offset;
1112                 n = s->nb_blocks[i];
1113                 c = s->comp_index[i];
1114                 h = s->h_scount[i];
1115                 v = s->v_scount[i];
1116                 x = 0;
1117                 y = 0;
1118                 for (j = 0; j < n; j++) {
1119                     block_offset = (((linesize[c] * (v * mb_y + y) * 8) +
1120                                      (h * mb_x + x) * 8 * bytes_per_pixel) >> s->avctx->lowres);
1121
1122                     if (s->interlaced && s->bottom_field)
1123                         block_offset += linesize[c] >> 1;
1124                     ptr = data[c] + block_offset;
1125                     if (!s->progressive) {
1126                         if (copy_mb)
1127                             mjpeg_copy_block(s, ptr, reference_data[c] + block_offset,
1128                                              linesize[c], s->avctx->lowres);
1129
1130                         else {
1131                             s->dsp.clear_block(s->block);
1132                             if (decode_block(s, s->block, i,
1133                                              s->dc_index[i], s->ac_index[i],
1134                                              s->quant_matrixes[s->quant_sindex[i]]) < 0) {
1135                                 av_log(s->avctx, AV_LOG_ERROR,
1136                                        "error y=%d x=%d\n", mb_y, mb_x);
1137                                 return AVERROR_INVALIDDATA;
1138                             }
1139                             s->dsp.idct_put(ptr, linesize[c], s->block);
1140                             if (s->bits & 7)
1141                                 shift_output(s, ptr, linesize[c]);
1142                         }
1143                     } else {
1144                         int block_idx  = s->block_stride[c] * (v * mb_y + y) +
1145                                          (h * mb_x + x);
1146                         int16_t *block = s->blocks[c][block_idx];
1147                         if (Ah)
1148                             block[0] += get_bits1(&s->gb) *
1149                                         s->quant_matrixes[s->quant_sindex[i]][0] << Al;
1150                         else if (decode_dc_progressive(s, block, i, s->dc_index[i],
1151                                                        s->quant_matrixes[s->quant_sindex[i]],
1152                                                        Al) < 0) {
1153                             av_log(s->avctx, AV_LOG_ERROR,
1154                                    "error y=%d x=%d\n", mb_y, mb_x);
1155                             return AVERROR_INVALIDDATA;
1156                         }
1157                     }
1158                     av_dlog(s->avctx, "mb: %d %d processed\n", mb_y, mb_x);
1159                     av_dlog(s->avctx, "%d %d %d %d %d %d %d %d \n",
1160                             mb_x, mb_y, x, y, c, s->bottom_field,
1161                             (v * mb_y + y) * 8, (h * mb_x + x) * 8);
1162                     if (++x == h) {
1163                         x = 0;
1164                         y++;
1165                     }
1166                 }
1167             }
1168
1169             handle_rstn(s, nb_components);
1170         }
1171     }
1172     return 0;
1173 }
1174
1175 static int mjpeg_decode_scan_progressive_ac(MJpegDecodeContext *s, int ss,
1176                                             int se, int Ah, int Al)
1177 {
1178     int mb_x, mb_y;
1179     int EOBRUN = 0;
1180     int c = s->comp_index[0];
1181     uint8_t *data = s->picture.data[c];
1182     int linesize  = s->linesize[c];
1183     int last_scan = 0;
1184     int16_t *quant_matrix = s->quant_matrixes[s->quant_sindex[0]];
1185     int bytes_per_pixel = 1 + (s->bits > 8);
1186
1187     av_assert0(ss>=0 && Ah>=0 && Al>=0);
1188     if (se < ss || se > 63) {
1189         av_log(s->avctx, AV_LOG_ERROR, "SS/SE %d/%d is invalid\n", ss, se);
1190         return AVERROR_INVALIDDATA;
1191     }
1192
1193     if (!Al) {
1194         s->coefs_finished[c] |= (1LL << (se + 1)) - (1LL << ss);
1195         last_scan = !~s->coefs_finished[c];
1196     }
1197
1198     if (s->interlaced && s->bottom_field)
1199         data += linesize >> 1;
1200
1201     s->restart_count = 0;
1202
1203     for (mb_y = 0; mb_y < s->mb_height; mb_y++) {
1204         uint8_t *ptr     = data + (mb_y * linesize * 8 >> s->avctx->lowres);
1205         int block_idx    = mb_y * s->block_stride[c];
1206         int16_t (*block)[64] = &s->blocks[c][block_idx];
1207         uint8_t *last_nnz    = &s->last_nnz[c][block_idx];
1208         for (mb_x = 0; mb_x < s->mb_width; mb_x++, block++, last_nnz++) {
1209                 int ret;
1210                 if (s->restart_interval && !s->restart_count)
1211                     s->restart_count = s->restart_interval;
1212
1213                 if (Ah)
1214                     ret = decode_block_refinement(s, *block, last_nnz, s->ac_index[0],
1215                                                   quant_matrix, ss, se, Al, &EOBRUN);
1216                 else
1217                     ret = decode_block_progressive(s, *block, last_nnz, s->ac_index[0],
1218                                                    quant_matrix, ss, se, Al, &EOBRUN);
1219                 if (ret < 0) {
1220                     av_log(s->avctx, AV_LOG_ERROR,
1221                            "error y=%d x=%d\n", mb_y, mb_x);
1222                     return AVERROR_INVALIDDATA;
1223                 }
1224
1225             if (last_scan) {
1226                     s->dsp.idct_put(ptr, linesize, *block);
1227                     if (s->bits & 7)
1228                         shift_output(s, ptr, linesize);
1229                     ptr += bytes_per_pixel*8 >> s->avctx->lowres;
1230             }
1231             if (handle_rstn(s, 0))
1232                 EOBRUN = 0;
1233         }
1234     }
1235     return 0;
1236 }
1237
1238 int ff_mjpeg_decode_sos(MJpegDecodeContext *s, const uint8_t *mb_bitmask,
1239                         const AVFrame *reference)
1240 {
1241     int len, nb_components, i, h, v, predictor, point_transform;
1242     int index, id, ret;
1243     const int block_size = s->lossless ? 1 : 8;
1244     int ilv, prev_shift;
1245
1246     if (!s->got_picture) {
1247         av_log(s->avctx, AV_LOG_WARNING,
1248                 "Can not process SOS before SOF, skipping\n");
1249         return -1;
1250     }
1251
1252     av_assert0(s->picture_ptr->data[0]);
1253     /* XXX: verify len field validity */
1254     len = get_bits(&s->gb, 16);
1255     nb_components = get_bits(&s->gb, 8);
1256     if (nb_components == 0 || nb_components > MAX_COMPONENTS) {
1257         av_log(s->avctx, AV_LOG_ERROR,
1258                "decode_sos: nb_components (%d) unsupported\n", nb_components);
1259         return AVERROR_PATCHWELCOME;
1260     }
1261     if (len != 6 + 2 * nb_components) {
1262         av_log(s->avctx, AV_LOG_ERROR, "decode_sos: invalid len (%d)\n", len);
1263         return AVERROR_INVALIDDATA;
1264     }
1265     for (i = 0; i < nb_components; i++) {
1266         id = get_bits(&s->gb, 8) - 1;
1267         av_log(s->avctx, AV_LOG_DEBUG, "component: %d\n", id);
1268         /* find component index */
1269         for (index = 0; index < s->nb_components; index++)
1270             if (id == s->component_id[index])
1271                 break;
1272         if (index == s->nb_components) {
1273             av_log(s->avctx, AV_LOG_ERROR,
1274                    "decode_sos: index(%d) out of components\n", index);
1275             return AVERROR_INVALIDDATA;
1276         }
1277         /* Metasoft MJPEG codec has Cb and Cr swapped */
1278         if (s->avctx->codec_tag == MKTAG('M', 'T', 'S', 'J')
1279             && nb_components == 3 && s->nb_components == 3 && i)
1280             index = 3 - i;
1281
1282         s->quant_sindex[i] = s->quant_index[index];
1283         s->nb_blocks[i] = s->h_count[index] * s->v_count[index];
1284         s->h_scount[i]  = s->h_count[index];
1285         s->v_scount[i]  = s->v_count[index];
1286
1287         if(nb_components == 3 && s->nb_components == 3 && s->avctx->pix_fmt == AV_PIX_FMT_GBR24P)
1288             index = (i+2)%3;
1289         if(nb_components == 1 && s->nb_components == 3 && s->avctx->pix_fmt == AV_PIX_FMT_GBR24P)
1290             index = (index+2)%3;
1291
1292         s->comp_index[i] = index;
1293
1294         s->dc_index[i] = get_bits(&s->gb, 4);
1295         s->ac_index[i] = get_bits(&s->gb, 4);
1296
1297         if (s->dc_index[i] <  0 || s->ac_index[i] < 0 ||
1298             s->dc_index[i] >= 4 || s->ac_index[i] >= 4)
1299             goto out_of_range;
1300         if (!s->vlcs[0][s->dc_index[i]].table || !(s->progressive ? s->vlcs[2][s->ac_index[0]].table : s->vlcs[1][s->ac_index[i]].table))
1301             goto out_of_range;
1302     }
1303
1304     predictor = get_bits(&s->gb, 8);       /* JPEG Ss / lossless JPEG predictor /JPEG-LS NEAR */
1305     ilv = get_bits(&s->gb, 8);             /* JPEG Se / JPEG-LS ILV */
1306     if(s->avctx->codec_tag != AV_RL32("CJPG")){
1307         prev_shift      = get_bits(&s->gb, 4); /* Ah */
1308         point_transform = get_bits(&s->gb, 4); /* Al */
1309     }else
1310         prev_shift = point_transform = 0;
1311
1312     if (nb_components > 1) {
1313         /* interleaved stream */
1314         s->mb_width  = (s->width  + s->h_max * block_size - 1) / (s->h_max * block_size);
1315         s->mb_height = (s->height + s->v_max * block_size - 1) / (s->v_max * block_size);
1316     } else if (!s->ls) { /* skip this for JPEG-LS */
1317         h = s->h_max / s->h_scount[0];
1318         v = s->v_max / s->v_scount[0];
1319         s->mb_width     = (s->width  + h * block_size - 1) / (h * block_size);
1320         s->mb_height    = (s->height + v * block_size - 1) / (v * block_size);
1321         s->nb_blocks[0] = 1;
1322         s->h_scount[0]  = 1;
1323         s->v_scount[0]  = 1;
1324     }
1325
1326     if (s->avctx->debug & FF_DEBUG_PICT_INFO)
1327         av_log(s->avctx, AV_LOG_DEBUG, "%s %s p:%d >>:%d ilv:%d bits:%d skip:%d %s comp:%d\n",
1328                s->lossless ? "lossless" : "sequential DCT", s->rgb ? "RGB" : "",
1329                predictor, point_transform, ilv, s->bits, s->mjpb_skiptosod,
1330                s->pegasus_rct ? "PRCT" : (s->rct ? "RCT" : ""), nb_components);
1331
1332
1333     /* mjpeg-b can have padding bytes between sos and image data, skip them */
1334     for (i = s->mjpb_skiptosod; i > 0; i--)
1335         skip_bits(&s->gb, 8);
1336
1337 next_field:
1338     for (i = 0; i < nb_components; i++)
1339         s->last_dc[i] = (4 << s->bits);
1340
1341     if (s->lossless) {
1342         av_assert0(s->picture_ptr == &s->picture);
1343         if (CONFIG_JPEGLS_DECODER && s->ls) {
1344 //            for () {
1345 //            reset_ls_coding_parameters(s, 0);
1346
1347             if ((ret = ff_jpegls_decode_picture(s, predictor,
1348                                                 point_transform, ilv)) < 0)
1349                 return ret;
1350         } else {
1351             if (s->rgb) {
1352                 if ((ret = ljpeg_decode_rgb_scan(s, nb_components, predictor, point_transform)) < 0)
1353                     return ret;
1354             } else {
1355                 if ((ret = ljpeg_decode_yuv_scan(s, predictor,
1356                                                  point_transform,
1357                                                  nb_components)) < 0)
1358                     return ret;
1359             }
1360         }
1361     } else {
1362         if (s->progressive && predictor) {
1363             av_assert0(s->picture_ptr == &s->picture);
1364             if ((ret = mjpeg_decode_scan_progressive_ac(s, predictor,
1365                                                         ilv, prev_shift,
1366                                                         point_transform)) < 0)
1367                 return ret;
1368         } else {
1369             if ((ret = mjpeg_decode_scan(s, nb_components,
1370                                          prev_shift, point_transform,
1371                                          mb_bitmask, reference)) < 0)
1372                 return ret;
1373         }
1374     }
1375
1376     if (s->interlaced &&
1377         get_bits_left(&s->gb) > 32 &&
1378         show_bits(&s->gb, 8) == 0xFF) {
1379         GetBitContext bak = s->gb;
1380         align_get_bits(&bak);
1381         if (show_bits(&bak, 16) == 0xFFD1) {
1382             av_log(s->avctx, AV_LOG_DEBUG, "AVRn interlaced picture marker found\n");
1383             s->gb = bak;
1384             skip_bits(&s->gb, 16);
1385             s->bottom_field ^= 1;
1386
1387             goto next_field;
1388         }
1389     }
1390
1391     emms_c();
1392     return 0;
1393  out_of_range:
1394     av_log(s->avctx, AV_LOG_ERROR, "decode_sos: ac/dc index out of range\n");
1395     return AVERROR_INVALIDDATA;
1396 }
1397
1398 static int mjpeg_decode_dri(MJpegDecodeContext *s)
1399 {
1400     if (get_bits(&s->gb, 16) != 4)
1401         return AVERROR_INVALIDDATA;
1402     s->restart_interval = get_bits(&s->gb, 16);
1403     s->restart_count    = 0;
1404     av_log(s->avctx, AV_LOG_DEBUG, "restart interval: %d\n",
1405            s->restart_interval);
1406
1407     return 0;
1408 }
1409
1410 static int mjpeg_decode_app(MJpegDecodeContext *s)
1411 {
1412     int len, id, i;
1413
1414     len = get_bits(&s->gb, 16);
1415     if (len < 5)
1416         return AVERROR_INVALIDDATA;
1417     if (8 * len > get_bits_left(&s->gb))
1418         return AVERROR_INVALIDDATA;
1419
1420     id   = get_bits_long(&s->gb, 32);
1421     len -= 6;
1422
1423     if (s->avctx->debug & FF_DEBUG_STARTCODE)
1424         av_log(s->avctx, AV_LOG_DEBUG, "APPx %8X len=%d\n", id, len);
1425
1426     /* Buggy AVID, it puts EOI only at every 10th frame. */
1427     /* Also, this fourcc is used by non-avid files too, it holds some
1428        information, but it's always present in AVID-created files. */
1429     if (id == AV_RB32("AVI1")) {
1430         /* structure:
1431             4bytes      AVI1
1432             1bytes      polarity
1433             1bytes      always zero
1434             4bytes      field_size
1435             4bytes      field_size_less_padding
1436         */
1437             s->buggy_avid = 1;
1438         i = get_bits(&s->gb, 8); len--;
1439         av_log(s->avctx, AV_LOG_DEBUG, "polarity %d\n", i);
1440 #if 0
1441         skip_bits(&s->gb, 8);
1442         skip_bits(&s->gb, 32);
1443         skip_bits(&s->gb, 32);
1444         len -= 10;
1445 #endif
1446         goto out;
1447     }
1448
1449 //    len -= 2;
1450
1451     if (id == AV_RB32("JFIF")) {
1452         int t_w, t_h, v1, v2;
1453         skip_bits(&s->gb, 8); /* the trailing zero-byte */
1454         v1 = get_bits(&s->gb, 8);
1455         v2 = get_bits(&s->gb, 8);
1456         skip_bits(&s->gb, 8);
1457
1458         s->avctx->sample_aspect_ratio.num = get_bits(&s->gb, 16);
1459         s->avctx->sample_aspect_ratio.den = get_bits(&s->gb, 16);
1460
1461         if (s->avctx->debug & FF_DEBUG_PICT_INFO)
1462             av_log(s->avctx, AV_LOG_INFO,
1463                    "mjpeg: JFIF header found (version: %x.%x) SAR=%d/%d\n",
1464                    v1, v2,
1465                    s->avctx->sample_aspect_ratio.num,
1466                    s->avctx->sample_aspect_ratio.den);
1467
1468         t_w = get_bits(&s->gb, 8);
1469         t_h = get_bits(&s->gb, 8);
1470         if (t_w && t_h) {
1471             /* skip thumbnail */
1472             if (len -10 - (t_w * t_h * 3) > 0)
1473                 len -= t_w * t_h * 3;
1474         }
1475         len -= 10;
1476         goto out;
1477     }
1478
1479     if (id == AV_RB32("Adob") && (get_bits(&s->gb, 8) == 'e')) {
1480         if (s->avctx->debug & FF_DEBUG_PICT_INFO)
1481             av_log(s->avctx, AV_LOG_INFO, "mjpeg: Adobe header found\n");
1482         skip_bits(&s->gb, 16); /* version */
1483         skip_bits(&s->gb, 16); /* flags0 */
1484         skip_bits(&s->gb, 16); /* flags1 */
1485         skip_bits(&s->gb,  8); /* transform */
1486         len -= 7;
1487         goto out;
1488     }
1489
1490     if (id == AV_RB32("LJIF")) {
1491         if (s->avctx->debug & FF_DEBUG_PICT_INFO)
1492             av_log(s->avctx, AV_LOG_INFO,
1493                    "Pegasus lossless jpeg header found\n");
1494         skip_bits(&s->gb, 16); /* version ? */
1495         skip_bits(&s->gb, 16); /* unknown always 0? */
1496         skip_bits(&s->gb, 16); /* unknown always 0? */
1497         skip_bits(&s->gb, 16); /* unknown always 0? */
1498         switch (i=get_bits(&s->gb, 8)) {
1499         case 1:
1500             s->rgb         = 1;
1501             s->pegasus_rct = 0;
1502             break;
1503         case 2:
1504             s->rgb         = 1;
1505             s->pegasus_rct = 1;
1506             break;
1507         default:
1508             av_log(s->avctx, AV_LOG_ERROR, "unknown colorspace %d\n", i);
1509         }
1510         len -= 9;
1511         goto out;
1512     }
1513     if (id == AV_RL32("colr") && len > 0) {
1514         s->colr = get_bits(&s->gb, 8);
1515         if (s->avctx->debug & FF_DEBUG_PICT_INFO)
1516             av_log(s->avctx, AV_LOG_INFO, "COLR %d\n", s->colr);
1517         len --;
1518         goto out;
1519     }
1520     if (id == AV_RL32("xfrm") && len > 0) {
1521         s->xfrm = get_bits(&s->gb, 8);
1522         if (s->avctx->debug & FF_DEBUG_PICT_INFO)
1523             av_log(s->avctx, AV_LOG_INFO, "XFRM %d\n", s->xfrm);
1524         len --;
1525         goto out;
1526     }
1527
1528     /* EXIF metadata */
1529     if (s->start_code == APP1 && id == AV_RB32("Exif")) {
1530         GetByteContext gbytes;
1531         int ret, le, ifd_offset, bytes_read;
1532         const uint8_t *aligned;
1533
1534         skip_bits(&s->gb, 16); // skip padding
1535         len -= 2;
1536
1537         // init byte wise reading
1538         aligned = align_get_bits(&s->gb);
1539         bytestream2_init(&gbytes, aligned, len);
1540
1541         // read TIFF header
1542         ret = ff_tdecode_header(&gbytes, &le, &ifd_offset);
1543         if (ret) {
1544             av_log(s->avctx, AV_LOG_ERROR, "mjpeg: invalid TIFF header in EXIF data\n");
1545             return ret;
1546         }
1547
1548         bytestream2_seek(&gbytes, ifd_offset, SEEK_SET);
1549
1550         // read 0th IFD and store the metadata
1551         // (return values > 0 indicate the presence of subimage metadata)
1552         ret = ff_exif_decode_ifd(s->avctx, &gbytes, le, 0, &s->exif_metadata);
1553         if (ret < 0) {
1554             av_log(s->avctx, AV_LOG_ERROR, "mjpeg: error decoding EXIF data\n");
1555             return ret;
1556         }
1557
1558         bytes_read = bytestream2_tell(&gbytes);
1559         skip_bits(&s->gb, bytes_read << 3);
1560         len -= bytes_read;
1561
1562         goto out;
1563     }
1564
1565     /* Apple MJPEG-A */
1566     if ((s->start_code == APP1) && (len > (0x28 - 8))) {
1567         id   = get_bits_long(&s->gb, 32);
1568         len -= 4;
1569         /* Apple MJPEG-A */
1570         if (id == AV_RB32("mjpg")) {
1571 #if 0
1572             skip_bits(&s->gb, 32); /* field size */
1573             skip_bits(&s->gb, 32); /* pad field size */
1574             skip_bits(&s->gb, 32); /* next off */
1575             skip_bits(&s->gb, 32); /* quant off */
1576             skip_bits(&s->gb, 32); /* huff off */
1577             skip_bits(&s->gb, 32); /* image off */
1578             skip_bits(&s->gb, 32); /* scan off */
1579             skip_bits(&s->gb, 32); /* data off */
1580 #endif
1581             if (s->avctx->debug & FF_DEBUG_PICT_INFO)
1582                 av_log(s->avctx, AV_LOG_INFO, "mjpeg: Apple MJPEG-A header found\n");
1583         }
1584     }
1585
1586 out:
1587     /* slow but needed for extreme adobe jpegs */
1588     if (len < 0)
1589         av_log(s->avctx, AV_LOG_ERROR,
1590                "mjpeg: error, decode_app parser read over the end\n");
1591     while (--len > 0)
1592         skip_bits(&s->gb, 8);
1593
1594     return 0;
1595 }
1596
1597 static int mjpeg_decode_com(MJpegDecodeContext *s)
1598 {
1599     int len = get_bits(&s->gb, 16);
1600     if (len >= 2 && 8 * len - 16 <= get_bits_left(&s->gb)) {
1601         char *cbuf = av_malloc(len - 1);
1602         if (cbuf) {
1603             int i;
1604             for (i = 0; i < len - 2; i++)
1605                 cbuf[i] = get_bits(&s->gb, 8);
1606             if (i > 0 && cbuf[i - 1] == '\n')
1607                 cbuf[i - 1] = 0;
1608             else
1609                 cbuf[i] = 0;
1610
1611             if (s->avctx->debug & FF_DEBUG_PICT_INFO)
1612                 av_log(s->avctx, AV_LOG_INFO, "comment: '%s'\n", cbuf);
1613
1614             /* buggy avid, it puts EOI only at every 10th frame */
1615             if (!strncmp(cbuf, "AVID", 4)) {
1616                 s->buggy_avid = 1;
1617                 if (len > 14 && cbuf[12] == 1) /* 1 - NTSC, 2 - PAL */
1618                     s->interlace_polarity = 1;
1619             } else if (!strcmp(cbuf, "CS=ITU601"))
1620                 s->cs_itu601 = 1;
1621             else if ((!strncmp(cbuf, "Intel(R) JPEG Library, version 1", 32)) ||
1622                      (!strncmp(cbuf, "Metasoft MJPEG Codec", 20)))
1623                 s->flipped = 1;
1624
1625             av_free(cbuf);
1626         }
1627     }
1628
1629     return 0;
1630 }
1631
1632 /* return the 8 bit start code value and update the search
1633    state. Return -1 if no start code found */
1634 static int find_marker(const uint8_t **pbuf_ptr, const uint8_t *buf_end)
1635 {
1636     const uint8_t *buf_ptr;
1637     unsigned int v, v2;
1638     int val;
1639     int skipped = 0;
1640
1641     buf_ptr = *pbuf_ptr;
1642     while (buf_end - buf_ptr > 1) {
1643         v  = *buf_ptr++;
1644         v2 = *buf_ptr;
1645         if ((v == 0xff) && (v2 >= 0xc0) && (v2 <= 0xfe) && buf_ptr < buf_end) {
1646             val = *buf_ptr++;
1647             goto found;
1648         }
1649         skipped++;
1650     }
1651     buf_ptr = buf_end;
1652     val = -1;
1653 found:
1654     av_dlog(NULL, "find_marker skipped %d bytes\n", skipped);
1655     *pbuf_ptr = buf_ptr;
1656     return val;
1657 }
1658
1659 int ff_mjpeg_find_marker(MJpegDecodeContext *s,
1660                          const uint8_t **buf_ptr, const uint8_t *buf_end,
1661                          const uint8_t **unescaped_buf_ptr,
1662                          int *unescaped_buf_size)
1663 {
1664     int start_code;
1665     start_code = find_marker(buf_ptr, buf_end);
1666
1667     av_fast_padded_malloc(&s->buffer, &s->buffer_size, buf_end - *buf_ptr);
1668     if (!s->buffer)
1669         return AVERROR(ENOMEM);
1670
1671     /* unescape buffer of SOS, use special treatment for JPEG-LS */
1672     if (start_code == SOS && !s->ls) {
1673         const uint8_t *src = *buf_ptr;
1674         uint8_t *dst = s->buffer;
1675
1676         while (src < buf_end) {
1677             uint8_t x = *(src++);
1678
1679             *(dst++) = x;
1680             if (s->avctx->codec_id != AV_CODEC_ID_THP) {
1681                 if (x == 0xff) {
1682                     while (src < buf_end && x == 0xff)
1683                         x = *(src++);
1684
1685                     if (x >= 0xd0 && x <= 0xd7)
1686                         *(dst++) = x;
1687                     else if (x)
1688                         break;
1689                 }
1690             }
1691         }
1692         *unescaped_buf_ptr  = s->buffer;
1693         *unescaped_buf_size = dst - s->buffer;
1694         memset(s->buffer + *unescaped_buf_size, 0,
1695                FF_INPUT_BUFFER_PADDING_SIZE);
1696
1697         av_log(s->avctx, AV_LOG_DEBUG, "escaping removed %td bytes\n",
1698                (buf_end - *buf_ptr) - (dst - s->buffer));
1699     } else if (start_code == SOS && s->ls) {
1700         const uint8_t *src = *buf_ptr;
1701         uint8_t *dst  = s->buffer;
1702         int bit_count = 0;
1703         int t = 0, b = 0;
1704         PutBitContext pb;
1705
1706         s->cur_scan++;
1707
1708         /* find marker */
1709         while (src + t < buf_end) {
1710             uint8_t x = src[t++];
1711             if (x == 0xff) {
1712                 while ((src + t < buf_end) && x == 0xff)
1713                     x = src[t++];
1714                 if (x & 0x80) {
1715                     t -= FFMIN(2, t);
1716                     break;
1717                 }
1718             }
1719         }
1720         bit_count = t * 8;
1721         init_put_bits(&pb, dst, t);
1722
1723         /* unescape bitstream */
1724         while (b < t) {
1725             uint8_t x = src[b++];
1726             put_bits(&pb, 8, x);
1727             if (x == 0xFF) {
1728                 x = src[b++];
1729                 put_bits(&pb, 7, x);
1730                 bit_count--;
1731             }
1732         }
1733         flush_put_bits(&pb);
1734
1735         *unescaped_buf_ptr  = dst;
1736         *unescaped_buf_size = (bit_count + 7) >> 3;
1737         memset(s->buffer + *unescaped_buf_size, 0,
1738                FF_INPUT_BUFFER_PADDING_SIZE);
1739     } else {
1740         *unescaped_buf_ptr  = *buf_ptr;
1741         *unescaped_buf_size = buf_end - *buf_ptr;
1742     }
1743
1744     return start_code;
1745 }
1746
1747 int ff_mjpeg_decode_frame(AVCodecContext *avctx, void *data, int *got_frame,
1748                           AVPacket *avpkt)
1749 {
1750     const uint8_t *buf = avpkt->data;
1751     int buf_size       = avpkt->size;
1752     MJpegDecodeContext *s = avctx->priv_data;
1753     const uint8_t *buf_end, *buf_ptr;
1754     const uint8_t *unescaped_buf_ptr;
1755     int hshift, vshift;
1756     int unescaped_buf_size;
1757     int start_code;
1758     int i, index;
1759     int ret = 0;
1760
1761     av_dict_free(&s->exif_metadata);
1762
1763     buf_ptr = buf;
1764     buf_end = buf + buf_size;
1765     while (buf_ptr < buf_end) {
1766         /* find start next marker */
1767         start_code = ff_mjpeg_find_marker(s, &buf_ptr, buf_end,
1768                                           &unescaped_buf_ptr,
1769                                           &unescaped_buf_size);
1770         /* EOF */
1771         if (start_code < 0) {
1772             goto the_end;
1773         } else if (unescaped_buf_size > INT_MAX / 8) {
1774             av_log(avctx, AV_LOG_ERROR,
1775                    "MJPEG packet 0x%x too big (%d/%d), corrupt data?\n",
1776                    start_code, unescaped_buf_size, buf_size);
1777             return AVERROR_INVALIDDATA;
1778         }
1779         av_log(avctx, AV_LOG_DEBUG, "marker=%x avail_size_in_buf=%td\n",
1780                start_code, buf_end - buf_ptr);
1781
1782         ret = init_get_bits8(&s->gb, unescaped_buf_ptr, unescaped_buf_size);
1783
1784         if (ret < 0) {
1785             av_log(avctx, AV_LOG_ERROR, "invalid buffer\n");
1786             goto fail;
1787         }
1788
1789         s->start_code = start_code;
1790         if (s->avctx->debug & FF_DEBUG_STARTCODE)
1791             av_log(avctx, AV_LOG_DEBUG, "startcode: %X\n", start_code);
1792
1793         /* process markers */
1794         if (start_code >= 0xd0 && start_code <= 0xd7)
1795             av_log(avctx, AV_LOG_DEBUG,
1796                    "restart marker: %d\n", start_code & 0x0f);
1797             /* APP fields */
1798         else if (start_code >= APP0 && start_code <= APP15)
1799             mjpeg_decode_app(s);
1800             /* Comment */
1801         else if (start_code == COM)
1802             mjpeg_decode_com(s);
1803
1804         ret = -1;
1805
1806         if (!CONFIG_JPEGLS_DECODER &&
1807             (start_code == SOF48 || start_code == LSE)) {
1808             av_log(avctx, AV_LOG_ERROR, "JPEG-LS support not enabled.\n");
1809             return AVERROR(ENOSYS);
1810         }
1811
1812         switch (start_code) {
1813         case SOI:
1814             s->restart_interval = 0;
1815             s->restart_count    = 0;
1816             /* nothing to do on SOI */
1817             break;
1818         case DQT:
1819             ff_mjpeg_decode_dqt(s);
1820             break;
1821         case DHT:
1822             if ((ret = ff_mjpeg_decode_dht(s)) < 0) {
1823                 av_log(avctx, AV_LOG_ERROR, "huffman table decode error\n");
1824                 goto fail;
1825             }
1826             break;
1827         case SOF0:
1828         case SOF1:
1829             s->lossless    = 0;
1830             s->ls          = 0;
1831             s->progressive = 0;
1832             if ((ret = ff_mjpeg_decode_sof(s)) < 0)
1833                 goto fail;
1834             break;
1835         case SOF2:
1836             s->lossless    = 0;
1837             s->ls          = 0;
1838             s->progressive = 1;
1839             if ((ret = ff_mjpeg_decode_sof(s)) < 0)
1840                 goto fail;
1841             break;
1842         case SOF3:
1843             s->lossless    = 1;
1844             s->ls          = 0;
1845             s->progressive = 0;
1846             if ((ret = ff_mjpeg_decode_sof(s)) < 0)
1847                 goto fail;
1848             break;
1849         case SOF48:
1850             s->lossless    = 1;
1851             s->ls          = 1;
1852             s->progressive = 0;
1853             if ((ret = ff_mjpeg_decode_sof(s)) < 0)
1854                 goto fail;
1855             break;
1856         case LSE:
1857             if (!CONFIG_JPEGLS_DECODER ||
1858                 (ret = ff_jpegls_decode_lse(s)) < 0)
1859                 goto fail;
1860             break;
1861         case EOI:
1862 eoi_parser:
1863             s->cur_scan = 0;
1864             if (!s->got_picture) {
1865                 av_log(avctx, AV_LOG_WARNING,
1866                        "Found EOI before any SOF, ignoring\n");
1867                 break;
1868             }
1869             if (s->interlaced) {
1870                 s->bottom_field ^= 1;
1871                 /* if not bottom field, do not output image yet */
1872                 if (s->bottom_field == !s->interlace_polarity)
1873                     break;
1874             }
1875             if ((ret = av_frame_ref(data, s->picture_ptr)) < 0)
1876                 return ret;
1877             *got_frame = 1;
1878             s->got_picture = 0;
1879
1880             if (!s->lossless) {
1881                 int qp = FFMAX3(s->qscale[0],
1882                                 s->qscale[1],
1883                                 s->qscale[2]);
1884                 int qpw = (s->width + 15) / 16;
1885                 AVBufferRef *qp_table_buf = av_buffer_alloc(qpw);
1886                 if (qp_table_buf) {
1887                     memset(qp_table_buf->data, qp, qpw);
1888                     av_frame_set_qp_table(data, qp_table_buf, 0, FF_QSCALE_TYPE_MPEG1);
1889                 }
1890
1891                 if(avctx->debug & FF_DEBUG_QP)
1892                     av_log(avctx, AV_LOG_DEBUG, "QP: %d\n", qp);
1893             }
1894
1895             goto the_end;
1896         case SOS:
1897             if ((ret = ff_mjpeg_decode_sos(s, NULL, NULL)) < 0 &&
1898                 (avctx->err_recognition & AV_EF_EXPLODE))
1899                 goto fail;
1900             break;
1901         case DRI:
1902             mjpeg_decode_dri(s);
1903             break;
1904         case SOF5:
1905         case SOF6:
1906         case SOF7:
1907         case SOF9:
1908         case SOF10:
1909         case SOF11:
1910         case SOF13:
1911         case SOF14:
1912         case SOF15:
1913         case JPG:
1914             av_log(avctx, AV_LOG_ERROR,
1915                    "mjpeg: unsupported coding type (%x)\n", start_code);
1916             break;
1917         }
1918
1919         /* eof process start code */
1920         buf_ptr += (get_bits_count(&s->gb) + 7) / 8;
1921         av_log(avctx, AV_LOG_DEBUG,
1922                "marker parser used %d bytes (%d bits)\n",
1923                (get_bits_count(&s->gb) + 7) / 8, get_bits_count(&s->gb));
1924     }
1925     if (s->got_picture) {
1926         av_log(avctx, AV_LOG_WARNING, "EOI missing, emulating\n");
1927         goto eoi_parser;
1928     }
1929     av_log(avctx, AV_LOG_FATAL, "No JPEG data found in image\n");
1930     return AVERROR_INVALIDDATA;
1931 fail:
1932     s->got_picture = 0;
1933     return ret;
1934 the_end:
1935     if (s->upscale_h) {
1936         uint8_t *line = s->picture_ptr->data[s->upscale_h];
1937         av_assert0(avctx->pix_fmt == AV_PIX_FMT_YUVJ444P ||
1938                    avctx->pix_fmt == AV_PIX_FMT_YUV444P  ||
1939                    avctx->pix_fmt == AV_PIX_FMT_YUVJ440P ||
1940                    avctx->pix_fmt == AV_PIX_FMT_YUV440P);
1941         for (i = 0; i < s->chroma_height; i++) {
1942             for (index = s->width - 1; index; index--)
1943                 line[index] = (line[index / 2] + line[(index + 1) / 2]) >> 1;
1944             line += s->linesize[s->upscale_h];
1945         }
1946     }
1947     if (s->upscale_v) {
1948         uint8_t *dst = &((uint8_t *)s->picture_ptr->data[s->upscale_v])[(s->height - 1) * s->linesize[s->upscale_v]];
1949         int w;
1950         avcodec_get_chroma_sub_sample(s->avctx->pix_fmt, &hshift, &vshift);
1951         w = s->width >> hshift;
1952         av_assert0(avctx->pix_fmt == AV_PIX_FMT_YUVJ444P ||
1953                    avctx->pix_fmt == AV_PIX_FMT_YUV444P  ||
1954                    avctx->pix_fmt == AV_PIX_FMT_YUVJ422P ||
1955                    avctx->pix_fmt == AV_PIX_FMT_YUV422P);
1956         for (i = s->height - 1; i; i--) {
1957             uint8_t *src1 = &((uint8_t *)s->picture_ptr->data[s->upscale_v])[i / 2 * s->linesize[s->upscale_v]];
1958             uint8_t *src2 = &((uint8_t *)s->picture_ptr->data[s->upscale_v])[(i + 1) / 2 * s->linesize[s->upscale_v]];
1959             if (src1 == src2) {
1960                 memcpy(dst, src1, w);
1961             } else {
1962                 for (index = 0; index < w; index++)
1963                     dst[index] = (src1[index] + src2[index]) >> 1;
1964             }
1965             dst -= s->linesize[s->upscale_v];
1966         }
1967     }
1968     if (s->flipped && (s->avctx->flags & CODEC_FLAG_EMU_EDGE)) {
1969         int j;
1970         avcodec_get_chroma_sub_sample(s->avctx->pix_fmt, &hshift, &vshift);
1971         for (index=0; index<4; index++) {
1972             uint8_t *dst = s->picture_ptr->data[index];
1973             int w = s->width;
1974             int h = s->height;
1975             if(index && index<3){
1976                 w = FF_CEIL_RSHIFT(w, hshift);
1977                 h = FF_CEIL_RSHIFT(h, vshift);
1978             }
1979             if(dst){
1980                 uint8_t *dst2 = dst + s->linesize[index]*(h-1);
1981                 for (i=0; i<h/2; i++) {
1982                     for (j=0; j<w; j++)
1983                         FFSWAP(int, dst[j], dst2[j]);
1984                     dst  += s->linesize[index];
1985                     dst2 -= s->linesize[index];
1986                 }
1987             }
1988         }
1989     }
1990
1991     av_dict_copy(avpriv_frame_get_metadatap(data), s->exif_metadata, 0);
1992     av_dict_free(&s->exif_metadata);
1993
1994     av_log(avctx, AV_LOG_DEBUG, "decode frame unused %td bytes\n",
1995            buf_end - buf_ptr);
1996 //  return buf_end - buf_ptr;
1997     return buf_ptr - buf;
1998 }
1999
2000 av_cold int ff_mjpeg_decode_end(AVCodecContext *avctx)
2001 {
2002     MJpegDecodeContext *s = avctx->priv_data;
2003     int i, j;
2004
2005     if (s->interlaced && s->bottom_field == !s->interlace_polarity && s->got_picture && !avctx->frame_number) {
2006         av_log(avctx, AV_LOG_INFO, "Single field\n");
2007     }
2008
2009     if (s->picture_ptr)
2010         av_frame_unref(s->picture_ptr);
2011
2012     av_free(s->buffer);
2013     av_freep(&s->ljpeg_buffer);
2014     s->ljpeg_buffer_size = 0;
2015
2016     for (i = 0; i < 3; i++) {
2017         for (j = 0; j < 4; j++)
2018             ff_free_vlc(&s->vlcs[i][j]);
2019     }
2020     for (i = 0; i < MAX_COMPONENTS; i++) {
2021         av_freep(&s->blocks[i]);
2022         av_freep(&s->last_nnz[i]);
2023     }
2024     av_dict_free(&s->exif_metadata);
2025     return 0;
2026 }
2027
2028 static void decode_flush(AVCodecContext *avctx)
2029 {
2030     MJpegDecodeContext *s = avctx->priv_data;
2031     s->got_picture = 0;
2032 }
2033
2034 #if CONFIG_MJPEG_DECODER
2035 #define OFFSET(x) offsetof(MJpegDecodeContext, x)
2036 #define VD AV_OPT_FLAG_VIDEO_PARAM | AV_OPT_FLAG_DECODING_PARAM
2037 static const AVOption options[] = {
2038     { "extern_huff", "Use external huffman table.",
2039       OFFSET(extern_huff), AV_OPT_TYPE_INT, { .i64 = 0 }, 0, 1, VD },
2040     { NULL },
2041 };
2042
2043 static const AVClass mjpegdec_class = {
2044     .class_name = "MJPEG decoder",
2045     .item_name  = av_default_item_name,
2046     .option     = options,
2047     .version    = LIBAVUTIL_VERSION_INT,
2048 };
2049
2050 AVCodec ff_mjpeg_decoder = {
2051     .name           = "mjpeg",
2052     .type           = AVMEDIA_TYPE_VIDEO,
2053     .id             = AV_CODEC_ID_MJPEG,
2054     .priv_data_size = sizeof(MJpegDecodeContext),
2055     .init           = ff_mjpeg_decode_init,
2056     .close          = ff_mjpeg_decode_end,
2057     .decode         = ff_mjpeg_decode_frame,
2058     .flush          = decode_flush,
2059     .capabilities   = CODEC_CAP_DR1,
2060     .max_lowres     = 3,
2061     .long_name      = NULL_IF_CONFIG_SMALL("MJPEG (Motion JPEG)"),
2062     .priv_class     = &mjpegdec_class,
2063 };
2064 #endif
2065 #if CONFIG_THP_DECODER
2066 AVCodec ff_thp_decoder = {
2067     .name           = "thp",
2068     .type           = AVMEDIA_TYPE_VIDEO,
2069     .id             = AV_CODEC_ID_THP,
2070     .priv_data_size = sizeof(MJpegDecodeContext),
2071     .init           = ff_mjpeg_decode_init,
2072     .close          = ff_mjpeg_decode_end,
2073     .decode         = ff_mjpeg_decode_frame,
2074     .flush          = decode_flush,
2075     .capabilities   = CODEC_CAP_DR1,
2076     .max_lowres     = 3,
2077     .long_name      = NULL_IF_CONFIG_SMALL("Nintendo Gamecube THP video"),
2078 };
2079 #endif