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