577 lines
14 KiB
C
577 lines
14 KiB
C
#include <fcntl.h>
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include <limits.h>
|
|
#include <sys/stat.h>
|
|
#include <sys/ioctl.h>
|
|
#include <linux/input.h>
|
|
#include <sys/sysmacros.h>
|
|
|
|
#include "udev.h"
|
|
#include "udev_list.h"
|
|
|
|
struct udev_device {
|
|
struct udev_list_entry properties;
|
|
struct udev_list_entry sysattrs;
|
|
struct udev_device *parent;
|
|
struct udev *udev;
|
|
int refcount;
|
|
};
|
|
|
|
const char *udev_device_get_syspath(struct udev_device *udev_device)
|
|
{
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
return udev_device_get_property_value(udev_device, "SYSPATH");
|
|
}
|
|
|
|
const char *udev_device_get_sysname(struct udev_device *udev_device)
|
|
{
|
|
const char *sysname;
|
|
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
if ((sysname = udev_device_get_property_value(udev_device, "DEVNAME"))) {
|
|
return sysname;
|
|
}
|
|
|
|
if ((sysname = udev_device_get_devpath(udev_device))) {
|
|
return strrchr(sysname, '/') + 1;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
const char *udev_device_get_sysnum(struct udev_device *udev_device)
|
|
{
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
return udev_device_get_property_value(udev_device, "SYSNUM");
|
|
}
|
|
|
|
const char *udev_device_get_devpath(struct udev_device *udev_device)
|
|
{
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
return udev_device_get_property_value(udev_device, "DEVPATH");
|
|
}
|
|
|
|
const char *udev_device_get_devnode(struct udev_device *udev_device)
|
|
{
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
return udev_device_get_property_value(udev_device, "DEVNODE");
|
|
}
|
|
|
|
dev_t udev_device_get_devnum(struct udev_device *udev_device)
|
|
{
|
|
const char *major, *minor;
|
|
|
|
if (!udev_device) {
|
|
return makedev(0, 0);
|
|
}
|
|
|
|
major = udev_device_get_property_value(udev_device, "MAJOR");
|
|
minor = udev_device_get_property_value(udev_device, "MINOR");
|
|
|
|
if (!major && !minor) {
|
|
return makedev(0, 0);
|
|
}
|
|
|
|
return makedev(atoi(major), atoi(minor));
|
|
}
|
|
|
|
const char *udev_device_get_devtype(struct udev_device *udev_device)
|
|
{
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
return udev_device_get_property_value(udev_device, "DEVTYPE");
|
|
}
|
|
|
|
const char *udev_device_get_subsystem(struct udev_device *udev_device)
|
|
{
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
return udev_device_get_property_value(udev_device, "SUBSYSTEM");
|
|
}
|
|
|
|
const char *udev_device_get_driver(struct udev_device *udev_device)
|
|
{
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
return udev_device_get_property_value(udev_device, "DRIVER");
|
|
}
|
|
|
|
struct udev *udev_device_get_udev(struct udev_device *udev_device)
|
|
{
|
|
return udev_device ? udev_device->udev : NULL;
|
|
}
|
|
|
|
struct udev_device *udev_device_get_parent(struct udev_device *udev_device)
|
|
{
|
|
char *tmp, *path;
|
|
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
path = strdup(udev_device_get_syspath(udev_device));
|
|
|
|
do {
|
|
if ((tmp = strrchr(path, '/'))) {
|
|
*tmp = '\0';
|
|
}
|
|
else {
|
|
break;
|
|
}
|
|
|
|
udev_device->parent = udev_device_new_from_syspath(udev_device->udev, path);
|
|
}
|
|
while (!udev_device->parent);
|
|
|
|
free(path);
|
|
return udev_device->parent;
|
|
}
|
|
|
|
struct udev_device *udev_device_get_parent_with_subsystem_devtype(struct udev_device *udev_device, const char *subsystem, const char *devtype)
|
|
{
|
|
const char *parent_subsystem, *parent_devtype;
|
|
struct udev_device *parent;
|
|
|
|
if (!udev_device || !subsystem) {
|
|
return NULL;
|
|
}
|
|
|
|
parent = udev_device_get_parent(udev_device);
|
|
|
|
while (parent) {
|
|
parent_subsystem = udev_device_get_subsystem(parent);
|
|
parent_devtype = udev_device_get_devtype(parent);
|
|
|
|
if (parent_subsystem && strcmp(parent_subsystem, subsystem) == 0) {
|
|
if (!devtype) {
|
|
return parent;
|
|
}
|
|
|
|
if (parent_devtype && strcmp(parent_devtype, devtype) == 0) {
|
|
return parent;
|
|
}
|
|
}
|
|
|
|
parent = udev_device_get_parent(parent);
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
int udev_device_get_is_initialized(struct udev_device *udev_device)
|
|
{
|
|
return 1;
|
|
}
|
|
|
|
const char *udev_device_get_action(struct udev_device *udev_device)
|
|
{
|
|
return NULL;
|
|
}
|
|
|
|
int udev_device_has_tag(struct udev_device *udev_device, const char *tag)
|
|
{
|
|
// XXX NOT IMPLEMENTED
|
|
return 0;
|
|
}
|
|
|
|
struct udev_list_entry *udev_device_get_devlinks_list_entry(struct udev_device *udev_device)
|
|
{
|
|
// XXX NOT IMPLEMENTED
|
|
return NULL;
|
|
}
|
|
|
|
struct udev_list_entry *udev_device_get_properties_list_entry(struct udev_device *udev_device)
|
|
{
|
|
return udev_device ? udev_list_entry_get_next(&udev_device->properties) : NULL;
|
|
}
|
|
|
|
struct udev_list_entry *udev_device_get_tags_list_entry(struct udev_device *udev_device)
|
|
{
|
|
// XXX NOT IMPLEMENTED
|
|
return NULL;
|
|
}
|
|
|
|
struct udev_list_entry *udev_device_get_sysattr_list_entry(struct udev_device *udev_device)
|
|
{
|
|
return udev_device ? udev_list_entry_get_next(&udev_device->sysattrs) : NULL;
|
|
}
|
|
|
|
const char *udev_device_get_property_value(struct udev_device *udev_device, const char *key)
|
|
{
|
|
struct udev_list_entry *list_entry;
|
|
|
|
list_entry = udev_list_entry_get_by_name(&udev_device->properties, key);
|
|
return udev_list_entry_get_value(list_entry);
|
|
}
|
|
|
|
const char *udev_device_get_sysattr_value(struct udev_device *udev_device, const char *sysattr)
|
|
{
|
|
struct udev_list_entry *list_entry;
|
|
char data[1024], path[PATH_MAX];
|
|
struct stat st;
|
|
int fd;
|
|
|
|
if (!udev_device || !sysattr) {
|
|
return NULL;
|
|
}
|
|
|
|
list_entry = udev_list_entry_get_by_name(&udev_device->sysattrs, sysattr);
|
|
|
|
if (list_entry) {
|
|
return udev_list_entry_get_value(list_entry);
|
|
}
|
|
|
|
snprintf(path, sizeof(path), "%s/%s", udev_device_get_syspath(udev_device), sysattr);
|
|
|
|
if (stat(path, &st) != 0 || S_ISDIR(st.st_mode)) {
|
|
return NULL;
|
|
}
|
|
|
|
fd = open(path, O_RDONLY | O_NOFOLLOW);
|
|
|
|
if (fd == -1) {
|
|
return NULL;
|
|
}
|
|
|
|
if (read(fd, data, sizeof(data)) == -1) {
|
|
close(fd);
|
|
return NULL;
|
|
}
|
|
|
|
close(fd);
|
|
data[strcspn(data, "\n")] = '\0';
|
|
list_entry = udev_list_entry_add(&udev_device->sysattrs, sysattr, data);
|
|
return udev_list_entry_get_value(list_entry);
|
|
}
|
|
|
|
int udev_device_set_sysattr_value(struct udev_device *udev_device, const char *sysattr, const char *value)
|
|
{
|
|
char path[PATH_MAX];
|
|
struct stat st;
|
|
int fd;
|
|
|
|
if (!udev_device || !sysattr || !value) {
|
|
return -1;
|
|
}
|
|
|
|
snprintf(path, sizeof(path), "%s/%s", udev_device_get_syspath(udev_device), sysattr);
|
|
|
|
if (stat(path, &st) != 0 || S_ISDIR(st.st_mode)) {
|
|
return -1;
|
|
}
|
|
|
|
fd = open(path, O_WRONLY | O_NOFOLLOW);
|
|
|
|
if (fd == -1) {
|
|
return -1;
|
|
}
|
|
|
|
if (write(fd, value, strlen(value)) == -1) {
|
|
close(fd);
|
|
return -1;
|
|
}
|
|
|
|
close(fd);
|
|
udev_list_entry_add(&udev_device->sysattrs, sysattr, value);
|
|
return 0;
|
|
}
|
|
|
|
static const char *udev_device_read_symlink(struct udev_device *udev_device, const char *name)
|
|
{
|
|
char link[PATH_MAX], path[PATH_MAX];
|
|
|
|
snprintf(path, sizeof(path), "%s/%s", udev_device_get_syspath(udev_device), name);
|
|
|
|
if (!realpath(path, link)) {
|
|
return NULL;
|
|
}
|
|
|
|
return strrchr(link, '/') + 1;
|
|
}
|
|
|
|
static void udev_device_set_properties_from_uevent(struct udev_device *udev_device)
|
|
{
|
|
char *key, *val, line[1024], path[PATH_MAX];
|
|
char *sysname, devnode[PATH_MAX];
|
|
FILE *file;
|
|
int i;
|
|
|
|
snprintf(path, sizeof(path), "%s/uevent", udev_device_get_syspath(udev_device));
|
|
|
|
file = fopen(path, "r");
|
|
|
|
if (!file) {
|
|
return;
|
|
}
|
|
|
|
while (fgets(line, sizeof(line), file)) {
|
|
line[strcspn(line, "\n")] = '\0';
|
|
|
|
if (strncmp(line, "DEVNAME", 7) == 0) {
|
|
sysname = strrchr(line + 8, '/');
|
|
|
|
if (!sysname) {
|
|
sysname = line + 8;
|
|
}
|
|
else {
|
|
sysname++;
|
|
}
|
|
|
|
udev_list_entry_add(&udev_device->properties, "DEVNAME", sysname);
|
|
|
|
for (i = 0; sysname[i] != '\0'; i++) {
|
|
if (sysname[i] >= '0' && sysname[i] <= '9') {
|
|
udev_list_entry_add(&udev_device->properties, "SYSNUM", sysname + i);
|
|
break;
|
|
}
|
|
}
|
|
|
|
snprintf(devnode, sizeof(devnode), "/dev/%s", line + 8);
|
|
udev_list_entry_add(&udev_device->properties, "DEVNODE", devnode);
|
|
}
|
|
else if (strncmp(line, "DEVTYPE", 7) == 0) {
|
|
udev_list_entry_add(&udev_device->properties, "DEVTYPE", line + 8);
|
|
}
|
|
else if (strncmp(line, "DRIVER", 6) == 0) {
|
|
continue;
|
|
}
|
|
else if (strncmp(line, "MAJOR", 5) == 0) {
|
|
udev_list_entry_add(&udev_device->properties, "MAJOR", line + 6);
|
|
}
|
|
else if (strncmp(line, "MINOR", 5) == 0) {
|
|
udev_list_entry_add(&udev_device->properties, "MINOR", line + 6);
|
|
}
|
|
else if (strchr(line, '=')) {
|
|
val = strchr(line, '=') + 1;
|
|
key = line;
|
|
key[strcspn(key, "=")] = '\0';
|
|
|
|
udev_list_entry_add(&udev_device->properties, key, val);
|
|
}
|
|
}
|
|
|
|
fclose(file);
|
|
}
|
|
|
|
static int test_bit(unsigned long int arr[], int bit)
|
|
{
|
|
return arr[bit / LONG_BIT] & (1 << (bit % LONG_BIT));
|
|
}
|
|
|
|
static void udev_device_set_properties_from_ioctl(struct udev_device *udev_device)
|
|
{
|
|
unsigned long int bits[96], key_bits[96], rel_bits[96], abs_bits[96];
|
|
const char *subsystem;
|
|
int fd;
|
|
|
|
subsystem = udev_device_get_subsystem(udev_device);
|
|
|
|
if (!subsystem || strcmp(subsystem, "input") != 0) {
|
|
return;
|
|
}
|
|
|
|
udev_list_entry_add(&udev_device->properties, "ID_INPUT", "1");
|
|
|
|
fd = open(udev_device_get_devnode(udev_device), O_RDONLY);
|
|
|
|
if (fd == -1) {
|
|
return;
|
|
}
|
|
|
|
if (ioctl(fd, (int)EVIOCGBIT(0, sizeof(bits)), &bits) == -1 ||
|
|
ioctl(fd, (int)EVIOCGBIT(EV_KEY, sizeof(key_bits)), &key_bits) == -1 ||
|
|
ioctl(fd, (int)EVIOCGBIT(EV_REL, sizeof(rel_bits)), &rel_bits) == -1 ||
|
|
ioctl(fd, (int)EVIOCGBIT(EV_ABS, sizeof(abs_bits)), &abs_bits) == -1) {
|
|
close(fd);
|
|
return;
|
|
}
|
|
|
|
if (test_bit(bits, EV_SW)) {
|
|
udev_list_entry_add(&udev_device->properties, "ID_INPUT_SWITCH", "1");
|
|
}
|
|
|
|
if (test_bit(bits, EV_KEY) && test_bit(key_bits, KEY_ENTER)) {
|
|
udev_list_entry_add(&udev_device->properties, "ID_INPUT_KEY", "1");
|
|
udev_list_entry_add(&udev_device->properties, "ID_INPUT_KEYBOARD", "1");
|
|
}
|
|
|
|
if (test_bit(bits, EV_REL) && test_bit(rel_bits, REL_Y) && test_bit(rel_bits, REL_X) &&
|
|
test_bit(key_bits, BTN_MOUSE)) {
|
|
udev_list_entry_add(&udev_device->properties, "ID_INPUT_MOUSE", "1");
|
|
}
|
|
|
|
if (test_bit(bits, EV_ABS) && test_bit(abs_bits, ABS_Y) && test_bit(abs_bits, ABS_X)) {
|
|
if (test_bit(key_bits, BTN_TOUCH) && !test_bit(key_bits, BTN_TOOL_PEN)) {
|
|
if (test_bit(key_bits, BTN_TOOL_FINGER)) {
|
|
udev_list_entry_add(&udev_device->properties, "ID_INPUT_TOUCHPAD", "1");
|
|
}
|
|
else {
|
|
udev_list_entry_add(&udev_device->properties, "ID_INPUT_TOUCHSCREEN", "1");
|
|
}
|
|
}
|
|
else if (test_bit(key_bits, BTN_MOUSE)) {
|
|
udev_list_entry_add(&udev_device->properties, "ID_INPUT_MOUSE", "1");
|
|
}
|
|
}
|
|
|
|
close(fd);
|
|
}
|
|
|
|
struct udev_device *udev_device_new_from_syspath(struct udev *udev, const char *syspath)
|
|
{
|
|
char path[PATH_MAX], file[PATH_MAX + 7];
|
|
struct udev_device *udev_device;
|
|
struct stat st;
|
|
|
|
if (!udev || !syspath) {
|
|
return NULL;
|
|
}
|
|
|
|
if (!realpath(syspath, path)) {
|
|
return NULL;
|
|
}
|
|
|
|
if (stat(path, &st) != 0 || S_ISDIR(st.st_mode) == 0) {
|
|
return NULL;
|
|
}
|
|
|
|
snprintf(file, sizeof(file), "%s/uevent", path);
|
|
|
|
if (access(file, R_OK) == -1) {
|
|
return NULL;
|
|
}
|
|
|
|
udev_device = calloc(1, sizeof(struct udev_device));
|
|
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
udev_device->udev = udev;
|
|
udev_device->refcount = 1;
|
|
udev_device->parent = NULL;
|
|
|
|
udev_list_entry_init(&udev_device->properties);
|
|
udev_list_entry_init(&udev_device->sysattrs);
|
|
|
|
udev_list_entry_add(&udev_device->properties, "SYSPATH", path);
|
|
udev_list_entry_add(&udev_device->properties, "DEVPATH", path + 4);
|
|
udev_list_entry_add(&udev_device->properties, "DRIVER", udev_device_read_symlink(udev_device, "driver"));
|
|
udev_list_entry_add(&udev_device->properties, "SUBSYSTEM", udev_device_read_symlink(udev_device, "subsystem"));
|
|
|
|
udev_device_set_properties_from_uevent(udev_device);
|
|
udev_device_set_properties_from_ioctl(udev_device);
|
|
|
|
return udev_device;
|
|
}
|
|
|
|
struct udev_device *udev_device_new_from_devnum(struct udev *udev, char type, dev_t devnum)
|
|
{
|
|
char path[PATH_MAX];
|
|
|
|
if (!udev || !type || !devnum) {
|
|
return NULL;
|
|
}
|
|
|
|
switch (type) {
|
|
case 'c':
|
|
snprintf(path, sizeof(path), "/sys/dev/char/%d:%d", major(devnum), minor(devnum));
|
|
break;
|
|
case 'b':
|
|
snprintf(path, sizeof(path), "/sys/dev/block/%d:%d", major(devnum), minor(devnum));
|
|
break;
|
|
default:
|
|
return NULL;
|
|
}
|
|
|
|
return udev_device_new_from_syspath(udev, path);
|
|
}
|
|
|
|
struct udev_device *udev_device_new_from_subsystem_sysname(struct udev *udev, const char *subsystem, const char *sysname)
|
|
{
|
|
char *fmt[] = { "/sys/bus/%s/devices/%s", "/sys/class/%s/%s", NULL };
|
|
char path[PATH_MAX];
|
|
int i;
|
|
|
|
if (!udev || !subsystem || !sysname) {
|
|
return NULL;
|
|
}
|
|
|
|
for (i = 0; fmt[i]; i++) {
|
|
snprintf(path, sizeof(path), fmt[i], subsystem, sysname);
|
|
|
|
if (access(path, R_OK) == 0) {
|
|
return udev_device_new_from_syspath(udev, path);
|
|
}
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
struct udev_device *udev_device_new_from_device_id(struct udev *udev, const char *id)
|
|
{
|
|
// XXX NOT IMPLEMENTED
|
|
return NULL;
|
|
}
|
|
|
|
struct udev_device *udev_device_new_from_environment(struct udev *udev)
|
|
{
|
|
// XXX NOT IMPLEMENTED
|
|
return NULL;
|
|
}
|
|
|
|
struct udev_device *udev_device_ref(struct udev_device *udev_device)
|
|
{
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
udev_device->refcount++;
|
|
return udev_device;
|
|
}
|
|
|
|
struct udev_device *udev_device_unref(struct udev_device *udev_device)
|
|
{
|
|
if (!udev_device) {
|
|
return NULL;
|
|
}
|
|
|
|
if (--udev_device->refcount > 0) {
|
|
return NULL;
|
|
}
|
|
|
|
if (udev_device->parent) {
|
|
udev_device_unref(udev_device->parent);
|
|
}
|
|
|
|
udev_list_entry_free_all(&udev_device->properties);
|
|
udev_list_entry_free_all(&udev_device->sysattrs);
|
|
|
|
free(udev_device);
|
|
return NULL;
|
|
}
|