2 Copyright 2005-2006 Mark Calderbank
4 This file is part of VOMP.
6 VOMP is free software; you can redistribute it and/or modify
7 it under the terms of the GNU General Public License as published by
8 the Free Software Foundation; either version 2 of the License, or
9 (at your option) any later version.
11 VOMP is distributed in the hope that it will be useful,
12 but WITHOUT ANY WARRANTY; without even the implied warranty of
13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 GNU General Public License for more details.
16 You should have received a copy of the GNU General Public License
17 along with VOMP; if not, write to the Free Software
18 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
25 #define __LITTLE_ENDIAN 1234
26 #define __BIG_ENDIAN 4321
27 #define __BYTE_ORDER __LITTLE_ENDIAN
30 #if __BYTE_ORDER == __BIG_ENDIAN
31 #define DEMUXER_SEQ_HEAD 0x000001B3
33 #define DEMUXER_SEQ_HEAD 0xB3010000
36 #define DEMUXER_PIC_HEAD 0x00000101
38 #define SEEK_THRESHOLD 150000 // About 1.5 seconds
40 const int Demuxer::FrameRates[9] = { 0, 23, 24, 25, 29, 30, 50, 59, 60 };
41 const ULLONG Demuxer::PESPacket::PTS_INVALID = (1LL << 33);
43 Demuxer* Demuxer::instance = NULL;
52 vid_seeking = aud_seeking = false;
53 video_pts = audio_pts = 0;
62 Demuxer* Demuxer::getInstance()
67 int Demuxer::init(Callback* tcallback, DrainTarget* audio, DrainTarget* video)
71 if ( !videostream.init(video, demuxMemoryV) ||
72 !audiostream.init(audio, demuxMemoryA))
74 Log::getInstance()->log("Demuxer", Log::CRIT,
75 "Failed to initialize demuxer");
90 video_current = audio_current = -1;
91 horizontal_size = vertical_size = 0;
92 aspect_ratio = (enum AspectRatio) 0;
93 frame_rate = bit_rate = 0;
95 for (int i = 0; i < PESTYPE_AUDMAX - PESTYPE_AUD0; i++)
97 avail_mpaudchan[i] = false;
101 int Demuxer::shutdown()
103 videostream.shutdown();
104 audiostream.shutdown();
109 void Demuxer::flush()
115 void Demuxer::flushAudio()
122 vid_seeking = aud_seeking = true;
123 video_pts = audio_pts = 0;
126 void Demuxer::setAudioStream(int id)
131 void Demuxer::setVideoStream(int id)
136 void Demuxer::setAspectRatio(enum AspectRatio ar)
138 if (aspect_ratio != ar)
140 Log::getInstance()->log("Demux", Log::DEBUG,
141 "Aspect ratio difference signalled");
142 if (++arcnt > 3) // avoid changing aspect ratio if glitch in signal
146 if (callback) callback->call(this);
153 bool Demuxer::writeAudio()
155 return audiostream.drain();
158 bool Demuxer::writeVideo()
160 return videostream.drain();
163 Demuxer::PESPacket::PESPacket()
171 void Demuxer::PESPacket::init(UCHAR type)
173 length = submitted = 0;
174 size = 6; closed = false;
176 data[4] = data[5] = 0;
182 int Demuxer::PESPacket::write(UCHAR *buf, int len)
184 if (closed) return 0;
185 if (length + len > 0xFFFA) return 0;
186 memcpy(data+length+6, buf, len);
189 data[4] = (length >> 8);
190 data[5] = (length & 0xFF);
194 int Demuxer::PESPacket::submit()
196 if (submitted >= size) return 0;
197 if (!closed) parseDetails();
200 Demuxer* dx = Demuxer::getInstance();
202 if (packetType >= PESTYPE_VID0 && packetType <= PESTYPE_VIDMAX)
204 if (dx->video_current == -1) dx->video_current = packetType;
205 if (dx->video_current == packetType && !dx->vid_seeking)
206 sent = dx->videostream.put(data+submitted, size-submitted);
208 sent = size-submitted;
210 else if (packetType >= PESTYPE_AUD0 && packetType <= PESTYPE_AUDMAX)
212 if (dx->audio_current == -1) dx->audio_current = packetType;
214 dx->avail_mpaudchan[packetType-PESTYPE_AUD0]=true;
216 if (dx->audio_current == packetType && !dx->aud_seeking)
217 sent = dx->audiostream.put(data+submitted, size-submitted);
219 sent = size-submitted;
223 sent = size-submitted;
227 if (submitted < size) // Stream is full.
233 void Demuxer::PESPacket::parseDetails()
235 Demuxer* dx = Demuxer::getInstance();
236 if (packetType >= PESTYPE_AUD0 && packetType <= PESTYPE_AUDMAX)
238 // Extract audio PTS if it exists
239 if ( size >= 14 && (data[7] & 0x80) ) // PTS_DTS_flags indicate PTS
241 dx->audio_pts = pts = ( (ULLONG)(data[9] & 0x0E) << 29 ) |
242 ( (ULLONG)(data[10]) << 22 ) |
243 ( (ULLONG)(data[11] & 0xFE) << 14 ) |
244 ( (ULLONG)(data[12]) << 7 ) |
245 ( (ULLONG)(data[13] & 0xFE) >> 1 );
247 // We continue to seek on the audio if the video PTS that we
248 // are trying to match is ahead of the audio PTS by at most
249 // SEEK_THRESHOLD. We consider the possibility of PTS wrap.
250 if (dx->aud_seeking && !dx->vid_seeking &&
251 !( (dx->video_pts_seek > dx->audio_pts &&
252 dx->video_pts_seek - dx->audio_pts < SEEK_THRESHOLD)
254 (dx->video_pts_seek < dx->audio_pts &&
255 dx->video_pts_seek + (1LL<<33) -
256 dx->audio_pts < SEEK_THRESHOLD) ))
259 Log::getInstance()->log("Demuxer", Log::DEBUG,
260 "Leaving audio sync: Audio PTS = %llu", dx->audio_pts);
264 else if (packetType >= PESTYPE_VID0 && packetType <= PESTYPE_VIDMAX)
266 // Extract video PTS if it exists
267 if ( size >= 14 && (data[7] & 0x80) ) // PTS_DTS_flags indicate PTS
269 dx->video_pts = pts = ( (ULLONG)(data[9] & 0x0E) << 29 ) |
270 ( (ULLONG)(data[10]) << 22 ) |
271 ( (ULLONG)(data[11] & 0xFE) << 14 ) |
272 ( (ULLONG)(data[12]) << 7 ) |
273 ( (ULLONG)(data[13] & 0xFE) >> 1 );
276 // Now, scan for a sequence header and extract information
277 UINT pos = 9; // Start searching from byte 9
278 while (pos < size - 5)
280 UINT pattern = *(UINT*)(data+pos);
281 if (pattern == DEMUXER_SEQ_HEAD)
285 if (pos+6 >= size) return;
286 dx->horizontal_size = ((int)data[pos] << 4) | ((int)data[pos+1] >> 4);
287 dx->vertical_size = (((int)data[pos+1] & 0xf) << 8) | (int)data[pos+2];
288 dx->setAspectRatio((enum AspectRatio)(data[pos+3] >> 4));
289 dx->frame_rate = data[pos+3] & 0x0f;
290 if (dx->frame_rate >= 1 && dx->frame_rate <= 8)
291 dx->frame_rate = FrameRates[dx->frame_rate];
294 dx->bit_rate = ((int)data[pos+4] << 10) |
295 ((int)data[pos+5] << 2) |
296 ((int)data[pos+6] >> 6);
300 dx->video_pts_seek = dx->video_pts;
301 Log::getInstance()->log("Demuxer", Log::DEBUG,
302 "Entering audio sync: Video PTS = %llu", dx->video_pts);
303 Log::getInstance()->log("Demuxer", Log::DEBUG,
304 "Entering audio sync: Audio PTS = %llu", dx->audio_pts);
313 UINT Demuxer::PESPacket::findPictureHeader()
315 if (size < 12) return 0;
316 UINT pattern = *(UINT*)(data+8);
318 while (pattern != DEMUXER_PIC_HEAD)
320 if (++pos >= size) return 0;
321 pattern = (pattern << 8) | data[pos];
326 UINT Demuxer::stripAudio(UCHAR* buf, UINT len)
328 UINT read_pos = 0, write_pos = 0;
329 UINT pattern, packet_length;
330 if (len < 4) return 0;
331 pattern = (buf[0] << 16) | (buf[1] << 8) | (buf[2]);
332 while (read_pos + 7 <= len)
334 pattern = ((pattern & 0xFFFFFF) << 8) | buf[read_pos+3];
335 if (pattern < (0x100|PESTYPE_VID0) || pattern > (0x100|PESTYPE_VIDMAX))
339 packet_length = ((buf[read_pos+4] << 8) | (buf[read_pos+5])) + 6;
340 if (read_pos + packet_length > len)
344 if (read_pos != write_pos)
345 memmove(buf+write_pos, buf+read_pos, packet_length);
346 read_pos += packet_length;
347 write_pos += packet_length;
348 pattern = (buf[read_pos] << 16) | (buf[read_pos+1] << 8)
356 bool* Demuxer::getmpAudioChannels()
358 return avail_mpaudchan;
361 int Demuxer::getselAudioChannel()
363 return audio_current;
366 void Demuxer::setmpAudioChannel(int aud_channel)
368 audio_current = aud_channel;