13391ba0eSKrzysztof Opasiak /* 23391ba0eSKrzysztof Opasiak * Copyright (C) 2015-2016 Samsung Electronics 33391ba0eSKrzysztof Opasiak * Igor Kotrasinski <i.kotrasinsk@samsung.com> 43391ba0eSKrzysztof Opasiak * Krzysztof Opasiak <k.opasiak@samsung.com> 53391ba0eSKrzysztof Opasiak * 63391ba0eSKrzysztof Opasiak * Refactored from usbip_host_driver.c, which is: 73391ba0eSKrzysztof Opasiak * Copyright (C) 2011 matt mooney <mfm@muteddisk.com> 83391ba0eSKrzysztof Opasiak * 2005-2007 Takahiro Hirofuchi 93391ba0eSKrzysztof Opasiak * 103391ba0eSKrzysztof Opasiak * This program is free software: you can redistribute it and/or modify 113391ba0eSKrzysztof Opasiak * it under the terms of the GNU General Public License as published by 123391ba0eSKrzysztof Opasiak * the Free Software Foundation, either version 2 of the License, or 133391ba0eSKrzysztof Opasiak * (at your option) any later version. 143391ba0eSKrzysztof Opasiak * 153391ba0eSKrzysztof Opasiak * This program is distributed in the hope that it will be useful, 163391ba0eSKrzysztof Opasiak * but WITHOUT ANY WARRANTY; without even the implied warranty of 173391ba0eSKrzysztof Opasiak * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 183391ba0eSKrzysztof Opasiak * GNU General Public License for more details. 193391ba0eSKrzysztof Opasiak * 203391ba0eSKrzysztof Opasiak * You should have received a copy of the GNU General Public License 213391ba0eSKrzysztof Opasiak * along with this program. If not, see <http://www.gnu.org/licenses/>. 223391ba0eSKrzysztof Opasiak */ 233391ba0eSKrzysztof Opasiak 243391ba0eSKrzysztof Opasiak #include <sys/types.h> 253391ba0eSKrzysztof Opasiak #include <sys/stat.h> 263391ba0eSKrzysztof Opasiak #include <fcntl.h> 273391ba0eSKrzysztof Opasiak 283391ba0eSKrzysztof Opasiak #include <errno.h> 293391ba0eSKrzysztof Opasiak #include <unistd.h> 303391ba0eSKrzysztof Opasiak 313391ba0eSKrzysztof Opasiak #include <libudev.h> 323391ba0eSKrzysztof Opasiak 333391ba0eSKrzysztof Opasiak #include "usbip_common.h" 343391ba0eSKrzysztof Opasiak #include "usbip_host_common.h" 353391ba0eSKrzysztof Opasiak #include "list.h" 363391ba0eSKrzysztof Opasiak #include "sysfs_utils.h" 373391ba0eSKrzysztof Opasiak 383391ba0eSKrzysztof Opasiak struct udev *udev_context; 393391ba0eSKrzysztof Opasiak 403391ba0eSKrzysztof Opasiak static int32_t read_attr_usbip_status(struct usbip_usb_device *udev) 413391ba0eSKrzysztof Opasiak { 423391ba0eSKrzysztof Opasiak char status_attr_path[SYSFS_PATH_MAX]; 43e5dfa3f9SJonathan Dieter int size; 443391ba0eSKrzysztof Opasiak int fd; 453391ba0eSKrzysztof Opasiak int length; 463391ba0eSKrzysztof Opasiak char status; 473391ba0eSKrzysztof Opasiak int value = 0; 483391ba0eSKrzysztof Opasiak 49e5dfa3f9SJonathan Dieter size = snprintf(status_attr_path, sizeof(status_attr_path), 50e5dfa3f9SJonathan Dieter "%s/usbip_status", udev->path); 51e5dfa3f9SJonathan Dieter if (size < 0 || (unsigned int)size >= sizeof(status_attr_path)) { 52e5dfa3f9SJonathan Dieter err("usbip_status path length %i >= %lu or < 0", size, 53e5dfa3f9SJonathan Dieter (long unsigned)sizeof(status_attr_path)); 54e5dfa3f9SJonathan Dieter return -1; 55e5dfa3f9SJonathan Dieter } 56e5dfa3f9SJonathan Dieter 573391ba0eSKrzysztof Opasiak 583391ba0eSKrzysztof Opasiak fd = open(status_attr_path, O_RDONLY); 593391ba0eSKrzysztof Opasiak if (fd < 0) { 603391ba0eSKrzysztof Opasiak err("error opening attribute %s", status_attr_path); 613391ba0eSKrzysztof Opasiak return -1; 623391ba0eSKrzysztof Opasiak } 633391ba0eSKrzysztof Opasiak 643391ba0eSKrzysztof Opasiak length = read(fd, &status, 1); 653391ba0eSKrzysztof Opasiak if (length < 0) { 663391ba0eSKrzysztof Opasiak err("error reading attribute %s", status_attr_path); 673391ba0eSKrzysztof Opasiak close(fd); 683391ba0eSKrzysztof Opasiak return -1; 693391ba0eSKrzysztof Opasiak } 703391ba0eSKrzysztof Opasiak 713391ba0eSKrzysztof Opasiak value = atoi(&status); 723391ba0eSKrzysztof Opasiak 733391ba0eSKrzysztof Opasiak return value; 743391ba0eSKrzysztof Opasiak } 753391ba0eSKrzysztof Opasiak 763391ba0eSKrzysztof Opasiak static 773391ba0eSKrzysztof Opasiak struct usbip_exported_device *usbip_exported_device_new( 783391ba0eSKrzysztof Opasiak struct usbip_host_driver *hdriver, const char *sdevpath) 793391ba0eSKrzysztof Opasiak { 803391ba0eSKrzysztof Opasiak struct usbip_exported_device *edev = NULL; 813391ba0eSKrzysztof Opasiak struct usbip_exported_device *edev_old; 823391ba0eSKrzysztof Opasiak size_t size; 833391ba0eSKrzysztof Opasiak int i; 843391ba0eSKrzysztof Opasiak 853391ba0eSKrzysztof Opasiak edev = calloc(1, sizeof(struct usbip_exported_device)); 863391ba0eSKrzysztof Opasiak 873391ba0eSKrzysztof Opasiak edev->sudev = 883391ba0eSKrzysztof Opasiak udev_device_new_from_syspath(udev_context, sdevpath); 893391ba0eSKrzysztof Opasiak if (!edev->sudev) { 903391ba0eSKrzysztof Opasiak err("udev_device_new_from_syspath: %s", sdevpath); 913391ba0eSKrzysztof Opasiak goto err; 923391ba0eSKrzysztof Opasiak } 933391ba0eSKrzysztof Opasiak 943391ba0eSKrzysztof Opasiak if (hdriver->ops.read_device(edev->sudev, &edev->udev) < 0) 953391ba0eSKrzysztof Opasiak goto err; 963391ba0eSKrzysztof Opasiak 973391ba0eSKrzysztof Opasiak edev->status = read_attr_usbip_status(&edev->udev); 983391ba0eSKrzysztof Opasiak if (edev->status < 0) 993391ba0eSKrzysztof Opasiak goto err; 1003391ba0eSKrzysztof Opasiak 1013391ba0eSKrzysztof Opasiak /* reallocate buffer to include usb interface data */ 1023391ba0eSKrzysztof Opasiak size = sizeof(struct usbip_exported_device) + 1033391ba0eSKrzysztof Opasiak edev->udev.bNumInterfaces * sizeof(struct usbip_usb_interface); 1043391ba0eSKrzysztof Opasiak 1053391ba0eSKrzysztof Opasiak edev_old = edev; 1063391ba0eSKrzysztof Opasiak edev = realloc(edev, size); 1073391ba0eSKrzysztof Opasiak if (!edev) { 1083391ba0eSKrzysztof Opasiak edev = edev_old; 1093391ba0eSKrzysztof Opasiak dbg("realloc failed"); 1103391ba0eSKrzysztof Opasiak goto err; 1113391ba0eSKrzysztof Opasiak } 1123391ba0eSKrzysztof Opasiak 1133391ba0eSKrzysztof Opasiak for (i = 0; i < edev->udev.bNumInterfaces; i++) { 1143391ba0eSKrzysztof Opasiak /* vudc does not support reading interfaces */ 1153391ba0eSKrzysztof Opasiak if (!hdriver->ops.read_interface) 1163391ba0eSKrzysztof Opasiak break; 1173391ba0eSKrzysztof Opasiak hdriver->ops.read_interface(&edev->udev, i, &edev->uinf[i]); 1183391ba0eSKrzysztof Opasiak } 1193391ba0eSKrzysztof Opasiak 1203391ba0eSKrzysztof Opasiak return edev; 1213391ba0eSKrzysztof Opasiak err: 1223391ba0eSKrzysztof Opasiak if (edev->sudev) 1233391ba0eSKrzysztof Opasiak udev_device_unref(edev->sudev); 1243391ba0eSKrzysztof Opasiak if (edev) 1253391ba0eSKrzysztof Opasiak free(edev); 1263391ba0eSKrzysztof Opasiak 1273391ba0eSKrzysztof Opasiak return NULL; 1283391ba0eSKrzysztof Opasiak } 1293391ba0eSKrzysztof Opasiak 1303391ba0eSKrzysztof Opasiak static int refresh_exported_devices(struct usbip_host_driver *hdriver) 1313391ba0eSKrzysztof Opasiak { 1323391ba0eSKrzysztof Opasiak struct usbip_exported_device *edev; 1333391ba0eSKrzysztof Opasiak struct udev_enumerate *enumerate; 1343391ba0eSKrzysztof Opasiak struct udev_list_entry *devices, *dev_list_entry; 1353391ba0eSKrzysztof Opasiak struct udev_device *dev; 1363391ba0eSKrzysztof Opasiak const char *path; 1373391ba0eSKrzysztof Opasiak 1383391ba0eSKrzysztof Opasiak enumerate = udev_enumerate_new(udev_context); 1393391ba0eSKrzysztof Opasiak udev_enumerate_add_match_subsystem(enumerate, hdriver->udev_subsystem); 1403391ba0eSKrzysztof Opasiak udev_enumerate_scan_devices(enumerate); 1413391ba0eSKrzysztof Opasiak 1423391ba0eSKrzysztof Opasiak devices = udev_enumerate_get_list_entry(enumerate); 1433391ba0eSKrzysztof Opasiak 1443391ba0eSKrzysztof Opasiak udev_list_entry_foreach(dev_list_entry, devices) { 1453391ba0eSKrzysztof Opasiak path = udev_list_entry_get_name(dev_list_entry); 1463391ba0eSKrzysztof Opasiak dev = udev_device_new_from_syspath(udev_context, 1473391ba0eSKrzysztof Opasiak path); 1483391ba0eSKrzysztof Opasiak if (dev == NULL) 1493391ba0eSKrzysztof Opasiak continue; 1503391ba0eSKrzysztof Opasiak 1513391ba0eSKrzysztof Opasiak /* Check whether device uses usbip driver. */ 1523391ba0eSKrzysztof Opasiak if (hdriver->ops.is_my_device(dev)) { 1533391ba0eSKrzysztof Opasiak edev = usbip_exported_device_new(hdriver, path); 1543391ba0eSKrzysztof Opasiak if (!edev) { 1553391ba0eSKrzysztof Opasiak dbg("usbip_exported_device_new failed"); 1563391ba0eSKrzysztof Opasiak continue; 1573391ba0eSKrzysztof Opasiak } 1583391ba0eSKrzysztof Opasiak 1593391ba0eSKrzysztof Opasiak list_add(&edev->node, &hdriver->edev_list); 1603391ba0eSKrzysztof Opasiak hdriver->ndevs++; 1613391ba0eSKrzysztof Opasiak } 1623391ba0eSKrzysztof Opasiak } 1633391ba0eSKrzysztof Opasiak 1643391ba0eSKrzysztof Opasiak return 0; 1653391ba0eSKrzysztof Opasiak } 1663391ba0eSKrzysztof Opasiak 1673391ba0eSKrzysztof Opasiak static void usbip_exported_device_destroy(struct list_head *devs) 1683391ba0eSKrzysztof Opasiak { 1693391ba0eSKrzysztof Opasiak struct list_head *i, *tmp; 1703391ba0eSKrzysztof Opasiak struct usbip_exported_device *edev; 1713391ba0eSKrzysztof Opasiak 1723391ba0eSKrzysztof Opasiak list_for_each_safe(i, tmp, devs) { 1733391ba0eSKrzysztof Opasiak edev = list_entry(i, struct usbip_exported_device, node); 1743391ba0eSKrzysztof Opasiak list_del(i); 1753391ba0eSKrzysztof Opasiak free(edev); 1763391ba0eSKrzysztof Opasiak } 1773391ba0eSKrzysztof Opasiak } 1783391ba0eSKrzysztof Opasiak 1793391ba0eSKrzysztof Opasiak int usbip_generic_driver_open(struct usbip_host_driver *hdriver) 1803391ba0eSKrzysztof Opasiak { 1813391ba0eSKrzysztof Opasiak int rc; 1823391ba0eSKrzysztof Opasiak 1833391ba0eSKrzysztof Opasiak udev_context = udev_new(); 1843391ba0eSKrzysztof Opasiak if (!udev_context) { 1853391ba0eSKrzysztof Opasiak err("udev_new failed"); 1863391ba0eSKrzysztof Opasiak return -1; 1873391ba0eSKrzysztof Opasiak } 1883391ba0eSKrzysztof Opasiak 1893391ba0eSKrzysztof Opasiak rc = refresh_exported_devices(hdriver); 1903391ba0eSKrzysztof Opasiak if (rc < 0) 1913391ba0eSKrzysztof Opasiak goto err; 1923391ba0eSKrzysztof Opasiak return 0; 1933391ba0eSKrzysztof Opasiak err: 1943391ba0eSKrzysztof Opasiak udev_unref(udev_context); 1953391ba0eSKrzysztof Opasiak return -1; 1963391ba0eSKrzysztof Opasiak } 1973391ba0eSKrzysztof Opasiak 1983391ba0eSKrzysztof Opasiak void usbip_generic_driver_close(struct usbip_host_driver *hdriver) 1993391ba0eSKrzysztof Opasiak { 2003391ba0eSKrzysztof Opasiak if (!hdriver) 2013391ba0eSKrzysztof Opasiak return; 2023391ba0eSKrzysztof Opasiak 2033391ba0eSKrzysztof Opasiak usbip_exported_device_destroy(&hdriver->edev_list); 2043391ba0eSKrzysztof Opasiak 2053391ba0eSKrzysztof Opasiak udev_unref(udev_context); 2063391ba0eSKrzysztof Opasiak } 2073391ba0eSKrzysztof Opasiak 2083391ba0eSKrzysztof Opasiak int usbip_generic_refresh_device_list(struct usbip_host_driver *hdriver) 2093391ba0eSKrzysztof Opasiak { 2103391ba0eSKrzysztof Opasiak int rc; 2113391ba0eSKrzysztof Opasiak 2123391ba0eSKrzysztof Opasiak usbip_exported_device_destroy(&hdriver->edev_list); 2133391ba0eSKrzysztof Opasiak 2143391ba0eSKrzysztof Opasiak hdriver->ndevs = 0; 2153391ba0eSKrzysztof Opasiak INIT_LIST_HEAD(&hdriver->edev_list); 2163391ba0eSKrzysztof Opasiak 2173391ba0eSKrzysztof Opasiak rc = refresh_exported_devices(hdriver); 2183391ba0eSKrzysztof Opasiak if (rc < 0) 2193391ba0eSKrzysztof Opasiak return -1; 2203391ba0eSKrzysztof Opasiak 2213391ba0eSKrzysztof Opasiak return 0; 2223391ba0eSKrzysztof Opasiak } 2233391ba0eSKrzysztof Opasiak 2243391ba0eSKrzysztof Opasiak int usbip_export_device(struct usbip_exported_device *edev, int sockfd) 2253391ba0eSKrzysztof Opasiak { 2263391ba0eSKrzysztof Opasiak char attr_name[] = "usbip_sockfd"; 2273391ba0eSKrzysztof Opasiak char sockfd_attr_path[SYSFS_PATH_MAX]; 228e5dfa3f9SJonathan Dieter int size; 2293391ba0eSKrzysztof Opasiak char sockfd_buff[30]; 2303391ba0eSKrzysztof Opasiak int ret; 2313391ba0eSKrzysztof Opasiak 2323391ba0eSKrzysztof Opasiak if (edev->status != SDEV_ST_AVAILABLE) { 2333391ba0eSKrzysztof Opasiak dbg("device not available: %s", edev->udev.busid); 2343391ba0eSKrzysztof Opasiak switch (edev->status) { 2353391ba0eSKrzysztof Opasiak case SDEV_ST_ERROR: 2363391ba0eSKrzysztof Opasiak dbg("status SDEV_ST_ERROR"); 237c207a10dSShuah Khan ret = ST_DEV_ERR; 2383391ba0eSKrzysztof Opasiak break; 2393391ba0eSKrzysztof Opasiak case SDEV_ST_USED: 2403391ba0eSKrzysztof Opasiak dbg("status SDEV_ST_USED"); 241c207a10dSShuah Khan ret = ST_DEV_BUSY; 2423391ba0eSKrzysztof Opasiak break; 2433391ba0eSKrzysztof Opasiak default: 2443391ba0eSKrzysztof Opasiak dbg("status unknown: 0x%x", edev->status); 245c207a10dSShuah Khan ret = -1; 2463391ba0eSKrzysztof Opasiak } 247c207a10dSShuah Khan return ret; 2483391ba0eSKrzysztof Opasiak } 2493391ba0eSKrzysztof Opasiak 2503391ba0eSKrzysztof Opasiak /* only the first interface is true */ 251e5dfa3f9SJonathan Dieter size = snprintf(sockfd_attr_path, sizeof(sockfd_attr_path), "%s/%s", 2523391ba0eSKrzysztof Opasiak edev->udev.path, attr_name); 253e5dfa3f9SJonathan Dieter if (size < 0 || (unsigned int)size >= sizeof(sockfd_attr_path)) { 254e5dfa3f9SJonathan Dieter err("exported device path length %i >= %lu or < 0", size, 255e5dfa3f9SJonathan Dieter (long unsigned)sizeof(sockfd_attr_path)); 256e5dfa3f9SJonathan Dieter return -1; 257e5dfa3f9SJonathan Dieter } 2583391ba0eSKrzysztof Opasiak 259e5dfa3f9SJonathan Dieter size = snprintf(sockfd_buff, sizeof(sockfd_buff), "%d\n", sockfd); 260e5dfa3f9SJonathan Dieter if (size < 0 || (unsigned int)size >= sizeof(sockfd_buff)) { 261e5dfa3f9SJonathan Dieter err("socket length %i >= %lu or < 0", size, 262e5dfa3f9SJonathan Dieter (long unsigned)sizeof(sockfd_buff)); 263e5dfa3f9SJonathan Dieter return -1; 264e5dfa3f9SJonathan Dieter } 2653391ba0eSKrzysztof Opasiak 2663391ba0eSKrzysztof Opasiak ret = write_sysfs_attribute(sockfd_attr_path, sockfd_buff, 2673391ba0eSKrzysztof Opasiak strlen(sockfd_buff)); 2683391ba0eSKrzysztof Opasiak if (ret < 0) { 2693391ba0eSKrzysztof Opasiak err("write_sysfs_attribute failed: sockfd %s to %s", 2703391ba0eSKrzysztof Opasiak sockfd_buff, sockfd_attr_path); 2713391ba0eSKrzysztof Opasiak return ret; 2723391ba0eSKrzysztof Opasiak } 2733391ba0eSKrzysztof Opasiak 2743391ba0eSKrzysztof Opasiak info("connect: %s", edev->udev.busid); 2753391ba0eSKrzysztof Opasiak 2763391ba0eSKrzysztof Opasiak return ret; 2773391ba0eSKrzysztof Opasiak } 2783391ba0eSKrzysztof Opasiak 2793391ba0eSKrzysztof Opasiak struct usbip_exported_device *usbip_generic_get_device( 2803391ba0eSKrzysztof Opasiak struct usbip_host_driver *hdriver, int num) 2813391ba0eSKrzysztof Opasiak { 2823391ba0eSKrzysztof Opasiak struct list_head *i; 2833391ba0eSKrzysztof Opasiak struct usbip_exported_device *edev; 2843391ba0eSKrzysztof Opasiak int cnt = 0; 2853391ba0eSKrzysztof Opasiak 2863391ba0eSKrzysztof Opasiak list_for_each(i, &hdriver->edev_list) { 2873391ba0eSKrzysztof Opasiak edev = list_entry(i, struct usbip_exported_device, node); 2883391ba0eSKrzysztof Opasiak if (num == cnt) 2893391ba0eSKrzysztof Opasiak return edev; 2903391ba0eSKrzysztof Opasiak cnt++; 2913391ba0eSKrzysztof Opasiak } 2923391ba0eSKrzysztof Opasiak 2933391ba0eSKrzysztof Opasiak return NULL; 2943391ba0eSKrzysztof Opasiak } 295