RealAudio Lossless decoder
[ffmpeg.git] / 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 if (v == MKBETAG('L', 'S', 'D', ':')) {
314         avio_seek(pb, -4, SEEK_CUR);
315         if ((ret = rm_read_extradata(pb, st->codec, codec_data_size)) < 0)
316             return ret;
317
318         st->codec->codec_type = AVMEDIA_TYPE_AUDIO;
319         st->codec->codec_tag  = AV_RL32(st->codec->extradata);
320         st->codec->codec_id   = ff_codec_get_id(ff_rm_codec_tags,
321                                                 st->codec->codec_tag);
322     } else {
323         int fps;
324         if (avio_rl32(pb) != MKTAG('V', 'I', 'D', 'O')) {
325         fail1:
326             av_log(st->codec, AV_LOG_ERROR, "Unsupported video codec\n");
327             goto skip;
328         }
329         st->codec->codec_tag = avio_rl32(pb);
330         st->codec->codec_id  = ff_codec_get_id(ff_rm_codec_tags,
331                                                st->codec->codec_tag);
332 //        av_log(s, AV_LOG_DEBUG, "%X %X\n", st->codec->codec_tag, MKTAG('R', 'V', '2', '0'));
333         if (st->codec->codec_id == CODEC_ID_NONE)
334             goto fail1;
335         st->codec->width  = avio_rb16(pb);
336         st->codec->height = avio_rb16(pb);
337         avio_skip(pb, 2); // looks like bits per sample
338         avio_skip(pb, 4); // always zero?
339         st->codec->codec_type = AVMEDIA_TYPE_VIDEO;
340         st->need_parsing = AVSTREAM_PARSE_TIMESTAMPS;
341         fps = avio_rb32(pb);
342
343         if ((ret = rm_read_extradata(pb, st->codec, codec_data_size - (avio_tell(pb) - codec_pos))) < 0)
344             return ret;
345
346         av_reduce(&st->r_frame_rate.den, &st->r_frame_rate.num,
347                   0x10000, fps, (1 << 30) - 1);
348         st->avg_frame_rate = st->r_frame_rate;
349     }
350
351 skip:
352     /* skip codec info */
353     size = avio_tell(pb) - codec_pos;
354     avio_skip(pb, codec_data_size - size);
355
356     return 0;
357 }
358
359 /** this function assumes that the demuxer has already seeked to the start
360  * of the INDX chunk, and will bail out if not. */
361 static int rm_read_index(AVFormatContext *s)
362 {
363     AVIOContext *pb = s->pb;
364     unsigned int size, n_pkts, str_id, next_off, n, pos, pts;
365     AVStream *st;
366
367     do {
368         if (avio_rl32(pb) != MKTAG('I','N','D','X'))
369             return -1;
370         size     = avio_rb32(pb);
371         if (size < 20)
372             return -1;
373         avio_skip(pb, 2);
374         n_pkts   = avio_rb32(pb);
375         str_id   = avio_rb16(pb);
376         next_off = avio_rb32(pb);
377         for (n = 0; n < s->nb_streams; n++)
378             if (s->streams[n]->id == str_id) {
379                 st = s->streams[n];
380                 break;
381             }
382         if (n == s->nb_streams) {
383             av_log(s, AV_LOG_ERROR,
384                    "Invalid stream index %d for index at pos %"PRId64"\n",
385                    str_id, avio_tell(pb));
386             goto skip;
387         } else if ((avio_size(pb) - avio_tell(pb)) / 14 < n_pkts) {
388             av_log(s, AV_LOG_ERROR,
389                    "Nr. of packets in packet index for stream index %d "
390                    "exceeds filesize (%"PRId64" at %"PRId64" = %"PRId64")\n",
391                    str_id, avio_size(pb), avio_tell(pb),
392                    (avio_size(pb) - avio_tell(pb)) / 14);
393             goto skip;
394         }
395
396         for (n = 0; n < n_pkts; n++) {
397             avio_skip(pb, 2);
398             pts = avio_rb32(pb);
399             pos = avio_rb32(pb);
400             avio_skip(pb, 4); /* packet no. */
401
402             av_add_index_entry(st, pos, pts, 0, 0, AVINDEX_KEYFRAME);
403         }
404
405 skip:
406         if (next_off && avio_tell(pb) < next_off &&
407             avio_seek(pb, next_off, SEEK_SET) < 0) {
408             av_log(s, AV_LOG_ERROR,
409                    "Non-linear index detected, not supported\n");
410             return -1;
411         }
412     } while (next_off);
413
414     return 0;
415 }
416
417 static int rm_read_header_old(AVFormatContext *s)
418 {
419     RMDemuxContext *rm = s->priv_data;
420     AVStream *st;
421
422     rm->old_format = 1;
423     st = avformat_new_stream(s, NULL);
424     if (!st)
425         return -1;
426     st->priv_data = ff_rm_alloc_rmstream();
427     return rm_read_audio_stream_info(s, s->pb, st, st->priv_data, 1);
428 }
429
430 static int rm_read_header(AVFormatContext *s)
431 {
432     RMDemuxContext *rm = s->priv_data;
433     AVStream *st;
434     AVIOContext *pb = s->pb;
435     unsigned int tag;
436     int tag_size;
437     unsigned int start_time, duration;
438     unsigned int data_off = 0, indx_off = 0;
439     char buf[128];
440     int flags = 0;
441
442     tag = avio_rl32(pb);
443     if (tag == MKTAG('.', 'r', 'a', 0xfd)) {
444         /* very old .ra format */
445         return rm_read_header_old(s);
446     } else if (tag != MKTAG('.', 'R', 'M', 'F')) {
447         return AVERROR(EIO);
448     }
449
450     tag_size = avio_rb32(pb);
451     avio_skip(pb, tag_size - 8);
452
453     for(;;) {
454         if (pb->eof_reached)
455             return -1;
456         tag = avio_rl32(pb);
457         tag_size = avio_rb32(pb);
458         avio_rb16(pb);
459         av_dlog(s, "tag=%c%c%c%c (%08x) size=%d\n",
460                 (tag      ) & 0xff,
461                 (tag >>  8) & 0xff,
462                 (tag >> 16) & 0xff,
463                 (tag >> 24) & 0xff,
464                 tag,
465                 tag_size);
466         if (tag_size < 10 && tag != MKTAG('D', 'A', 'T', 'A'))
467             return -1;
468         switch(tag) {
469         case MKTAG('P', 'R', 'O', 'P'):
470             /* file header */
471             avio_rb32(pb); /* max bit rate */
472             avio_rb32(pb); /* avg bit rate */
473             avio_rb32(pb); /* max packet size */
474             avio_rb32(pb); /* avg packet size */
475             avio_rb32(pb); /* nb packets */
476             avio_rb32(pb); /* duration */
477             avio_rb32(pb); /* preroll */
478             indx_off = avio_rb32(pb); /* index offset */
479             data_off = avio_rb32(pb); /* data offset */
480             avio_rb16(pb); /* nb streams */
481             flags = avio_rb16(pb); /* flags */
482             break;
483         case MKTAG('C', 'O', 'N', 'T'):
484             rm_read_metadata(s, 1);
485             break;
486         case MKTAG('M', 'D', 'P', 'R'):
487             st = avformat_new_stream(s, NULL);
488             if (!st)
489                 return AVERROR(ENOMEM);
490             st->id = avio_rb16(pb);
491             avio_rb32(pb); /* max bit rate */
492             st->codec->bit_rate = avio_rb32(pb); /* bit rate */
493             avio_rb32(pb); /* max packet size */
494             avio_rb32(pb); /* avg packet size */
495             start_time = avio_rb32(pb); /* start time */
496             avio_rb32(pb); /* preroll */
497             duration = avio_rb32(pb); /* duration */
498             st->start_time = start_time;
499             st->duration = duration;
500             get_str8(pb, buf, sizeof(buf)); /* desc */
501             get_str8(pb, buf, sizeof(buf)); /* mimetype */
502             st->codec->codec_type = AVMEDIA_TYPE_DATA;
503             st->priv_data = ff_rm_alloc_rmstream();
504             if (ff_rm_read_mdpr_codecdata(s, s->pb, st, st->priv_data,
505                                           avio_rb32(pb)) < 0)
506                 return -1;
507             break;
508         case MKTAG('D', 'A', 'T', 'A'):
509             goto header_end;
510         default:
511             /* unknown tag: skip it */
512             avio_skip(pb, tag_size - 10);
513             break;
514         }
515     }
516  header_end:
517     rm->nb_packets = avio_rb32(pb); /* number of packets */
518     if (!rm->nb_packets && (flags & 4))
519         rm->nb_packets = 3600 * 25;
520     avio_rb32(pb); /* next data header */
521
522     if (!data_off)
523         data_off = avio_tell(pb) - 18;
524     if (indx_off && pb->seekable && !(s->flags & AVFMT_FLAG_IGNIDX) &&
525         avio_seek(pb, indx_off, SEEK_SET) >= 0) {
526         rm_read_index(s);
527         avio_seek(pb, data_off + 18, SEEK_SET);
528     }
529
530     return 0;
531 }
532
533 static int get_num(AVIOContext *pb, int *len)
534 {
535     int n, n1;
536
537     n = avio_rb16(pb);
538     (*len)-=2;
539     n &= 0x7FFF;
540     if (n >= 0x4000) {
541         return n - 0x4000;
542     } else {
543         n1 = avio_rb16(pb);
544         (*len)-=2;
545         return (n << 16) | n1;
546     }
547 }
548
549 /* multiple of 20 bytes for ra144 (ugly) */
550 #define RAW_PACKET_SIZE 1000
551
552 static int sync(AVFormatContext *s, int64_t *timestamp, int *flags, int *stream_index, int64_t *pos){
553     RMDemuxContext *rm = s->priv_data;
554     AVIOContext *pb = s->pb;
555     AVStream *st;
556     uint32_t state=0xFFFFFFFF;
557
558     while(!pb->eof_reached){
559         int len, num, i;
560         *pos= avio_tell(pb) - 3;
561         if(rm->remaining_len > 0){
562             num= rm->current_stream;
563             len= rm->remaining_len;
564             *timestamp = AV_NOPTS_VALUE;
565             *flags= 0;
566         }else{
567             state= (state<<8) + avio_r8(pb);
568
569             if(state == MKBETAG('I', 'N', 'D', 'X')){
570                 int n_pkts, expected_len;
571                 len = avio_rb32(pb);
572                 avio_skip(pb, 2);
573                 n_pkts = avio_rb32(pb);
574                 expected_len = 20 + n_pkts * 14;
575                 if (len == 20)
576                     /* some files don't add index entries to chunk size... */
577                     len = expected_len;
578                 else if (len != expected_len)
579                     av_log(s, AV_LOG_WARNING,
580                            "Index size %d (%d pkts) is wrong, should be %d.\n",
581                            len, n_pkts, expected_len);
582                 len -= 14; // we already read part of the index header
583                 if(len<0)
584                     continue;
585                 goto skip;
586             } else if (state == MKBETAG('D','A','T','A')) {
587                 av_log(s, AV_LOG_WARNING,
588                        "DATA tag in middle of chunk, file may be broken.\n");
589             }
590
591             if(state > (unsigned)0xFFFF || state <= 12)
592                 continue;
593             len=state - 12;
594             state= 0xFFFFFFFF;
595
596             num = avio_rb16(pb);
597             *timestamp = avio_rb32(pb);
598             avio_r8(pb); /* reserved */
599             *flags = avio_r8(pb); /* flags */
600         }
601         for(i=0;i<s->nb_streams;i++) {
602             st = s->streams[i];
603             if (num == st->id)
604                 break;
605         }
606         if (i == s->nb_streams) {
607 skip:
608             /* skip packet if unknown number */
609             avio_skip(pb, len);
610             rm->remaining_len = 0;
611             continue;
612         }
613         *stream_index= i;
614
615         return len;
616     }
617     return -1;
618 }
619
620 static int rm_assemble_video_frame(AVFormatContext *s, AVIOContext *pb,
621                                    RMDemuxContext *rm, RMStream *vst,
622                                    AVPacket *pkt, int len, int *pseq,
623                                    int64_t *timestamp)
624 {
625     int hdr, seq, pic_num, len2, pos;
626     int type;
627
628     hdr = avio_r8(pb); len--;
629     type = hdr >> 6;
630
631     if(type != 3){  // not frame as a part of packet
632         seq = avio_r8(pb); len--;
633     }
634     if(type != 1){  // not whole frame
635         len2 = get_num(pb, &len);
636         pos  = get_num(pb, &len);
637         pic_num = avio_r8(pb); len--;
638     }
639     if(len<0)
640         return -1;
641     rm->remaining_len = len;
642     if(type&1){     // frame, not slice
643         if(type == 3){  // frame as a part of packet
644             len= len2;
645             *timestamp = pos;
646         }
647         if(rm->remaining_len < len)
648             return -1;
649         rm->remaining_len -= len;
650         if(av_new_packet(pkt, len + 9) < 0)
651             return AVERROR(EIO);
652         pkt->data[0] = 0;
653         AV_WL32(pkt->data + 1, 1);
654         AV_WL32(pkt->data + 5, 0);
655         avio_read(pb, pkt->data + 9, len);
656         return 0;
657     }
658     //now we have to deal with single slice
659
660     *pseq = seq;
661     if((seq & 0x7F) == 1 || vst->curpic_num != pic_num){
662         vst->slices = ((hdr & 0x3F) << 1) + 1;
663         vst->videobufsize = len2 + 8*vst->slices + 1;
664         av_free_packet(&vst->pkt); //FIXME this should be output.
665         if(av_new_packet(&vst->pkt, vst->videobufsize) < 0)
666             return AVERROR(ENOMEM);
667         vst->videobufpos = 8*vst->slices + 1;
668         vst->cur_slice = 0;
669         vst->curpic_num = pic_num;
670         vst->pktpos = avio_tell(pb);
671     }
672     if(type == 2)
673         len = FFMIN(len, pos);
674
675     if(++vst->cur_slice > vst->slices)
676         return 1;
677     AV_WL32(vst->pkt.data - 7 + 8*vst->cur_slice, 1);
678     AV_WL32(vst->pkt.data - 3 + 8*vst->cur_slice, vst->videobufpos - 8*vst->slices - 1);
679     if(vst->videobufpos + len > vst->videobufsize)
680         return 1;
681     if (avio_read(pb, vst->pkt.data + vst->videobufpos, len) != len)
682         return AVERROR(EIO);
683     vst->videobufpos += len;
684     rm->remaining_len-= len;
685
686     if (type == 2 || vst->videobufpos == vst->videobufsize) {
687         vst->pkt.data[0] = vst->cur_slice-1;
688         *pkt= vst->pkt;
689         vst->pkt.data= NULL;
690         vst->pkt.size= 0;
691         if(vst->slices != vst->cur_slice) //FIXME find out how to set slices correct from the begin
692             memmove(pkt->data + 1 + 8*vst->cur_slice, pkt->data + 1 + 8*vst->slices,
693                 vst->videobufpos - 1 - 8*vst->slices);
694         pkt->size = vst->videobufpos + 8*(vst->cur_slice - vst->slices);
695         pkt->pts = AV_NOPTS_VALUE;
696         pkt->pos = vst->pktpos;
697         vst->slices = 0;
698         return 0;
699     }
700
701     return 1;
702 }
703
704 static inline void
705 rm_ac3_swap_bytes (AVStream *st, AVPacket *pkt)
706 {
707     uint8_t *ptr;
708     int j;
709
710     if (st->codec->codec_id == CODEC_ID_AC3) {
711         ptr = pkt->data;
712         for (j=0;j<pkt->size;j+=2) {
713             FFSWAP(int, ptr[0], ptr[1]);
714             ptr += 2;
715         }
716     }
717 }
718
719 /**
720  * Perform 4-bit block reordering for SIPR data.
721  * @todo This can be optimized, e.g. use memcpy() if data blocks are aligned
722  */
723 void ff_rm_reorder_sipr_data(uint8_t *buf, int sub_packet_h, int framesize)
724 {
725     int n, bs = sub_packet_h * framesize * 2 / 96; // nibbles per subpacket
726
727     for (n = 0; n < 38; n++) {
728         int j;
729         int i = bs * sipr_swaps[n][0];
730         int o = bs * sipr_swaps[n][1];
731
732         /* swap 4bit-nibbles of block 'i' with 'o' */
733         for (j = 0; j < bs; j++, i++, o++) {
734             int x = (buf[i >> 1] >> (4 * (i & 1))) & 0xF,
735                 y = (buf[o >> 1] >> (4 * (o & 1))) & 0xF;
736
737             buf[o >> 1] = (x << (4 * (o & 1))) |
738                 (buf[o >> 1] & (0xF << (4 * !(o & 1))));
739             buf[i >> 1] = (y << (4 * (i & 1))) |
740                 (buf[i >> 1] & (0xF << (4 * !(i & 1))));
741         }
742     }
743 }
744
745 int
746 ff_rm_parse_packet (AVFormatContext *s, AVIOContext *pb,
747                     AVStream *st, RMStream *ast, int len, AVPacket *pkt,
748                     int *seq, int flags, int64_t timestamp)
749 {
750     RMDemuxContext *rm = s->priv_data;
751
752     if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO) {
753         rm->current_stream= st->id;
754         if(rm_assemble_video_frame(s, pb, rm, ast, pkt, len, seq, &timestamp))
755             return -1; //got partial frame
756     } else if (st->codec->codec_type == AVMEDIA_TYPE_AUDIO) {
757         if ((ast->deint_id == DEINT_ID_GENR) ||
758             (ast->deint_id == DEINT_ID_INT4) ||
759             (ast->deint_id == DEINT_ID_SIPR)) {
760             int x;
761             int sps = ast->sub_packet_size;
762             int cfs = ast->coded_framesize;
763             int h = ast->sub_packet_h;
764             int y = ast->sub_packet_cnt;
765             int w = ast->audio_framesize;
766
767             if (flags & 2)
768                 y = ast->sub_packet_cnt = 0;
769             if (!y)
770                 ast->audiotimestamp = timestamp;
771
772             switch (ast->deint_id) {
773                 case DEINT_ID_INT4:
774                     for (x = 0; x < h/2; x++)
775                         avio_read(pb, ast->pkt.data+x*2*w+y*cfs, cfs);
776                     break;
777                 case DEINT_ID_GENR:
778                     for (x = 0; x < w/sps; x++)
779                         avio_read(pb, ast->pkt.data+sps*(h*x+((h+1)/2)*(y&1)+(y>>1)), sps);
780                     break;
781                 case DEINT_ID_SIPR:
782                     avio_read(pb, ast->pkt.data + y * w, w);
783                     break;
784             }
785
786             if (++(ast->sub_packet_cnt) < h)
787                 return -1;
788             if (ast->deint_id == DEINT_ID_SIPR)
789                 ff_rm_reorder_sipr_data(ast->pkt.data, h, w);
790
791              ast->sub_packet_cnt = 0;
792              rm->audio_stream_num = st->index;
793              rm->audio_pkt_cnt = h * w / st->codec->block_align;
794         } else if ((ast->deint_id == DEINT_ID_VBRF) ||
795                    (ast->deint_id == DEINT_ID_VBRS)) {
796             int x;
797             rm->audio_stream_num = st->index;
798             ast->sub_packet_cnt = (avio_rb16(pb) & 0xf0) >> 4;
799             if (ast->sub_packet_cnt) {
800                 for (x = 0; x < ast->sub_packet_cnt; x++)
801                     ast->sub_packet_lengths[x] = avio_rb16(pb);
802                 rm->audio_pkt_cnt = ast->sub_packet_cnt;
803                 ast->audiotimestamp = timestamp;
804             } else
805                 return -1;
806         } else {
807             av_get_packet(pb, pkt, len);
808             rm_ac3_swap_bytes(st, pkt);
809         }
810     } else
811         av_get_packet(pb, pkt, len);
812
813     pkt->stream_index = st->index;
814
815 #if 0
816     if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO) {
817         if(st->codec->codec_id == CODEC_ID_RV20){
818             int seq= 128*(pkt->data[2]&0x7F) + (pkt->data[3]>>1);
819             av_log(s, AV_LOG_DEBUG, "%d %"PRId64" %d\n", *timestamp, *timestamp*512LL/25, seq);
820
821             seq |= (timestamp&~0x3FFF);
822             if(seq - timestamp >  0x2000) seq -= 0x4000;
823             if(seq - timestamp < -0x2000) seq += 0x4000;
824         }
825     }
826 #endif
827
828     pkt->pts = timestamp;
829     if (flags & 2)
830         pkt->flags |= AV_PKT_FLAG_KEY;
831
832     return st->codec->codec_type == AVMEDIA_TYPE_AUDIO ? rm->audio_pkt_cnt : 0;
833 }
834
835 int
836 ff_rm_retrieve_cache (AVFormatContext *s, AVIOContext *pb,
837                       AVStream *st, RMStream *ast, AVPacket *pkt)
838 {
839     RMDemuxContext *rm = s->priv_data;
840
841     assert (rm->audio_pkt_cnt > 0);
842
843     if (ast->deint_id == DEINT_ID_VBRF ||
844         ast->deint_id == DEINT_ID_VBRS)
845         av_get_packet(pb, pkt, ast->sub_packet_lengths[ast->sub_packet_cnt - rm->audio_pkt_cnt]);
846     else {
847         av_new_packet(pkt, st->codec->block_align);
848         memcpy(pkt->data, ast->pkt.data + st->codec->block_align * //FIXME avoid this
849                (ast->sub_packet_h * ast->audio_framesize / st->codec->block_align - rm->audio_pkt_cnt),
850                st->codec->block_align);
851     }
852     rm->audio_pkt_cnt--;
853     if ((pkt->pts = ast->audiotimestamp) != AV_NOPTS_VALUE) {
854         ast->audiotimestamp = AV_NOPTS_VALUE;
855         pkt->flags = AV_PKT_FLAG_KEY;
856     } else
857         pkt->flags = 0;
858     pkt->stream_index = st->index;
859
860     return rm->audio_pkt_cnt;
861 }
862
863 static int rm_read_packet(AVFormatContext *s, AVPacket *pkt)
864 {
865     RMDemuxContext *rm = s->priv_data;
866     AVStream *st;
867     int i, len, res, seq = 1;
868     int64_t timestamp, pos;
869     int flags;
870
871     for (;;) {
872         if (rm->audio_pkt_cnt) {
873             // If there are queued audio packet return them first
874             st = s->streams[rm->audio_stream_num];
875             ff_rm_retrieve_cache(s, s->pb, st, st->priv_data, pkt);
876             flags = 0;
877         } else {
878             if (rm->old_format) {
879                 RMStream *ast;
880
881                 st = s->streams[0];
882                 ast = st->priv_data;
883                 timestamp = AV_NOPTS_VALUE;
884                 len = !ast->audio_framesize ? RAW_PACKET_SIZE :
885                     ast->coded_framesize * ast->sub_packet_h / 2;
886                 flags = (seq++ == 1) ? 2 : 0;
887                 pos = avio_tell(s->pb);
888             } else {
889                 len=sync(s, &timestamp, &flags, &i, &pos);
890                 if (len > 0)
891                     st = s->streams[i];
892             }
893
894             if(len<0 || s->pb->eof_reached)
895                 return AVERROR(EIO);
896
897             res = ff_rm_parse_packet (s, s->pb, st, st->priv_data, len, pkt,
898                                       &seq, flags, timestamp);
899             if((flags&2) && (seq&0x7F) == 1)
900                 av_add_index_entry(st, pos, timestamp, 0, 0, AVINDEX_KEYFRAME);
901             if (res)
902                 continue;
903         }
904
905         if(  (st->discard >= AVDISCARD_NONKEY && !(flags&2))
906            || st->discard >= AVDISCARD_ALL){
907             av_free_packet(pkt);
908         } else
909             break;
910     }
911
912     return 0;
913 }
914
915 static int rm_read_close(AVFormatContext *s)
916 {
917     int i;
918
919     for (i=0;i<s->nb_streams;i++)
920         ff_rm_free_rmstream(s->streams[i]->priv_data);
921
922     return 0;
923 }
924
925 static int rm_probe(AVProbeData *p)
926 {
927     /* check file header */
928     if ((p->buf[0] == '.' && p->buf[1] == 'R' &&
929          p->buf[2] == 'M' && p->buf[3] == 'F' &&
930          p->buf[4] == 0 && p->buf[5] == 0) ||
931         (p->buf[0] == '.' && p->buf[1] == 'r' &&
932          p->buf[2] == 'a' && p->buf[3] == 0xfd))
933         return AVPROBE_SCORE_MAX;
934     else
935         return 0;
936 }
937
938 static int64_t rm_read_dts(AVFormatContext *s, int stream_index,
939                                int64_t *ppos, int64_t pos_limit)
940 {
941     RMDemuxContext *rm = s->priv_data;
942     int64_t pos, dts;
943     int stream_index2, flags, len, h;
944
945     pos = *ppos;
946
947     if(rm->old_format)
948         return AV_NOPTS_VALUE;
949
950     avio_seek(s->pb, pos, SEEK_SET);
951     rm->remaining_len=0;
952     for(;;){
953         int seq=1;
954         AVStream *st;
955
956         len=sync(s, &dts, &flags, &stream_index2, &pos);
957         if(len<0)
958             return AV_NOPTS_VALUE;
959
960         st = s->streams[stream_index2];
961         if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO) {
962             h= avio_r8(s->pb); len--;
963             if(!(h & 0x40)){
964                 seq = avio_r8(s->pb); len--;
965             }
966         }
967
968         if((flags&2) && (seq&0x7F) == 1){
969 //            av_log(s, AV_LOG_DEBUG, "%d %d-%d %"PRId64" %d\n", flags, stream_index2, stream_index, dts, seq);
970             av_add_index_entry(st, pos, dts, 0, 0, AVINDEX_KEYFRAME);
971             if(stream_index2 == stream_index)
972                 break;
973         }
974
975         avio_skip(s->pb, len);
976     }
977     *ppos = pos;
978     return dts;
979 }
980
981 AVInputFormat ff_rm_demuxer = {
982     .name           = "rm",
983     .long_name      = NULL_IF_CONFIG_SMALL("RealMedia format"),
984     .priv_data_size = sizeof(RMDemuxContext),
985     .read_probe     = rm_probe,
986     .read_header    = rm_read_header,
987     .read_packet    = rm_read_packet,
988     .read_close     = rm_read_close,
989     .read_timestamp = rm_read_dts,
990 };
991
992 AVInputFormat ff_rdt_demuxer = {
993     .name           = "rdt",
994     .long_name      = NULL_IF_CONFIG_SMALL("RDT demuxer"),
995     .priv_data_size = sizeof(RMDemuxContext),
996     .read_close     = rm_read_close,
997     .flags          = AVFMT_NOFILE,
998 };