mirror of
https://gitlab.freedesktop.org/gstreamer/gstreamer.git
synced 2024-12-20 07:16:55 +00:00
9c1e52ad11
Original commit message from CVS: This patch: 1) would provide v4l2 plugins, if only the CVS server wouldn't bork on all commits :-(. This patch will come later on in a separate commit when SF fixes her repository. 2) it fixes capsnego for all the video4linux1 plugins 3) it rewrites the debugging of all v4l1 plugins, which now make use of the standard gstreamer debugging features (gst-mask=...). This should make debugging video4linux1/gstreamer problems much easier then it used to be. VS: ----------------------------------------------------------------------
545 lines
16 KiB
C
545 lines
16 KiB
C
/* G-Streamer hardware MJPEG video sink plugin
|
|
* Copyright (C) 2001-2002 Ronald Bultje <rbultje@ronald.bitfreak.net>
|
|
*
|
|
* 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 <stdlib.h>
|
|
#include <sys/types.h>
|
|
#include <sys/stat.h>
|
|
#include <fcntl.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/mman.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include "v4lmjpegsink_calls.h"
|
|
|
|
/* On some systems MAP_FAILED seems to be missing */
|
|
#ifndef MAP_FAILED
|
|
#define MAP_FAILED ( (caddr_t) -1 )
|
|
#endif
|
|
|
|
#define DEBUG(format, args...) \
|
|
GST_DEBUG_ELEMENT(GST_CAT_PLUGIN_INFO, \
|
|
GST_ELEMENT(v4lmjpegsink), \
|
|
"V4LMJPEGSINK: " format "\n", ##args)
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_sync_thread()
|
|
* thread keeps track of played frames
|
|
******************************************************/
|
|
|
|
static void *
|
|
gst_v4lmjpegsink_sync_thread (void *arg)
|
|
{
|
|
GstV4lMjpegSink *v4lmjpegsink = GST_V4LMJPEGSINK(arg);
|
|
gint frame = 0; /* frame that we're currently syncing on */
|
|
|
|
DEBUG("starting sync thread");
|
|
|
|
/* Allow easy shutting down by other processes... */
|
|
pthread_setcancelstate( PTHREAD_CANCEL_ENABLE, NULL );
|
|
pthread_setcanceltype( PTHREAD_CANCEL_ASYNCHRONOUS, NULL );
|
|
|
|
while (1)
|
|
{
|
|
pthread_mutex_lock(&(v4lmjpegsink->mutex_queued_frames));
|
|
if (!v4lmjpegsink->isqueued_queued_frames[frame])
|
|
{
|
|
pthread_cond_wait(&(v4lmjpegsink->cond_queued_frames[frame]),
|
|
&(v4lmjpegsink->mutex_queued_frames));
|
|
}
|
|
if (v4lmjpegsink->isqueued_queued_frames[frame] != 1)
|
|
{
|
|
pthread_mutex_unlock(&(v4lmjpegsink->mutex_queued_frames));
|
|
goto end;
|
|
}
|
|
pthread_mutex_unlock(&(v4lmjpegsink->mutex_queued_frames));
|
|
|
|
DEBUG("thread-syncing on next frame");
|
|
if (ioctl(GST_V4LELEMENT(v4lmjpegsink)->video_fd, MJPIOC_SYNC,
|
|
&(v4lmjpegsink->bsync)) < 0)
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Failed to sync on frame %d: %s",
|
|
frame, sys_errlist[errno]);
|
|
pthread_mutex_lock(&(v4lmjpegsink->mutex_queued_frames));
|
|
v4lmjpegsink->isqueued_queued_frames[frame] = -1;
|
|
pthread_cond_broadcast(&(v4lmjpegsink->cond_queued_frames[frame]));
|
|
pthread_mutex_unlock(&(v4lmjpegsink->mutex_queued_frames));
|
|
goto end;
|
|
}
|
|
else
|
|
{
|
|
/* be sure that we're not confusing */
|
|
if (frame != v4lmjpegsink->bsync.frame)
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Internal error: frame number confusion");
|
|
goto end;
|
|
}
|
|
pthread_mutex_lock(&(v4lmjpegsink->mutex_queued_frames));
|
|
v4lmjpegsink->isqueued_queued_frames[frame] = 0;
|
|
pthread_cond_broadcast(&(v4lmjpegsink->cond_queued_frames[frame]));
|
|
pthread_mutex_unlock(&(v4lmjpegsink->mutex_queued_frames));
|
|
}
|
|
|
|
frame = (frame+1)%v4lmjpegsink->breq.count;
|
|
}
|
|
|
|
end:
|
|
DEBUG("Sync thread got signalled to exit");
|
|
pthread_exit(NULL);
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_queue_frame()
|
|
* queue a frame for playback
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
|
|
static gboolean
|
|
gst_v4lmjpegsink_queue_frame (GstV4lMjpegSink *v4lmjpegsink,
|
|
gint num)
|
|
{
|
|
DEBUG("queueing frame %d", num);
|
|
|
|
/* queue on this frame */
|
|
if (ioctl(GST_V4LELEMENT(v4lmjpegsink)->video_fd, MJPIOC_QBUF_PLAY, &num) < 0)
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Failed to queue frame %d: %s",
|
|
num, sys_errlist[errno]);
|
|
return FALSE;
|
|
}
|
|
|
|
pthread_mutex_lock(&(v4lmjpegsink->mutex_queued_frames));
|
|
v4lmjpegsink->isqueued_queued_frames[num] = 1;
|
|
pthread_cond_broadcast(&(v4lmjpegsink->cond_queued_frames[num]));
|
|
pthread_mutex_unlock(&(v4lmjpegsink->mutex_queued_frames));
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_sync_frame()
|
|
* wait for a frame to be finished playing
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
|
|
static gboolean
|
|
gst_v4lmjpegsink_sync_frame (GstV4lMjpegSink *v4lmjpegsink,
|
|
gint *num)
|
|
{
|
|
DEBUG("syncing on next frame");
|
|
|
|
/* calculate next frame */
|
|
v4lmjpegsink->current_frame = (v4lmjpegsink->current_frame+1)%v4lmjpegsink->breq.count;
|
|
*num = v4lmjpegsink->current_frame;
|
|
|
|
pthread_mutex_lock(&(v4lmjpegsink->mutex_queued_frames));
|
|
if (v4lmjpegsink->isqueued_queued_frames[*num] == 1)
|
|
{
|
|
pthread_cond_wait(&(v4lmjpegsink->cond_queued_frames[*num]),
|
|
&(v4lmjpegsink->mutex_queued_frames));
|
|
}
|
|
if (v4lmjpegsink->isqueued_queued_frames[*num] != 0)
|
|
{
|
|
pthread_mutex_unlock(&(v4lmjpegsink->mutex_queued_frames));
|
|
return FALSE;
|
|
}
|
|
else
|
|
pthread_mutex_unlock(&(v4lmjpegsink->mutex_queued_frames));
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_set_buffer()
|
|
* set buffer options
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
|
|
gboolean
|
|
gst_v4lmjpegsink_set_buffer (GstV4lMjpegSink *v4lmjpegsink,
|
|
gint numbufs,
|
|
gint bufsize)
|
|
{
|
|
DEBUG("setting buffer info to numbufs = %d, bufsize = %d KB",
|
|
numbufs, bufsize);
|
|
GST_V4L_CHECK_OPEN(GST_V4LELEMENT(v4lmjpegsink));
|
|
GST_V4L_CHECK_NOT_ACTIVE(GST_V4LELEMENT(v4lmjpegsink));
|
|
|
|
v4lmjpegsink->breq.size = bufsize * 1024;
|
|
v4lmjpegsink->breq.count = numbufs;
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_set_playback()
|
|
* set playback options (video, interlacing, etc.)
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
|
|
gboolean
|
|
gst_v4lmjpegsink_set_playback (GstV4lMjpegSink *v4lmjpegsink,
|
|
gint width,
|
|
gint height,
|
|
gint x_offset,
|
|
gint y_offset,
|
|
gint norm,
|
|
gint interlacing)
|
|
{
|
|
gint mw, mh;
|
|
struct mjpeg_params bparm;
|
|
|
|
DEBUG("setting size = %dx%d, X/Y-offsets = %d/%d, norm = %d, interlacing = %d\n",
|
|
width, height, x_offset, y_offset, norm, interlacing);
|
|
GST_V4L_CHECK_OPEN(GST_V4LELEMENT(v4lmjpegsink));
|
|
/*GST_V4L_CHECK_NOT_ACTIVE(GST_V4LELEMENT(v4lmjpegsink)); */
|
|
|
|
if (ioctl(GST_V4LELEMENT(v4lmjpegsink)->video_fd, MJPIOC_G_PARAMS, &bparm) < 0)
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Error getting playback parameters: %s",
|
|
sys_errlist[errno]);
|
|
return FALSE;
|
|
}
|
|
|
|
bparm.input = 0;
|
|
bparm.norm = norm;
|
|
bparm.decimation = 0; /* we'll set proper values later on */
|
|
|
|
/* maxwidth is broken on marvel cards */
|
|
mw = GST_V4LELEMENT(v4lmjpegsink)->vcap.maxwidth;
|
|
if (mw != 768 && mw != 640)
|
|
mw = 720;
|
|
mh = (norm==VIDEO_MODE_NTSC?480:576);
|
|
|
|
if (width > mw || height > mh)
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Video dimensions (%dx%d) are larger than device max (%dx%d)",
|
|
width, height, mw, mh);
|
|
return FALSE;
|
|
}
|
|
|
|
if (width <= mw/4)
|
|
bparm.HorDcm = 4;
|
|
else if (width <= mw/2)
|
|
bparm.HorDcm = 2;
|
|
else
|
|
bparm.HorDcm = 1;
|
|
|
|
/* TODO: add proper interlacing handling */
|
|
#if 0
|
|
if (interlacing != INTERLACING_NOT_INTERLACED)
|
|
{
|
|
bparm.field_per_buff = 2;
|
|
bparm.TmpDcm = 1;
|
|
|
|
if (height <= mh/2)
|
|
bparm.VerDcm = 2;
|
|
else
|
|
bparm.VerDcm = 1;
|
|
}
|
|
else
|
|
#endif
|
|
{
|
|
if (height > mh/2)
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Video dimensions (%dx%d) too large for non-interlaced playback (%dx%d)",
|
|
width, height, mw, mh/2);
|
|
return FALSE;
|
|
}
|
|
|
|
bparm.field_per_buff = 1;
|
|
bparm.TmpDcm = 2;
|
|
|
|
if (height <= mh/4)
|
|
bparm.VerDcm = 2;
|
|
else
|
|
bparm.VerDcm = 1;
|
|
}
|
|
|
|
/* TODO: add proper interlacing handling */
|
|
#if 0
|
|
bparm.odd_even = (interlacing==INTERLACING_TOP_FIRST);
|
|
#endif
|
|
|
|
bparm.quality = 100;
|
|
bparm.img_width = bparm.HorDcm * width;
|
|
bparm.img_height = bparm.VerDcm * height/bparm.field_per_buff;
|
|
|
|
/* image X/Y offset on device */
|
|
if (x_offset < 0)
|
|
bparm.img_x = (mw - bparm.img_width)/2;
|
|
else
|
|
{
|
|
if (x_offset + bparm.img_width > mw)
|
|
bparm.img_x = mw - bparm.img_width;
|
|
else
|
|
bparm.img_x = x_offset;
|
|
}
|
|
|
|
if (y_offset < 0)
|
|
bparm.img_y = (mh/2 - bparm.img_height)/2;
|
|
else
|
|
{
|
|
if (y_offset + bparm.img_height*2 > mh)
|
|
bparm.img_y = mh/2 - bparm.img_height;
|
|
else
|
|
bparm.img_y = y_offset/2;
|
|
}
|
|
|
|
if (ioctl(GST_V4LELEMENT(v4lmjpegsink)->video_fd, MJPIOC_S_PARAMS, &bparm) < 0)
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Error setting playback parameters: %s",
|
|
sys_errlist[errno]);
|
|
return FALSE;
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_playback_init()
|
|
* initialize playback system, set up buffer, etc.
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
|
|
gboolean
|
|
gst_v4lmjpegsink_playback_init (GstV4lMjpegSink *v4lmjpegsink)
|
|
{
|
|
gint n;
|
|
|
|
DEBUG("initting playback subsystem");
|
|
GST_V4L_CHECK_OPEN(GST_V4LELEMENT(v4lmjpegsink));
|
|
GST_V4L_CHECK_NOT_ACTIVE(GST_V4LELEMENT(v4lmjpegsink));
|
|
|
|
/* Request buffers */
|
|
if (ioctl(GST_V4LELEMENT(v4lmjpegsink)->video_fd, MJPIOC_REQBUFS, &(v4lmjpegsink->breq)) < 0)
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Error requesting video buffers: %s",
|
|
sys_errlist[errno]);
|
|
return FALSE;
|
|
}
|
|
|
|
gst_info("Got %ld buffers of size %ld KB\n",
|
|
v4lmjpegsink->breq.count, v4lmjpegsink->breq.size/1024);
|
|
|
|
/* Map the buffers */
|
|
GST_V4LELEMENT(v4lmjpegsink)->buffer = mmap(0,
|
|
v4lmjpegsink->breq.count * v4lmjpegsink->breq.size,
|
|
PROT_READ|PROT_WRITE, MAP_SHARED, GST_V4LELEMENT(v4lmjpegsink)->video_fd, 0);
|
|
if (GST_V4LELEMENT(v4lmjpegsink)->buffer == MAP_FAILED)
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Error mapping video buffers: %s",
|
|
sys_errlist[errno]);
|
|
GST_V4LELEMENT(v4lmjpegsink)->buffer = NULL;
|
|
return FALSE;
|
|
}
|
|
|
|
/* allocate/init the pthread thingies */
|
|
pthread_mutex_init(&(v4lmjpegsink->mutex_queued_frames), NULL);
|
|
v4lmjpegsink->isqueued_queued_frames = (gint8 *)
|
|
malloc(sizeof(gint8) * v4lmjpegsink->breq.count);
|
|
if (!v4lmjpegsink->isqueued_queued_frames)
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Failed to create queue tracker: %s",
|
|
sys_errlist[errno]);
|
|
return FALSE;
|
|
}
|
|
v4lmjpegsink->cond_queued_frames = (pthread_cond_t *)
|
|
malloc(sizeof(pthread_cond_t) * v4lmjpegsink->breq.count);
|
|
if (!v4lmjpegsink->cond_queued_frames)
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Failed to create queue condition holders: %s",
|
|
sys_errlist[errno]);
|
|
return FALSE;
|
|
}
|
|
for (n=0;n<v4lmjpegsink->breq.count;n++)
|
|
pthread_cond_init(&(v4lmjpegsink->cond_queued_frames[n]), NULL);
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_playback_start()
|
|
* start playback system
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
|
|
gboolean
|
|
gst_v4lmjpegsink_playback_start (GstV4lMjpegSink *v4lmjpegsink)
|
|
{
|
|
gint n;
|
|
|
|
DEBUG("starting playback");
|
|
GST_V4L_CHECK_OPEN(GST_V4LELEMENT(v4lmjpegsink));
|
|
GST_V4L_CHECK_ACTIVE(GST_V4LELEMENT(v4lmjpegsink));
|
|
|
|
/* mark all buffers as unqueued */
|
|
for (n=0;n<v4lmjpegsink->breq.count;n++)
|
|
v4lmjpegsink->isqueued_queued_frames[n] = 0;
|
|
|
|
v4lmjpegsink->current_frame = -1;
|
|
|
|
/* create sync() thread */
|
|
if (pthread_create(&(v4lmjpegsink->thread_queued_frames), NULL,
|
|
gst_v4lmjpegsink_sync_thread, (void *) v4lmjpegsink))
|
|
{
|
|
gst_element_error(GST_ELEMENT(v4lmjpegsink),
|
|
"Failed to create sync thread: %s",
|
|
sys_errlist[errno]);
|
|
return FALSE;
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_get_buffer()
|
|
* get address of a buffer
|
|
* return value: buffer's address or NULL
|
|
******************************************************/
|
|
|
|
guint8 *
|
|
gst_v4lmjpegsink_get_buffer (GstV4lMjpegSink *v4lmjpegsink,
|
|
gint num)
|
|
{
|
|
DEBUG("gst_v4lmjpegsink_get_buffer(), num = %d", num);
|
|
|
|
if (!GST_V4L_IS_ACTIVE(GST_V4LELEMENT(v4lmjpegsink)) ||
|
|
!GST_V4L_IS_OPEN(GST_V4LELEMENT(v4lmjpegsink)))
|
|
return NULL;
|
|
|
|
if (num < 0 || num >= v4lmjpegsink->breq.count)
|
|
return NULL;
|
|
|
|
return GST_V4LELEMENT(v4lmjpegsink)->buffer+(v4lmjpegsink->breq.size*num);
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_play_frame()
|
|
* queue a new buffer
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
|
|
gboolean
|
|
gst_v4lmjpegsink_play_frame (GstV4lMjpegSink *v4lmjpegsink,
|
|
gint num)
|
|
{
|
|
DEBUG("playing frame %d", num);
|
|
GST_V4L_CHECK_OPEN(GST_V4LELEMENT(v4lmjpegsink));
|
|
GST_V4L_CHECK_ACTIVE(GST_V4LELEMENT(v4lmjpegsink));
|
|
|
|
if (!gst_v4lmjpegsink_queue_frame(v4lmjpegsink, num))
|
|
return FALSE;
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_wait_frame()
|
|
* wait for buffer to be actually played
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
|
|
gboolean
|
|
gst_v4lmjpegsink_wait_frame (GstV4lMjpegSink *v4lmjpegsink,
|
|
gint *num)
|
|
{
|
|
DEBUG("waiting for next frame to be finished playing");
|
|
GST_V4L_CHECK_OPEN(GST_V4LELEMENT(v4lmjpegsink));
|
|
GST_V4L_CHECK_ACTIVE(GST_V4LELEMENT(v4lmjpegsink));
|
|
|
|
if (!gst_v4lmjpegsink_sync_frame(v4lmjpegsink, num))
|
|
return FALSE;
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_playback_stop()
|
|
* stop playback system and sync on remaining frames
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
|
|
gboolean
|
|
gst_v4lmjpegsink_playback_stop (GstV4lMjpegSink *v4lmjpegsink)
|
|
{
|
|
gint num;
|
|
|
|
DEBUG("stopping playback");
|
|
GST_V4L_CHECK_OPEN(GST_V4LELEMENT(v4lmjpegsink));
|
|
GST_V4L_CHECK_ACTIVE(GST_V4LELEMENT(v4lmjpegsink));
|
|
|
|
/* mark next buffer as wrong */
|
|
if (!gst_v4lmjpegsink_sync_frame(v4lmjpegsink, &num) ||
|
|
!gst_v4lmjpegsink_queue_frame(v4lmjpegsink, num))
|
|
{
|
|
return FALSE;
|
|
}
|
|
|
|
/* .. and wait for all buffers to be queued on */
|
|
pthread_join(v4lmjpegsink->thread_queued_frames, NULL);
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4lmjpegsink_playback_deinit()
|
|
* deinitialize the playback system and unmap buffer
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
|
|
gboolean
|
|
gst_v4lmjpegsink_playback_deinit (GstV4lMjpegSink *v4lmjpegsink)
|
|
{
|
|
DEBUG("quitting playback subsystem");
|
|
GST_V4L_CHECK_OPEN(GST_V4LELEMENT(v4lmjpegsink));
|
|
GST_V4L_CHECK_ACTIVE(GST_V4LELEMENT(v4lmjpegsink));
|
|
|
|
/* free pthread thingies */
|
|
free(v4lmjpegsink->cond_queued_frames);
|
|
free(v4lmjpegsink->isqueued_queued_frames);
|
|
|
|
/* unmap the buffer */
|
|
munmap(GST_V4LELEMENT(v4lmjpegsink)->buffer, v4lmjpegsink->breq.size * v4lmjpegsink->breq.count);
|
|
GST_V4LELEMENT(v4lmjpegsink)->buffer = NULL;
|
|
|
|
return TRUE;
|
|
}
|