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