Add udev helper library to v4l2 plugin.
This adds a small helper library to the v4l2 plugin that uses udev to get events for v4l2 devices.master
parent
43184d1775
commit
1bae57668c
|
@ -6,6 +6,8 @@ if(DISABLE_V4L2)
|
|||
endif()
|
||||
|
||||
find_package(Libv4l2)
|
||||
find_package(LibUDev QUIET)
|
||||
|
||||
if(NOT LIBV4L2_FOUND AND ENABLE_V4L2)
|
||||
message(FATAL_ERROR "libv4l2 not found bit plugin set as enabled")
|
||||
elseif(NOT LIBV4L2_FOUND)
|
||||
|
@ -13,10 +15,20 @@ elseif(NOT LIBV4L2_FOUND)
|
|||
return()
|
||||
endif()
|
||||
|
||||
if(NOT UDEV_FOUND OR DISABLE_UDEV)
|
||||
message(STATUS "udev disabled for v4l2 plugin")
|
||||
else()
|
||||
set(linux-v4l2-udev_SOURCES
|
||||
v4l2-udev.c
|
||||
)
|
||||
add_definitions(-DHAVE_UDEV)
|
||||
endif()
|
||||
|
||||
set(linux-v4l2_SOURCES
|
||||
linux-v4l2.c
|
||||
v4l2-input.c
|
||||
v4l2-helpers.c
|
||||
${linux-v4l2-udev_SOURCES}
|
||||
)
|
||||
|
||||
add_library(linux-v4l2 MODULE
|
||||
|
@ -25,6 +37,7 @@ add_library(linux-v4l2 MODULE
|
|||
target_link_libraries(linux-v4l2
|
||||
libobs
|
||||
${LIBV4L2_LIBRARIES}
|
||||
${UDEV_LIBRARIES}
|
||||
)
|
||||
|
||||
install_obs_plugin_with_data(linux-v4l2 data)
|
||||
|
|
|
@ -0,0 +1,224 @@
|
|||
/*
|
||||
Copyright (C) 2014 by Leonhard Oelke <leonhard@in-verted.de>
|
||||
|
||||
This program is free software: you can redistribute it and/or modify
|
||||
it under the terms of the GNU General Public License as published by
|
||||
the Free Software Foundation, either version 2 of the License, or
|
||||
(at your option) any later version.
|
||||
|
||||
This program 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 General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <libudev.h>
|
||||
|
||||
#include <util/threading.h>
|
||||
#include <util/darray.h>
|
||||
#include <obs.h>
|
||||
|
||||
#include "v4l2-udev.h"
|
||||
|
||||
#define UDEV_DATA(voidptr) struct v4l2_udev_mon_t *m \
|
||||
= (struct v4l2_udev_mon_t *) voidptr;
|
||||
|
||||
/** udev action enum */
|
||||
enum udev_action {
|
||||
UDEV_ACTION_ADDED,
|
||||
UDEV_ACTION_REMOVED,
|
||||
UDEV_ACTION_UNKNOWN
|
||||
};
|
||||
|
||||
/** monitor object holding the callbacks */
|
||||
struct v4l2_udev_mon_t {
|
||||
/* data for the device added callback */
|
||||
void *dev_added_userdata;
|
||||
v4l2_device_added_cb dev_added_cb;
|
||||
/* data for the device removed callback */
|
||||
void *dev_removed_userdata;
|
||||
v4l2_device_removed_cb dev_removed_cb;
|
||||
};
|
||||
|
||||
/* global data */
|
||||
static uint_fast32_t udev_refs = 0;
|
||||
static pthread_mutex_t udev_mutex = PTHREAD_MUTEX_INITIALIZER;
|
||||
|
||||
static pthread_t udev_thread;
|
||||
static os_event_t *udev_event;
|
||||
|
||||
static DARRAY(struct v4l2_udev_mon_t) udev_clients;
|
||||
|
||||
/**
|
||||
* udev gives us the device action as string, so we convert it here ...
|
||||
*
|
||||
* @param action the udev action as string
|
||||
* @return the udev action as enum value
|
||||
*/
|
||||
static enum udev_action udev_action_to_enum(const char *action)
|
||||
{
|
||||
if (!action)
|
||||
return UDEV_ACTION_UNKNOWN;
|
||||
|
||||
if (!strncmp("add", action, 3))
|
||||
return UDEV_ACTION_ADDED;
|
||||
if (!strncmp("remove", action, 6))
|
||||
return UDEV_ACTION_REMOVED;
|
||||
|
||||
return UDEV_ACTION_UNKNOWN;
|
||||
}
|
||||
|
||||
/**
|
||||
* Call all registered callbacks with the event
|
||||
*
|
||||
* @param dev udev device that had an event occuring
|
||||
*/
|
||||
static inline void udev_call_callbacks(struct udev_device *dev)
|
||||
{
|
||||
const char *node;
|
||||
enum udev_action action;
|
||||
|
||||
pthread_mutex_lock(&udev_mutex);
|
||||
|
||||
node = udev_device_get_devnode(dev);
|
||||
action = udev_action_to_enum(udev_device_get_action(dev));
|
||||
|
||||
for (size_t idx = 0; idx < udev_clients.num; idx++) {
|
||||
struct v4l2_udev_mon_t *c = &udev_clients.array[idx];
|
||||
|
||||
switch (action) {
|
||||
case UDEV_ACTION_ADDED:
|
||||
if (!c->dev_added_cb)
|
||||
continue;
|
||||
c->dev_added_cb(node, c->dev_added_userdata);
|
||||
break;
|
||||
case UDEV_ACTION_REMOVED:
|
||||
if (!c->dev_removed_cb)
|
||||
continue;
|
||||
c->dev_removed_cb(node, c->dev_removed_userdata);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
pthread_mutex_unlock(&udev_mutex);
|
||||
}
|
||||
|
||||
/**
|
||||
* Event listener thread
|
||||
*/
|
||||
static void *udev_event_thread(void *vptr)
|
||||
{
|
||||
UNUSED_PARAMETER(vptr);
|
||||
|
||||
int fd;
|
||||
fd_set fds;
|
||||
struct timeval tv;
|
||||
struct udev *udev;
|
||||
struct udev_monitor *mon;
|
||||
struct udev_device *dev;
|
||||
|
||||
/* set up udev monitoring */
|
||||
udev = udev_new();
|
||||
mon = udev_monitor_new_from_netlink(udev, "udev");
|
||||
udev_monitor_filter_add_match_subsystem_devtype(
|
||||
mon, "video4linux", NULL);
|
||||
if (udev_monitor_enable_receiving(mon) < 0)
|
||||
return NULL;
|
||||
|
||||
/* set up fds */
|
||||
fd = udev_monitor_get_fd(mon);
|
||||
|
||||
while (os_event_try(udev_event) == EAGAIN) {
|
||||
FD_ZERO(&fds);
|
||||
FD_SET(fd, &fds);
|
||||
tv.tv_sec = 1;
|
||||
tv.tv_usec = 0;
|
||||
|
||||
if (select(fd + 1, &fds, NULL, NULL, &tv) <= 0)
|
||||
continue;
|
||||
|
||||
dev = udev_monitor_receive_device(mon);
|
||||
if (!dev)
|
||||
continue;
|
||||
|
||||
udev_call_callbacks(dev);
|
||||
|
||||
udev_device_unref(dev);
|
||||
}
|
||||
|
||||
udev_monitor_unref(mon);
|
||||
udev_unref(udev);
|
||||
|
||||
return NULL;
|
||||
}
|
||||
|
||||
void *v4l2_init_udev(void)
|
||||
{
|
||||
struct v4l2_udev_mon_t *ret = NULL;
|
||||
|
||||
pthread_mutex_lock(&udev_mutex);
|
||||
|
||||
/* set up udev */
|
||||
if (udev_refs == 0) {
|
||||
if (os_event_init(&udev_event, OS_EVENT_TYPE_MANUAL) != 0)
|
||||
goto fail;
|
||||
if (pthread_create(&udev_thread, NULL, udev_event_thread,
|
||||
NULL) != 0)
|
||||
goto fail;
|
||||
da_init(udev_clients);
|
||||
}
|
||||
udev_refs++;
|
||||
|
||||
/* create monitor object */
|
||||
ret = da_push_back_new(udev_clients);
|
||||
fail:
|
||||
pthread_mutex_unlock(&udev_mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
void v4l2_unref_udev(void *monitor)
|
||||
{
|
||||
UDEV_DATA(monitor);
|
||||
pthread_mutex_lock(&udev_mutex);
|
||||
|
||||
/* clean up monitor object */
|
||||
da_erase_item(udev_clients, m);
|
||||
|
||||
/* unref udev monitor */
|
||||
udev_refs--;
|
||||
if (udev_refs == 0) {
|
||||
os_event_signal(udev_event);
|
||||
pthread_join(udev_thread, NULL);
|
||||
os_event_destroy(udev_event);
|
||||
da_free(udev_clients);
|
||||
}
|
||||
|
||||
pthread_mutex_unlock(&udev_mutex);
|
||||
}
|
||||
|
||||
void v4l2_set_device_added_callback(void *monitor, v4l2_device_added_cb cb,
|
||||
void *userdata)
|
||||
{
|
||||
UDEV_DATA(monitor);
|
||||
if (!m)
|
||||
return;
|
||||
|
||||
m->dev_added_cb = cb;
|
||||
m->dev_added_userdata = userdata;
|
||||
}
|
||||
|
||||
void v4l2_set_device_removed_callback(void *monitor, v4l2_device_removed_cb cb,
|
||||
void *userdata)
|
||||
{
|
||||
UDEV_DATA(monitor);
|
||||
if (!m)
|
||||
return;
|
||||
|
||||
m->dev_removed_cb = cb;
|
||||
m->dev_removed_userdata = userdata;
|
||||
}
|
|
@ -0,0 +1,80 @@
|
|||
/*
|
||||
Copyright (C) 2014 by Leonhard Oelke <leonhard@in-verted.de>
|
||||
|
||||
This program is free software: you can redistribute it and/or modify
|
||||
it under the terms of the GNU General Public License as published by
|
||||
the Free Software Foundation, either version 2 of the License, or
|
||||
(at your option) any later version.
|
||||
|
||||
This program 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 General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#pragma once
|
||||
|
||||
#include <inttypes.h>
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/**
|
||||
* Initialize udev system to watch for device events
|
||||
*
|
||||
* @return monitor object, or NULL on error
|
||||
*/
|
||||
void *v4l2_init_udev(void);
|
||||
|
||||
/**
|
||||
* Unref the udev system
|
||||
*
|
||||
* This will also remove any registered callbacks if there are any
|
||||
*
|
||||
* @param monitor monitor object
|
||||
*/
|
||||
void v4l2_unref_udev(void *monitor);
|
||||
|
||||
/**
|
||||
* Callback when a device was added.
|
||||
*
|
||||
* @param dev device node of the device that was added
|
||||
* @param userdata pointer to userdata specified when registered
|
||||
*/
|
||||
typedef void (*v4l2_device_added_cb)(const char *dev, void *userdata);
|
||||
|
||||
/**
|
||||
* Callback when a device was removed.
|
||||
*
|
||||
* @param dev device node of the device that was removed
|
||||
* @param userdata pointer to userdata specified when registered
|
||||
*/
|
||||
typedef void (*v4l2_device_removed_cb)(const char *dev, void *userdata);
|
||||
|
||||
/**
|
||||
* Register the device added callback
|
||||
*
|
||||
* @param monitor monitor object
|
||||
* @param cb the function that should be called
|
||||
* @param userdata pointer to userdata that should be passed to the callback
|
||||
*/
|
||||
void v4l2_set_device_added_callback(void *monitor, v4l2_device_added_cb cb,
|
||||
void *userdata);
|
||||
|
||||
/**
|
||||
* Register the device remove callback
|
||||
*
|
||||
* @param monitor monitor object
|
||||
* @param cb the function that should be called
|
||||
* @param userdata pointer to userdata that should be passed to the callback
|
||||
*/
|
||||
void v4l2_set_device_removed_callback(void *monitor, v4l2_device_removed_cb cb,
|
||||
void *userdata);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
Loading…
Reference in New Issue