1
|
1 // MPG/VOB file parser for DEMUXER v2.5 by A'rpi/ESP-team
|
|
2
|
501
|
3 //#define MAX_PS_PACKETSIZE 4096
|
|
4 #define MAX_PS_PACKETSIZE (224*1024)
|
|
5
|
1
|
6 static unsigned int read_mpeg_timestamp(stream_t *s,int c){
|
|
7 int d,e;
|
|
8 unsigned int pts;
|
|
9 d=stream_read_word(s);
|
|
10 e=stream_read_word(s);
|
|
11 if( ((c&1)!=1) || ((d&1)!=1) || ((e&1)!=1) ) return 0; // invalid pts
|
|
12 pts=(((c>>1)&7)<<30)|((d>>1)<<15)|(e>>1);
|
|
13 if(verbose>=3) printf("{%d}",pts);
|
|
14 return pts;
|
|
15 }
|
|
16
|
501
|
17 //static char dvdaudio_table[256];
|
1
|
18 //static unsigned int packet_start_pos=0;
|
|
19
|
|
20 static int demux_mpg_read_packet(demuxer_t *demux,int id){
|
|
21 int d;
|
|
22 int len;
|
492
|
23 #ifdef HAVE_LIBCSS
|
|
24 int css=0;
|
|
25 #endif
|
1
|
26 unsigned char c=0;
|
|
27 unsigned int pts=0;
|
|
28 unsigned int dts=0;
|
|
29 demux_stream_t *ds=NULL;
|
|
30
|
|
31 if(verbose>=3) printf("demux_read_packet: %X\n",id);
|
|
32
|
501
|
33 if(id==0x1F0){
|
|
34 demux->synced=0; // force resync after 0x1F0
|
|
35 return -1;
|
|
36 }
|
|
37
|
1
|
38 // if(id==0x1BA) packet_start_pos=stream_tell(demux->stream);
|
501
|
39 if(id<0x1BC || id>=0x1F0) return -1;
|
1
|
40 if(id==0x1BE) return -1; // padding stream
|
|
41 if(id==0x1BF) return -1; // private2
|
|
42
|
|
43 len=stream_read_word(demux->stream);
|
|
44 if(verbose>=3) printf("PACKET len=%d",len);
|
501
|
45 // if(len==0 || len>MAX_PS_PACKETSIZE) return -2; // invalid packet !!!!!!
|
|
46 if(len==0 || len>MAX_PS_PACKETSIZE){
|
|
47 if(verbose>=2) printf("Invalid PS packet len: %d\n",len);
|
|
48 return -2; // invalid packet !!!!!!
|
|
49 }
|
1
|
50
|
|
51 while(len>0){ // Skip stuFFing bytes
|
|
52 c=stream_read_char(demux->stream);--len;
|
|
53 if(c!=0xFF)break;
|
|
54 }
|
|
55 if((c>>6)==1){ // Read (skip) STD scale & size value
|
|
56 // printf(" STD_scale=%d",(c>>5)&1);
|
|
57 d=((c&0x1F)<<8)|stream_read_char(demux->stream);
|
|
58 len-=2;
|
|
59 // printf(" STD_size=%d",d);
|
|
60 c=stream_read_char(demux->stream);
|
|
61 }
|
|
62 // Read System-1 stream timestamps:
|
|
63 if((c>>4)==2){
|
|
64 pts=read_mpeg_timestamp(demux->stream,c);
|
|
65 len-=4;
|
|
66 } else
|
|
67 if((c>>4)==3){
|
|
68 pts=read_mpeg_timestamp(demux->stream,c);
|
|
69 c=stream_read_char(demux->stream);
|
|
70 if((c>>4)!=1) pts=0; //printf("{ERROR4}");
|
|
71 dts=read_mpeg_timestamp(demux->stream,c);
|
|
72 len-=4+1+4;
|
|
73 } else
|
|
74 if((c>>6)==2){
|
|
75 int pts_flags;
|
|
76 int hdrlen;
|
|
77 // System-2 (.VOB) stream:
|
492
|
78 if((c>>4)&3) {
|
|
79 #ifdef HAVE_LIBCSS
|
|
80 css=1;
|
|
81 #else
|
|
82 printf("Encrypted VOB file (not compiled with libcss support)! Read file DOCS/DVD\n");
|
|
83 #endif
|
|
84 }
|
1
|
85 c=stream_read_char(demux->stream); pts_flags=c>>6;
|
|
86 c=stream_read_char(demux->stream); hdrlen=c;
|
|
87 len-=2;
|
|
88 if(verbose>=3) printf(" hdrlen=%d (len=%d)",hdrlen,len);
|
242
|
89 if(hdrlen>len){ printf("demux_mpg: invalid header length \n"); return -1;}
|
1
|
90 if(pts_flags==2){
|
|
91 c=stream_read_char(demux->stream);
|
|
92 pts=read_mpeg_timestamp(demux->stream,c);
|
|
93 len-=5;hdrlen-=5;
|
|
94 } else
|
|
95 if(pts_flags==3){
|
|
96 c=stream_read_char(demux->stream);
|
|
97 pts=read_mpeg_timestamp(demux->stream,c);
|
|
98 c=stream_read_char(demux->stream);
|
|
99 dts=read_mpeg_timestamp(demux->stream,c);
|
|
100 len-=10;hdrlen-=10;
|
|
101 }
|
|
102 len-=hdrlen;
|
|
103 if(hdrlen>0) stream_skip(demux->stream,hdrlen); // skip header bytes
|
|
104
|
|
105 //============== DVD Audio sub-stream ======================
|
|
106 if(id==0x1BD){
|
426
|
107 int aid=128+(stream_read_char(demux->stream)&0x7F);--len;
|
1
|
108 if(len<3) return -1; // invalid audio packet
|
426
|
109
|
|
110 if(!avi_header.a_streams[aid]) new_sh_audio(aid);
|
|
111 if(demux->audio->id==-1) demux->audio->id=aid;
|
|
112
|
|
113 if(demux->audio->id==aid){
|
|
114 ds=demux->audio;
|
|
115 if(!ds->sh) ds->sh=avi_header.a_streams[aid];
|
1
|
116 // READ Packet: Skip additional audio header data:
|
|
117 c=stream_read_char(demux->stream);
|
|
118 c=stream_read_char(demux->stream);
|
|
119 c=stream_read_char(demux->stream);
|
|
120 len-=3;
|
|
121 if(ds->type==-1){
|
|
122 // autodetect type
|
|
123 ds->type=((aid&0x70)==0x20)?2:3;
|
|
124 }
|
|
125 if(ds->type==2 && len>=2){
|
|
126 // read PCM header
|
|
127 int head;
|
|
128 head=stream_read_char(demux->stream); head=c<<8;
|
|
129 c=stream_read_char(demux->stream); head|=c; len-=2;
|
|
130 while(len>0 && head!=0x180){
|
|
131 head=c<<8;
|
|
132 c=stream_read_char(demux->stream);
|
|
133 head|=c;--len;
|
|
134 }
|
|
135 if(!len) printf("End of packet while searching for PCM header\n");
|
|
136 }
|
|
137 }
|
|
138 }
|
|
139
|
|
140 } else {
|
|
141 //if(c!=0x0f) printf(" {ERROR5,c=%d} \n",c);
|
|
142 }
|
242
|
143 if(verbose>=3) printf(" => len=%d\n",len);
|
1
|
144
|
501
|
145 // if(len<=0 || len>MAX_PS_PACKETSIZE) return -1; // Invalid packet size
|
|
146 if(len<=0 || len>MAX_PS_PACKETSIZE){
|
|
147 if(verbose>=2) printf("Invalid PS data len: %d\n",len);
|
|
148 return -1; // invalid packet !!!!!!
|
|
149 }
|
1
|
150
|
|
151 if(id>=0x1C0 && id<=0x1DF){
|
|
152 // mpeg audio
|
|
153 int aid=id-0x1C0;
|
426
|
154 if(!avi_header.a_streams[aid]) new_sh_audio(aid);
|
1
|
155 if(demux->audio->id==-1) demux->audio->id=aid;
|
|
156 if(demux->audio->id==aid){
|
|
157 ds=demux->audio;
|
426
|
158 if(!ds->sh) ds->sh=avi_header.a_streams[aid];
|
1
|
159 if(ds->type==-1) ds->type=1;
|
|
160 }
|
|
161 } else
|
|
162 if(id>=0x1E0 && id<=0x1EF){
|
|
163 // mpeg video
|
|
164 int aid=id-0x1E0;
|
426
|
165 if(!avi_header.v_streams[aid]) new_sh_video(aid);
|
1
|
166 if(demux->video->id==-1) demux->video->id=aid;
|
426
|
167 if(demux->video->id==aid){
|
|
168 ds=demux->video;
|
|
169 if(!ds->sh) ds->sh=avi_header.v_streams[aid];
|
|
170 }
|
1
|
171 }
|
|
172
|
|
173 if(ds){
|
|
174 if(verbose>=2) printf("DEMUX_MPG: Read %d data bytes from packet %04X\n",len,id);
|
|
175 // printf("packet start = 0x%X \n",stream_tell(demux->stream)-packet_start_pos);
|
492
|
176 #ifdef HAVE_LIBCSS
|
|
177 if (css) CSSDescramble(demux->stream->buffer,key_title);
|
|
178 #endif
|
1
|
179 ds_read_packet(ds,demux->stream,len,pts/90000.0f,0);
|
|
180 return 1;
|
|
181 }
|
|
182 if(verbose>=2) printf("DEMUX_MPG: Skipping %d data bytes from packet %04X\n",len,id);
|
|
183 stream_skip(demux->stream,len);
|
|
184 return 0;
|
|
185 }
|
|
186
|
|
187 static int num_elementary_packets100=0;
|
|
188 static int num_elementary_packets101=0;
|
|
189
|
|
190 int demux_mpg_es_fill_buffer(demuxer_t *demux){
|
|
191 //if(demux->type==DEMUXER_TYPE_MPEG_ES)
|
|
192 // Elementary video stream
|
|
193 if(demux->stream->eof) return 0;
|
|
194 demux->filepos=stream_tell(demux->stream);
|
501
|
195 ds_read_packet(demux->video,demux->stream,STREAM_BUFFER_SIZE,0,0);
|
1
|
196 return 1;
|
|
197 }
|
|
198
|
|
199 int demux_mpg_fill_buffer(demuxer_t *demux){
|
|
200 unsigned int head=0;
|
|
201 int skipped=0;
|
|
202 int max_packs=128;
|
|
203 int ret=0;
|
|
204
|
|
205 // System stream
|
|
206 do{
|
|
207 demux->filepos=stream_tell(demux->stream);
|
|
208 head=stream_read_dword(demux->stream);
|
|
209 while((head&0xffffff00)!=0x00000100){
|
|
210 if(stream_eof(demux->stream)) break;
|
|
211 head=(head<<8)|stream_read_char(demux->stream);
|
|
212 ++skipped; ++demux->filepos;
|
|
213 }
|
|
214 if(stream_eof(demux->stream)) break;
|
|
215 // sure: head=0x000001XX
|
|
216 if(demux->synced==0){
|
|
217 if(head==0x1BA) demux->synced=1;
|
|
218 } else
|
|
219 if(demux->synced==1){
|
|
220 if(head==0x1BB || (head>=0x1C0 && head<=0x1EF)){
|
|
221 demux->synced=2;
|
|
222 if(verbose) printf("system stream synced at 0x%X (%d)!\n",demux->filepos,demux->filepos);
|
|
223 } else demux->synced=0;
|
|
224 } // else
|
|
225 if(demux->synced==2){
|
|
226 ret=demux_mpg_read_packet(demux,head);
|
|
227 if(!ret)
|
|
228 if(--max_packs==0){
|
|
229 demux->stream->eof=1;
|
|
230 printf("demux: file doesn't contain the selected audio or video stream\n");
|
|
231 return 0;
|
|
232 }
|
|
233 } else {
|
|
234 if(head>=0x100 && head<0x1B0){
|
|
235 if(head==0x100)
|
|
236 ++num_elementary_packets100;
|
|
237 else
|
|
238 if(head==0x101) ++num_elementary_packets101;
|
|
239 if(verbose>=3) printf("Opps... elementary video packet found: %03X\n",head);
|
|
240 }
|
|
241 #if 1
|
|
242 if(num_elementary_packets100>50 && num_elementary_packets101>50
|
|
243 && skipped>4000000){
|
|
244 if(verbose) printf("sync_mpeg_ps: seems to be ES stream...\n");
|
|
245 demux->stream->eof=1;
|
|
246 break;
|
|
247 }
|
|
248 #endif
|
|
249 }
|
|
250 } while(ret!=1);
|
|
251 if(verbose>=2) printf("demux: %d bad bytes skipped\n",skipped);
|
|
252 if(demux->stream->eof){
|
|
253 if(verbose>=2) printf("MPEG Stream reached EOF\n");
|
|
254 return 0;
|
|
255 }
|
|
256 return 1;
|
|
257 }
|
|
258
|