1 /*****************************************************************************
2 * dc1394.c: firewire input module
3 *****************************************************************************
4 * Copyright (C) 2006-2009 VideoLAN
6 * Authors: Xant Majere <xant@xant.net>
7 * Rob Shortt <rob@tvcentric.com> - libdc1394 V2 API updates
8 * Frederic Benoist <fridorik@gmail.com> - updates from Rob's work
10 *****************************************************************************
11 * This library is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU Lesser General Public
13 * License as published by the Free Software Foundation;
14 * version 2 of the License.
16 * This library is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
19 * Lesser General Public License for more details.
21 * You should have received a copy of the GNU Lesser General Public
22 * License along with this library; if not, write to the Free Software
23 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
25 *****************************************************************************/
27 /*****************************************************************************
29 *****************************************************************************/
35 #include <vlc_common.h>
36 #include <vlc_plugin.h>
37 #include <vlc_input.h>
38 #include <vlc_demux.h>
39 #include <vlc_charset.h>
40 #include <vlc_picture.h>
47 #elif defined( WIN32 ) && !defined( UNDER_CE )
51 #include <sys/ioctl.h>
52 #include <sys/soundcard.h>
54 #include <libraw1394/raw1394.h>
55 #include <dc1394/dc1394.h>
57 #define MAX_IEEE1394_HOSTS 32
58 #define MAX_CAMERA_NODES 32
60 /*****************************************************************************
62 *****************************************************************************/
63 static int Open ( vlc_object_t * );
64 static void Close( vlc_object_t * );
65 static void OpenAudioDev( demux_t *p_demux );
66 static inline void CloseAudioDev( demux_t *p_demux );
69 set_description( N_("dc1394 input") )
70 set_capability( "access_demux", 10 )
71 add_shortcut( "dc1394" )
72 set_callbacks( Open, Close )
78 dc1394_t *p_dccontext;
80 dc1394camera_t *camera;
82 uint64_t selected_uid;
85 dc1394featureset_t features;
86 quadlet_t supported_framerates;
91 dc1394video_mode_t video_mode;
96 unsigned int brightness;
98 es_out_id_t *p_es_video;
99 dc1394video_frame_t *frame;
104 int i_audio_max_frame_size;
107 es_out_id_t *p_es_audio;
110 /*****************************************************************************
112 *****************************************************************************/
113 static int Demux( demux_t *p_demux );
114 static int Control( demux_t *, int, va_list );
115 static block_t *GrabVideo( demux_t *p_demux );
116 static block_t *GrabAudio( demux_t *p_demux );
117 static int process_options( demux_t *p_demux);
119 /*****************************************************************************
121 *****************************************************************************/
122 static int FindCamera( demux_sys_t *sys, demux_t *p_demux )
124 dc1394camera_list_t *list;
125 int i_ret = VLC_EGENERIC;
127 msg_Dbg( p_demux, "Scanning for ieee1394 ports ..." );
129 if( dc1394_camera_enumerate (sys->p_dccontext, &list) != DC1394_SUCCESS )
131 msg_Err(p_demux, "Can not ennumerate cameras");
137 msg_Err(p_demux, "Can not find cameras");
141 sys->num_cameras = list->num;
142 msg_Dbg( p_demux, "Found %d dc1394 cameras.", list->num);
144 if( sys->selected_uid )
147 for( unsigned i = 0; i < sys->num_cameras; i++ )
149 if( list->ids[i].guid == sys->selected_uid )
151 sys->camera = dc1394_camera_new(sys->p_dccontext,
159 msg_Err( p_demux, "Can't find camera with uid : 0x%llx.",
164 else if( sys->selected_camera >= (int)list->num )
166 msg_Err( p_demux, "There are not this many cameras. (%d/%d)",
167 sys->selected_camera, sys->num_cameras );
170 else if( sys->selected_camera >= 0 )
172 sys->camera = dc1394_camera_new(sys->p_dccontext,
173 list->ids[sys->selected_camera].guid);
177 sys->camera = dc1394_camera_new(sys->p_dccontext,
184 dc1394_camera_free_list (list);
188 /*****************************************************************************
190 *****************************************************************************/
191 static int Open( vlc_object_t *p_this )
193 demux_t *p_demux = (demux_t*)p_this;
200 if( strncmp(p_demux->psz_access, "dc1394", 6) != 0 )
204 p_demux->pf_demux = Demux;
205 p_demux->pf_control = Control;
206 p_demux->info.i_update = 0;
207 p_demux->info.i_title = 0;
208 p_demux->info.i_seekpoint = 0;
210 p_demux->p_sys = p_sys = calloc( 1, sizeof( demux_sys_t ) );
214 memset( &fmt, 0, sizeof( es_format_t ) );
217 p_sys->video_mode = DC1394_VIDEO_MODE_640x480_YUV422;
220 p_sys->frame_rate = DC1394_FRAMERATE_15;
221 p_sys->brightness = 200;
223 p_sys->fd_audio = -1;
224 p_sys->p_dccontext = NULL;
225 p_sys->camera = NULL;
226 p_sys->selected_camera = -1;
227 p_sys->dma_buffers = 1;
228 p_sys->reset_bus = 0;
230 /* PROCESS INPUT OPTIONS */
231 if( process_options(p_demux) != VLC_SUCCESS )
233 msg_Err( p_demux, "Bad MRL, please check the option line "
240 p_sys->p_dccontext = dc1394_new();
241 if( !p_sys->p_dccontext )
243 msg_Err( p_demux, "Failed to initialise libdc1394");
248 if( FindCamera( p_sys, p_demux ) != VLC_SUCCESS )
250 dc1394_free( p_sys->p_dccontext );
257 msg_Err( p_demux, "No camera found !!" );
258 dc1394_free( p_sys->p_dccontext );
263 if( p_sys->reset_bus )
265 if( dc1394_reset_bus( p_sys->camera ) != DC1394_SUCCESS )
267 msg_Err( p_demux, "Unable to reset IEEE 1394 bus");
271 else msg_Dbg( p_demux, "Successfully reset IEEE 1394 bus");
274 if( dc1394_camera_reset( p_sys->camera ) != DC1394_SUCCESS )
276 msg_Err( p_demux, "Unable to reset camera");
281 if( dc1394_camera_print_info( p_sys->camera,
282 stderr ) != DC1394_SUCCESS )
284 msg_Err( p_demux, "Unable to print camera info");
289 if( dc1394_feature_get_all( p_sys->camera,
290 &p_sys->features ) != DC1394_SUCCESS )
292 msg_Err( p_demux, "Unable to get feature set");
296 // TODO: only print features if verbosity increased
297 dc1394_feature_print_all(&p_sys->features, stderr);
299 #if 0 //"Note that you need to execute this function only if you use exotic video1394 device names. /dev/video1394, /dev/video1394/* and /dev/video1394-* are automatically recognized." http://damien.douxchamps.net/ieee1394/libdc1394/v2.x/api/capture/
300 if( p_sys->video_device )
302 if( dc1394_capture_set_device_filename( p_sys->camera,
303 p_sys->video_device ) != DC1394_SUCCESS )
305 msg_Err( p_demux, "Unable to set video device");
314 if( dc1394_feature_set_value( p_sys->camera,
315 DC1394_FEATURE_FOCUS,
316 p_sys->focus ) != DC1394_SUCCESS )
318 msg_Err( p_demux, "Unable to set initial focus to %u",
321 msg_Dbg( p_demux, "Initial focus set to %u", p_sys->focus );
324 if( dc1394_feature_set_value( p_sys->camera,
325 DC1394_FEATURE_FOCUS,
326 p_sys->brightness ) != DC1394_SUCCESS )
328 msg_Err( p_demux, "Unable to set initial brightness to %u",
331 msg_Dbg( p_demux, "Initial brightness set to %u", p_sys->brightness );
333 if( dc1394_video_set_framerate( p_sys->camera,
334 p_sys->frame_rate ) != DC1394_SUCCESS )
336 msg_Err( p_demux, "Unable to set framerate");
341 if( dc1394_video_set_mode( p_sys->camera,
342 p_sys->video_mode ) != DC1394_SUCCESS )
344 msg_Err( p_demux, "Unable to set video mode");
349 if( dc1394_video_set_iso_speed( p_sys->camera,
350 DC1394_ISO_SPEED_400 ) != DC1394_SUCCESS )
352 msg_Err( p_demux, "Unable to set iso speed");
357 /* and setup capture */
358 res = dc1394_capture_setup( p_sys->camera,
360 DC1394_CAPTURE_FLAGS_DEFAULT);
361 if( res != DC1394_SUCCESS )
363 if( res == DC1394_NO_BANDWIDTH )
365 msg_Err( p_demux ,"No bandwidth: try adding the "
366 "\"resetbus\" option" );
370 msg_Err( p_demux ,"Unable to setup capture" );
376 /* TODO - UYV444 chroma converter is missing, when it will be available
377 * fourcc will become variable (and not just a fixed value for UYVY)
379 i_width = p_sys->width;
380 i_height = p_sys->height;
382 if( picture_Setup( &p_sys->pic, VLC_CODEC_UYVY,
384 i_width * VOUT_ASPECT_FACTOR / i_height ) )
386 msg_Err( p_demux ,"unknown chroma" );
391 es_format_Init( &fmt, VIDEO_ES, VLC_CODEC_UYVY );
393 fmt.video.i_width = i_width;
394 fmt.video.i_height = i_height;
396 msg_Dbg( p_demux, "Added new video es %4.4s %dx%d",
397 (char*)&fmt.i_codec, fmt.video.i_width, fmt.video.i_height );
399 p_sys->p_es_video = es_out_Add( p_demux->out, &fmt );
401 if( p_sys->audio_device )
403 OpenAudioDev( p_demux );
404 if( p_sys->fd_audio >= 0 )
407 es_format_Init( &fmt, AUDIO_ES, VLC_CODEC_S16L ); /* FIXME: hmm, ?? */
409 fmt.audio.i_channels = p_sys->channels ? p_sys->channels : 1;
410 fmt.audio.i_rate = p_sys->i_sample_rate;
411 fmt.audio.i_bitspersample = 16;
412 fmt.audio.i_blockalign = fmt.audio.i_channels *
413 fmt.audio.i_bitspersample / 8;
414 fmt.i_bitrate = fmt.audio.i_channels * fmt.audio.i_rate *
415 fmt.audio.i_bitspersample;
417 msg_Dbg( p_demux, "New audio es %d channels %dHz",
418 fmt.audio.i_channels, fmt.audio.i_rate );
420 p_sys->p_es_audio = es_out_Add( p_demux->out, &fmt );
424 /* have the camera start sending us data */
425 if( dc1394_video_set_transmission( p_sys->camera,
426 DC1394_ON ) != DC1394_SUCCESS )
428 msg_Err( p_demux, "Unable to start camera iso transmission" );
429 dc1394_capture_stop( p_sys->camera );
433 msg_Dbg( p_demux, "Set iso transmission" );
434 // TODO: reread camera
438 static void OpenAudioDev( demux_t *p_demux )
440 demux_sys_t *p_sys = p_demux->p_sys;
441 char *psz_device = p_sys->audio_device;
442 int i_format = AFMT_S16_LE;
445 p_sys->fd_audio = utf8_open( psz_device, O_RDONLY | O_NONBLOCK );
446 if( p_sys->fd_audio < 0 )
448 msg_Err( p_demux, "Cannot open audio device (%s)", psz_device );
449 CloseAudioDev( p_demux );
452 if( !p_sys->i_sample_rate )
453 p_sys->i_sample_rate = 44100;
455 result = ioctl( p_sys->fd_audio, SNDCTL_DSP_SETFMT, &i_format );
456 if( (result < 0) || (i_format != AFMT_S16_LE) )
458 msg_Err( p_demux, "Cannot set audio format (16b little endian) "
460 CloseAudioDev( p_demux );
463 result = ioctl( p_sys->fd_audio, SNDCTL_DSP_CHANNELS, &p_sys->channels );
466 msg_Err( p_demux, "Cannot set audio channels count (%d)",
468 CloseAudioDev( p_demux );
471 result = ioctl( p_sys->fd_audio, SNDCTL_DSP_SPEED, &p_sys->i_sample_rate );
474 msg_Err( p_demux, "Cannot set audio sample rate (%d)",
475 p_sys->i_sample_rate );
476 CloseAudioDev( p_demux );
479 msg_Dbg( p_demux, "Opened adev=`%s' %s %dHz",
481 (p_sys->channels > 1) ? "stereo" : "mono",
482 p_sys->i_sample_rate );
484 p_sys->i_audio_max_frame_size = 32 * 1024;
487 static inline void CloseAudioDev( demux_t *p_demux )
489 demux_sys_t *p_sys = p_demux->p_sys;
491 if( p_sys->fd_audio >= 0 )
492 close( p_sys->fd_audio );
495 /*****************************************************************************
497 *****************************************************************************/
498 static void Close( vlc_object_t *p_this )
500 demux_t *p_demux = (demux_t*)p_this;
501 demux_sys_t *p_sys = p_demux->p_sys;
503 /* Stop data transmission */
504 if( dc1394_video_set_transmission( p_sys->camera,
505 DC1394_OFF ) != DC1394_SUCCESS )
506 msg_Err( p_demux, "Unable to stop camera iso transmission" );
509 dc1394_capture_stop( p_sys->camera );
511 CloseAudioDev( p_demux );
513 dc1394_camera_free(p_sys->camera);
514 dc1394_free(p_sys->p_dccontext);
516 free( p_sys->audio_device );
521 static void MovePixelUYVY( void *src, int spos, void *dst, int dpos )
527 sc = (u_char *)src + (spos*2);
540 dc = (u_char *)dst+(dpos*2);
554 /*****************************************************************************
556 *****************************************************************************/
557 static block_t *GrabVideo( demux_t *p_demux )
559 demux_sys_t *p_sys = p_demux->p_sys;
560 block_t *p_block = NULL;
562 if( dc1394_capture_dequeue( p_sys->camera,
563 DC1394_CAPTURE_POLICY_WAIT,
564 &p_sys->frame ) != DC1394_SUCCESS )
566 msg_Err( p_demux, "Unable to capture a frame" );
570 p_block = block_New( p_demux, p_sys->frame->size[0] *
571 p_sys->frame->size[1] * 2 );
574 msg_Err( p_demux, "Can not get block" );
578 if( !p_sys->frame->image )
580 msg_Err (p_demux, "Capture buffer empty");
581 block_Release( p_block );
585 memcpy( p_block->p_buffer, (const char *)p_sys->frame->image,
586 p_sys->width * p_sys->height * 2 );
588 p_block->i_pts = p_block->i_dts = mdate();
589 dc1394_capture_enqueue( p_sys->camera, p_sys->frame );
593 static block_t *GrabAudio( demux_t *p_demux )
595 demux_sys_t *p_sys = p_demux->p_sys;
596 struct audio_buf_info buf_info;
597 block_t *p_block = NULL;
602 p_block = block_New( p_demux, p_sys->i_audio_max_frame_size );
605 msg_Warn( p_demux, "Cannot get buffer" );
609 i_read = read( p_sys->fd_audio, p_block->p_buffer,
610 p_sys->i_audio_max_frame_size );
615 p_block->i_buffer = i_read;
617 /* Correct the date because of kernel buffering */
619 result = ioctl( p_sys->fd_audio, SNDCTL_DSP_GETISPACE, &buf_info );
621 i_correct += buf_info.bytes;
623 p_block->i_pts = p_block->i_dts =
624 mdate() - INT64_C(1000000) * (mtime_t)i_correct /
625 2 / p_sys->channels / p_sys->i_sample_rate;
629 static int Demux( demux_t *p_demux )
631 demux_sys_t *p_sys = p_demux->p_sys;
632 block_t *p_blocka = NULL;
633 block_t *p_blockv = NULL;
635 /* Try grabbing audio frames first */
636 if( p_sys->fd_audio > 0 )
637 p_blocka = GrabAudio( p_demux );
639 /* Try grabbing video frame */
640 p_blockv = GrabVideo( p_demux );
642 if( !p_blocka && !p_blockv )
644 /* Sleep so we do not consume all the cpu, 10ms seems
645 * like a good value (100fps)
653 es_out_Control( p_demux->out, ES_OUT_SET_PCR, p_blocka->i_pts );
654 es_out_Send( p_demux->out, p_sys->p_es_audio, p_blocka );
659 es_out_Control( p_demux->out, ES_OUT_SET_PCR, p_blockv->i_pts );
660 es_out_Send( p_demux->out, p_sys->p_es_video, p_blockv );
665 /*****************************************************************************
667 *****************************************************************************/
668 static int Control( demux_t *p_demux, int i_query, va_list args )
670 VLC_UNUSED( p_demux );
673 /* Special for access_demux */
674 case DEMUX_CAN_PAUSE:
676 case DEMUX_SET_PAUSE_STATE:
677 case DEMUX_CAN_CONTROL_PACE:
678 *va_arg( args, bool * ) = false;
681 case DEMUX_GET_PTS_DELAY:
682 *va_arg( args, int64_t * ) = (int64_t)DEFAULT_PTS_DELAY;
686 *va_arg( args, int64_t * ) = mdate();
689 /* TODO implement others */
696 static int process_options( demux_t *p_demux )
698 demux_sys_t *p_sys = p_demux->p_sys;
703 const char *in_size = NULL;
704 const char *in_fmt = NULL;
707 psz_dup = strdup( p_demux->psz_path );
708 psz_parser = psz_dup;
709 for( token = strtok_r( psz_parser,":",&state); token;
710 token = strtok_r( NULL, ":", &state ) )
712 if( strncmp( token, "size=", strlen("size=") ) == 0 )
714 token += strlen("size=");
715 if( strncmp( token, "160x120", 7 ) == 0 )
717 /* TODO - UYV444 chroma converter is needed ...
718 * video size of 160x120 is temporarily disabled
721 "video size of 160x120 is actually disabled for lack of"
722 "chroma support. It will relased ASAP, until then try "
723 "an higher size (320x240 and 640x480 are fully supported)" );
732 else if( strncmp( token, "320x240", 7 ) == 0 )
738 else if( strncmp( token, "640x480", 7 ) == 0 )
747 "This program currently suppots frame sizes of"
748 " 160x120, 320x240, and 640x480. "
749 "Please specify one of them. You have specified %s.",
754 msg_Dbg( p_demux, "Requested video size : %s",token );
756 if( strncmp( token, "format=", strlen("format=") ) == 0 )
758 token += strlen("format=");
759 if( strncmp( token, "YUV411", 6 ) == 0 )
763 else if( strncmp( token, "YUV422", 6 ) == 0 )
767 else if( strncmp( token, "YUV444", 6 ) == 0 )
771 else if( strncmp( token, "RGB8", 4 ) == 0 )
775 else if( strncmp( token, "MONO8", 5 ) == 0 )
779 else if( strncmp( token, "MONO16", 6 ) == 0 )
785 msg_Err( p_demux, "Invalid format %s.", token );
789 msg_Dbg( p_demux, "Requested video format : %s", token );
791 else if( strncmp( token, "fps=", strlen( "fps=" ) ) == 0 )
793 token += strlen("fps=");
794 sscanf( token, "%g", &rate_f );
795 if( rate_f == 1.875 )
796 p_sys->frame_rate = DC1394_FRAMERATE_1_875;
797 else if( rate_f == 3.75 )
798 p_sys->frame_rate = DC1394_FRAMERATE_3_75;
799 else if( rate_f == 7.5 )
800 p_sys->frame_rate = DC1394_FRAMERATE_7_5;
801 else if( rate_f == 15 )
802 p_sys->frame_rate = DC1394_FRAMERATE_15;
803 else if( rate_f == 30 )
804 p_sys->frame_rate = DC1394_FRAMERATE_30;
805 else if( rate_f == 60 )
806 p_sys->frame_rate = DC1394_FRAMERATE_60;
810 "This program supports framerates of"
811 " 1.875, 3.75, 7.5, 15, 30, 60. "
812 "Please specify one of them. You have specified %s.",
817 msg_Dbg( p_demux, "Requested frame rate : %s",token );
819 else if( strncmp( token, "resetbus", strlen( "resetbus" ) ) == 0 )
821 token += strlen("resetbus");
822 p_sys->reset_bus = 1;
824 else if( strncmp( token, "brightness=", strlen( "brightness=" ) ) == 0 )
827 token += strlen("brightness=");
828 nr = sscanf( token, "%u", &p_sys->brightness);
831 msg_Err( p_demux, "Bad brightness value '%s', "
832 "must be an unsigned integer.",
838 else if( strncmp( token, "buffers=", strlen( "buffers=" ) ) == 0 )
842 token += strlen("buffers=");
843 nr = sscanf( token, "%d", &in_buf);
844 if( nr != 1 || in_buf < 1 )
846 msg_Err( p_demux, "DMA buffers must be 1 or greater." );
850 else p_sys->dma_buffers = in_buf;
853 // NOTE: If controller support is added back, more logic will needed to be added
854 // after the cameras are scanned.
855 else if( strncmp( token, "controller=", strlen( "controller=" ) ) == 0 )
858 token += strlen("controller=");
859 nr = sscanf( token, "%u", &p_sys->controller );
862 msg_Err(p_demux, "Bad controller value '%s', "
863 "must be an unsigned integer.",
869 else if( strncmp( token, "camera=", strlen( "camera=" ) ) == 0 )
872 token += strlen("camera=");
873 nr = sscanf(token,"%u",&p_sys->selected_camera);
876 msg_Err( p_demux, "Bad camera number '%s', "
877 "must be an unsigned integer.",
883 else if( strncmp( token, "vdev=", strlen( "vdev=" ) ) == 0)
885 token += strlen("vdev=");
886 p_sys->video_device = strdup(token);
887 msg_Dbg( p_demux, "Using video device '%s'.", token );
889 else if( strncmp( token, "adev=", strlen( "adev=" ) ) == 0 )
891 token += strlen("adev=");
892 p_sys->audio_device = strdup(token);
893 msg_Dbg( p_demux, "Using audio device '%s'.", token );
895 else if( strncmp( token, "samplerate=", strlen( "samplerate=" ) ) == 0 )
897 token += strlen("samplerate=");
898 sscanf( token, "%d", &p_sys->i_sample_rate );
900 else if( strncmp( token, "channels=", strlen("channels=" ) ) == 0 )
902 token += strlen("channels=");
903 sscanf( token, "%d", &p_sys->channels );
905 else if( strncmp( token, "focus=", strlen("focus=" ) ) == 0)
908 token += strlen("focus=");
909 nr = sscanf( token, "%u", &p_sys->focus );
912 msg_Err( p_demux, "Bad focus value '%s', "
913 "must be an unsigned integer.",
919 else if( strncmp( token, "uid=", strlen("uid=") ) == 0)
921 token += strlen("uid=");
922 sscanf( token, "0x%llx", &p_sys->selected_uid );
926 // The mode is a combination of size and format and not every format
927 // is supported by every size.
930 if( strcmp( in_size, "160x120") == 0)
932 if( in_fmt && (strcmp( in_fmt, "YUV444") != 0) )
933 msg_Err(p_demux, "160x120 only supports YUV444 - forcing");
934 p_sys->video_mode = DC1394_VIDEO_MODE_160x120_YUV444;
936 else if( strcmp( in_size, "320x240") == 0)
938 if( in_fmt && (strcmp( in_fmt, "YUV422") != 0) )
939 msg_Err(p_demux, "320x240 only supports YUV422 - forcing");
940 p_sys->video_mode = DC1394_VIDEO_MODE_320x240_YUV422;
947 if( strcmp( in_fmt, "RGB8") == 0)
948 p_sys->video_mode = DC1394_VIDEO_MODE_640x480_RGB8;
949 else if( strcmp( in_fmt, "MONO8") == 0)
950 p_sys->video_mode = DC1394_VIDEO_MODE_640x480_MONO8;
951 else if( strcmp( in_fmt, "MONO16") == 0)
952 p_sys->video_mode = DC1394_VIDEO_MODE_640x480_MONO16;
953 else if( strcmp( in_fmt, "YUV411") == 0)
954 p_sys->video_mode = DC1394_VIDEO_MODE_640x480_YUV411;
955 else // YUV422 default
956 p_sys->video_mode = DC1394_VIDEO_MODE_640x480_YUV422;
958 else // YUV422 default
959 p_sys->video_mode = DC1394_VIDEO_MODE_640x480_YUV422;