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