avcodec/mjpegdec: Read EXIF metadata in JPEG input.
[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_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_ptr < buf_end) {
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     val = -1;
1623 found:
1624     av_dlog(NULL, "find_marker skipped %d bytes\n", skipped);
1625     *pbuf_ptr = buf_ptr;
1626     return val;
1627 }
1628
1629 int ff_mjpeg_find_marker(MJpegDecodeContext *s,
1630                          const uint8_t **buf_ptr, const uint8_t *buf_end,
1631                          const uint8_t **unescaped_buf_ptr,
1632                          int *unescaped_buf_size)
1633 {
1634     int start_code;
1635     start_code = find_marker(buf_ptr, buf_end);
1636
1637     av_fast_padded_malloc(&s->buffer, &s->buffer_size, buf_end - *buf_ptr);
1638     if (!s->buffer)
1639         return AVERROR(ENOMEM);
1640
1641     /* unescape buffer of SOS, use special treatment for JPEG-LS */
1642     if (start_code == SOS && !s->ls) {
1643         const uint8_t *src = *buf_ptr;
1644         uint8_t *dst = s->buffer;
1645
1646         while (src < buf_end) {
1647             uint8_t x = *(src++);
1648
1649             *(dst++) = x;
1650             if (s->avctx->codec_id != AV_CODEC_ID_THP) {
1651                 if (x == 0xff) {
1652                     while (src < buf_end && x == 0xff)
1653                         x = *(src++);
1654
1655                     if (x >= 0xd0 && x <= 0xd7)
1656                         *(dst++) = x;
1657                     else if (x)
1658                         break;
1659                 }
1660             }
1661         }
1662         *unescaped_buf_ptr  = s->buffer;
1663         *unescaped_buf_size = dst - s->buffer;
1664         memset(s->buffer + *unescaped_buf_size, 0,
1665                FF_INPUT_BUFFER_PADDING_SIZE);
1666
1667         av_log(s->avctx, AV_LOG_DEBUG, "escaping removed %td bytes\n",
1668                (buf_end - *buf_ptr) - (dst - s->buffer));
1669     } else if (start_code == SOS && s->ls) {
1670         const uint8_t *src = *buf_ptr;
1671         uint8_t *dst  = s->buffer;
1672         int bit_count = 0;
1673         int t = 0, b = 0;
1674         PutBitContext pb;
1675
1676         s->cur_scan++;
1677
1678         /* find marker */
1679         while (src + t < buf_end) {
1680             uint8_t x = src[t++];
1681             if (x == 0xff) {
1682                 while ((src + t < buf_end) && x == 0xff)
1683                     x = src[t++];
1684                 if (x & 0x80) {
1685                     t -= FFMIN(2, t);
1686                     break;
1687                 }
1688             }
1689         }
1690         bit_count = t * 8;
1691         init_put_bits(&pb, dst, t);
1692
1693         /* unescape bitstream */
1694         while (b < t) {
1695             uint8_t x = src[b++];
1696             put_bits(&pb, 8, x);
1697             if (x == 0xFF) {
1698                 x = src[b++];
1699                 put_bits(&pb, 7, x);
1700                 bit_count--;
1701             }
1702         }
1703         flush_put_bits(&pb);
1704
1705         *unescaped_buf_ptr  = dst;
1706         *unescaped_buf_size = (bit_count + 7) >> 3;
1707         memset(s->buffer + *unescaped_buf_size, 0,
1708                FF_INPUT_BUFFER_PADDING_SIZE);
1709     } else {
1710         *unescaped_buf_ptr  = *buf_ptr;
1711         *unescaped_buf_size = buf_end - *buf_ptr;
1712     }
1713
1714     return start_code;
1715 }
1716
1717 int ff_mjpeg_decode_frame(AVCodecContext *avctx, void *data, int *got_frame,
1718                           AVPacket *avpkt)
1719 {
1720     const uint8_t *buf = avpkt->data;
1721     int buf_size       = avpkt->size;
1722     MJpegDecodeContext *s = avctx->priv_data;
1723     const uint8_t *buf_end, *buf_ptr;
1724     const uint8_t *unescaped_buf_ptr;
1725     int hshift, vshift;
1726     int unescaped_buf_size;
1727     int start_code;
1728     int i, index;
1729     int ret = 0;
1730
1731     av_dict_free(&s->exif_metadata);
1732
1733     buf_ptr = buf;
1734     buf_end = buf + buf_size;
1735     while (buf_ptr < buf_end) {
1736         /* find start next marker */
1737         start_code = ff_mjpeg_find_marker(s, &buf_ptr, buf_end,
1738                                           &unescaped_buf_ptr,
1739                                           &unescaped_buf_size);
1740         /* EOF */
1741         if (start_code < 0) {
1742             goto the_end;
1743         } else if (unescaped_buf_size > INT_MAX / 8) {
1744             av_log(avctx, AV_LOG_ERROR,
1745                    "MJPEG packet 0x%x too big (%d/%d), corrupt data?\n",
1746                    start_code, unescaped_buf_size, buf_size);
1747             return AVERROR_INVALIDDATA;
1748         }
1749         av_log(avctx, AV_LOG_DEBUG, "marker=%x avail_size_in_buf=%td\n",
1750                start_code, buf_end - buf_ptr);
1751
1752         ret = init_get_bits8(&s->gb, unescaped_buf_ptr, unescaped_buf_size);
1753
1754         if (ret < 0) {
1755             av_log(avctx, AV_LOG_ERROR, "invalid buffer\n");
1756             goto fail;
1757         }
1758
1759         s->start_code = start_code;
1760         if (s->avctx->debug & FF_DEBUG_STARTCODE)
1761             av_log(avctx, AV_LOG_DEBUG, "startcode: %X\n", start_code);
1762
1763         /* process markers */
1764         if (start_code >= 0xd0 && start_code <= 0xd7)
1765             av_log(avctx, AV_LOG_DEBUG,
1766                    "restart marker: %d\n", start_code & 0x0f);
1767             /* APP fields */
1768         else if (start_code >= APP0 && start_code <= APP15)
1769             mjpeg_decode_app(s);
1770             /* Comment */
1771         else if (start_code == COM)
1772             mjpeg_decode_com(s);
1773
1774         ret = -1;
1775
1776         if (!CONFIG_JPEGLS_DECODER &&
1777             (start_code == SOF48 || start_code == LSE)) {
1778             av_log(avctx, AV_LOG_ERROR, "JPEG-LS support not enabled.\n");
1779             return AVERROR(ENOSYS);
1780         }
1781
1782         switch (start_code) {
1783         case SOI:
1784             s->restart_interval = 0;
1785             s->restart_count    = 0;
1786             /* nothing to do on SOI */
1787             break;
1788         case DQT:
1789             ff_mjpeg_decode_dqt(s);
1790             break;
1791         case DHT:
1792             if ((ret = ff_mjpeg_decode_dht(s)) < 0) {
1793                 av_log(avctx, AV_LOG_ERROR, "huffman table decode error\n");
1794                 goto fail;
1795             }
1796             break;
1797         case SOF0:
1798         case SOF1:
1799             s->lossless    = 0;
1800             s->ls          = 0;
1801             s->progressive = 0;
1802             if ((ret = ff_mjpeg_decode_sof(s)) < 0)
1803                 goto fail;
1804             break;
1805         case SOF2:
1806             s->lossless    = 0;
1807             s->ls          = 0;
1808             s->progressive = 1;
1809             if ((ret = ff_mjpeg_decode_sof(s)) < 0)
1810                 goto fail;
1811             break;
1812         case SOF3:
1813             s->lossless    = 1;
1814             s->ls          = 0;
1815             s->progressive = 0;
1816             if ((ret = ff_mjpeg_decode_sof(s)) < 0)
1817                 goto fail;
1818             break;
1819         case SOF48:
1820             s->lossless    = 1;
1821             s->ls          = 1;
1822             s->progressive = 0;
1823             if ((ret = ff_mjpeg_decode_sof(s)) < 0)
1824                 goto fail;
1825             break;
1826         case LSE:
1827             if (!CONFIG_JPEGLS_DECODER ||
1828                 (ret = ff_jpegls_decode_lse(s)) < 0)
1829                 goto fail;
1830             break;
1831         case EOI:
1832 eoi_parser:
1833             s->cur_scan = 0;
1834             if (!s->got_picture) {
1835                 av_log(avctx, AV_LOG_WARNING,
1836                        "Found EOI before any SOF, ignoring\n");
1837                 break;
1838             }
1839             if (s->interlaced) {
1840                 s->bottom_field ^= 1;
1841                 /* if not bottom field, do not output image yet */
1842                 if (s->bottom_field == !s->interlace_polarity)
1843                     break;
1844             }
1845             if ((ret = av_frame_ref(data, s->picture_ptr)) < 0)
1846                 return ret;
1847             *got_frame = 1;
1848             s->got_picture = 0;
1849
1850             if (!s->lossless) {
1851                 int qp = FFMAX3(s->qscale[0],
1852                                 s->qscale[1],
1853                                 s->qscale[2]);
1854                 int qpw = (s->width + 15) / 16;
1855                 AVBufferRef *qp_table_buf = av_buffer_alloc(qpw);
1856                 if (qp_table_buf) {
1857                     memset(qp_table_buf->data, qp, qpw);
1858                     av_frame_set_qp_table(data, qp_table_buf, 0, FF_QSCALE_TYPE_MPEG1);
1859                 }
1860
1861                 if(avctx->debug & FF_DEBUG_QP)
1862                     av_log(avctx, AV_LOG_DEBUG, "QP: %d\n", qp);
1863             }
1864
1865             goto the_end;
1866         case SOS:
1867             if ((ret = ff_mjpeg_decode_sos(s, NULL, NULL)) < 0 &&
1868                 (avctx->err_recognition & AV_EF_EXPLODE))
1869                 goto fail;
1870             break;
1871         case DRI:
1872             mjpeg_decode_dri(s);
1873             break;
1874         case SOF5:
1875         case SOF6:
1876         case SOF7:
1877         case SOF9:
1878         case SOF10:
1879         case SOF11:
1880         case SOF13:
1881         case SOF14:
1882         case SOF15:
1883         case JPG:
1884             av_log(avctx, AV_LOG_ERROR,
1885                    "mjpeg: unsupported coding type (%x)\n", start_code);
1886             break;
1887         }
1888
1889         /* eof process start code */
1890         buf_ptr += (get_bits_count(&s->gb) + 7) / 8;
1891         av_log(avctx, AV_LOG_DEBUG,
1892                "marker parser used %d bytes (%d bits)\n",
1893                (get_bits_count(&s->gb) + 7) / 8, get_bits_count(&s->gb));
1894     }
1895     if (s->got_picture) {
1896         av_log(avctx, AV_LOG_WARNING, "EOI missing, emulating\n");
1897         goto eoi_parser;
1898     }
1899     av_log(avctx, AV_LOG_FATAL, "No JPEG data found in image\n");
1900     return AVERROR_INVALIDDATA;
1901 fail:
1902     s->got_picture = 0;
1903     return ret;
1904 the_end:
1905     if (s->upscale_h) {
1906         uint8_t *line = s->picture_ptr->data[s->upscale_h];
1907         av_assert0(avctx->pix_fmt == AV_PIX_FMT_YUVJ444P ||
1908                    avctx->pix_fmt == AV_PIX_FMT_YUV444P  ||
1909                    avctx->pix_fmt == AV_PIX_FMT_YUVJ440P ||
1910                    avctx->pix_fmt == AV_PIX_FMT_YUV440P);
1911         for (i = 0; i < s->chroma_height; i++) {
1912             for (index = s->width - 1; index; index--)
1913                 line[index] = (line[index / 2] + line[(index + 1) / 2]) >> 1;
1914             line += s->linesize[s->upscale_h];
1915         }
1916     }
1917     if (s->upscale_v) {
1918         uint8_t *dst = &((uint8_t *)s->picture_ptr->data[s->upscale_v])[(s->height - 1) * s->linesize[s->upscale_v]];
1919         int w;
1920         avcodec_get_chroma_sub_sample(s->avctx->pix_fmt, &hshift, &vshift);
1921         w = s->width >> hshift;
1922         av_assert0(avctx->pix_fmt == AV_PIX_FMT_YUVJ444P ||
1923                    avctx->pix_fmt == AV_PIX_FMT_YUV444P  ||
1924                    avctx->pix_fmt == AV_PIX_FMT_YUVJ422P ||
1925                    avctx->pix_fmt == AV_PIX_FMT_YUV422P);
1926         for (i = s->height - 1; i; i--) {
1927             uint8_t *src1 = &((uint8_t *)s->picture_ptr->data[s->upscale_v])[i / 2 * s->linesize[s->upscale_v]];
1928             uint8_t *src2 = &((uint8_t *)s->picture_ptr->data[s->upscale_v])[(i + 1) / 2 * s->linesize[s->upscale_v]];
1929             if (src1 == src2) {
1930                 memcpy(dst, src1, w);
1931             } else {
1932                 for (index = 0; index < w; index++)
1933                     dst[index] = (src1[index] + src2[index]) >> 1;
1934             }
1935             dst -= s->linesize[s->upscale_v];
1936         }
1937     }
1938     if (s->flipped && (s->avctx->flags & CODEC_FLAG_EMU_EDGE)) {
1939         int j;
1940         avcodec_get_chroma_sub_sample(s->avctx->pix_fmt, &hshift, &vshift);
1941         for (index=0; index<4; index++) {
1942             uint8_t *dst = s->picture_ptr->data[index];
1943             int w = s->width;
1944             int h = s->height;
1945             if(index && index<3){
1946                 w = FF_CEIL_RSHIFT(w, hshift);
1947                 h = FF_CEIL_RSHIFT(h, vshift);
1948             }
1949             if(dst){
1950                 uint8_t *dst2 = dst + s->linesize[index]*(h-1);
1951                 for (i=0; i<h/2; i++) {
1952                     for (j=0; j<w; j++)
1953                         FFSWAP(int, dst[j], dst2[j]);
1954                     dst  += s->linesize[index];
1955                     dst2 -= s->linesize[index];
1956                 }
1957             }
1958         }
1959     }
1960
1961     av_dict_copy(avpriv_frame_get_metadatap(data), s->exif_metadata, 0);
1962     av_dict_free(&s->exif_metadata);
1963
1964     av_log(avctx, AV_LOG_DEBUG, "decode frame unused %td bytes\n",
1965            buf_end - buf_ptr);
1966 //  return buf_end - buf_ptr;
1967     return buf_ptr - buf;
1968 }
1969
1970 av_cold int ff_mjpeg_decode_end(AVCodecContext *avctx)
1971 {
1972     MJpegDecodeContext *s = avctx->priv_data;
1973     int i, j;
1974
1975     if (s->picture_ptr)
1976         av_frame_unref(s->picture_ptr);
1977
1978     av_free(s->buffer);
1979     av_freep(&s->ljpeg_buffer);
1980     s->ljpeg_buffer_size = 0;
1981
1982     for (i = 0; i < 3; i++) {
1983         for (j = 0; j < 4; j++)
1984             ff_free_vlc(&s->vlcs[i][j]);
1985     }
1986     for (i = 0; i < MAX_COMPONENTS; i++) {
1987         av_freep(&s->blocks[i]);
1988         av_freep(&s->last_nnz[i]);
1989     }
1990     av_dict_free(&s->exif_metadata);
1991     return 0;
1992 }
1993
1994 static void decode_flush(AVCodecContext *avctx)
1995 {
1996     MJpegDecodeContext *s = avctx->priv_data;
1997     s->got_picture = 0;
1998 }
1999
2000 #if CONFIG_MJPEG_DECODER
2001 #define OFFSET(x) offsetof(MJpegDecodeContext, x)
2002 #define VD AV_OPT_FLAG_VIDEO_PARAM | AV_OPT_FLAG_DECODING_PARAM
2003 static const AVOption options[] = {
2004     { "extern_huff", "Use external huffman table.",
2005       OFFSET(extern_huff), AV_OPT_TYPE_INT, { .i64 = 0 }, 0, 1, VD },
2006     { NULL },
2007 };
2008
2009 static const AVClass mjpegdec_class = {
2010     .class_name = "MJPEG decoder",
2011     .item_name  = av_default_item_name,
2012     .option     = options,
2013     .version    = LIBAVUTIL_VERSION_INT,
2014 };
2015
2016 AVCodec ff_mjpeg_decoder = {
2017     .name           = "mjpeg",
2018     .type           = AVMEDIA_TYPE_VIDEO,
2019     .id             = AV_CODEC_ID_MJPEG,
2020     .priv_data_size = sizeof(MJpegDecodeContext),
2021     .init           = ff_mjpeg_decode_init,
2022     .close          = ff_mjpeg_decode_end,
2023     .decode         = ff_mjpeg_decode_frame,
2024     .flush          = decode_flush,
2025     .capabilities   = CODEC_CAP_DR1,
2026     .max_lowres     = 3,
2027     .long_name      = NULL_IF_CONFIG_SMALL("MJPEG (Motion JPEG)"),
2028     .priv_class     = &mjpegdec_class,
2029 };
2030 #endif
2031 #if CONFIG_THP_DECODER
2032 AVCodec ff_thp_decoder = {
2033     .name           = "thp",
2034     .type           = AVMEDIA_TYPE_VIDEO,
2035     .id             = AV_CODEC_ID_THP,
2036     .priv_data_size = sizeof(MJpegDecodeContext),
2037     .init           = ff_mjpeg_decode_init,
2038     .close          = ff_mjpeg_decode_end,
2039     .decode         = ff_mjpeg_decode_frame,
2040     .flush          = decode_flush,
2041     .capabilities   = CODEC_CAP_DR1,
2042     .max_lowres     = 3,
2043     .long_name      = NULL_IF_CONFIG_SMALL("Nintendo Gamecube THP video"),
2044 };
2045 #endif