From 3ec5a0a054fd36290f006aa2101da35d03d9f5ed Mon Sep 17 00:00:00 2001 From: "Ronald S. Bultje" Date: Mon, 9 Sep 2002 07:14:35 +0000 Subject: this adds video4linux2 source and element plugins. The division in v4l2* plugins is the same as for v4l1 - i.e. an el... Original commit message from CVS: this adds video4linux2 source and element plugins. The division in v4l2* plugins is the same as for v4l1 - i.e. an element, a src and a sink, but there won't be separate encoding plugins (like v4lmjpegsrc) - all functionality is (thanks to video4linux2) integrated in one plugin: v4l2src. v4l2sink is still to be done, that'll come later. --- sys/v4l2/v4l2src_calls.c | 397 +++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 397 insertions(+) create mode 100644 sys/v4l2/v4l2src_calls.c (limited to 'sys/v4l2/v4l2src_calls.c') diff --git a/sys/v4l2/v4l2src_calls.c b/sys/v4l2/v4l2src_calls.c new file mode 100644 index 00000000..5dcff336 --- /dev/null +++ b/sys/v4l2/v4l2src_calls.c @@ -0,0 +1,397 @@ +/* G-Streamer Video4linux2 video-capture plugin - system calls + * Copyright (C) 2002 Ronald Bultje + * + * This library is free software; you can redistribute it and/or + * modify it under the terms of the GNU Library General Public + * License as published by the Free Software Foundation; either + * version 2 of the License, or (at your option) any later version. + * + * This library is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU + * Library General Public License for more details. + * + * You should have received a copy of the GNU Library General Public + * License along with this library; if not, write to the + * Free Software Foundation, Inc., 59 Temple Place - Suite 330, + * Boston, MA 02111-1307, USA. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include "v4l2src_calls.h" +#include + +#define DEBUG(format, args...) \ + GST_DEBUG_ELEMENT(GST_CAT_PLUGIN_INFO, \ + GST_ELEMENT(v4l2src), \ + "V4L2SRC: " format "\n", ##args) + +#define MIN_BUFFERS_QUEUED 2 + +/* On some systems MAP_FAILED seems to be missing */ +#ifndef MAP_FAILED +#define MAP_FAILED ( (caddr_t) -1 ) +#endif + + +/****************************************************** + * gst_v4l2src_queue_frame(): + * queue a frame for capturing + * return value: TRUE on success, FALSE on error + ******************************************************/ + +static gboolean +gst_v4l2src_queue_frame (GstV4l2Src *v4l2src, + gint num) +{ + DEBUG("queueing frame %d", num); + + v4l2src->bufsettings.index = num; + if (ioctl(GST_V4L2ELEMENT(v4l2src)->video_fd, VIDIOC_QBUF, &v4l2src->bufsettings) < 0) { + gst_element_error(GST_ELEMENT(v4l2src), + "Error queueing buffer %d on device %s: %s", + num, GST_V4L2ELEMENT(v4l2src)->device, sys_errlist[errno]); + return FALSE; + } + + return TRUE; +} + + +/****************************************************** + * gst_v4lsrc_sync_frame(): + * sync on a frame for capturing + * return value: TRUE on success, FALSE on error + ******************************************************/ + +static gboolean +gst_v4l2src_sync_next_frame (GstV4l2Src *v4l2src, + gint *num) +{ + if (ioctl(GST_V4L2ELEMENT(v4l2src)->video_fd, VIDIOC_DQBUF, &v4l2src->bufsettings) < 0) { + gst_element_error(GST_ELEMENT(v4l2src), + "Error syncing on a buffer on device %s: %s", + GST_V4L2ELEMENT(v4l2src)->device, sys_errlist[errno]); + return FALSE; + } + DEBUG("synced on frame %d", v4l2src->bufsettings.index); + *num = v4l2src->bufsettings.index; + + return TRUE; +} + + +/****************************************************** + * gst_v4l2src_get_capture(): + * get capture parameters + * return value: TRUE on success, FALSE on error + ******************************************************/ + +gboolean +gst_v4l2src_get_capture (GstV4l2Src *v4l2src) +{ + DEBUG("Getting capture format"); + + GST_V4L2_CHECK_OPEN(GST_V4L2ELEMENT(v4l2src)); + + if (ioctl(GST_V4L2ELEMENT(v4l2src)->video_fd, VIDIOC_G_FMT, &v4l2src->format) < 0) { + gst_element_error(GST_ELEMENT(v4l2src), + "Failed to get pixel format for device %s: %s", + GST_V4L2ELEMENT(v4l2src)->device, sys_errlist[errno]); + return FALSE; + } + + return TRUE; +} + + +/****************************************************** + * gst_v4l2src_set_capture(): + * set capture parameters + * return value: TRUE on success, FALSE on error + ******************************************************/ + +gboolean +gst_v4l2src_set_capture (GstV4l2Src *v4l2src, + struct v4l2_fmtdesc *fmt, + gint width, + gint height) +{ + DEBUG("Setting capture format to %dx%d, format %s", + width, height, fmt->description); + + GST_V4L2_CHECK_OPEN(GST_V4L2ELEMENT(v4l2src)); + GST_V4L2_CHECK_NOT_ACTIVE(GST_V4L2ELEMENT(v4l2src)); + + memset(&v4l2src->format, 0, sizeof(struct v4l2_format)); + v4l2src->format.fmt.pix.width = width; + v4l2src->format.fmt.pix.height = height; + v4l2src->format.fmt.pix.pixelformat = fmt->pixelformat; + if (fmt->flags & V4L2_FMT_FLAG_COMPRESSED) { + v4l2src->format.fmt.pix.flags = V4L2_FMT_FLAG_COMPRESSED; + v4l2src->format.type = V4L2_BUF_TYPE_CODECIN; + } else { + v4l2src->format.type = V4L2_BUF_TYPE_CAPTURE; + } + + if (ioctl(GST_V4L2ELEMENT(v4l2src)->video_fd, VIDIOC_S_FMT, &v4l2src->format) < 0) { + gst_element_error(GST_ELEMENT(v4l2src), + "Failed to set pixel format to %s @ %dx%d for device %s: %s", + fmt->description, width, height, + GST_V4L2ELEMENT(v4l2src)->device, sys_errlist[errno]); + return FALSE; + } + + return TRUE; +} + + +/****************************************************** + * gst_v4l2src_capture_init(): + * initialize the capture system + * return value: TRUE on success, FALSE on error + ******************************************************/ + +gboolean +gst_v4l2src_capture_init (GstV4l2Src *v4l2src) +{ + gint n; + gchar *desc = NULL; + + DEBUG("initting the capture system"); + + GST_V4L2_CHECK_OPEN(GST_V4L2ELEMENT(v4l2src)); + GST_V4L2_CHECK_NOT_ACTIVE(GST_V4L2ELEMENT(v4l2src)); + + /* request buffer info */ + if (v4l2src->breq.count < MIN_BUFFERS_QUEUED) + v4l2src->breq.count = MIN_BUFFERS_QUEUED; + v4l2src->breq.type = v4l2src->format.type; + if (ioctl(GST_V4L2ELEMENT(v4l2src)->video_fd, VIDIOC_REQBUFS, &v4l2src->breq) < 0) { + gst_element_error(GST_ELEMENT(v4l2src), + "Error requesting buffers (%d) for %s: %s", + v4l2src->breq.count, GST_V4L2ELEMENT(v4l2src)->device, sys_errlist[errno]); + return FALSE; + } + + if (v4l2src->breq.count < MIN_BUFFERS_QUEUED) { + gst_element_error(GST_ELEMENT(v4l2src), + "Too little buffers. We got %d, we want at least %d", + v4l2src->breq.count, MIN_BUFFERS_QUEUED); + return FALSE; + } + v4l2src->bufsettings.type = v4l2src->format.type; + + for (n=0;nformats);n++) { + struct v4l2_fmtdesc *fmt = (struct v4l2_fmtdesc *) g_list_nth_data(GST_V4L2ELEMENT(v4l2src)->formats, n); + if (v4l2src->format.fmt.pix.pixelformat == fmt->pixelformat) { + desc = fmt->description; + break; + } + } + gst_info("Got %d buffers (%s) of size %d KB\n", + v4l2src->breq.count, desc, v4l2src->format.fmt.pix.sizeimage/1024); + + /* Map the buffers */ + GST_V4L2ELEMENT(v4l2src)->buffer = (guint8 **) g_malloc(sizeof(guint8*) * v4l2src->breq.count); + for (n=0;nbreq.count;n++) { + GST_V4L2ELEMENT(v4l2src)->buffer[n] = mmap(0, v4l2src->format.fmt.pix.sizeimage, + PROT_READ|PROT_WRITE, MAP_SHARED, GST_V4L2ELEMENT(v4l2src)->video_fd, v4l2src->format.fmt.pix.sizeimage*n); + if (GST_V4L2ELEMENT(v4l2src)->buffer[n] == MAP_FAILED) { + gst_element_error(GST_ELEMENT(v4l2src), + "Error mapping video buffer %d on device %s: %s", + n, GST_V4L2ELEMENT(v4l2src)->device, sys_errlist[errno]); + GST_V4L2ELEMENT(v4l2src)->buffer[n] = NULL; + return FALSE; + } + } + + return TRUE; +} + + +/****************************************************** + * gst_v4l2src_capture_start(): + * start streaming capture + * return value: TRUE on success, FALSE on error + ******************************************************/ + +gboolean +gst_v4l2src_capture_start (GstV4l2Src *v4l2src) +{ + gint n; + + DEBUG("starting the capturing"); + GST_V4L2_CHECK_OPEN(GST_V4L2ELEMENT(v4l2src)); + GST_V4L2_CHECK_ACTIVE(GST_V4L2ELEMENT(v4l2src)); + + /* queue all buffers, this starts streaming capture */ + for (n=0;nbreq.count;n++) + if (!gst_v4l2src_queue_frame(v4l2src, n)) + return FALSE; + n = 1; + if (ioctl(GST_V4L2ELEMENT(v4l2src)->video_fd, VIDIOC_STREAMON, &n) < 0) { + gst_element_error(GST_ELEMENT(v4l2src), + "Error starting streaming capture for %s: %s", + GST_V4L2ELEMENT(v4l2src)->device, sys_errlist[errno]); + return FALSE; + } + + return TRUE; +} + + +/****************************************************** + * gst_v4l2src_grab_frame(): + * capture one frame during streaming capture + * return value: TRUE on success, FALSE on error + ******************************************************/ + +gboolean +gst_v4l2src_grab_frame (GstV4l2Src *v4l2src, + gint *num) +{ + DEBUG("syncing on the next frame"); + + GST_V4L2_CHECK_OPEN(GST_V4L2ELEMENT(v4l2src)); + GST_V4L2_CHECK_ACTIVE(GST_V4L2ELEMENT(v4l2src)); + + /* syncing on the buffer grabs it */ + if (!gst_v4l2src_sync_next_frame(v4l2src, num)) + return FALSE; + + return TRUE; +} + + +/****************************************************** + * gst_v4l2src_requeue_frame(): + * re-queue a frame after we're done with the buffer + * return value: TRUE on success, FALSE on error + ******************************************************/ + +gboolean +gst_v4l2src_requeue_frame (GstV4l2Src *v4l2src, + gint num) +{ + DEBUG("requeueing frame %d", num); + GST_V4L2_CHECK_OPEN(GST_V4L2ELEMENT(v4l2src)); + GST_V4L2_CHECK_ACTIVE(GST_V4L2ELEMENT(v4l2src)); + + /* and let's queue the buffer */ + if (!gst_v4l2src_queue_frame(v4l2src, num)) + return FALSE; + + return TRUE; +} + + +/****************************************************** + * gst_v4l2src_capture_stop(): + * stop streaming capture + * return value: TRUE on success, FALSE on error + ******************************************************/ + +gboolean +gst_v4l2src_capture_stop (GstV4l2Src *v4l2src) +{ + gint n = 0; + + DEBUG("stopping capturing"); + GST_V4L2_CHECK_OPEN(GST_V4L2ELEMENT(v4l2src)); + GST_V4L2_CHECK_ACTIVE(GST_V4L2ELEMENT(v4l2src)); + + /* we actually need to sync on all queued buffers but not on the non-queued ones */ + if (ioctl(GST_V4L2ELEMENT(v4l2src)->video_fd, VIDIOC_STREAMOFF, &n) < 0) { + gst_element_error(GST_ELEMENT(v4l2src), + "Error stopping streaming capture for %s: %s", + GST_V4L2ELEMENT(v4l2src)->device, sys_errlist[errno]); + return FALSE; + } + + return TRUE; +} + + +/****************************************************** + * gst_v4l2src_capture_deinit(): + * deinitialize the capture system + * return value: TRUE on success, FALSE on error + ******************************************************/ + +gboolean +gst_v4l2src_capture_deinit (GstV4l2Src *v4l2src) +{ + gint n; + + DEBUG("deinitting capture system"); + GST_V4L2_CHECK_OPEN(GST_V4L2ELEMENT(v4l2src)); + GST_V4L2_CHECK_ACTIVE(GST_V4L2ELEMENT(v4l2src)); + + /* unmap the buffer */ + for (n=0;nbreq.count;n++) { + if (!GST_V4L2ELEMENT(v4l2src)->buffer[n]) + break; + munmap(GST_V4L2ELEMENT(v4l2src)->buffer[n], v4l2src->format.fmt.pix.sizeimage); + GST_V4L2ELEMENT(v4l2src)->buffer[n] = NULL; + } + g_free(GST_V4L2ELEMENT(v4l2src)->buffer); + GST_V4L2ELEMENT(v4l2src)->buffer = NULL; + + return TRUE; +} + + +/****************************************************** + * gst_v4l2src_get_fourcc_list(): + * create a list of all available fourccs + * return value: the list + ******************************************************/ + +GList * +gst_v4l2src_get_fourcc_list (GstV4l2Src *v4l2src) +{ + GList *list = NULL; + GstV4l2Element *v4l2element = GST_V4L2ELEMENT(v4l2src); + gint n; + + for (n=0;nformats);n++) { + struct v4l2_fmtdesc *fmt = (struct v4l2_fmtdesc *) g_list_nth_data(v4l2element->formats, n); + guint32 print_format = GUINT32_FROM_LE(fmt->pixelformat); + gchar *print_format_str = (gchar *) &print_format; + + list = g_list_append(list, g_strndup(print_format_str, 4)); + } + + return list; +} + + +/****************************************************** + * gst_v4l2src_get_format_list(): + * create a list of all available capture formats + * return value: the list + ******************************************************/ + +GList * +gst_v4l2src_get_format_list (GstV4l2Src *v4l2src) +{ + GList *list = NULL; + GstV4l2Element *v4l2element = GST_V4L2ELEMENT(v4l2src); + gint n; + + for (n=0;nformats);n++) { + struct v4l2_fmtdesc *fmt = (struct v4l2_fmtdesc *) g_list_nth_data(v4l2element->formats, n); + + list = g_list_append(list, g_strdup(fmt->description)); + } + + return list; +} -- cgit v1.2.1