test if access dc1394 is right earlier in the probing process to avoid side effect...
[vlc.git] / modules / access / dc1394.c
1 /*****************************************************************************
2  * dc1394.c: firewire input module
3  *****************************************************************************
4  * Copyright (C) 2006 the VideoLAN team
5  *
6  * Authors: Xant Majere <xant@xant.net>
7  *
8  *****************************************************************************
9  * This library is free software; you can redistribute it and/or
10  * modify it under the terms of the GNU Lesser General Public
11  * License as published by the Free Software Foundation;
12  * version 2 of the License.
13  *
14  * This library is distributed in the hope that it will be useful,
15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
17  * Lesser General Public License for more details.
18  *
19  * You should have received a copy of the GNU Lesser General Public
20  * License along with this library; if not, write to the Free Software
21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
22  *
23  *****************************************************************************/
24
25 /*****************************************************************************
26  * Preamble
27  *****************************************************************************/
28
29 #ifdef HAVE_CONFIG_H
30 # include "config.h"
31 #endif
32
33 #include <vlc_common.h>
34 #include <vlc_plugin.h>
35 #include <vlc_input.h>
36 #include <vlc_vout.h>
37 #include <vlc_demux.h>
38
39
40 #ifdef HAVE_FCNTL_H
41 #   include <fcntl.h>
42 #endif
43 #ifdef HAVE_UNISTD_H
44 #   include <unistd.h>
45 #elif defined( WIN32 ) && !defined( UNDER_CE )
46 #   include <io.h>
47 #endif
48
49 #include <sys/ioctl.h>
50 #include <sys/soundcard.h>
51
52 #include <libraw1394/raw1394.h>
53 #include <libdc1394/dc1394_control.h>
54
55 #define MAX_IEEE1394_HOSTS 32
56 #define MAX_CAMERA_NODES 32
57
58 /*****************************************************************************
59  * Module descriptor
60  *****************************************************************************/
61 static int  Open ( vlc_object_t * );
62 static void Close( vlc_object_t * );
63 static void OpenAudioDev( demux_t *p_demux );
64 static inline void CloseAudioDev( demux_t *p_demux );
65
66 vlc_module_begin ()
67     set_description( N_("dc1394 input") )
68     set_capability( "access_demux", 10 )
69     add_shortcut( "dc1394" )
70     set_callbacks( Open, Close )
71 vlc_module_end ()
72
73 typedef struct __dc_camera
74 {
75     int port;
76     nodeid_t node;
77     u_int64_t uid;
78 } dc_camera;
79
80 typedef struct demux_sys_t
81 {
82     dc1394_cameracapture camera;
83     picture_t            pic;
84     int                  dma_capture;
85 #define DMA_OFF 0
86 #define DMA_ON 1
87     int                 num_ports;
88     int                 num_cameras;
89     int                 selected_camera;
90     u_int64_t           selected_uid;
91
92     dc_camera           *camera_nodes;
93     dc1394_camerainfo   camera_info;
94     dc1394_miscinfo     misc_info;
95     raw1394handle_t     fd_video;
96     quadlet_t           supported_framerates;
97
98     int                 width;
99     int                 height;
100     int                 frame_size;
101     int                 frame_rate;
102     unsigned int        brightness;
103     unsigned int        focus;
104     char                *dma_device;
105     es_out_id_t         *p_es_video;
106
107     /* audio stuff */
108     int                 i_sample_rate;
109     int                 channels;
110     int                 i_audio_max_frame_size;
111     int                 fd_audio;
112     char                *audio_device;
113 #define NO_ROTATION 0
114 #define ROTATION_LEFT 1
115 #define ROTATION_RIGHT 2
116     es_out_id_t         *p_es_audio;
117 } dc1394_sys;
118
119 /*****************************************************************************
120  * Local prototypes
121  *****************************************************************************/
122 static int Demux( demux_t *p_demux );
123 static int Control( demux_t *, int, va_list );
124 static block_t *GrabVideo( demux_t *p_demux );
125 static block_t *GrabAudio( demux_t *p_demux );
126 static int process_options( demux_t *p_demux);
127
128 /*****************************************************************************
129  * ScanCameras
130  *****************************************************************************/
131 static void ScanCameras( dc1394_sys *sys, demux_t *p_demux )
132 {
133     struct raw1394_portinfo portinfo[MAX_IEEE1394_HOSTS];
134     raw1394handle_t tempFd;
135     dc1394_camerainfo  info;
136     dc_camera *node_list = NULL;
137     nodeid_t  *nodes = NULL;
138     int num_ports = 0;
139     int num_cameras = 0;
140     int nodecount;
141     int i, n;
142
143     memset( &portinfo, 0, sizeof(portinfo) );
144
145     msg_Dbg( p_demux, "Scanning for ieee1394 ports ..." );
146
147     tempFd = raw1394_new_handle();
148     if( !tempFd )
149         return VLC_EGENERIC;
150     raw1394_get_port_info( tempFd, portinfo, MAX_IEEE1394_HOSTS);
151     raw1394_destroy_handle( tempFd );
152
153     for( i=0; i < MAX_IEEE1394_HOSTS; i++ )
154     {
155         /* check if port exists and has at least one node*/
156         if( !portinfo[i].nodes )
157             continue;
158         nodes = NULL;
159         nodecount = 0;
160         tempFd = dc1394_create_handle( i );
161
162         /* skip this port if we can't obtain a valid handle */
163         if( !tempFd )
164             continue;
165         msg_Dbg( p_demux, "Found ieee1394 port %d (%s) ... "
166                           "checking for camera nodes",
167                           i, portinfo[i].name );
168         num_ports++;
169
170         nodes = dc1394_get_camera_nodes( tempFd, &nodecount, 0 );
171         if( nodecount )
172         {
173             msg_Dbg( p_demux, "Found %d dc1394 cameras on port %d (%s)",
174                      nodecount, i, portinfo[i].name );
175
176             if( node_list )
177                 node_list = realloc( node_list, sizeof(dc_camera) * (num_cameras+nodecount) );
178             else
179                 node_list = malloc( sizeof(dc_camera) * nodecount);
180
181             for( n = 0; n < nodecount; n++ )
182             {
183                 int result = 0;
184
185                 result = dc1394_get_camera_info( tempFd, nodes[n], &info );
186                 if( result == DC1394_SUCCESS )
187                 {
188                     node_list[num_cameras+n].uid = info.euid_64;
189                 }
190                 node_list[num_cameras+n].node = nodes[n];
191                 node_list[num_cameras+n].port = i;
192             }
193             num_cameras += nodecount;
194         }
195         else
196             msg_Dbg( p_demux, "no cameras found  on port %d (%s)",
197                      i, portinfo[i].name );
198
199         if( tempFd )
200             dc1394_destroy_handle( tempFd );
201     }
202     sys->num_ports = num_ports;
203     sys->num_cameras = num_cameras;
204     sys->camera_nodes = node_list;
205 }
206
207 /*****************************************************************************
208  * Open:
209  *****************************************************************************/
210 static int Open( vlc_object_t *p_this )
211 {
212     demux_t     *p_demux = (demux_t*)p_this;
213     demux_sys_t *p_sys;
214     es_format_t fmt;
215     int i;
216     int i_width;
217     int i_height;
218     int i_aspect;
219     int result = 0;
220
221     if( strncmp(p_demux->psz_access, "dc1394", 6) != 0 )
222         return VLC_EGENERIC;
223
224     /* Set up p_demux */
225     p_demux->pf_demux = Demux;
226     p_demux->pf_control = Control;
227     p_demux->info.i_update = 0;
228     p_demux->info.i_title = 0;
229     p_demux->info.i_seekpoint = 0;
230
231     p_demux->p_sys = p_sys = calloc( 1, sizeof( demux_sys_t ) );
232     if( !p_sys )
233         return VLC_ENOMEM;
234     memset( &fmt, 0, sizeof( es_format_t ) );
235
236     /* DEFAULTS */
237     p_sys->frame_size = MODE_640x480_YUV422;
238     p_sys->width      = 640;
239     p_sys->height     = 480;
240     p_sys->frame_rate = FRAMERATE_30;
241     p_sys->brightness = 200;
242     p_sys->focus      = 0;
243     p_sys->dma_capture = DMA_ON; /* defaults to VIDEO1394 capture mode */
244     p_sys->fd_audio   = -1;
245     p_sys->fd_video   = NULL;
246     p_sys->camera_nodes = NULL;
247     p_sys->selected_camera = 0;
248     p_sys->dma_device = NULL;
249     p_sys->selected_uid = 0;
250
251     /* PROCESS INPUT OPTIONS */
252     if( process_options(p_demux) != VLC_SUCCESS )
253     {
254         msg_Err( p_demux, "Bad MRL, please check the option line "
255                           "(MRL was: %s)",
256                           p_demux->psz_path );
257         free( p_sys );
258         p_demux->p_sys = NULL;
259         return VLC_EGENERIC;
260     }
261
262     msg_Dbg( p_demux, "Selected camera %d", p_sys->selected_camera );
263     msg_Dbg( p_demux, "Selected uid 0x%llx", p_sys->selected_uid );
264
265     ScanCameras( p_sys, p_demux );
266     if( !p_sys->camera_nodes )
267     {
268         msg_Err( p_demux, "No camera found !!" );
269         free( p_sys );
270         p_demux->p_sys = NULL;
271         return VLC_EGENERIC;
272     }
273
274     if( p_sys->selected_uid )
275     {
276         int found = 0;
277         for( i=0; i < p_sys->num_cameras; i++ )
278         {
279             if( p_sys->camera_nodes[i].uid == p_sys->selected_uid )
280             {
281                 p_sys->selected_camera = i;
282                 found++;
283                 break;
284             }
285         }
286         if( !found )
287         {
288             msg_Err( p_demux, "Can't find camera with uid : 0x%llx.",
289                      p_sys->selected_uid );
290             Close( p_this );
291             return VLC_EGENERIC;
292         }
293     }
294     else if( p_sys->selected_camera >= p_sys->num_cameras )
295     {
296         msg_Err( p_demux, "there are not this many cameras. (%d/%d)",
297                           p_sys->selected_camera, p_sys->num_cameras );
298         Close( p_this );
299         return VLC_EGENERIC;
300     }
301
302     p_sys->fd_video = dc1394_create_handle(
303                         p_sys->camera_nodes[p_sys->selected_camera].port );
304     if( (int)p_sys->fd_video < 0 )
305     {
306         msg_Err( p_demux, "Can't init dc1394 handle" );
307         Close( p_this );
308         return VLC_EGENERIC;
309     }
310
311     /* get camera info */
312     result = dc1394_get_camera_info( p_sys->fd_video,
313                         p_sys->camera_nodes[p_sys->selected_camera].node,
314                         &p_sys->camera_info );
315     if( result != DC1394_SUCCESS )
316     {
317         msg_Err( p_demux ,"unable to get camera info" );
318         Close( p_this );
319         return VLC_EGENERIC;
320     }
321
322     dc1394_print_camera_info( &p_sys->camera_info );
323     result = dc1394_get_camera_misc_info( p_sys->fd_video,
324                         p_sys->camera_nodes[p_sys->selected_camera].node,
325                         &p_sys->misc_info );
326     if( result != DC1394_SUCCESS )
327     {
328         msg_Err( p_demux, "unable to get camera misc info" );
329         Close( p_this );
330         return VLC_EGENERIC;
331     }
332
333     /* init camera and set some video options  */
334     result = dc1394_init_camera( p_sys->camera_info.handle,
335                                  p_sys->camera_info.id );
336     if( result != DC1394_SUCCESS )
337     {
338         msg_Err( p_demux, "unable to get init dc1394 camera" );
339         Close( p_this );
340         return VLC_EGENERIC;
341     }
342
343     if( p_sys->focus )
344     {
345         result = dc1394_set_focus( p_sys->camera_info.handle,
346                         p_sys->camera_nodes[p_sys->selected_camera].node,
347                         p_sys->focus );
348         if( result != DC1394_SUCCESS )
349         {
350             msg_Err( p_demux, "unable to set initial focus to %u",
351                      p_sys->focus );
352         }
353         msg_Dbg( p_demux, "Initial focus set to %u", p_sys->focus );
354     }
355
356     result = dc1394_set_brightness( p_sys->camera_info.handle,
357                         p_sys->camera_nodes[p_sys->selected_camera].node,
358                         p_sys->brightness );
359     if( result != DC1394_SUCCESS )
360     {
361         msg_Err( p_demux, "unable to set init brightness to %d",
362                  p_sys->brightness);
363         Close( p_this );
364         return VLC_EGENERIC;
365     }
366
367     result = dc1394_set_video_framerate( p_sys->camera_info.handle,
368                         p_sys->camera_nodes[p_sys->selected_camera].node,
369                         p_sys->frame_rate );
370     if( result != DC1394_SUCCESS )
371     {
372         msg_Err( p_demux, "unable to set framerate to %d",
373                  p_sys->frame_rate );
374         Close( p_this );
375         return VLC_EGENERIC;
376     }
377     p_sys->misc_info.framerate = p_sys->frame_rate;
378
379     result = dc1394_set_video_format( p_sys->camera_info.handle,
380                         p_sys->camera_nodes[p_sys->selected_camera].node,
381                         FORMAT_VGA_NONCOMPRESSED );
382     if( result != DC1394_SUCCESS )
383     {
384         msg_Err( p_demux, "unable to set video format to VGA_NONCOMPRESSED" );
385         Close( p_this );
386         return VLC_EGENERIC;
387     }
388     p_sys->misc_info.format = FORMAT_VGA_NONCOMPRESSED;
389
390     result = dc1394_set_video_mode( p_sys->camera_info.handle,
391                         p_sys->camera_nodes[p_sys->selected_camera].node,
392                         p_sys->frame_size );
393     if( result != DC1394_SUCCESS )
394     {
395         msg_Err( p_demux, "unable to set video mode" );
396         Close( p_this );
397         return VLC_EGENERIC;
398     }
399     p_sys->misc_info.mode = p_sys->frame_size;
400
401     /* reprobe everything */
402     result = dc1394_get_camera_info( p_sys->camera_info.handle,
403                                      p_sys->camera_info.id,
404                                      &p_sys->camera_info );
405     if( result != DC1394_SUCCESS )
406     {
407         msg_Err( p_demux, "Could not get camera basic information!" );
408         Close( p_this );
409         return VLC_EGENERIC;
410     }
411
412     result = dc1394_get_camera_misc_info( p_sys->camera_info.handle,
413                                           p_sys->camera_info.id,
414                                           &p_sys->misc_info );
415     if( result != DC1394_SUCCESS )
416     {
417         msg_Err( p_demux, "Could not get camera misc information!" );
418         Close( p_this );
419         return VLC_EGENERIC;
420     }
421
422     /* set iso_channel */
423     result = dc1394_set_iso_channel_and_speed( p_sys->camera_info.handle,
424                                                p_sys->camera_info.id,
425                                                p_sys->selected_camera,
426                                                SPEED_400 );
427     if( result != DC1394_SUCCESS )
428     {
429         msg_Err( p_demux, "Could not set iso channel!" );
430         Close( p_this );
431         return VLC_EGENERIC;
432     }
433     msg_Dbg( p_demux, "Using ISO channel %d", p_sys->misc_info.iso_channel );
434     p_sys->misc_info.iso_channel = p_sys->selected_camera;
435
436     /* and setup capture */
437     if( p_sys->dma_capture )
438     {
439         result = dc1394_dma_setup_capture( p_sys->camera_info.handle,
440                         p_sys->camera_info.id,
441                         p_sys->misc_info.iso_channel,
442                         p_sys->misc_info.format,
443                         p_sys->misc_info.mode,
444                         SPEED_400,
445                         p_sys->misc_info.framerate,
446                         10, 0,
447                         p_sys->dma_device,
448                         &p_sys->camera );
449         if( result != DC1394_SUCCESS )
450         {
451             msg_Err( p_demux ,"unable to setup camera" );
452             Close( p_this );
453             return VLC_EGENERIC;
454         }
455     }
456     else
457     {
458         result = dc1394_setup_capture( p_sys->camera_info.handle,
459                     p_sys->camera_info.id,
460                     p_sys->misc_info.iso_channel,
461                     p_sys->misc_info.format,
462                     p_sys->misc_info.mode,
463                     SPEED_400,
464                     p_sys->misc_info.framerate,
465                     &p_sys->camera );
466         if( result != DC1394_SUCCESS)
467         {
468             msg_Err( p_demux ,"unable to setup camera" );
469             Close( p_this );
470             return VLC_EGENERIC;
471         }
472     }
473
474     /* TODO - UYV444 chroma converter is missing, when it will be available
475      * fourcc will become variable (and not just a fixed value for UYVY)
476      */
477     i_width = p_sys->camera.frame_width;
478     i_height = p_sys->camera.frame_height;
479
480     i_aspect = vout_InitPicture( VLC_OBJECT(p_demux), &p_sys->pic,
481                     VLC_FOURCC('U', 'Y', 'V', 'Y'),
482                     i_width, i_height,
483                     i_width * VOUT_ASPECT_FACTOR / i_height );
484
485     es_format_Init( &fmt, VIDEO_ES, VLC_FOURCC('U', 'Y', 'V', 'Y') );
486
487     fmt.video.i_width = i_width;
488     fmt.video.i_height = i_height;
489
490     msg_Dbg( p_demux, "added new video es %4.4s %dx%d",
491              (char*)&fmt.i_codec, fmt.video.i_width, fmt.video.i_height );
492
493     p_sys->p_es_video = es_out_Add( p_demux->out, &fmt );
494
495     if( p_sys->audio_device )
496     {
497         OpenAudioDev( p_demux );
498         if( p_sys->fd_audio >= 0 )
499         {
500             es_format_t fmt;
501             es_format_Init( &fmt, AUDIO_ES, VLC_FOURCC('a','r','a','w') );
502
503             fmt.audio.i_channels = p_sys->channels ? p_sys->channels : 1;
504             fmt.audio.i_rate = p_sys->i_sample_rate;
505             fmt.audio.i_bitspersample = 16; /* FIXME: hmm, ?? */
506             fmt.audio.i_blockalign = fmt.audio.i_channels *
507                                      fmt.audio.i_bitspersample / 8;
508             fmt.i_bitrate = fmt.audio.i_channels * fmt.audio.i_rate *
509                             fmt.audio.i_bitspersample;
510
511             msg_Dbg( p_demux, "new audio es %d channels %dHz",
512             fmt.audio.i_channels, fmt.audio.i_rate );
513
514             p_sys->p_es_audio = es_out_Add( p_demux->out, &fmt );
515         }
516     }
517
518     /* have the camera start sending us data */
519     result = dc1394_start_iso_transmission( p_sys->camera_info.handle,
520                                             p_sys->camera_info.id );
521     if( result != DC1394_SUCCESS )
522     {
523         msg_Err( p_demux, "unable to start camera iso transmission" );
524         if( p_sys->dma_capture )
525         {
526             dc1394_dma_release_camera( p_sys->fd_video, &p_sys->camera );
527         }
528         else
529         {
530             dc1394_release_camera( p_sys->fd_video, &p_sys->camera );
531         }
532         Close( p_this );
533         return VLC_EGENERIC;
534     }
535     p_sys->misc_info.is_iso_on = DC1394_TRUE;
536     return VLC_SUCCESS;
537 }
538
539 static void OpenAudioDev( demux_t *p_demux )
540 {
541     demux_sys_t *p_sys = p_demux->p_sys;
542     char *psz_device = p_sys->audio_device;
543     int i_format = AFMT_S16_LE;
544     int result;
545
546     p_sys->fd_audio = open( psz_device, O_RDONLY | O_NONBLOCK );
547     if( p_sys->fd_audio  < 0 )
548     {
549         msg_Err( p_demux, "cannot open audio device (%s)", psz_device );
550         CloseAudioDev( p_demux );
551     }
552
553     if( !p_sys->i_sample_rate )
554         p_sys->i_sample_rate = 44100;
555
556     result = ioctl( p_sys->fd_audio, SNDCTL_DSP_SETFMT, &i_format );
557     if( (result  < 0) || (i_format != AFMT_S16_LE) )
558     {
559         msg_Err( p_demux, "cannot set audio format (16b little endian) "
560                           "(%d)", i_format );
561         CloseAudioDev( p_demux );
562     }
563
564     result = ioctl( p_sys->fd_audio, SNDCTL_DSP_CHANNELS, &p_sys->channels );
565     if( result < 0 )
566     {
567         msg_Err( p_demux, "cannot set audio channels count (%d)",
568                  p_sys->channels );
569         CloseAudioDev( p_demux );
570     }
571
572     result = ioctl( p_sys->fd_audio, SNDCTL_DSP_SPEED, &p_sys->i_sample_rate );
573     if( result < 0 )
574     {
575         msg_Err( p_demux, "cannot set audio sample rate (%s)", p_sys->i_sample_rate );
576         CloseAudioDev( p_demux );
577     }
578
579     msg_Dbg( p_demux, "opened adev=`%s' %s %dHz",
580              psz_device,
581              (p_sys->channels > 1) ? "stereo" : "mono",
582              p_sys->i_sample_rate );
583
584     p_sys->i_audio_max_frame_size = 32 * 1024;
585 }
586
587 static inline void CloseAudioDev( demux_t *p_demux )
588 {
589     demux_sys_t *p_sys = NULL;
590
591     if( p_demux )
592     {
593         p_sys = p_demux->p_sys;
594         if( p_sys->fd_audio >= 0 )
595             close( p_sys->fd_audio );
596     }
597 }
598
599 /*****************************************************************************
600  * Close:
601  *****************************************************************************/
602 static void Close( vlc_object_t *p_this )
603 {
604     demux_t     *p_demux = (demux_t*)p_this;
605     demux_sys_t *p_sys = p_demux->p_sys;
606     int result = 0;
607
608     /* Stop data transmission */
609     result = dc1394_stop_iso_transmission( p_sys->fd_video,
610                                            p_sys->camera.node );
611     if( result != DC1394_SUCCESS )
612     {
613         msg_Err( p_demux, "couldn't stop the camera" );
614     }
615
616     /* Close camera */
617     if( p_sys->dma_capture )
618     {
619         dc1394_dma_unlisten( p_sys->fd_video, &p_sys->camera );
620         dc1394_dma_release_camera( p_sys->fd_video, &p_sys->camera );
621     }
622     else
623     {
624         dc1394_release_camera( p_sys->fd_video, &p_sys->camera );
625     }
626
627     if( p_sys->fd_video )
628         dc1394_destroy_handle( p_sys->fd_video );
629     CloseAudioDev( p_demux );
630
631     free( p_sys->camera_nodes );
632     free( p_sys->audio_device );
633
634     free( p_sys );
635 }
636
637 static void MovePixelUYVY( void *src, int spos, void *dst, int dpos )
638 {
639     char u,v,y;
640     u_char  *sc;
641     u_char  *dc;
642
643     sc = (u_char *)src + (spos*2);
644     if( spos % 2 )
645     {
646         v = sc[0];
647         y = sc[1];
648         u = *(sc -2);
649     }
650     else
651     {
652         u = sc[0];
653         y = sc[1];
654         v = sc[2];
655     }
656     dc = (u_char *)dst+(dpos*2);
657     if( dpos % 2 )
658     {
659         dc[0] = v;
660         dc[1] = y;
661     }
662     else
663     {
664         dc[0] = u;
665         dc[1] = y;
666     }
667 }
668
669 /*****************************************************************************
670  * Demux:
671  *****************************************************************************/
672 static block_t *GrabVideo( demux_t *p_demux )
673 {
674     demux_sys_t *p_sys = p_demux->p_sys;
675     block_t     *p_block = NULL;
676     int result = 0;
677
678     if( p_sys->dma_capture )
679     {
680         result = dc1394_dma_single_capture( &p_sys->camera );
681         if( result != DC1394_SUCCESS )
682         {
683             msg_Err( p_demux, "unable to capture a frame" );
684             return NULL;
685         }
686     }
687     else
688     {
689         result = dc1394_single_capture( p_sys->camera_info.handle,
690                                         &p_sys->camera );
691         if( result != DC1394_SUCCESS )
692         {
693             msg_Err( p_demux, "unable to capture a frame" );
694             return NULL;
695         }
696     }
697
698     p_block = block_New( p_demux, p_sys->camera.frame_width *
699                                   p_sys->camera.frame_height * 2 );
700     if( !p_block )
701     {
702         msg_Err( p_demux, "cannot get block" );
703         return NULL;
704     }
705
706     if( !p_sys->camera.capture_buffer )
707     {
708         msg_Err (p_demux, "caputer buffer empty");
709         block_Release( p_block );
710         return NULL;
711     }
712
713     memcpy( p_block->p_buffer, (const char *)p_sys->camera.capture_buffer,
714             p_sys->camera.frame_width * p_sys->camera.frame_height * 2 );
715
716     p_block->i_pts = p_block->i_dts = mdate();
717     if( p_sys->dma_capture )
718         dc1394_dma_done_with_buffer( &p_sys->camera );
719     return p_block;
720 }
721
722 static block_t *GrabAudio( demux_t *p_demux )
723 {
724     demux_sys_t *p_sys = p_demux->p_sys;
725     struct audio_buf_info buf_info;
726     block_t *p_block = NULL;
727     int i_read = 0;
728     int i_correct = 0;
729     int result = 0;
730
731     p_block = block_New( p_demux, p_sys->i_audio_max_frame_size );
732     if( !p_block )
733     {
734         msg_Warn( p_demux, "cannot get buffer" );
735         return NULL;
736     }
737
738     i_read = read( p_sys->fd_audio, p_block->p_buffer,
739                    p_sys->i_audio_max_frame_size );
740
741     if( i_read <= 0 )
742         return NULL;
743
744     p_block->i_buffer = i_read;
745
746     /* Correct the date because of kernel buffering */
747     i_correct = i_read;
748     result = ioctl( p_sys->fd_audio, SNDCTL_DSP_GETISPACE, &buf_info );
749     if( result == 0 )
750         i_correct += buf_info.bytes;
751
752     p_block->i_pts = p_block->i_dts =
753                         mdate() - INT64_C(1000000) * (mtime_t)i_correct /
754                         2 / p_sys->channels / p_sys->i_sample_rate;
755     return p_block;
756 }
757
758 static int Demux( demux_t *p_demux )
759 {
760     demux_sys_t *p_sys = p_demux->p_sys;
761     block_t *p_blocka = NULL;
762     block_t *p_blockv = NULL;
763
764     /* Try grabbing audio frames first */
765     if( p_sys->fd_audio > 0 )
766         p_blocka = GrabAudio( p_demux );
767
768     /* Try grabbing video frame */
769     if( (int)p_sys->fd_video > 0 )
770         p_blockv = GrabVideo( p_demux );
771
772     if( !p_blocka && !p_blockv )
773     {
774         /* Sleep so we do not consume all the cpu, 10ms seems
775          * like a good value (100fps)
776          */
777         msleep( 10000 );
778         return 1;
779     }
780
781     if( p_blocka )
782     {
783         es_out_Control( p_demux->out, ES_OUT_SET_PCR, p_blocka->i_pts );
784         es_out_Send( p_demux->out, p_sys->p_es_audio, p_blocka );
785     }
786
787     if( p_blockv )
788     {
789         es_out_Control( p_demux->out, ES_OUT_SET_PCR, p_blockv->i_pts );
790         es_out_Send( p_demux->out, p_sys->p_es_video, p_blockv );
791     }
792     return 1;
793 }
794
795 /*****************************************************************************
796  * Control:
797  *****************************************************************************/
798 static int Control( demux_t *p_demux, int i_query, va_list args )
799 {
800     bool *pb;
801     int64_t    *pi64;
802
803     switch( i_query )
804     {
805         /* Special for access_demux */
806         case DEMUX_CAN_PAUSE:
807         case DEMUX_CAN_SEEK:
808         case DEMUX_SET_PAUSE_STATE:
809         case DEMUX_CAN_CONTROL_PACE:
810             pb = (bool*)va_arg( args, bool * );
811             *pb = false;
812             return VLC_SUCCESS;
813
814         case DEMUX_GET_PTS_DELAY:
815             pi64 = (int64_t*)va_arg( args, int64_t * );
816             *pi64 = (int64_t)DEFAULT_PTS_DELAY;
817             return VLC_SUCCESS;
818
819         case DEMUX_GET_TIME:
820             pi64 = (int64_t*)va_arg( args, int64_t * );
821             *pi64 = mdate();
822             return VLC_SUCCESS;
823
824         /* TODO implement others */
825         default:
826             return VLC_EGENERIC;
827     }
828     return VLC_EGENERIC;
829 }
830
831 static int process_options( demux_t *p_demux )
832 {
833     demux_sys_t *p_sys = p_demux->p_sys;
834     char *psz_dup;
835     char *psz_parser;
836     char *token = NULL;
837     char *state = NULL;
838     float rate_f;
839
840     psz_dup = strdup( p_demux->psz_path );
841     psz_parser = psz_dup;
842     for( token = strtok_r( psz_parser,":",&state); token;
843          token = strtok_r( NULL, ":", &state ) )
844     {
845         if( strncmp( token, "size=", strlen("size=") ) == 0 )
846         {
847             token += strlen("size=");
848             if( strncmp( token, "160x120", 7 ) == 0 )
849             {
850                 /* TODO - UYV444 chroma converter is needed ...
851                     * video size of 160x120 is temporarily disabled
852                     */
853                 msg_Err( p_demux,
854                     "video size of 160x120 is actually disabled for lack of chroma "
855                     "support. It will relased ASAP, until then try an higher size "
856                     "(320x240 and 640x480 are fully supported)" );
857                 free( psz_dup );
858                 return VLC_EGENERIC;
859 #if 0
860                 p_sys->frame_size = MODE_160x120_YUV444;
861                 p_sys->width = 160;
862                 p_sys->height = 120;
863 #endif
864             }
865             else if( strncmp( token, "320x240", 7 ) == 0 )
866             {
867                 p_sys->frame_size = MODE_320x240_YUV422;
868                 p_sys->width = 320;
869                 p_sys->height = 240;
870             }
871             else if( strncmp( token, "640x480", 7 ) == 0 )
872             {
873                 p_sys->frame_size = MODE_640x480_YUV422;
874                 p_sys->width = 640;
875                 p_sys->height = 480;
876             }
877             else
878             {
879                 msg_Err( p_demux,
880                     "This program currently suppots frame sizes of"
881                     " 160x120, 320x240, and 640x480. "
882                     "Please specify one of them. You have specified %s.",
883                     token );
884                 free( psz_dup );
885                 return VLC_EGENERIC;
886             }
887             msg_Dbg( p_demux, "Requested video size : %s",token );
888         }
889         else if( strncmp( token, "fps=", strlen( "fps=" ) ) == 0 )
890         {
891             token += strlen("fps=");
892             sscanf( token, "%g", &rate_f );
893             if( rate_f == 1.875 )
894                 p_sys->frame_rate = FRAMERATE_1_875;
895             else if( rate_f == 3.75 )
896                 p_sys->frame_rate = FRAMERATE_3_75;
897             else if( rate_f == 7.5 )
898                 p_sys->frame_rate = FRAMERATE_7_5;
899             else if( rate_f == 15 )
900                 p_sys->frame_rate = FRAMERATE_15;
901             else if( rate_f == 30 )
902                 p_sys->frame_rate = FRAMERATE_30;
903             else if( rate_f == 60 )
904                 p_sys->frame_rate = FRAMERATE_60;
905             else
906             {
907                 msg_Err( p_demux ,
908                     "This program supports framerates of"
909                     " 1.875, 3.75, 7.5, 15, 30, 60. "
910                     "Please specify one of them. You have specified %s.",
911                     token);
912                 free( psz_dup );
913                 return VLC_EGENERIC;
914             }
915             msg_Dbg( p_demux, "Requested frame rate : %s",token );
916         }
917         else if( strncmp( token, "brightness=", strlen( "brightness=" ) ) == 0 )
918         {
919             int nr = 0;
920             token += strlen("brightness=");
921             nr = sscanf( token, "%u", &p_sys->brightness);
922             if( nr != 1 )
923             {
924                 msg_Err( p_demux, "Bad brightness value '%s', "
925                                   "must be an unsigned integer.",
926                                   token );
927                 free( psz_dup );
928                 return VLC_EGENERIC;
929             }
930         }
931 #if 0
932         else if( strncmp( token, "controller=", strlen( "controller=" ) ) == 0 )
933         {
934             int nr = 0;
935             token += strlen("controller=");
936             nr = sscanf( token, "%u", &p_sys->controller );
937             if( nr != 1)
938             {
939                 msg_Err(p_demux, "Bad controller value '%s', "
940                                  "must be an unsigned integer.",
941                                  token );
942                 return VLC_EGENERIC;
943             }
944         }
945 #endif
946         else if( strncmp( token, "camera=", strlen( "camera=" ) ) == 0 )
947         {
948             int nr = 0;
949             token += strlen("camera=");
950             nr = sscanf(token,"%u",&p_sys->selected_camera);
951             if( nr != 1)
952             {
953                 msg_Err( p_demux, "Bad camera number '%s', "
954                                   "must be an unsigned integer.",
955                                   token );
956                 free( psz_dup );
957                 return VLC_EGENERIC;
958             }
959         }
960         else if( strncmp( token, "capture=", strlen( "capture=" ) ) == 0)
961         {
962             token += strlen("capture=");
963             if( strncmp(token, "raw1394",7) == 0 )
964             {
965                 msg_Dbg( p_demux, "DMA capture disabled!" );
966                 p_sys->dma_capture = DMA_OFF;
967             }
968             else if( strncmp(token,"video1394",9) == 0 )
969             {
970                 msg_Dbg( p_demux, "DMA capture enabled!" );
971                 p_sys->dma_capture = DMA_ON;
972             }
973             else
974             {
975                 msg_Err(p_demux, "Bad capture method value '%s', "
976                                  "it can be 'raw1394' or 'video1394'.",
977                                 token );
978                 free( psz_dup );
979                 return VLC_EGENERIC;
980             }
981         }
982         else if( strncmp( token, "adev=", strlen( "adev=" ) ) == 0 )
983         {
984             token += strlen("adev=");
985             p_sys->audio_device = strdup(token);
986             msg_Dbg( p_demux, "Using audio device '%s'.", token );
987         }
988         else if( strncmp( token, "samplerate=", strlen( "samplerate=" ) ) == 0 )
989         {
990             token += strlen("samplerate=");
991             sscanf( token, "%d", &p_sys->i_sample_rate );
992         }
993         else if( strncmp( token, "channels=", strlen("channels=" ) ) == 0 )
994         {
995             token += strlen("channels=");
996             sscanf( token, "%d", &p_sys->channels );
997         }
998         else if( strncmp( token, "focus=", strlen("focus=" ) ) == 0)
999         {
1000             token += strlen("focus=");
1001             sscanf( token, "%u", &p_sys->focus );
1002         }
1003         else if( strncmp( token, "uid=", strlen("uid=") ) == 0)
1004         {
1005             token += strlen("uid=");
1006             sscanf( token, "0x%llx", &p_sys->selected_uid );
1007         }
1008     }
1009     free( psz_dup );
1010     return VLC_SUCCESS;
1011 }
1012