configure: Attempt to fix compilation with FreeBSD's dvdio.h
[mplayer/glamo.git] / libmpdemux / demux_lmlm4.c
blob7f95e36de05d426fd3bae20c4d8af7a4ee7b5b59
1 /*
2 * LMLM4 MPEG4 Compression Card stream & file parser
3 * Copyright (C) 2003 Maxim Yevtyushkin <max@linuxmedialabs.com>
4 * based on SMJPEG file parser by Alex Beregszaszi
6 * This file is part of MPlayer.
8 * MPlayer is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * MPlayer is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License along
19 * with MPlayer; if not, write to the Free Software Foundation, Inc.,
20 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
23 #include <stdio.h>
24 #include <stdlib.h>
25 #include <unistd.h>
26 #include <string.h> /* strtok */
28 #include "config.h"
29 #include "mp_msg.h"
31 #include "stream/stream.h"
32 #include "demuxer.h"
33 #include "stheader.h"
35 typedef struct FrameInfo
37 ssize_t frameSize;
38 ssize_t paddingSize;
39 int frameType;
40 int channelNo;
41 } FrameInfo;
43 #define FRAMETYPE_I 0
44 #define FRAMETYPE_P 1
45 #define FRAMETYPE_B 2
46 #define FRAMETYPE_AUDIO_MPEG1L2 4
47 #define FRAMETYPE_AUDIO_ULAW 5
48 #define FRAMETYPE_AUDIO_ADPCM 6
50 #define PACKET_BLOCK_SIZE 0x00000200
51 #define PACKET_BLOCK_LAST 0x000001FF
52 #define PACKET_BLOCK_MASK 0xFFFFFE00
54 #define MAX_PACKET_SIZE 1048576 // 1 Mb
56 #define STREAM_START_CODE_SIZE 4
59 // codes in MSB first
60 static unsigned int start_code [] =
62 0xB0010000, // VISUAL_OBJECT_SEQUENCE_START_CODE
63 0xB6010000, // VOP_START_CODE
64 0x04C4FDFF, // MPEG1LAYERII_START_CODE
65 0x00000000 // end of start codes list
69 static int imeHeaderValid(FrameInfo *frame)
71 if ( frame->channelNo > 7 ||
72 frame->frameSize > MAX_PACKET_SIZE || frame->frameSize <= 0)
74 mp_msg(MSGT_DEMUX, MSGL_V,
75 "Invalid packet in LMLM4 stream: ch=%d size=%zd\n",
76 frame->channelNo, frame->frameSize);
77 return 0;
79 switch (frame->frameType) {
80 case FRAMETYPE_I:
81 case FRAMETYPE_P:
82 case FRAMETYPE_B:
83 case FRAMETYPE_AUDIO_MPEG1L2:
84 case FRAMETYPE_AUDIO_ULAW:
85 case FRAMETYPE_AUDIO_ADPCM:
86 break;
87 default:
88 mp_msg(MSGT_DEMUX, MSGL_V, "Invalid packet in LMLM4 stream (wrong packet type %d)\n", frame->frameType);
89 return 0;
91 return 1;
95 int searchMPEG4Stream(demuxer_t* demuxer, IME6400Header *imeHeader)
97 void *data;
98 ssize_t imeHeaderSize = sizeof(IME6400Header);
99 ssize_t dataSize = sizeof(IME6400Header) * 3;
100 ssize_t ptr = imeHeaderSize * 2;
101 int errNo, startCodeNo;
102 off_t pos;
104 data = malloc(dataSize);
106 imeHeaderSwap(imeHeader);
107 memcpy(data + imeHeaderSize, imeHeader, imeHeaderSize);
109 // printHex(data + imeHeaderSize, imeHeaderSize);
111 while ((errNo = stream_read(demuxer->stream, data + imeHeaderSize * 2 , imeHeaderSize)) == imeHeaderSize)
113 // printHex(data + imeHeaderSize * 2, imeHeaderSize);
115 pos = stream_tell(demuxer->stream);
116 while (dataSize - ptr >= STREAM_START_CODE_SIZE) {
117 startCodeNo = 0;
118 while (start_code[startCodeNo])
120 if (memcmp(&start_code[startCodeNo], data + ptr, STREAM_START_CODE_SIZE) == 0) // start code match
122 memcpy(imeHeader, data + ptr - imeHeaderSize, imeHeaderSize);
123 imeHeaderSwap(imeHeader);
124 if (imeHeaderValid(imeHeader))
126 stream_seek(demuxer->stream, pos - (dataSize - ptr));
127 free(data);
128 return 0;
131 startCodeNo++;
133 ptr++;
135 memcpy(data,data + imeHeaderSize, imeHeaderSize * 2);
136 ptr -= imeHeaderSize;
139 free(data);
140 return errNo;
144 static int getFrame(demuxer_t *demuxer, FrameInfo *frameInfo)
146 unsigned int packetSize;
148 frameInfo->channelNo = stream_read_word(demuxer->stream);
149 frameInfo->frameType = stream_read_word(demuxer->stream);
150 packetSize=stream_read_dword(demuxer->stream);
152 if(stream_eof(demuxer->stream)){
153 frameInfo->frameSize = 0;
154 return 0;
157 frameInfo->frameSize = packetSize - 8; //sizeof(IME6400Header);
158 frameInfo->paddingSize = (packetSize & PACKET_BLOCK_LAST) ? PACKET_BLOCK_SIZE - (packetSize & PACKET_BLOCK_LAST) : 0;
160 mp_msg(MSGT_DEMUX, MSGL_DBG2, "typ: %d chan: %d size: %zd pad: %zd\n",
161 frameInfo->frameType,
162 frameInfo->channelNo,
163 frameInfo->frameSize,
164 frameInfo->paddingSize);
166 if(!imeHeaderValid(frameInfo)){
167 // skip this packet
168 stream_skip(demuxer->stream,PACKET_BLOCK_SIZE-8);
169 frameInfo->frameSize = 0;
170 return -1;
173 return 1;
176 static int lmlm4_check_file(demuxer_t* demuxer)
178 FrameInfo frameInfo;
179 unsigned int first;
181 mp_msg(MSGT_DEMUX, MSGL_V, "Checking for LMLM4 Stream Format\n");
183 if(getFrame(demuxer, &frameInfo)!=1){
184 stream_skip(demuxer->stream,-8);
185 mp_msg(MSGT_DEMUX, MSGL_V, "LMLM4 Stream Format not found\n");
186 return 0;
188 first=stream_read_dword(demuxer->stream);
189 stream_skip(demuxer->stream,-12);
191 mp_msg(MSGT_DEMUXER,MSGL_V,"LMLM4: first=0x%08X\n",first);
193 switch(frameInfo.frameType){
194 case FRAMETYPE_AUDIO_MPEG1L2:
195 if( (first & 0xffe00000) != 0xffe00000 ){
196 mp_msg(MSGT_DEMUXER,MSGL_V,"LMLM4: not mpeg audio\n");
197 return 0;
199 if((4-((first>>17)&3))!=2){
200 mp_msg(MSGT_DEMUXER,MSGL_V,"LMLM4: not layer-2\n");
201 return 0;
203 if(((first>>10)&0x3)==3){
204 mp_msg(MSGT_DEMUXER,MSGL_V,"LMLM4: invalid audio sampelrate\n");
205 return 0;
207 mp_msg(MSGT_DEMUXER,MSGL_V,"LMLM4: first packet is audio, header checks OK!\n");
208 break;
209 // TODO: add checks for video header too, for case of disabled audio
213 // stream_reset(demuxer->stream);
214 mp_msg(MSGT_DEMUX, MSGL_V, "LMLM4 Stream Format found\n");
216 return DEMUXER_TYPE_LMLM4;
219 static int video = 0;
220 static int frames= 0;
222 // return value:
223 // 0 = EOF or no stream found
224 // 1 = successfully read a packet
225 static int demux_lmlm4_fill_buffer(demuxer_t *demux, demux_stream_t *ds)
227 FrameInfo frameInfo;
228 double pts;
229 int id=1;
230 int ret;
232 //hdr:
233 demux->filepos = stream_tell(demux->stream);
234 mp_msg(MSGT_DEMUX, MSGL_DBG2, "fpos = %"PRId64"\n", (int64_t)demux->filepos);
236 ret=getFrame(demux, &frameInfo);
237 if(ret<=0) return ret; // EOF/error
239 pts=demux->video->sh ? frames*((sh_video_t*)(demux->video->sh))->frametime : 0;
241 switch(frameInfo.frameType){
242 case FRAMETYPE_AUDIO_MPEG1L2:
243 mp_dbg(MSGT_DEMUX, MSGL_DBG2, "Audio Packet\n");
244 if (!video)
246 stream_skip(demux->stream, frameInfo.frameSize + frameInfo.paddingSize);
247 mp_msg(MSGT_DEMUX, MSGL_V, "Skip Audio Packet\n");
248 return -1; //goto hdr;
250 if(demux->audio->id==-1){
251 if(!demux->a_streams[id]) new_sh_audio(demux,id);
252 demux->audio->id=id;
253 demux->audio->sh=demux->a_streams[id];
254 ((sh_audio_t*)(demux->audio->sh))->format=0x50; // mpeg audio layer 1/2
256 if(demux->audio->id==id)
257 ds_read_packet(demux->audio, demux->stream, frameInfo.frameSize,
258 pts, demux->filepos, 0);
259 else
260 stream_skip(demux->stream,frameInfo.frameSize);
261 break;
262 case FRAMETYPE_I:
263 if (!video) {
264 video = 1;
265 mp_dbg(MSGT_DEMUX, MSGL_DBG2, "First Video Packet\n");
267 case FRAMETYPE_P:
268 frames=(frames+1)&(1024*1024-1); // wrap around at 4 hrs to avoid inaccurate float calculations
269 if (!video)
271 stream_skip(demux->stream, frameInfo.frameSize + frameInfo.paddingSize);
272 mp_msg(MSGT_DEMUX, MSGL_V, "Skip Video P Packet\n");
273 return -1; //goto hdr;
275 mp_dbg(MSGT_DEMUX, MSGL_DBG2, "Video Packet\n");
276 if(demux->video->id==-1){
277 if(!demux->v_streams[id]) new_sh_video(demux,id);
278 demux->video->id=id;
279 demux->video->sh=demux->v_streams[id];
280 ((sh_video_t*)(demux->video->sh))->format=0x10000004; // mpeg4-ES
282 if(demux->video->id==id)
283 ds_read_packet(demux->video, demux->stream, frameInfo.frameSize,
284 pts, demux->filepos, 0);
285 break;
286 default:
287 stream_skip(demux->stream,frameInfo.frameSize);
290 stream_skip(demux->stream, frameInfo.paddingSize);
292 return 1;
295 static demuxer_t* demux_open_lmlm4(demuxer_t* demuxer){
296 sh_audio_t *sh_audio=NULL;
297 sh_video_t *sh_video=NULL;
299 #if 0
300 sh_video_t* sh_video;
301 sh_audio_t* sh_audio;
302 unsigned int htype = 0, hleng;
303 int i = 0;
305 sh_video = new_sh_video(demuxer, 0);
306 demuxer->video->sh = sh_video;
307 sh_video->ds = demuxer->video;
308 sh_video->disp_w = 640;
309 sh_video->disp_h = 480;
310 sh_video->format = mmioFOURCC('D','I','V','X');
312 sh_video->bih = malloc(sizeof(BITMAPINFOHEADER));
313 memset(sh_video->bih, 0, sizeof(BITMAPINFOHEADER));
315 /* these are false values */
316 sh_video->bih->biSize = 40;
317 sh_video->bih->biWidth = sh_video->disp_w;
318 sh_video->bih->biHeight = sh_video->disp_h;
319 sh_video->bih->biPlanes = 3;
320 sh_video->bih->biBitCount = 16;
321 sh_video->bih->biCompression = sh_video->format;
322 sh_video->bih->biSizeImage = sh_video->disp_w*sh_video->disp_h;
324 sh_audio = new_sh_audio(demuxer, 0);
325 demuxer->audio->sh = sh_audio;
326 sh_audio->ds = demuxer->audio;
328 sh_audio->wf = malloc(sizeof(WAVEFORMATEX));
329 memset(sh_audio->wf, 0, sizeof(WAVEFORMATEX));
331 sh_audio->samplerate = 48000;
332 sh_audio->wf->wBitsPerSample = 16;
333 sh_audio->channels = 2;
334 sh_audio->format = 0x50;
335 sh_audio->wf->wFormatTag = sh_audio->format;
336 sh_audio->wf->nChannels = sh_audio->channels;
337 sh_audio->wf->nSamplesPerSec = sh_audio->samplerate;
338 sh_audio->wf->nAvgBytesPerSec = sh_audio->wf->nChannels*
339 sh_audio->wf->wBitsPerSample*sh_audio->wf->nSamplesPerSec/8;
340 sh_audio->wf->nBlockAlign = sh_audio->channels *2;
341 sh_audio->wf->cbSize = 0;
343 #endif
345 demuxer->seekable = 0;
347 if(!ds_fill_buffer(demuxer->video)){
348 mp_msg(MSGT_DEMUXER, MSGL_INFO, "LMLM4: %s",
349 mp_gtext("No video stream found.\n"));
350 demuxer->video->sh=NULL;
351 } else {
352 sh_video=demuxer->video->sh;sh_video->ds=demuxer->video;
354 if(demuxer->audio->id!=-2) {
355 if(!ds_fill_buffer(demuxer->audio)){
356 mp_msg(MSGT_DEMUXER, MSGL_INFO, "LMLM4: %s",
357 mp_gtext("No audio stream found -> no sound.\n"));
358 demuxer->audio->sh=NULL;
359 } else {
360 sh_audio=demuxer->audio->sh;sh_audio->ds=demuxer->audio;
364 return demuxer;
367 static void demux_close_lmlm4(demuxer_t *demuxer)
369 // printf("Close LMLM4 Stream\n");
370 return;
374 const demuxer_desc_t demuxer_desc_lmlm4 = {
375 "LMLM4 MPEG4 Compression Card stream demuxer",
376 "lmlm4",
377 "RAW LMLM4",
378 "Maxim Yevtyushkin",
380 DEMUXER_TYPE_LMLM4,
381 0, // unsafe autodetect
382 lmlm4_check_file,
383 demux_lmlm4_fill_buffer,
384 demux_open_lmlm4,
385 demux_close_lmlm4,
386 NULL,
387 NULL