diff options
Diffstat (limited to 'sys/v4l/v4lmjpegsink_calls.c')
| -rw-r--r-- | sys/v4l/v4lmjpegsink_calls.c | 525 |
1 files changed, 0 insertions, 525 deletions
diff --git a/sys/v4l/v4lmjpegsink_calls.c b/sys/v4l/v4lmjpegsink_calls.c deleted file mode 100644 index 416f80ea..00000000 --- a/sys/v4l/v4lmjpegsink_calls.c +++ /dev/null @@ -1,525 +0,0 @@ -/* GStreamer - * - * v4lmjpegsink_calls.c: functions for hardware MJPEG video sink - * - * 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. - */ - -#ifdef HAVE_CONFIG_H -#include <config.h> -#endif - -#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 - -GST_DEBUG_CATEGORY_EXTERN (v4lmjpegsink_debug); -#define GST_CAT_DEFAULT v4lmjpegsink_debug - -/****************************************************** - * 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 */ - - GST_DEBUG_OBJECT (v4lmjpegsink, "starting sync thread"); - -#if 0 - /* Allow easy shutting down by other processes... */ - pthread_setcancelstate (PTHREAD_CANCEL_ENABLE, NULL); - pthread_setcanceltype (PTHREAD_CANCEL_ASYNCHRONOUS, NULL); -#endif - - while (1) { - g_mutex_lock (v4lmjpegsink->mutex_queued_frames); - if (!v4lmjpegsink->isqueued_queued_frames[frame]) { - g_cond_wait (v4lmjpegsink->cond_queued_frames[frame], - v4lmjpegsink->mutex_queued_frames); - } - if (v4lmjpegsink->isqueued_queued_frames[frame] != 1) { - g_mutex_unlock (v4lmjpegsink->mutex_queued_frames); - goto end; - } - g_mutex_unlock (v4lmjpegsink->mutex_queued_frames); - - GST_DEBUG_OBJECT (v4lmjpegsink, "thread-syncing on next frame"); - if (ioctl (GST_V4LELEMENT (v4lmjpegsink)->video_fd, MJPIOC_SYNC, - &(v4lmjpegsink->bsync)) < 0) { - GST_ELEMENT_ERROR (v4lmjpegsink, RESOURCE, SYNC, (NULL), - ("Failed to sync on frame %d: %s", frame, g_strerror (errno))); - g_mutex_lock (v4lmjpegsink->mutex_queued_frames); - v4lmjpegsink->isqueued_queued_frames[frame] = -1; - g_cond_broadcast (v4lmjpegsink->cond_queued_frames[frame]); - g_mutex_unlock (v4lmjpegsink->mutex_queued_frames); - goto end; - } else { - /* be sure that we're not confusing */ - if (frame != v4lmjpegsink->bsync.frame) { - GST_ELEMENT_ERROR (v4lmjpegsink, CORE, TOO_LAZY, (NULL), - ("Internal error: frame number confusion")); - goto end; - } - g_mutex_lock (v4lmjpegsink->mutex_queued_frames); - v4lmjpegsink->isqueued_queued_frames[frame] = 0; - g_cond_broadcast (v4lmjpegsink->cond_queued_frames[frame]); - g_mutex_unlock (v4lmjpegsink->mutex_queued_frames); - } - - frame = (frame + 1) % v4lmjpegsink->breq.count; - } - -end: - GST_DEBUG_OBJECT (v4lmjpegsink, "Sync thread got signalled to exit"); - g_thread_exit (NULL); - return 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) -{ - GST_DEBUG_OBJECT (v4lmjpegsink, "queueing frame %d", num); - - /* queue on this frame */ - if (ioctl (GST_V4LELEMENT (v4lmjpegsink)->video_fd, MJPIOC_QBUF_PLAY, - &num) < 0) { - GST_ELEMENT_ERROR (v4lmjpegsink, RESOURCE, WRITE, (NULL), - ("Failed to queue frame %d: %s", num, g_strerror (errno))); - return FALSE; - } - - g_mutex_lock (v4lmjpegsink->mutex_queued_frames); - v4lmjpegsink->isqueued_queued_frames[num] = 1; - g_cond_broadcast (v4lmjpegsink->cond_queued_frames[num]); - g_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) -{ - GST_DEBUG_OBJECT (v4lmjpegsink, "syncing on next frame"); - - /* calculate next frame */ - v4lmjpegsink->current_frame = - (v4lmjpegsink->current_frame + 1) % v4lmjpegsink->breq.count; - *num = v4lmjpegsink->current_frame; - - g_mutex_lock (v4lmjpegsink->mutex_queued_frames); - if (v4lmjpegsink->isqueued_queued_frames[*num] == 1) { - g_cond_wait (v4lmjpegsink->cond_queued_frames[*num], - v4lmjpegsink->mutex_queued_frames); - } - if (v4lmjpegsink->isqueued_queued_frames[*num] != 0) { - g_mutex_unlock (v4lmjpegsink->mutex_queued_frames); - return FALSE; - } else - g_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) -{ - GST_DEBUG_OBJECT (v4lmjpegsink, - "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; - - GST_DEBUG_OBJECT (v4lmjpegsink, - "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 (v4lmjpegsink, RESOURCE, SETTINGS, (NULL), - GST_ERROR_SYSTEM); - 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 (v4lmjpegsink, RESOURCE, TOO_LAZY, (NULL), - ("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 (v4lmjpegsink, RESOURCE, TOO_LAZY, (NULL), - ("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 (v4lmjpegsink, RESOURCE, SETTINGS, (NULL), - GST_ERROR_SYSTEM); - 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; - - GST_DEBUG_OBJECT (v4lmjpegsink, "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 (v4lmjpegsink, RESOURCE, READ, (NULL), GST_ERROR_SYSTEM); - return FALSE; - } - - GST_INFO_OBJECT (v4lmjpegsink, "Got %ld buffers of size %ld KB", - 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 (v4lmjpegsink, RESOURCE, TOO_LAZY, (NULL), - ("Error mapping video buffers: %s", g_strerror (errno))); - GST_V4LELEMENT (v4lmjpegsink)->buffer = NULL; - return FALSE; - } - - /* allocate/init the GThread thingies */ - v4lmjpegsink->mutex_queued_frames = g_mutex_new (); - v4lmjpegsink->isqueued_queued_frames = (gint8 *) - malloc (sizeof (gint8) * v4lmjpegsink->breq.count); - if (!v4lmjpegsink->isqueued_queued_frames) { - GST_ELEMENT_ERROR (v4lmjpegsink, RESOURCE, TOO_LAZY, (NULL), - ("Failed to create queue tracker: %s", g_strerror (errno))); - return FALSE; - } - v4lmjpegsink->cond_queued_frames = (GCond **) - malloc (sizeof (GCond *) * v4lmjpegsink->breq.count); - if (!v4lmjpegsink->cond_queued_frames) { - GST_ELEMENT_ERROR (v4lmjpegsink, RESOURCE, TOO_LAZY, (NULL), - ("Failed to create queue condition holders: %s", g_strerror (errno))); - return FALSE; - } - for (n = 0; n < v4lmjpegsink->breq.count; n++) - v4lmjpegsink->cond_queued_frames[n] = g_cond_new (); - - return TRUE; -} - - -/****************************************************** - * gst_v4lmjpegsink_playback_start() - * start playback system - * return value: TRUE on success, FALSE on error - ******************************************************/ - -gboolean -gst_v4lmjpegsink_playback_start (GstV4lMjpegSink * v4lmjpegsink) -{ - GError *error; - gint n; - - GST_DEBUG_OBJECT (v4lmjpegsink, "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 */ - v4lmjpegsink->thread_queued_frames = - g_thread_create (gst_v4lmjpegsink_sync_thread, (void *) v4lmjpegsink, - TRUE, &error); - if (!v4lmjpegsink->thread_queued_frames) { - GST_ELEMENT_ERROR (v4lmjpegsink, RESOURCE, TOO_LAZY, (NULL), - ("Failed to create sync thread: %s", error->message)); - 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) -{ - /*GST_DEBUG_OBJECT (v4lmjpegsink, 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) -{ - GST_DEBUG_OBJECT (v4lmjpegsink, "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) -{ - GST_DEBUG_OBJECT (v4lmjpegsink, - "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; - - GST_DEBUG_OBJECT (v4lmjpegsink, "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 */ - g_thread_join (v4lmjpegsink->thread_queued_frames); - - 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) -{ - int n; - - GST_DEBUG_OBJECT (v4lmjpegsink, "quitting playback subsystem"); - GST_V4L_CHECK_OPEN (GST_V4LELEMENT (v4lmjpegsink)); - GST_V4L_CHECK_ACTIVE (GST_V4LELEMENT (v4lmjpegsink)); - - /* free GThread thingies */ - g_mutex_free (v4lmjpegsink->mutex_queued_frames); - for (n = 0; n < v4lmjpegsink->breq.count; n++) - g_cond_free (v4lmjpegsink->cond_queued_frames[n]); - 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; -} |