OSDN Git Service

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