]> git.sesse.net Git - ffmpeg/blob - libavformat/rmdec.c
ttadec: unbreak playback of matroska files
[ffmpeg] / libavformat / rmdec.c
1 /*
2  * "Real" compatible demuxer.
3  * Copyright (c) 2000, 2001 Fabrice Bellard
4  *
5  * This file is part of Libav.
6  *
7  * Libav is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU Lesser General Public
9  * License as published by the Free Software Foundation; either
10  * version 2.1 of the License, or (at your option) any later version.
11  *
12  * Libav is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15  * Lesser General Public License for more details.
16  *
17  * You should have received a copy of the GNU Lesser General Public
18  * License along with Libav; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20  */
21
22 #include "libavutil/avstring.h"
23 #include "libavutil/intreadwrite.h"
24 #include "libavutil/dict.h"
25 #include "avformat.h"
26 #include "internal.h"
27 #include "riff.h"
28 #include "rm.h"
29
30 #define DEINT_ID_GENR MKTAG('g', 'e', 'n', 'r') ///< interleaving for Cooker/Atrac
31 #define DEINT_ID_INT0 MKTAG('I', 'n', 't', '0') ///< no interleaving needed
32 #define DEINT_ID_INT4 MKTAG('I', 'n', 't', '4') ///< interleaving for 28.8
33 #define DEINT_ID_SIPR MKTAG('s', 'i', 'p', 'r') ///< interleaving for Sipro
34 #define DEINT_ID_VBRF MKTAG('v', 'b', 'r', 'f') ///< VBR case for AAC
35 #define DEINT_ID_VBRS MKTAG('v', 'b', 'r', 's') ///< VBR case for AAC
36
37 struct RMStream {
38     AVPacket pkt;      ///< place to store merged video frame / reordered audio data
39     int videobufsize;  ///< current assembled frame size
40     int videobufpos;   ///< position for the next slice in the video buffer
41     int curpic_num;    ///< picture number of current frame
42     int cur_slice, slices;
43     int64_t pktpos;    ///< first slice position in file
44     /// Audio descrambling matrix parameters
45     int64_t audiotimestamp; ///< Audio packet timestamp
46     int sub_packet_cnt; // Subpacket counter, used while reading
47     int sub_packet_size, sub_packet_h, coded_framesize; ///< Descrambling parameters from container
48     int audio_framesize; /// Audio frame size from container
49     int sub_packet_lengths[16]; /// Length of each subpacket
50     int32_t deint_id;  ///< deinterleaver used in audio stream
51 };
52
53 typedef struct {
54     int nb_packets;
55     int old_format;
56     int current_stream;
57     int remaining_len;
58     int audio_stream_num; ///< Stream number for audio packets
59     int audio_pkt_cnt; ///< Output packet counter
60 } RMDemuxContext;
61
62 static const unsigned char sipr_swaps[38][2] = {
63     {  0, 63 }, {  1, 22 }, {  2, 44 }, {  3, 90 },
64     {  5, 81 }, {  7, 31 }, {  8, 86 }, {  9, 58 },
65     { 10, 36 }, { 12, 68 }, { 13, 39 }, { 14, 73 },
66     { 15, 53 }, { 16, 69 }, { 17, 57 }, { 19, 88 },
67     { 20, 34 }, { 21, 71 }, { 24, 46 }, { 25, 94 },
68     { 26, 54 }, { 28, 75 }, { 29, 50 }, { 32, 70 },
69     { 33, 92 }, { 35, 74 }, { 38, 85 }, { 40, 56 },
70     { 42, 87 }, { 43, 65 }, { 45, 59 }, { 48, 79 },
71     { 49, 93 }, { 51, 89 }, { 55, 95 }, { 61, 76 },
72     { 67, 83 }, { 77, 80 }
73 };
74
75 const unsigned char ff_sipr_subpk_size[4] = { 29, 19, 37, 20 };
76
77 static inline void get_strl(AVIOContext *pb, char *buf, int buf_size, int len)
78 {
79     int i;
80     char *q, r;
81
82     q = buf;
83     for(i=0;i<len;i++) {
84         r = avio_r8(pb);
85         if (i < buf_size - 1)
86             *q++ = r;
87     }
88     if (buf_size > 0) *q = '\0';
89 }
90
91 static void get_str8(AVIOContext *pb, char *buf, int buf_size)
92 {
93     get_strl(pb, buf, buf_size, avio_r8(pb));
94 }
95
96 static int rm_read_extradata(AVIOContext *pb, AVCodecContext *avctx, unsigned size)
97 {
98     if (size >= 1<<24)
99         return -1;
100     avctx->extradata = av_malloc(size + FF_INPUT_BUFFER_PADDING_SIZE);
101     if (!avctx->extradata)
102         return AVERROR(ENOMEM);
103     avctx->extradata_size = avio_read(pb, avctx->extradata, size);
104     memset(avctx->extradata + avctx->extradata_size, 0, FF_INPUT_BUFFER_PADDING_SIZE);
105     if (avctx->extradata_size != size)
106         return AVERROR(EIO);
107     return 0;
108 }
109
110 static void rm_read_metadata(AVFormatContext *s, int wide)
111 {
112     char buf[1024];
113     int i;
114     for (i=0; i<FF_ARRAY_ELEMS(ff_rm_metadata); i++) {
115         int len = wide ? avio_rb16(s->pb) : avio_r8(s->pb);
116         get_strl(s->pb, buf, sizeof(buf), len);
117         av_dict_set(&s->metadata, ff_rm_metadata[i], buf, 0);
118     }
119 }
120
121 RMStream *ff_rm_alloc_rmstream (void)
122 {
123     RMStream *rms = av_mallocz(sizeof(RMStream));
124     rms->curpic_num = -1;
125     return rms;
126 }
127
128 void ff_rm_free_rmstream (RMStream *rms)
129 {
130     av_free_packet(&rms->pkt);
131 }
132
133 static int rm_read_audio_stream_info(AVFormatContext *s, AVIOContext *pb,
134                                      AVStream *st, RMStream *ast, int read_all)
135 {
136     char buf[256];
137     uint32_t version;
138     int ret;
139
140     /* ra type header */
141     version = avio_rb16(pb); /* version */
142     if (version == 3) {
143         int header_size = avio_rb16(pb);
144         int64_t startpos = avio_tell(pb);
145         avio_skip(pb, 14);
146         rm_read_metadata(s, 0);
147         if ((startpos + header_size) >= avio_tell(pb) + 2) {
148             // fourcc (should always be "lpcJ")
149             avio_r8(pb);
150             get_str8(pb, buf, sizeof(buf));
151         }
152         // Skip extra header crap (this should never happen)
153         if ((startpos + header_size) > avio_tell(pb))
154             avio_skip(pb, header_size + startpos - avio_tell(pb));
155         st->codec->sample_rate = 8000;
156         st->codec->channels = 1;
157         st->codec->codec_type = AVMEDIA_TYPE_AUDIO;
158         st->codec->codec_id = CODEC_ID_RA_144;
159         ast->deint_id = DEINT_ID_INT0;
160     } else {
161         int flavor, sub_packet_h, coded_framesize, sub_packet_size;
162         int codecdata_length;
163         /* old version (4) */
164         avio_skip(pb, 2); /* unused */
165         avio_rb32(pb); /* .ra4 */
166         avio_rb32(pb); /* data size */
167         avio_rb16(pb); /* version2 */
168         avio_rb32(pb); /* header size */
169         flavor= avio_rb16(pb); /* add codec info / flavor */
170         ast->coded_framesize = coded_framesize = avio_rb32(pb); /* coded frame size */
171         avio_rb32(pb); /* ??? */
172         avio_rb32(pb); /* ??? */
173         avio_rb32(pb); /* ??? */
174         ast->sub_packet_h = sub_packet_h = avio_rb16(pb); /* 1 */
175         st->codec->block_align= avio_rb16(pb); /* frame size */
176         ast->sub_packet_size = sub_packet_size = avio_rb16(pb); /* sub packet size */
177         avio_rb16(pb); /* ??? */
178         if (version == 5) {
179             avio_rb16(pb); avio_rb16(pb); avio_rb16(pb);
180         }
181         st->codec->sample_rate = avio_rb16(pb);
182         avio_rb32(pb);
183         st->codec->channels = avio_rb16(pb);
184         if (version == 5) {
185             ast->deint_id = avio_rl32(pb);
186             avio_read(pb, buf, 4);
187             buf[4] = 0;
188         } else {
189             get_str8(pb, buf, sizeof(buf)); /* desc */
190             ast->deint_id = AV_RL32(buf);
191             get_str8(pb, buf, sizeof(buf)); /* desc */
192         }
193         st->codec->codec_type = AVMEDIA_TYPE_AUDIO;
194         st->codec->codec_tag  = AV_RL32(buf);
195         st->codec->codec_id   = ff_codec_get_id(ff_rm_codec_tags,
196                                                 st->codec->codec_tag);
197
198         switch (st->codec->codec_id) {
199         case CODEC_ID_AC3:
200             st->need_parsing = AVSTREAM_PARSE_FULL;
201             break;
202         case CODEC_ID_RA_288:
203             st->codec->extradata_size= 0;
204             ast->audio_framesize = st->codec->block_align;
205             st->codec->block_align = coded_framesize;
206             break;
207         case CODEC_ID_COOK:
208         case CODEC_ID_ATRAC3:
209         case CODEC_ID_SIPR:
210             avio_rb16(pb); avio_r8(pb);
211             if (version == 5)
212                 avio_r8(pb);
213             codecdata_length = avio_rb32(pb);
214             if(codecdata_length + FF_INPUT_BUFFER_PADDING_SIZE <= (unsigned)codecdata_length){
215                 av_log(s, AV_LOG_ERROR, "codecdata_length too large\n");
216                 return -1;
217             }
218
219             ast->audio_framesize = st->codec->block_align;
220             if (st->codec->codec_id == CODEC_ID_SIPR) {
221                 if (flavor > 3) {
222                     av_log(s, AV_LOG_ERROR, "bad SIPR file flavor %d\n",
223                            flavor);
224                     return -1;
225                 }
226                 st->codec->block_align = ff_sipr_subpk_size[flavor];
227             } else {
228                 if(sub_packet_size <= 0){
229                     av_log(s, AV_LOG_ERROR, "sub_packet_size is invalid\n");
230                     return -1;
231                 }
232                 st->codec->block_align = ast->sub_packet_size;
233             }
234             if ((ret = rm_read_extradata(pb, st->codec, codecdata_length)) < 0)
235                 return ret;
236             break;
237         case CODEC_ID_AAC:
238             avio_rb16(pb); avio_r8(pb);
239             if (version == 5)
240                 avio_r8(pb);
241             codecdata_length = avio_rb32(pb);
242             if(codecdata_length + FF_INPUT_BUFFER_PADDING_SIZE <= (unsigned)codecdata_length){
243                 av_log(s, AV_LOG_ERROR, "codecdata_length too large\n");
244                 return -1;
245             }
246             if (codecdata_length >= 1) {
247                 avio_r8(pb);
248                 if ((ret = rm_read_extradata(pb, st->codec, codecdata_length - 1)) < 0)
249                     return ret;
250             }
251             break;
252         default:
253             av_strlcpy(st->codec->codec_name, buf, sizeof(st->codec->codec_name));
254         }
255         if (ast->deint_id == DEINT_ID_INT4 ||
256             ast->deint_id == DEINT_ID_GENR ||
257             ast->deint_id == DEINT_ID_SIPR) {
258             if (st->codec->block_align <= 0 ||
259                 ast->audio_framesize * sub_packet_h > (unsigned)INT_MAX ||
260                 ast->audio_framesize * sub_packet_h < st->codec->block_align)
261                 return AVERROR_INVALIDDATA;
262             if (av_new_packet(&ast->pkt, ast->audio_framesize * sub_packet_h) < 0)
263                 return AVERROR(ENOMEM);
264         }
265         switch (ast->deint_id) {
266         case DEINT_ID_INT4:
267             if (ast->coded_framesize > ast->audio_framesize ||
268                 sub_packet_h <= 1 ||
269                 ast->coded_framesize * sub_packet_h > (2 + (sub_packet_h & 1)) * ast->audio_framesize)
270                 return AVERROR_INVALIDDATA;
271             break;
272         case DEINT_ID_GENR:
273             if (ast->sub_packet_size <= 0 ||
274                 ast->sub_packet_size > ast->audio_framesize)
275                 return AVERROR_INVALIDDATA;
276             break;
277         case DEINT_ID_SIPR:
278         case DEINT_ID_INT0:
279         case DEINT_ID_VBRS:
280         case DEINT_ID_VBRF:
281             break;
282         default:
283             av_log(NULL,0,"Unknown interleaver %X\n", ast->deint_id);
284             return AVERROR_INVALIDDATA;
285         }
286
287         if (read_all) {
288             avio_r8(pb);
289             avio_r8(pb);
290             avio_r8(pb);
291             rm_read_metadata(s, 0);
292         }
293     }
294     return 0;
295 }
296
297 int
298 ff_rm_read_mdpr_codecdata (AVFormatContext *s, AVIOContext *pb,
299                            AVStream *st, RMStream *rst, int codec_data_size)
300 {
301     unsigned int v;
302     int size;
303     int64_t codec_pos;
304     int ret;
305
306     avpriv_set_pts_info(st, 64, 1, 1000);
307     codec_pos = avio_tell(pb);
308     v = avio_rb32(pb);
309     if (v == MKTAG(0xfd, 'a', 'r', '.')) {
310         /* ra type header */
311         if (rm_read_audio_stream_info(s, pb, st, rst, 0))
312             return -1;
313     } else {
314         int fps;
315         if (avio_rl32(pb) != MKTAG('V', 'I', 'D', 'O')) {
316         fail1:
317             av_log(st->codec, AV_LOG_ERROR, "Unsupported video codec\n");
318             goto skip;
319         }
320         st->codec->codec_tag = avio_rl32(pb);
321         st->codec->codec_id  = ff_codec_get_id(ff_rm_codec_tags,
322                                                st->codec->codec_tag);
323 //        av_log(s, AV_LOG_DEBUG, "%X %X\n", st->codec->codec_tag, MKTAG('R', 'V', '2', '0'));
324         if (st->codec->codec_id == CODEC_ID_NONE)
325             goto fail1;
326         st->codec->width  = avio_rb16(pb);
327         st->codec->height = avio_rb16(pb);
328         avio_skip(pb, 2); // looks like bits per sample
329         avio_skip(pb, 4); // always zero?
330         st->codec->codec_type = AVMEDIA_TYPE_VIDEO;
331         st->need_parsing = AVSTREAM_PARSE_TIMESTAMPS;
332         fps = avio_rb32(pb);
333
334         if ((ret = rm_read_extradata(pb, st->codec, codec_data_size - (avio_tell(pb) - codec_pos))) < 0)
335             return ret;
336
337         av_reduce(&st->r_frame_rate.den, &st->r_frame_rate.num,
338                   0x10000, fps, (1 << 30) - 1);
339         st->avg_frame_rate = st->r_frame_rate;
340     }
341
342 skip:
343     /* skip codec info */
344     size = avio_tell(pb) - codec_pos;
345     avio_skip(pb, codec_data_size - size);
346
347     return 0;
348 }
349
350 /** this function assumes that the demuxer has already seeked to the start
351  * of the INDX chunk, and will bail out if not. */
352 static int rm_read_index(AVFormatContext *s)
353 {
354     AVIOContext *pb = s->pb;
355     unsigned int size, n_pkts, str_id, next_off, n, pos, pts;
356     AVStream *st;
357
358     do {
359         if (avio_rl32(pb) != MKTAG('I','N','D','X'))
360             return -1;
361         size     = avio_rb32(pb);
362         if (size < 20)
363             return -1;
364         avio_skip(pb, 2);
365         n_pkts   = avio_rb32(pb);
366         str_id   = avio_rb16(pb);
367         next_off = avio_rb32(pb);
368         for (n = 0; n < s->nb_streams; n++)
369             if (s->streams[n]->id == str_id) {
370                 st = s->streams[n];
371                 break;
372             }
373         if (n == s->nb_streams) {
374             av_log(s, AV_LOG_ERROR,
375                    "Invalid stream index %d for index at pos %"PRId64"\n",
376                    str_id, avio_tell(pb));
377             goto skip;
378         } else if ((avio_size(pb) - avio_tell(pb)) / 14 < n_pkts) {
379             av_log(s, AV_LOG_ERROR,
380                    "Nr. of packets in packet index for stream index %d "
381                    "exceeds filesize (%"PRId64" at %"PRId64" = %"PRId64")\n",
382                    str_id, avio_size(pb), avio_tell(pb),
383                    (avio_size(pb) - avio_tell(pb)) / 14);
384             goto skip;
385         }
386
387         for (n = 0; n < n_pkts; n++) {
388             avio_skip(pb, 2);
389             pts = avio_rb32(pb);
390             pos = avio_rb32(pb);
391             avio_skip(pb, 4); /* packet no. */
392
393             av_add_index_entry(st, pos, pts, 0, 0, AVINDEX_KEYFRAME);
394         }
395
396 skip:
397         if (next_off && avio_tell(pb) < next_off &&
398             avio_seek(pb, next_off, SEEK_SET) < 0) {
399             av_log(s, AV_LOG_ERROR,
400                    "Non-linear index detected, not supported\n");
401             return -1;
402         }
403     } while (next_off);
404
405     return 0;
406 }
407
408 static int rm_read_header_old(AVFormatContext *s)
409 {
410     RMDemuxContext *rm = s->priv_data;
411     AVStream *st;
412
413     rm->old_format = 1;
414     st = avformat_new_stream(s, NULL);
415     if (!st)
416         return -1;
417     st->priv_data = ff_rm_alloc_rmstream();
418     return rm_read_audio_stream_info(s, s->pb, st, st->priv_data, 1);
419 }
420
421 static int rm_read_header(AVFormatContext *s)
422 {
423     RMDemuxContext *rm = s->priv_data;
424     AVStream *st;
425     AVIOContext *pb = s->pb;
426     unsigned int tag;
427     int tag_size;
428     unsigned int start_time, duration;
429     unsigned int data_off = 0, indx_off = 0;
430     char buf[128];
431     int flags = 0;
432
433     tag = avio_rl32(pb);
434     if (tag == MKTAG('.', 'r', 'a', 0xfd)) {
435         /* very old .ra format */
436         return rm_read_header_old(s);
437     } else if (tag != MKTAG('.', 'R', 'M', 'F')) {
438         return AVERROR(EIO);
439     }
440
441     tag_size = avio_rb32(pb);
442     avio_skip(pb, tag_size - 8);
443
444     for(;;) {
445         if (pb->eof_reached)
446             return -1;
447         tag = avio_rl32(pb);
448         tag_size = avio_rb32(pb);
449         avio_rb16(pb);
450         av_dlog(s, "tag=%c%c%c%c (%08x) size=%d\n",
451                 (tag      ) & 0xff,
452                 (tag >>  8) & 0xff,
453                 (tag >> 16) & 0xff,
454                 (tag >> 24) & 0xff,
455                 tag,
456                 tag_size);
457         if (tag_size < 10 && tag != MKTAG('D', 'A', 'T', 'A'))
458             return -1;
459         switch(tag) {
460         case MKTAG('P', 'R', 'O', 'P'):
461             /* file header */
462             avio_rb32(pb); /* max bit rate */
463             avio_rb32(pb); /* avg bit rate */
464             avio_rb32(pb); /* max packet size */
465             avio_rb32(pb); /* avg packet size */
466             avio_rb32(pb); /* nb packets */
467             avio_rb32(pb); /* duration */
468             avio_rb32(pb); /* preroll */
469             indx_off = avio_rb32(pb); /* index offset */
470             data_off = avio_rb32(pb); /* data offset */
471             avio_rb16(pb); /* nb streams */
472             flags = avio_rb16(pb); /* flags */
473             break;
474         case MKTAG('C', 'O', 'N', 'T'):
475             rm_read_metadata(s, 1);
476             break;
477         case MKTAG('M', 'D', 'P', 'R'):
478             st = avformat_new_stream(s, NULL);
479             if (!st)
480                 return AVERROR(ENOMEM);
481             st->id = avio_rb16(pb);
482             avio_rb32(pb); /* max bit rate */
483             st->codec->bit_rate = avio_rb32(pb); /* bit rate */
484             avio_rb32(pb); /* max packet size */
485             avio_rb32(pb); /* avg packet size */
486             start_time = avio_rb32(pb); /* start time */
487             avio_rb32(pb); /* preroll */
488             duration = avio_rb32(pb); /* duration */
489             st->start_time = start_time;
490             st->duration = duration;
491             get_str8(pb, buf, sizeof(buf)); /* desc */
492             get_str8(pb, buf, sizeof(buf)); /* mimetype */
493             st->codec->codec_type = AVMEDIA_TYPE_DATA;
494             st->priv_data = ff_rm_alloc_rmstream();
495             if (ff_rm_read_mdpr_codecdata(s, s->pb, st, st->priv_data,
496                                           avio_rb32(pb)) < 0)
497                 return -1;
498             break;
499         case MKTAG('D', 'A', 'T', 'A'):
500             goto header_end;
501         default:
502             /* unknown tag: skip it */
503             avio_skip(pb, tag_size - 10);
504             break;
505         }
506     }
507  header_end:
508     rm->nb_packets = avio_rb32(pb); /* number of packets */
509     if (!rm->nb_packets && (flags & 4))
510         rm->nb_packets = 3600 * 25;
511     avio_rb32(pb); /* next data header */
512
513     if (!data_off)
514         data_off = avio_tell(pb) - 18;
515     if (indx_off && pb->seekable && !(s->flags & AVFMT_FLAG_IGNIDX) &&
516         avio_seek(pb, indx_off, SEEK_SET) >= 0) {
517         rm_read_index(s);
518         avio_seek(pb, data_off + 18, SEEK_SET);
519     }
520
521     return 0;
522 }
523
524 static int get_num(AVIOContext *pb, int *len)
525 {
526     int n, n1;
527
528     n = avio_rb16(pb);
529     (*len)-=2;
530     n &= 0x7FFF;
531     if (n >= 0x4000) {
532         return n - 0x4000;
533     } else {
534         n1 = avio_rb16(pb);
535         (*len)-=2;
536         return (n << 16) | n1;
537     }
538 }
539
540 /* multiple of 20 bytes for ra144 (ugly) */
541 #define RAW_PACKET_SIZE 1000
542
543 static int sync(AVFormatContext *s, int64_t *timestamp, int *flags, int *stream_index, int64_t *pos){
544     RMDemuxContext *rm = s->priv_data;
545     AVIOContext *pb = s->pb;
546     AVStream *st;
547     uint32_t state=0xFFFFFFFF;
548
549     while(!pb->eof_reached){
550         int len, num, i;
551         *pos= avio_tell(pb) - 3;
552         if(rm->remaining_len > 0){
553             num= rm->current_stream;
554             len= rm->remaining_len;
555             *timestamp = AV_NOPTS_VALUE;
556             *flags= 0;
557         }else{
558             state= (state<<8) + avio_r8(pb);
559
560             if(state == MKBETAG('I', 'N', 'D', 'X')){
561                 int n_pkts, expected_len;
562                 len = avio_rb32(pb);
563                 avio_skip(pb, 2);
564                 n_pkts = avio_rb32(pb);
565                 expected_len = 20 + n_pkts * 14;
566                 if (len == 20)
567                     /* some files don't add index entries to chunk size... */
568                     len = expected_len;
569                 else if (len != expected_len)
570                     av_log(s, AV_LOG_WARNING,
571                            "Index size %d (%d pkts) is wrong, should be %d.\n",
572                            len, n_pkts, expected_len);
573                 len -= 14; // we already read part of the index header
574                 if(len<0)
575                     continue;
576                 goto skip;
577             } else if (state == MKBETAG('D','A','T','A')) {
578                 av_log(s, AV_LOG_WARNING,
579                        "DATA tag in middle of chunk, file may be broken.\n");
580             }
581
582             if(state > (unsigned)0xFFFF || state <= 12)
583                 continue;
584             len=state - 12;
585             state= 0xFFFFFFFF;
586
587             num = avio_rb16(pb);
588             *timestamp = avio_rb32(pb);
589             avio_r8(pb); /* reserved */
590             *flags = avio_r8(pb); /* flags */
591         }
592         for(i=0;i<s->nb_streams;i++) {
593             st = s->streams[i];
594             if (num == st->id)
595                 break;
596         }
597         if (i == s->nb_streams) {
598 skip:
599             /* skip packet if unknown number */
600             avio_skip(pb, len);
601             rm->remaining_len = 0;
602             continue;
603         }
604         *stream_index= i;
605
606         return len;
607     }
608     return -1;
609 }
610
611 static int rm_assemble_video_frame(AVFormatContext *s, AVIOContext *pb,
612                                    RMDemuxContext *rm, RMStream *vst,
613                                    AVPacket *pkt, int len, int *pseq,
614                                    int64_t *timestamp)
615 {
616     int hdr, seq, pic_num, len2, pos;
617     int type;
618
619     hdr = avio_r8(pb); len--;
620     type = hdr >> 6;
621
622     if(type != 3){  // not frame as a part of packet
623         seq = avio_r8(pb); len--;
624     }
625     if(type != 1){  // not whole frame
626         len2 = get_num(pb, &len);
627         pos  = get_num(pb, &len);
628         pic_num = avio_r8(pb); len--;
629     }
630     if(len<0)
631         return -1;
632     rm->remaining_len = len;
633     if(type&1){     // frame, not slice
634         if(type == 3){  // frame as a part of packet
635             len= len2;
636             *timestamp = pos;
637         }
638         if(rm->remaining_len < len)
639             return -1;
640         rm->remaining_len -= len;
641         if(av_new_packet(pkt, len + 9) < 0)
642             return AVERROR(EIO);
643         pkt->data[0] = 0;
644         AV_WL32(pkt->data + 1, 1);
645         AV_WL32(pkt->data + 5, 0);
646         avio_read(pb, pkt->data + 9, len);
647         return 0;
648     }
649     //now we have to deal with single slice
650
651     *pseq = seq;
652     if((seq & 0x7F) == 1 || vst->curpic_num != pic_num){
653         vst->slices = ((hdr & 0x3F) << 1) + 1;
654         vst->videobufsize = len2 + 8*vst->slices + 1;
655         av_free_packet(&vst->pkt); //FIXME this should be output.
656         if(av_new_packet(&vst->pkt, vst->videobufsize) < 0)
657             return AVERROR(ENOMEM);
658         vst->videobufpos = 8*vst->slices + 1;
659         vst->cur_slice = 0;
660         vst->curpic_num = pic_num;
661         vst->pktpos = avio_tell(pb);
662     }
663     if(type == 2)
664         len = FFMIN(len, pos);
665
666     if(++vst->cur_slice > vst->slices)
667         return 1;
668     AV_WL32(vst->pkt.data - 7 + 8*vst->cur_slice, 1);
669     AV_WL32(vst->pkt.data - 3 + 8*vst->cur_slice, vst->videobufpos - 8*vst->slices - 1);
670     if(vst->videobufpos + len > vst->videobufsize)
671         return 1;
672     if (avio_read(pb, vst->pkt.data + vst->videobufpos, len) != len)
673         return AVERROR(EIO);
674     vst->videobufpos += len;
675     rm->remaining_len-= len;
676
677     if (type == 2 || vst->videobufpos == vst->videobufsize) {
678         vst->pkt.data[0] = vst->cur_slice-1;
679         *pkt= vst->pkt;
680         vst->pkt.data= NULL;
681         vst->pkt.size= 0;
682         if(vst->slices != vst->cur_slice) //FIXME find out how to set slices correct from the begin
683             memmove(pkt->data + 1 + 8*vst->cur_slice, pkt->data + 1 + 8*vst->slices,
684                 vst->videobufpos - 1 - 8*vst->slices);
685         pkt->size = vst->videobufpos + 8*(vst->cur_slice - vst->slices);
686         pkt->pts = AV_NOPTS_VALUE;
687         pkt->pos = vst->pktpos;
688         vst->slices = 0;
689         return 0;
690     }
691
692     return 1;
693 }
694
695 static inline void
696 rm_ac3_swap_bytes (AVStream *st, AVPacket *pkt)
697 {
698     uint8_t *ptr;
699     int j;
700
701     if (st->codec->codec_id == CODEC_ID_AC3) {
702         ptr = pkt->data;
703         for (j=0;j<pkt->size;j+=2) {
704             FFSWAP(int, ptr[0], ptr[1]);
705             ptr += 2;
706         }
707     }
708 }
709
710 /**
711  * Perform 4-bit block reordering for SIPR data.
712  * @todo This can be optimized, e.g. use memcpy() if data blocks are aligned
713  */
714 void ff_rm_reorder_sipr_data(uint8_t *buf, int sub_packet_h, int framesize)
715 {
716     int n, bs = sub_packet_h * framesize * 2 / 96; // nibbles per subpacket
717
718     for (n = 0; n < 38; n++) {
719         int j;
720         int i = bs * sipr_swaps[n][0];
721         int o = bs * sipr_swaps[n][1];
722
723         /* swap 4bit-nibbles of block 'i' with 'o' */
724         for (j = 0; j < bs; j++, i++, o++) {
725             int x = (buf[i >> 1] >> (4 * (i & 1))) & 0xF,
726                 y = (buf[o >> 1] >> (4 * (o & 1))) & 0xF;
727
728             buf[o >> 1] = (x << (4 * (o & 1))) |
729                 (buf[o >> 1] & (0xF << (4 * !(o & 1))));
730             buf[i >> 1] = (y << (4 * (i & 1))) |
731                 (buf[i >> 1] & (0xF << (4 * !(i & 1))));
732         }
733     }
734 }
735
736 int
737 ff_rm_parse_packet (AVFormatContext *s, AVIOContext *pb,
738                     AVStream *st, RMStream *ast, int len, AVPacket *pkt,
739                     int *seq, int flags, int64_t timestamp)
740 {
741     RMDemuxContext *rm = s->priv_data;
742
743     if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO) {
744         rm->current_stream= st->id;
745         if(rm_assemble_video_frame(s, pb, rm, ast, pkt, len, seq, &timestamp))
746             return -1; //got partial frame
747     } else if (st->codec->codec_type == AVMEDIA_TYPE_AUDIO) {
748         if ((ast->deint_id == DEINT_ID_GENR) ||
749             (ast->deint_id == DEINT_ID_INT4) ||
750             (ast->deint_id == DEINT_ID_SIPR)) {
751             int x;
752             int sps = ast->sub_packet_size;
753             int cfs = ast->coded_framesize;
754             int h = ast->sub_packet_h;
755             int y = ast->sub_packet_cnt;
756             int w = ast->audio_framesize;
757
758             if (flags & 2)
759                 y = ast->sub_packet_cnt = 0;
760             if (!y)
761                 ast->audiotimestamp = timestamp;
762
763             switch (ast->deint_id) {
764                 case DEINT_ID_INT4:
765                     for (x = 0; x < h/2; x++)
766                         avio_read(pb, ast->pkt.data+x*2*w+y*cfs, cfs);
767                     break;
768                 case DEINT_ID_GENR:
769                     for (x = 0; x < w/sps; x++)
770                         avio_read(pb, ast->pkt.data+sps*(h*x+((h+1)/2)*(y&1)+(y>>1)), sps);
771                     break;
772                 case DEINT_ID_SIPR:
773                     avio_read(pb, ast->pkt.data + y * w, w);
774                     break;
775             }
776
777             if (++(ast->sub_packet_cnt) < h)
778                 return -1;
779             if (ast->deint_id == DEINT_ID_SIPR)
780                 ff_rm_reorder_sipr_data(ast->pkt.data, h, w);
781
782              ast->sub_packet_cnt = 0;
783              rm->audio_stream_num = st->index;
784              rm->audio_pkt_cnt = h * w / st->codec->block_align;
785         } else if ((ast->deint_id == DEINT_ID_VBRF) ||
786                    (ast->deint_id == DEINT_ID_VBRS)) {
787             int x;
788             rm->audio_stream_num = st->index;
789             ast->sub_packet_cnt = (avio_rb16(pb) & 0xf0) >> 4;
790             if (ast->sub_packet_cnt) {
791                 for (x = 0; x < ast->sub_packet_cnt; x++)
792                     ast->sub_packet_lengths[x] = avio_rb16(pb);
793                 rm->audio_pkt_cnt = ast->sub_packet_cnt;
794                 ast->audiotimestamp = timestamp;
795             } else
796                 return -1;
797         } else {
798             av_get_packet(pb, pkt, len);
799             rm_ac3_swap_bytes(st, pkt);
800         }
801     } else
802         av_get_packet(pb, pkt, len);
803
804     pkt->stream_index = st->index;
805
806 #if 0
807     if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO) {
808         if(st->codec->codec_id == CODEC_ID_RV20){
809             int seq= 128*(pkt->data[2]&0x7F) + (pkt->data[3]>>1);
810             av_log(s, AV_LOG_DEBUG, "%d %"PRId64" %d\n", *timestamp, *timestamp*512LL/25, seq);
811
812             seq |= (timestamp&~0x3FFF);
813             if(seq - timestamp >  0x2000) seq -= 0x4000;
814             if(seq - timestamp < -0x2000) seq += 0x4000;
815         }
816     }
817 #endif
818
819     pkt->pts = timestamp;
820     if (flags & 2)
821         pkt->flags |= AV_PKT_FLAG_KEY;
822
823     return st->codec->codec_type == AVMEDIA_TYPE_AUDIO ? rm->audio_pkt_cnt : 0;
824 }
825
826 int
827 ff_rm_retrieve_cache (AVFormatContext *s, AVIOContext *pb,
828                       AVStream *st, RMStream *ast, AVPacket *pkt)
829 {
830     RMDemuxContext *rm = s->priv_data;
831
832     assert (rm->audio_pkt_cnt > 0);
833
834     if (ast->deint_id == DEINT_ID_VBRF ||
835         ast->deint_id == DEINT_ID_VBRS)
836         av_get_packet(pb, pkt, ast->sub_packet_lengths[ast->sub_packet_cnt - rm->audio_pkt_cnt]);
837     else {
838         av_new_packet(pkt, st->codec->block_align);
839         memcpy(pkt->data, ast->pkt.data + st->codec->block_align * //FIXME avoid this
840                (ast->sub_packet_h * ast->audio_framesize / st->codec->block_align - rm->audio_pkt_cnt),
841                st->codec->block_align);
842     }
843     rm->audio_pkt_cnt--;
844     if ((pkt->pts = ast->audiotimestamp) != AV_NOPTS_VALUE) {
845         ast->audiotimestamp = AV_NOPTS_VALUE;
846         pkt->flags = AV_PKT_FLAG_KEY;
847     } else
848         pkt->flags = 0;
849     pkt->stream_index = st->index;
850
851     return rm->audio_pkt_cnt;
852 }
853
854 static int rm_read_packet(AVFormatContext *s, AVPacket *pkt)
855 {
856     RMDemuxContext *rm = s->priv_data;
857     AVStream *st;
858     int i, len, res, seq = 1;
859     int64_t timestamp, pos;
860     int flags;
861
862     for (;;) {
863         if (rm->audio_pkt_cnt) {
864             // If there are queued audio packet return them first
865             st = s->streams[rm->audio_stream_num];
866             ff_rm_retrieve_cache(s, s->pb, st, st->priv_data, pkt);
867             flags = 0;
868         } else {
869             if (rm->old_format) {
870                 RMStream *ast;
871
872                 st = s->streams[0];
873                 ast = st->priv_data;
874                 timestamp = AV_NOPTS_VALUE;
875                 len = !ast->audio_framesize ? RAW_PACKET_SIZE :
876                     ast->coded_framesize * ast->sub_packet_h / 2;
877                 flags = (seq++ == 1) ? 2 : 0;
878                 pos = avio_tell(s->pb);
879             } else {
880                 len=sync(s, &timestamp, &flags, &i, &pos);
881                 if (len > 0)
882                     st = s->streams[i];
883             }
884
885             if(len<0 || s->pb->eof_reached)
886                 return AVERROR(EIO);
887
888             res = ff_rm_parse_packet (s, s->pb, st, st->priv_data, len, pkt,
889                                       &seq, flags, timestamp);
890             if((flags&2) && (seq&0x7F) == 1)
891                 av_add_index_entry(st, pos, timestamp, 0, 0, AVINDEX_KEYFRAME);
892             if (res)
893                 continue;
894         }
895
896         if(  (st->discard >= AVDISCARD_NONKEY && !(flags&2))
897            || st->discard >= AVDISCARD_ALL){
898             av_free_packet(pkt);
899         } else
900             break;
901     }
902
903     return 0;
904 }
905
906 static int rm_read_close(AVFormatContext *s)
907 {
908     int i;
909
910     for (i=0;i<s->nb_streams;i++)
911         ff_rm_free_rmstream(s->streams[i]->priv_data);
912
913     return 0;
914 }
915
916 static int rm_probe(AVProbeData *p)
917 {
918     /* check file header */
919     if ((p->buf[0] == '.' && p->buf[1] == 'R' &&
920          p->buf[2] == 'M' && p->buf[3] == 'F' &&
921          p->buf[4] == 0 && p->buf[5] == 0) ||
922         (p->buf[0] == '.' && p->buf[1] == 'r' &&
923          p->buf[2] == 'a' && p->buf[3] == 0xfd))
924         return AVPROBE_SCORE_MAX;
925     else
926         return 0;
927 }
928
929 static int64_t rm_read_dts(AVFormatContext *s, int stream_index,
930                                int64_t *ppos, int64_t pos_limit)
931 {
932     RMDemuxContext *rm = s->priv_data;
933     int64_t pos, dts;
934     int stream_index2, flags, len, h;
935
936     pos = *ppos;
937
938     if(rm->old_format)
939         return AV_NOPTS_VALUE;
940
941     avio_seek(s->pb, pos, SEEK_SET);
942     rm->remaining_len=0;
943     for(;;){
944         int seq=1;
945         AVStream *st;
946
947         len=sync(s, &dts, &flags, &stream_index2, &pos);
948         if(len<0)
949             return AV_NOPTS_VALUE;
950
951         st = s->streams[stream_index2];
952         if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO) {
953             h= avio_r8(s->pb); len--;
954             if(!(h & 0x40)){
955                 seq = avio_r8(s->pb); len--;
956             }
957         }
958
959         if((flags&2) && (seq&0x7F) == 1){
960 //            av_log(s, AV_LOG_DEBUG, "%d %d-%d %"PRId64" %d\n", flags, stream_index2, stream_index, dts, seq);
961             av_add_index_entry(st, pos, dts, 0, 0, AVINDEX_KEYFRAME);
962             if(stream_index2 == stream_index)
963                 break;
964         }
965
966         avio_skip(s->pb, len);
967     }
968     *ppos = pos;
969     return dts;
970 }
971
972 AVInputFormat ff_rm_demuxer = {
973     .name           = "rm",
974     .long_name      = NULL_IF_CONFIG_SMALL("RealMedia format"),
975     .priv_data_size = sizeof(RMDemuxContext),
976     .read_probe     = rm_probe,
977     .read_header    = rm_read_header,
978     .read_packet    = rm_read_packet,
979     .read_close     = rm_read_close,
980     .read_timestamp = rm_read_dts,
981 };
982
983 AVInputFormat ff_rdt_demuxer = {
984     .name           = "rdt",
985     .long_name      = NULL_IF_CONFIG_SMALL("RDT demuxer"),
986     .priv_data_size = sizeof(RMDemuxContext),
987     .read_close     = rm_read_close,
988     .flags          = AVFMT_NOFILE,
989 };