1ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch/* -*- Mode: C; c-basic-offset:8 ; indent-tabs-mode:t -*- */ 2ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch/* 3ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * Linux usbfs backend for libusb 4ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * Copyright (C) 2007-2009 Daniel Drake <dsd@gentoo.org> 5ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * Copyright (c) 2001 Johannes Erdfelt <johannes@erdfelt.com> 6ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * Copyright (c) 2013 Nathan Hjelm <hjelmn@mac.com> 7ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * 8ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * This library is free software; you can redistribute it and/or 9ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * modify it under the terms of the GNU Lesser General Public 10ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * License as published by the Free Software Foundation; either 11ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * version 2.1 of the License, or (at your option) any later version. 12ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * 13ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * This library is distributed in the hope that it will be useful, 14ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * but WITHOUT ANY WARRANTY; without even the implied warranty of 15ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 16ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * Lesser General Public License for more details. 17ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * 18ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * You should have received a copy of the GNU Lesser General Public 19ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * License along with this library; if not, write to the Free Software 20ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA 21ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch */ 22ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 23ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include "config.h" 2468043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#include "libusb.h" 2568043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#include "libusbi.h" 2668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#include "linux_usbfs.h" 2768043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 28ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <ctype.h> 29ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <dirent.h> 30ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <errno.h> 31ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <fcntl.h> 32ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <poll.h> 33ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <stdio.h> 34ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <stdlib.h> 35ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <string.h> 36ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <sys/types.h> 3768043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 3868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#ifdef HAVE_ASM_TYPES_H 3968043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#include <asm/types.h> 4068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#endif 4168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 4268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#ifdef HAVE_SYS_SOCKET_H 43ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <sys/socket.h> 4468043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#endif 45ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 4668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#include <arpa/inet.h> 47ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 4868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#ifdef HAVE_LINUX_NETLINK_H 49ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <linux/netlink.h> 5068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#endif 5168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 5268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#ifdef HAVE_LINUX_FILTER_H 53ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#include <linux/filter.h> 5468043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#endif 55ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 56ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch#define KERNEL 1 57ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 58ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdochstatic int linux_netlink_socket = -1; 5968043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)static int netlink_control_pipe[2] = { -1, -1 }; 60ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdochstatic pthread_t libusb_linux_event_thread; 61ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 62ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdochstatic void *linux_netlink_event_thread_main(void *arg); 63ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 64ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdochstruct sockaddr_nl snl = { .nl_family=AF_NETLINK, .nl_groups=KERNEL }; 65ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 6668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)static int set_fd_cloexec_nb (int fd) 6768043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles){ 6868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) int flags; 6968043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 7068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#if defined(FD_CLOEXEC) 7168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) flags = fcntl (linux_netlink_socket, F_GETFD); 7268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) if (0 > flags) { 7368043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) return -1; 7468043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) } 7568043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 7668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) if (!(flags & FD_CLOEXEC)) { 7768043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) fcntl (linux_netlink_socket, F_SETFD, flags | FD_CLOEXEC); 7868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) } 7968043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#endif 8068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 8168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) flags = fcntl (linux_netlink_socket, F_GETFL); 8268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) if (0 > flags) { 8368043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) return -1; 8468043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) } 8568043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 8668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) if (!(flags & O_NONBLOCK)) { 8768043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) fcntl (linux_netlink_socket, F_SETFL, flags | O_NONBLOCK); 8868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) } 8968043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 9068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) return 0; 9168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)} 9268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 93ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdochint linux_netlink_start_event_monitor(void) 94ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch{ 9568043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) int socktype = SOCK_RAW; 96ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch int ret; 97ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 98ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch snl.nl_groups = KERNEL; 99ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 10068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#if defined(SOCK_CLOEXEC) 10168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) socktype |= SOCK_CLOEXEC; 10268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#endif 10368043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#if defined(SOCK_NONBLOCK) 10468043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) socktype |= SOCK_NONBLOCK; 10568043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles)#endif 10668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 10768043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) linux_netlink_socket = socket(PF_NETLINK, socktype, NETLINK_KOBJECT_UEVENT); 10868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) if (-1 == linux_netlink_socket && EINVAL == errno) { 10968043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) linux_netlink_socket = socket(PF_NETLINK, SOCK_RAW, NETLINK_KOBJECT_UEVENT); 11068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) } 11168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 112ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (-1 == linux_netlink_socket) { 113ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return LIBUSB_ERROR_OTHER; 114ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 115ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 11668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) ret = set_fd_cloexec_nb (linux_netlink_socket); 11768043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) if (0 != ret) { 11868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) close (linux_netlink_socket); 11968043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) linux_netlink_socket = -1; 12068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) return LIBUSB_ERROR_OTHER; 12168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) } 12268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 123ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch ret = bind(linux_netlink_socket, (struct sockaddr *) &snl, sizeof(snl)); 124ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (0 != ret) { 12568043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) close(linux_netlink_socket); 126ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return LIBUSB_ERROR_OTHER; 127ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 128ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 129ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch /* TODO -- add authentication */ 130ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch /* setsockopt(linux_netlink_socket, SOL_SOCKET, SO_PASSCRED, &one, sizeof(one)); */ 131ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 13268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) ret = usbi_pipe(netlink_control_pipe); 13368043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) if (ret) { 13468043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) usbi_err(NULL, "could not create netlink control pipe"); 13568043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) close(linux_netlink_socket); 13668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) return LIBUSB_ERROR_OTHER; 13768043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) } 13868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 139ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch ret = pthread_create(&libusb_linux_event_thread, NULL, linux_netlink_event_thread_main, NULL); 140ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (0 != ret) { 14168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) close(netlink_control_pipe[0]); 14268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) close(netlink_control_pipe[1]); 14368043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) close(linux_netlink_socket); 144ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return LIBUSB_ERROR_OTHER; 145ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 146ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 147ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return LIBUSB_SUCCESS; 148ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch} 149ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 150ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdochint linux_netlink_stop_event_monitor(void) 151ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch{ 152ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch int r; 15368043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) char dummy = 1; 154ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 155ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (-1 == linux_netlink_socket) { 156ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch /* already closed. nothing to do */ 157ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return LIBUSB_SUCCESS; 158ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 159ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 16068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) /* Write some dummy data to the control pipe and 16168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) * wait for the thread to exit */ 16268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) r = usbi_write(netlink_control_pipe[1], &dummy, sizeof(dummy)); 16368043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) if (r <= 0) { 16468043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) usbi_warn(NULL, "netlink control pipe signal failed"); 165ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 16668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) pthread_join(libusb_linux_event_thread, NULL); 167ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 16868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) close(linux_netlink_socket); 169ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch linux_netlink_socket = -1; 170ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 17168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) /* close and reset control pipe */ 17268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) close(netlink_control_pipe[0]); 17368043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) close(netlink_control_pipe[1]); 17468043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) netlink_control_pipe[0] = -1; 17568043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) netlink_control_pipe[1] = -1; 17668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) 177ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return LIBUSB_SUCCESS; 178ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch} 179ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 180ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdochstatic const char *netlink_message_parse (const char *buffer, size_t len, const char *key) 181ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch{ 182ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch size_t keylen = strlen(key); 183ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch size_t offset; 184ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 185ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch for (offset = 0 ; offset < len && '\0' != buffer[offset] ; offset += strlen(buffer + offset) + 1) { 186ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (0 == strncmp(buffer + offset, key, keylen) && 187ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch '=' == buffer[offset + keylen]) { 188ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return buffer + offset + keylen + 1; 189ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 190ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 191ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 192ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return NULL; 193ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch} 194ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 195ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch/* parse parts of netlink message common to both libudev and the kernel */ 196ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdochstatic int linux_netlink_parse(char *buffer, size_t len, int *detached, const char **sys_name, 197ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch uint8_t *busnum, uint8_t *devaddr) { 198ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch const char *tmp; 199ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch int i; 200ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 201ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch errno = 0; 202ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 203ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch *sys_name = NULL; 204ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch *detached = 0; 205ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch *busnum = 0; 206ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch *devaddr = 0; 207ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 208ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch tmp = netlink_message_parse((const char *) buffer, len, "ACTION"); 209ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (tmp == NULL) 210ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return -1; 211ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (0 == strcmp(tmp, "remove")) { 212ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch *detached = 1; 213ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } else if (0 != strcmp(tmp, "add")) { 214ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch usbi_dbg("unknown device action %s", tmp); 215ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return -1; 216ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 217ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 218ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch /* check that this is a usb message */ 219ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch tmp = netlink_message_parse(buffer, len, "SUBSYSTEM"); 220ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (NULL == tmp || 0 != strcmp(tmp, "usb")) { 221ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch /* not usb. ignore */ 222ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return -1; 223ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 224ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 225ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch tmp = netlink_message_parse(buffer, len, "BUSNUM"); 226ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (NULL == tmp) { 227ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch /* no bus number (likely a usb interface). ignore*/ 228ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return -1; 229ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 230ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 231ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch *busnum = (uint8_t)(strtoul(tmp, NULL, 10) & 0xff); 232ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (errno) { 233ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch errno = 0; 234ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return -1; 235ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 236ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 237ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch tmp = netlink_message_parse(buffer, len, "DEVNUM"); 238ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (NULL == tmp) { 239ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return -1; 240ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 241ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 242ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch *devaddr = (uint8_t)(strtoul(tmp, NULL, 10) & 0xff); 243ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (errno) { 244ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch errno = 0; 245ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return -1; 246ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 247ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 248ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch tmp = netlink_message_parse(buffer, len, "DEVPATH"); 249ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (NULL == tmp) { 250ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return -1; 251ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 252ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 253ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch for (i = strlen(tmp) - 1 ; i ; --i) { 254ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if ('/' ==tmp[i]) { 255ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch *sys_name = tmp + i + 1; 256ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch break; 257ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 258ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 259ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 260ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch /* found a usb device */ 261ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return 0; 262ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch} 263ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 264ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdochstatic int linux_netlink_read_message(void) 265ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch{ 266ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch unsigned char buffer[1024]; 267ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch struct iovec iov = {.iov_base = buffer, .iov_len = sizeof(buffer)}; 268ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch struct msghdr meh = { .msg_iov=&iov, .msg_iovlen=1, 269ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch .msg_name=&snl, .msg_namelen=sizeof(snl) }; 270ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch const char *sys_name = NULL; 271ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch uint8_t busnum, devaddr; 272ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch int detached, r; 273ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch size_t len; 274ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 275ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch /* read netlink message */ 276ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch memset(buffer, 0, sizeof(buffer)); 277ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch len = recvmsg(linux_netlink_socket, &meh, 0); 278ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (len < 32) { 279ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (errno != EAGAIN) 280ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch usbi_dbg("error recieving message from netlink"); 281ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return -1; 282ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 283ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 284ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch /* TODO -- authenticate this message is from the kernel or udevd */ 285ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 286ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch r = linux_netlink_parse(buffer, len, &detached, &sys_name, 287ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch &busnum, &devaddr); 288ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (r) 289ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return r; 290ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 291ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch usbi_dbg("netlink hotplug found device busnum: %hhu, devaddr: %hhu, sys_name: %s, removed: %s", 292ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch busnum, devaddr, sys_name, detached ? "yes" : "no"); 293ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 294ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch /* signal device is available (or not) to all contexts */ 295ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch if (detached) 29668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) linux_device_disconnected(busnum, devaddr, sys_name); 297ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch else 298ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch linux_hotplug_enumerate(busnum, devaddr, sys_name); 299ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 300ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return 0; 301ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch} 302ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 303ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdochstatic void *linux_netlink_event_thread_main(void *arg) 304ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch{ 30568043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) char dummy; 30668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) int r; 30768043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) struct pollfd fds[] = { 30868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) { .fd = netlink_control_pipe[0], 30968043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) .events = POLLIN }, 31068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) { .fd = linux_netlink_socket, 31168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) .events = POLLIN }, 31268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) }; 313ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 314ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch /* silence compiler warning */ 315ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch (void) arg; 316ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 31768043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) while (poll(fds, 2, -1) >= 0) { 31868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) if (fds[0].revents & POLLIN) { 31968043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) /* activity on control pipe, read the byte and exit */ 32068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) r = usbi_read(netlink_control_pipe[0], &dummy, sizeof(dummy)); 32168043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) if (r <= 0) { 32268043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) usbi_warn(NULL, "netlink control pipe read failed"); 32368043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) } 324ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch break; 325ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 32668043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) if (fds[1].revents & POLLIN) { 32768043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) usbi_mutex_static_lock(&linux_hotplug_lock); 32868043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) linux_netlink_read_message(); 32968043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) usbi_mutex_static_unlock(&linux_hotplug_lock); 33068043e1e95eeb07d5cae7aca370b26518b0867d6Torne (Richard Coles) } 331ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } 332ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 333ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch return NULL; 334ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch} 335ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 336ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdochvoid linux_netlink_hotplug_poll(void) 337ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch{ 338ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch int r; 339ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch 340ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch usbi_mutex_static_lock(&linux_hotplug_lock); 341ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch do { 342ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch r = linux_netlink_read_message(); 343ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch } while (r == 0); 344ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch usbi_mutex_static_unlock(&linux_hotplug_lock); 345ca12bfac764ba476d6cd062bf1dde12cc64c3f40Ben Murdoch} 346