mirror of
https://gitlab.freedesktop.org/pipewire/pipewire.git
synced 2025-12-16 08:56:45 -05:00
v4l2: add inotify support
Wait with inotify until we can access the device node before emiting the new device. Clean up alsa-udev and make it more like v4l2-udev
This commit is contained in:
parent
69da2ec601
commit
22c793aa87
2 changed files with 292 additions and 140 deletions
|
|
@ -29,7 +29,6 @@
|
||||||
#include <sys/stat.h>
|
#include <sys/stat.h>
|
||||||
#include <sys/inotify.h>
|
#include <sys/inotify.h>
|
||||||
#include <fcntl.h>
|
#include <fcntl.h>
|
||||||
#include <poll.h>
|
|
||||||
|
|
||||||
#include <libudev.h>
|
#include <libudev.h>
|
||||||
#include <alsa/asoundlib.h>
|
#include <alsa/asoundlib.h>
|
||||||
|
|
@ -46,13 +45,12 @@
|
||||||
|
|
||||||
#define NAME "alsa-udev"
|
#define NAME "alsa-udev"
|
||||||
|
|
||||||
#define MAX_CARDS 64
|
#define MAX_DEVICES 64
|
||||||
|
|
||||||
#define ACTION_ADD 0
|
#define ACTION_ADD 0
|
||||||
#define ACTION_CHANGE 1
|
#define ACTION_REMOVE 1
|
||||||
#define ACTION_REMOVE 2
|
|
||||||
|
|
||||||
struct card {
|
struct device {
|
||||||
uint32_t id;
|
uint32_t id;
|
||||||
struct udev_device *dev;
|
struct udev_device *dev;
|
||||||
unsigned int accessible:1;
|
unsigned int accessible:1;
|
||||||
|
|
@ -75,8 +73,8 @@ struct impl {
|
||||||
struct udev *udev;
|
struct udev *udev;
|
||||||
struct udev_monitor *umonitor;
|
struct udev_monitor *umonitor;
|
||||||
|
|
||||||
struct card cards[MAX_CARDS];
|
struct device devices[MAX_DEVICES];
|
||||||
uint32_t n_cards;
|
uint32_t n_devices;
|
||||||
|
|
||||||
struct spa_source source;
|
struct spa_source source;
|
||||||
struct spa_source notify;
|
struct spa_source notify;
|
||||||
|
|
@ -101,50 +99,59 @@ static int impl_udev_close(struct impl *this)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct card *add_card(struct impl *this, uint32_t id, struct udev_device *dev)
|
static struct device *add_device(struct impl *this, uint32_t id, struct udev_device *dev)
|
||||||
{
|
{
|
||||||
struct card *card;
|
struct device *device;
|
||||||
|
|
||||||
if (this->n_cards >= MAX_CARDS)
|
if (this->n_devices >= MAX_DEVICES)
|
||||||
return NULL;
|
return NULL;
|
||||||
card = &this->cards[this->n_cards++];
|
device = &this->devices[this->n_devices++];
|
||||||
spa_zero(*card);
|
spa_zero(*device);
|
||||||
card->id = id;
|
device->id = id;
|
||||||
udev_device_ref(dev);
|
udev_device_ref(dev);
|
||||||
card->dev = dev;
|
device->dev = dev;
|
||||||
return card;
|
return device;
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct card *find_card(struct impl *this, uint32_t id)
|
static struct device *find_device(struct impl *this, uint32_t id)
|
||||||
{
|
{
|
||||||
uint32_t i;
|
uint32_t i;
|
||||||
for (i = 0; i < this->n_cards; i++) {
|
for (i = 0; i < this->n_devices; i++) {
|
||||||
if (this->cards[i].id == id)
|
if (this->devices[i].id == id)
|
||||||
return &this->cards[i];
|
return &this->devices[i];
|
||||||
}
|
}
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void remove_card(struct impl *this, struct card *card)
|
static void remove_device(struct impl *this, struct device *device)
|
||||||
{
|
{
|
||||||
udev_device_unref(card->dev);
|
udev_device_unref(device->dev);
|
||||||
*card = this->cards[--this->n_cards];
|
*device = this->devices[--this->n_devices];
|
||||||
}
|
}
|
||||||
|
|
||||||
static const char *path_get_card_id(const char *path)
|
static uint32_t get_card_id(struct impl *this, struct udev_device *dev)
|
||||||
{
|
{
|
||||||
const char *e;
|
const char *e, *str;
|
||||||
|
|
||||||
if (!path)
|
if (udev_device_get_property_value(dev, "ACP_IGNORE"))
|
||||||
return NULL;
|
return SPA_ID_INVALID;
|
||||||
|
|
||||||
if (!(e = strrchr(path, '/')))
|
if ((str = udev_device_get_property_value(dev, "SOUND_CLASS")) && strcmp(str, "modem") == 0)
|
||||||
return NULL;
|
return SPA_ID_INVALID;
|
||||||
|
|
||||||
|
if ((str = udev_device_get_property_value(dev, "SOUND_INITIALIZED")) == NULL)
|
||||||
|
return SPA_ID_INVALID;
|
||||||
|
|
||||||
|
if ((str = udev_device_get_property_value(dev, "DEVPATH")) == NULL)
|
||||||
|
return SPA_ID_INVALID;
|
||||||
|
|
||||||
|
if ((e = strrchr(str, '/')) == NULL)
|
||||||
|
return SPA_ID_INVALID;
|
||||||
|
|
||||||
if (strlen(e) <= 5 || strncmp(e, "/card", 5) != 0)
|
if (strlen(e) <= 5 || strncmp(e, "/card", 5) != 0)
|
||||||
return NULL;
|
return SPA_ID_INVALID;
|
||||||
|
|
||||||
return e + 5;
|
return atoi(e + 5);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int dehex(char x)
|
static int dehex(char x)
|
||||||
|
|
@ -227,19 +234,17 @@ static void unescape(const char *src, char *dst)
|
||||||
*d = 0;
|
*d = 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int emit_object_info(struct impl *this, uint32_t id, struct udev_device *dev)
|
static int emit_object_info(struct impl *this, struct device *device)
|
||||||
{
|
{
|
||||||
struct spa_device_object_info info;
|
struct spa_device_object_info info;
|
||||||
|
uint32_t id = device->id;
|
||||||
|
struct udev_device *dev = device->dev;
|
||||||
snd_ctl_t *ctl_hndl;
|
snd_ctl_t *ctl_hndl;
|
||||||
const char *str;
|
const char *str;
|
||||||
char path[32];
|
char path[32];
|
||||||
struct spa_dict_item items[23];
|
struct spa_dict_item items[23];
|
||||||
uint32_t n_items = 0;
|
uint32_t n_items = 0;
|
||||||
int res, pcm;
|
int res, pcm;
|
||||||
struct card *card;
|
|
||||||
|
|
||||||
if ((card = find_card(this, id)) == NULL)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
snprintf(path, sizeof(path), "hw:%u", id);
|
snprintf(path, sizeof(path), "hw:%u", id);
|
||||||
spa_log_debug(this->log, "open card %s", path);
|
spa_log_debug(this->log, "open card %s", path);
|
||||||
|
|
@ -258,12 +263,12 @@ static int emit_object_info(struct impl *this, uint32_t id, struct udev_device *
|
||||||
|
|
||||||
if (res < 0) {
|
if (res < 0) {
|
||||||
spa_log_error(this->log, "error iterating devices: %s", snd_strerror(res));
|
spa_log_error(this->log, "error iterating devices: %s", snd_strerror(res));
|
||||||
card->ignored = true;
|
device->ignored = true;
|
||||||
return res;
|
return res;
|
||||||
}
|
}
|
||||||
if (pcm < 0) {
|
if (pcm < 0) {
|
||||||
spa_log_debug(this->log, "no pcm devices for %s", path);
|
spa_log_debug(this->log, "no pcm devices for %s", path);
|
||||||
card->ignored = true;
|
device->ignored = true;
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -356,98 +361,55 @@ static int emit_object_info(struct impl *this, uint32_t id, struct udev_device *
|
||||||
info.props = &SPA_DICT_INIT(items, n_items);
|
info.props = &SPA_DICT_INIT(items, n_items);
|
||||||
|
|
||||||
spa_device_emit_object_info(&this->hooks, id, &info);
|
spa_device_emit_object_info(&this->hooks, id, &info);
|
||||||
card->emited = true;
|
device->emited = true;
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
static bool check_access(struct impl *this, struct card *card)
|
static bool check_access(struct impl *this, struct device *device)
|
||||||
{
|
{
|
||||||
char path[128];
|
char path[128];
|
||||||
|
|
||||||
snprintf(path, sizeof(path)-1, "/dev/snd/controlC%u", card->id);
|
snprintf(path, sizeof(path)-1, "/dev/snd/controlC%u", device->id);
|
||||||
card->accessible = access(path, R_OK|W_OK) >= 0;
|
device->accessible = access(path, R_OK|W_OK) >= 0;
|
||||||
spa_log_debug(this->log, "%s accessible:%u", path, card->accessible);
|
spa_log_debug(this->log, "%s accessible:%u", path, device->accessible);
|
||||||
|
|
||||||
return card->accessible;
|
return device->accessible;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int need_notify(struct impl *this, struct udev_device *dev, uint32_t action, bool enumerated,
|
static void process_device(struct impl *this, uint32_t action, struct udev_device *dev)
|
||||||
uint32_t *obj_id)
|
|
||||||
{
|
{
|
||||||
const char *str;
|
|
||||||
uint32_t id;
|
uint32_t id;
|
||||||
struct card *card;
|
struct device *device;
|
||||||
bool emited;
|
bool emited;
|
||||||
|
|
||||||
if (udev_device_get_property_value(dev, "ACP_IGNORE"))
|
if ((id = get_card_id(this, dev)) == SPA_ID_INVALID)
|
||||||
return 0;
|
return;
|
||||||
|
|
||||||
if ((str = udev_device_get_property_value(dev, "SOUND_CLASS")) && strcmp(str, "modem") == 0)
|
device = find_device(this, id);
|
||||||
return 0;
|
if (device && device->ignored)
|
||||||
|
return;
|
||||||
if ((str = path_get_card_id(udev_device_get_property_value(dev, "DEVPATH"))) == NULL)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
id = atoi(str);
|
|
||||||
card = find_card(this, id);
|
|
||||||
if (card && card->ignored)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
switch (action) {
|
switch (action) {
|
||||||
case ACTION_ADD:
|
case ACTION_ADD:
|
||||||
if (card != NULL)
|
if (device == NULL)
|
||||||
return 0;
|
device = add_device(this, id, dev);
|
||||||
if ((card = add_card(this, id, dev)) == NULL)
|
if (device == NULL)
|
||||||
return 0;
|
return;
|
||||||
/** don't notify on add, wait for the next change event */
|
if (!check_access(this, device))
|
||||||
if (!enumerated)
|
return;
|
||||||
return 0;
|
emit_object_info(this, device);
|
||||||
if (!check_access(this, card))
|
|
||||||
return 0;
|
|
||||||
break;
|
|
||||||
|
|
||||||
case ACTION_CHANGE:
|
|
||||||
if (card == NULL)
|
|
||||||
return 0;
|
|
||||||
if ((str = udev_device_get_property_value(dev, "SOUND_INITIALIZED")) == NULL)
|
|
||||||
return 0;
|
|
||||||
if (!check_access(this, card))
|
|
||||||
return 0;
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case ACTION_REMOVE:
|
case ACTION_REMOVE:
|
||||||
if (card == NULL)
|
if (device == NULL)
|
||||||
return 0;
|
return;
|
||||||
emited = card->emited;
|
emited = device->emited;
|
||||||
remove_card(this, card);
|
remove_device(this, device);
|
||||||
if (!emited)
|
if (emited)
|
||||||
return 0;
|
spa_device_emit_object_info(&this->hooks, id, NULL);
|
||||||
break;
|
|
||||||
default:
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
*obj_id = id;
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int emit_device(struct impl *this, uint32_t action, bool enumerated, struct udev_device *dev)
|
|
||||||
{
|
|
||||||
uint32_t id;
|
|
||||||
|
|
||||||
if (!need_notify(this, dev, action, enumerated, &id))
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
switch (action) {
|
|
||||||
case ACTION_ADD:
|
|
||||||
case ACTION_CHANGE:
|
|
||||||
emit_object_info(this, id, dev);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
spa_device_emit_object_info(&this->hooks, id, NULL);
|
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int stop_inotify(struct impl *this)
|
static int stop_inotify(struct impl *this)
|
||||||
|
|
@ -486,17 +448,17 @@ static void impl_on_notify_events(struct spa_source *source)
|
||||||
for (p = &buf; p < e;
|
for (p = &buf; p < e;
|
||||||
p = SPA_MEMBER(p, sizeof(struct inotify_event) + event->len, void)) {
|
p = SPA_MEMBER(p, sizeof(struct inotify_event) + event->len, void)) {
|
||||||
unsigned int id;
|
unsigned int id;
|
||||||
struct card *card;
|
struct device *device;
|
||||||
|
|
||||||
event = (const struct inotify_event *) p;
|
event = (const struct inotify_event *) p;
|
||||||
|
|
||||||
if ((event->mask & IN_ATTRIB)) {
|
if ((event->mask & IN_ATTRIB)) {
|
||||||
if (sscanf(event->name, "controlC%u", &id) != 1)
|
if (sscanf(event->name, "controlC%u", &id) != 1)
|
||||||
continue;
|
continue;
|
||||||
if ((card = find_card(this, id)) == NULL)
|
if ((device = find_device(this, id)) == NULL)
|
||||||
continue;
|
continue;
|
||||||
if (!card->emited)
|
if (!device->emited)
|
||||||
emit_device(this, ACTION_CHANGE, false, card->dev);
|
process_device(this, ACTION_ADD, device->dev);
|
||||||
}
|
}
|
||||||
/* /dev/snd/ might have been removed */
|
/* /dev/snd/ might have been removed */
|
||||||
if ((event->mask & (IN_DELETE_SELF | IN_MOVE_SELF)))
|
if ((event->mask & (IN_DELETE_SELF | IN_MOVE_SELF)))
|
||||||
|
|
@ -546,11 +508,10 @@ static void impl_on_fd_events(struct spa_source *source)
|
||||||
struct impl *this = source->data;
|
struct impl *this = source->data;
|
||||||
struct udev_device *dev;
|
struct udev_device *dev;
|
||||||
const char *action;
|
const char *action;
|
||||||
uint32_t a;
|
|
||||||
|
|
||||||
dev = udev_monitor_receive_device(this->umonitor);
|
dev = udev_monitor_receive_device(this->umonitor);
|
||||||
if (dev == NULL)
|
if (dev == NULL)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
if ((action = udev_device_get_action(dev)) == NULL)
|
if ((action = udev_device_get_action(dev)) == NULL)
|
||||||
action = "change";
|
action = "change";
|
||||||
|
|
@ -559,17 +520,11 @@ static void impl_on_fd_events(struct spa_source *source)
|
||||||
|
|
||||||
start_inotify(this);
|
start_inotify(this);
|
||||||
|
|
||||||
if (strcmp(action, "add") == 0) {
|
if (strcmp(action, "change") == 0) {
|
||||||
a = ACTION_ADD;
|
process_device(this, ACTION_ADD, dev);
|
||||||
} else if (strcmp(action, "change") == 0) {
|
|
||||||
a = ACTION_CHANGE;
|
|
||||||
} else if (strcmp(action, "remove") == 0) {
|
} else if (strcmp(action, "remove") == 0) {
|
||||||
a = ACTION_REMOVE;
|
process_device(this, ACTION_REMOVE, dev);
|
||||||
} else
|
}
|
||||||
return;
|
|
||||||
|
|
||||||
emit_device(this, a, false, dev);
|
|
||||||
|
|
||||||
udev_device_unref(dev);
|
udev_device_unref(dev);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -593,6 +548,7 @@ static int start_monitor(struct impl *this)
|
||||||
this->source.fd = udev_monitor_get_fd(this->umonitor);;
|
this->source.fd = udev_monitor_get_fd(this->umonitor);;
|
||||||
this->source.mask = SPA_IO_IN | SPA_IO_ERR;
|
this->source.mask = SPA_IO_IN | SPA_IO_ERR;
|
||||||
|
|
||||||
|
spa_log_debug(this->log, "monitor %p", this->umonitor);
|
||||||
spa_loop_add_source(this->main_loop, &this->source);
|
spa_loop_add_source(this->main_loop, &this->source);
|
||||||
|
|
||||||
if ((res = start_inotify(this)) < 0)
|
if ((res = start_inotify(this)) < 0)
|
||||||
|
|
@ -635,7 +591,7 @@ static int enum_devices(struct impl *this)
|
||||||
if (dev == NULL)
|
if (dev == NULL)
|
||||||
continue;
|
continue;
|
||||||
|
|
||||||
emit_device(this, ACTION_ADD, true, dev);
|
process_device(this, ACTION_ADD, dev);
|
||||||
|
|
||||||
udev_device_unref(dev);
|
udev_device_unref(dev);
|
||||||
}
|
}
|
||||||
|
|
@ -726,7 +682,7 @@ static int impl_get_interface(struct spa_handle *handle, const char *type, void
|
||||||
|
|
||||||
static int impl_clear(struct spa_handle *handle)
|
static int impl_clear(struct spa_handle *handle)
|
||||||
{
|
{
|
||||||
struct impl *this = (struct impl *) handle;
|
struct impl *this = (struct impl *) handle;
|
||||||
stop_monitor(this);
|
stop_monitor(this);
|
||||||
impl_udev_close(this);
|
impl_udev_close(this);
|
||||||
return 0;
|
return 0;
|
||||||
|
|
|
||||||
|
|
@ -22,26 +22,42 @@
|
||||||
* DEALINGS IN THE SOFTWARE.
|
* DEALINGS IN THE SOFTWARE.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <errno.h>
|
|
||||||
#include <stddef.h>
|
#include <stddef.h>
|
||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <limits.h>
|
||||||
#include <sys/types.h>
|
#include <sys/types.h>
|
||||||
#include <sys/stat.h>
|
#include <sys/stat.h>
|
||||||
|
#include <sys/inotify.h>
|
||||||
#include <fcntl.h>
|
#include <fcntl.h>
|
||||||
|
|
||||||
#include <libudev.h>
|
#include <libudev.h>
|
||||||
|
|
||||||
#include <spa/support/log.h>
|
#include <spa/support/log.h>
|
||||||
#include <spa/support/loop.h>
|
|
||||||
#include <spa/support/plugin.h>
|
|
||||||
#include <spa/utils/type.h>
|
#include <spa/utils/type.h>
|
||||||
#include <spa/utils/keys.h>
|
#include <spa/utils/keys.h>
|
||||||
#include <spa/utils/names.h>
|
#include <spa/utils/names.h>
|
||||||
|
#include <spa/utils/result.h>
|
||||||
|
#include <spa/support/loop.h>
|
||||||
|
#include <spa/support/plugin.h>
|
||||||
#include <spa/monitor/device.h>
|
#include <spa/monitor/device.h>
|
||||||
#include <spa/monitor/utils.h>
|
#include <spa/monitor/utils.h>
|
||||||
|
|
||||||
#define NAME "v4l2-udev"
|
#define NAME "v4l2-udev"
|
||||||
|
|
||||||
|
#define MAX_DEVICES 64
|
||||||
|
|
||||||
|
#define ACTION_ADD 0
|
||||||
|
#define ACTION_REMOVE 1
|
||||||
|
|
||||||
|
struct device {
|
||||||
|
uint32_t id;
|
||||||
|
struct udev_device *dev;
|
||||||
|
unsigned int accessible:1;
|
||||||
|
unsigned int ignored:1;
|
||||||
|
unsigned int emited:1;
|
||||||
|
};
|
||||||
|
|
||||||
struct impl {
|
struct impl {
|
||||||
struct spa_handle handle;
|
struct spa_handle handle;
|
||||||
struct spa_device device;
|
struct spa_device device;
|
||||||
|
|
@ -57,7 +73,11 @@ struct impl {
|
||||||
struct udev *udev;
|
struct udev *udev;
|
||||||
struct udev_monitor *umonitor;
|
struct udev_monitor *umonitor;
|
||||||
|
|
||||||
|
struct device devices[MAX_DEVICES];
|
||||||
|
uint32_t n_devices;
|
||||||
|
|
||||||
struct spa_source source;
|
struct spa_source source;
|
||||||
|
struct spa_source notify;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int impl_udev_open(struct impl *this)
|
static int impl_udev_open(struct impl *this)
|
||||||
|
|
@ -69,6 +89,7 @@ static int impl_udev_open(struct impl *this)
|
||||||
}
|
}
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int impl_udev_close(struct impl *this)
|
static int impl_udev_close(struct impl *this)
|
||||||
{
|
{
|
||||||
if (this->udev != NULL)
|
if (this->udev != NULL)
|
||||||
|
|
@ -77,6 +98,36 @@ static int impl_udev_close(struct impl *this)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static struct device *add_device(struct impl *this, uint32_t id, struct udev_device *dev)
|
||||||
|
{
|
||||||
|
struct device *device;
|
||||||
|
|
||||||
|
if (this->n_devices >= MAX_DEVICES)
|
||||||
|
return NULL;
|
||||||
|
device = &this->devices[this->n_devices++];
|
||||||
|
spa_zero(*device);
|
||||||
|
device->id = id;
|
||||||
|
udev_device_ref(dev);
|
||||||
|
device->dev = dev;
|
||||||
|
return device;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct device *find_device(struct impl *this, uint32_t id)
|
||||||
|
{
|
||||||
|
uint32_t i;
|
||||||
|
for (i = 0; i < this->n_devices; i++) {
|
||||||
|
if (this->devices[i].id == id)
|
||||||
|
return &this->devices[i];
|
||||||
|
}
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void remove_device(struct impl *this, struct device *device)
|
||||||
|
{
|
||||||
|
udev_device_unref(device->dev);
|
||||||
|
*device = this->devices[--this->n_devices];
|
||||||
|
}
|
||||||
|
|
||||||
static uint32_t get_device_id(struct impl *this, struct udev_device *dev)
|
static uint32_t get_device_id(struct impl *this, struct udev_device *dev)
|
||||||
{
|
{
|
||||||
const char *str;
|
const char *str;
|
||||||
|
|
@ -173,9 +224,11 @@ static void unescape(const char *src, char *dst)
|
||||||
*d = 0;
|
*d = 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int emit_object_info(struct impl *this, uint32_t id, struct udev_device *dev)
|
static int emit_object_info(struct impl *this, struct device *device)
|
||||||
{
|
{
|
||||||
struct spa_device_object_info info;
|
struct spa_device_object_info info;
|
||||||
|
uint32_t id = device->id;
|
||||||
|
struct udev_device *dev = device->dev;
|
||||||
const char *str;
|
const char *str;
|
||||||
struct spa_dict_item items[20];
|
struct spa_dict_item items[20];
|
||||||
uint32_t n_items = 0;
|
uint32_t n_items = 0;
|
||||||
|
|
@ -261,38 +314,178 @@ static int emit_object_info(struct impl *this, uint32_t id, struct udev_device *
|
||||||
}
|
}
|
||||||
info.props = &SPA_DICT_INIT(items, n_items);
|
info.props = &SPA_DICT_INIT(items, n_items);
|
||||||
spa_device_emit_object_info(&this->hooks, id, &info);
|
spa_device_emit_object_info(&this->hooks, id, &info);
|
||||||
|
device->emited = true;
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static bool check_access(struct impl *this, struct device *device)
|
||||||
|
{
|
||||||
|
char path[128];
|
||||||
|
|
||||||
|
snprintf(path, sizeof(path)-1, "/dev/video%u", device->id);
|
||||||
|
device->accessible = access(path, R_OK|W_OK) >= 0;
|
||||||
|
spa_log_debug(this->log, "%s accessible:%u", path, device->accessible);
|
||||||
|
|
||||||
|
return device->accessible;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void process_device(struct impl *this, uint32_t action, struct udev_device *dev)
|
||||||
|
{
|
||||||
|
uint32_t id;
|
||||||
|
struct device *device;
|
||||||
|
bool emited;
|
||||||
|
|
||||||
|
if ((id = get_device_id(this, dev)) == SPA_ID_INVALID)
|
||||||
|
return;
|
||||||
|
|
||||||
|
device = find_device(this, id);
|
||||||
|
if (device && device->ignored)
|
||||||
|
return;
|
||||||
|
|
||||||
|
switch (action) {
|
||||||
|
case ACTION_ADD:
|
||||||
|
if (device == NULL)
|
||||||
|
device = add_device(this, id, dev);
|
||||||
|
if (device == NULL)
|
||||||
|
return;
|
||||||
|
if (!check_access(this, device))
|
||||||
|
return;
|
||||||
|
emit_object_info(this, device);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case ACTION_REMOVE:
|
||||||
|
if (device == NULL)
|
||||||
|
return;
|
||||||
|
emited = device->emited;
|
||||||
|
remove_device(this, device);
|
||||||
|
if (emited)
|
||||||
|
spa_device_emit_object_info(&this->hooks, id, NULL);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static int stop_inotify(struct impl *this)
|
||||||
|
{
|
||||||
|
if (this->notify.fd == -1)
|
||||||
|
return 0;
|
||||||
|
spa_log_info(this->log, "stop inotify");
|
||||||
|
spa_loop_remove_source(this->main_loop, &this->notify);
|
||||||
|
close(this->notify.fd);
|
||||||
|
this->notify.fd = -1;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void impl_on_notify_events(struct spa_source *source)
|
||||||
|
{
|
||||||
|
bool deleted = false;
|
||||||
|
struct impl *this = source->data;
|
||||||
|
struct {
|
||||||
|
struct inotify_event e;
|
||||||
|
char name[NAME_MAX+1];
|
||||||
|
} buf;
|
||||||
|
|
||||||
|
while (true) {
|
||||||
|
ssize_t len;
|
||||||
|
const struct inotify_event *event;
|
||||||
|
void *p, *e;
|
||||||
|
|
||||||
|
len = read(source->fd, &buf, sizeof(buf));
|
||||||
|
if (len < 0 && errno != EAGAIN)
|
||||||
|
break;
|
||||||
|
if (len <= 0)
|
||||||
|
break;
|
||||||
|
|
||||||
|
e = SPA_MEMBER(&buf, len, void);
|
||||||
|
|
||||||
|
for (p = &buf; p < e;
|
||||||
|
p = SPA_MEMBER(p, sizeof(struct inotify_event) + event->len, void)) {
|
||||||
|
unsigned int id;
|
||||||
|
struct device *device;
|
||||||
|
|
||||||
|
event = (const struct inotify_event *) p;
|
||||||
|
|
||||||
|
if ((event->mask & IN_ATTRIB)) {
|
||||||
|
if (sscanf(event->name, "video%u", &id) != 1)
|
||||||
|
continue;
|
||||||
|
if ((device = find_device(this, id)) == NULL)
|
||||||
|
continue;
|
||||||
|
if (!device->emited)
|
||||||
|
process_device(this, ACTION_ADD, device->dev);
|
||||||
|
}
|
||||||
|
/* /dev/ might have been removed */
|
||||||
|
if ((event->mask & (IN_DELETE_SELF | IN_MOVE_SELF)))
|
||||||
|
deleted = true;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if (deleted)
|
||||||
|
stop_inotify(this);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int start_inotify(struct impl *this)
|
||||||
|
{
|
||||||
|
int res, notify_fd;
|
||||||
|
|
||||||
|
if (this->notify.fd != -1)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
if ((notify_fd = inotify_init1(IN_CLOEXEC | IN_NONBLOCK)) < 0)
|
||||||
|
return -errno;
|
||||||
|
|
||||||
|
res = inotify_add_watch(notify_fd, "/dev",
|
||||||
|
IN_ATTRIB | IN_CLOSE_WRITE | IN_DELETE_SELF | IN_MOVE_SELF);
|
||||||
|
if (res < 0) {
|
||||||
|
res = -errno;
|
||||||
|
close(notify_fd);
|
||||||
|
|
||||||
|
if (res == -ENOENT) {
|
||||||
|
spa_log_debug(this->log, "/dev/ does not exist yet");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
spa_log_error(this->log, "inotify_add_watch() failed: %s", spa_strerror(res));
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
spa_log_info(this->log, "start inotify");
|
||||||
|
this->notify.func = impl_on_notify_events;
|
||||||
|
this->notify.data = this;
|
||||||
|
this->notify.fd = notify_fd;
|
||||||
|
this->notify.mask = SPA_IO_IN | SPA_IO_ERR;
|
||||||
|
|
||||||
|
spa_loop_add_source(this->main_loop, &this->notify);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
static void impl_on_fd_events(struct spa_source *source)
|
static void impl_on_fd_events(struct spa_source *source)
|
||||||
{
|
{
|
||||||
struct impl *this = source->data;
|
struct impl *this = source->data;
|
||||||
struct udev_device *dev;
|
struct udev_device *dev;
|
||||||
const char *action;
|
const char *action;
|
||||||
uint32_t id;
|
|
||||||
|
|
||||||
dev = udev_monitor_receive_device(this->umonitor);
|
dev = udev_monitor_receive_device(this->umonitor);
|
||||||
if (dev == NULL)
|
if (dev == NULL)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
if ((id = get_device_id(this, dev)) == SPA_ID_INVALID)
|
|
||||||
return;
|
|
||||||
|
|
||||||
if ((action = udev_device_get_action(dev)) == NULL)
|
if ((action = udev_device_get_action(dev)) == NULL)
|
||||||
action = "change";
|
action = "change";
|
||||||
|
|
||||||
|
spa_log_debug(this->log, "action %s", action);
|
||||||
|
|
||||||
|
start_inotify(this);
|
||||||
|
|
||||||
if (strcmp(action, "add") == 0 ||
|
if (strcmp(action, "add") == 0 ||
|
||||||
strcmp(action, "change") == 0) {
|
strcmp(action, "change") == 0) {
|
||||||
emit_object_info(this, id, dev);
|
process_device(this, ACTION_ADD, dev);
|
||||||
} else {
|
} else if (strcmp(action, "remove") == 0) {
|
||||||
spa_device_emit_object_info(&this->hooks, id, NULL);
|
process_device(this, ACTION_REMOVE, dev);
|
||||||
}
|
}
|
||||||
udev_device_unref(dev);
|
udev_device_unref(dev);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int start_monitor(struct impl *this)
|
static int start_monitor(struct impl *this)
|
||||||
{
|
{
|
||||||
|
int res;
|
||||||
|
|
||||||
if (this->umonitor != NULL)
|
if (this->umonitor != NULL)
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
|
|
@ -312,6 +505,9 @@ static int start_monitor(struct impl *this)
|
||||||
spa_log_debug(this->log, "monitor %p", this->umonitor);
|
spa_log_debug(this->log, "monitor %p", this->umonitor);
|
||||||
spa_loop_add_source(this->main_loop, &this->source);
|
spa_loop_add_source(this->main_loop, &this->source);
|
||||||
|
|
||||||
|
if ((res = start_inotify(this)) < 0)
|
||||||
|
return res;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -323,6 +519,9 @@ static int stop_monitor(struct impl *this)
|
||||||
spa_loop_remove_source(this->main_loop, &this->source);
|
spa_loop_remove_source(this->main_loop, &this->source);
|
||||||
udev_monitor_unref(this->umonitor);
|
udev_monitor_unref(this->umonitor);
|
||||||
this->umonitor = NULL;
|
this->umonitor = NULL;
|
||||||
|
|
||||||
|
stop_inotify(this);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -341,14 +540,12 @@ static int enum_devices(struct impl *this)
|
||||||
for (devices = udev_enumerate_get_list_entry(enumerate); devices;
|
for (devices = udev_enumerate_get_list_entry(enumerate); devices;
|
||||||
devices = udev_list_entry_get_next(devices)) {
|
devices = udev_list_entry_get_next(devices)) {
|
||||||
struct udev_device *dev;
|
struct udev_device *dev;
|
||||||
uint32_t id;
|
|
||||||
|
|
||||||
dev = udev_device_new_from_syspath(this->udev, udev_list_entry_get_name(devices));
|
dev = udev_device_new_from_syspath(this->udev, udev_list_entry_get_name(devices));
|
||||||
if (dev == NULL)
|
if (dev == NULL)
|
||||||
continue;
|
continue;
|
||||||
|
|
||||||
if ((id = get_device_id(this, dev)) != SPA_ID_INVALID)
|
process_device(this, ACTION_ADD, dev);
|
||||||
emit_object_info(this, id, dev);
|
|
||||||
|
|
||||||
udev_device_unref(dev);
|
udev_device_unref(dev);
|
||||||
}
|
}
|
||||||
|
|
@ -363,7 +560,6 @@ static const struct spa_dict_item device_info_items[] = {
|
||||||
{ SPA_KEY_API_UDEV_MATCH, "video4linux" },
|
{ SPA_KEY_API_UDEV_MATCH, "video4linux" },
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
static void emit_device_info(struct impl *this, bool full)
|
static void emit_device_info(struct impl *this, bool full)
|
||||||
{
|
{
|
||||||
if (full)
|
if (full)
|
||||||
|
|
@ -469,6 +665,7 @@ impl_init(const struct spa_handle_factory *factory,
|
||||||
handle->clear = impl_clear;
|
handle->clear = impl_clear;
|
||||||
|
|
||||||
this = (struct impl *) handle;
|
this = (struct impl *) handle;
|
||||||
|
this->notify.fd = -1;
|
||||||
|
|
||||||
this->log = spa_support_find(support, n_support, SPA_TYPE_INTERFACE_Log);
|
this->log = spa_support_find(support, n_support, SPA_TYPE_INTERFACE_Log);
|
||||||
this->main_loop = spa_support_find(support, n_support, SPA_TYPE_INTERFACE_Loop);
|
this->main_loop = spa_support_find(support, n_support, SPA_TYPE_INTERFACE_Loop);
|
||||||
|
|
@ -509,7 +706,6 @@ impl_enum_interface_info(const struct spa_handle_factory *factory,
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
*info = &impl_interfaces[(*index)++];
|
*info = &impl_interfaces[(*index)++];
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Add table
Add a link
Reference in a new issue