^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright (C) 2003-2008 Takahiro Hirofuchi
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (C) 2015-2016 Nobuo Iwata
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/kthread.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/file.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/net.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) /* Hardening for Spectre-v1 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/nospec.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include "usbip_common.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include "vhci.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) /* TODO: refine locking ?*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) * output example:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) * hub port sta spd dev sockfd local_busid
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) * hs 0000 004 000 00000000 000003 1-2.3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) * ................................................
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) * ss 0008 004 000 00000000 000004 2-3.4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) * ................................................
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) * Output includes socket fd instead of socket pointer address to avoid
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) * leaking kernel memory address in:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) * /sys/devices/platform/vhci_hcd.0/status and in debug output.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) * The socket pointer address is not used at the moment and it was made
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) * visible as a convenient way to find IP address from socket pointer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) * address by looking up /proc/net/{tcp,tcp6}. As this opens a security
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) * hole, the change is made to use sockfd instead.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) static void port_show_vhci(char **out, int hub, int port, struct vhci_device *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) if (hub == HUB_SPEED_HIGH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) *out += sprintf(*out, "hs %04u %03u ",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) port, vdev->ud.status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) else /* hub == HUB_SPEED_SUPER */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) *out += sprintf(*out, "ss %04u %03u ",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) port, vdev->ud.status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) if (vdev->ud.status == VDEV_ST_USED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) *out += sprintf(*out, "%03u %08x ",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) vdev->speed, vdev->devid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) *out += sprintf(*out, "%06u %s",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) vdev->ud.sockfd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) dev_name(&vdev->udev->dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) *out += sprintf(*out, "000 00000000 ");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) *out += sprintf(*out, "000000 0-0");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) *out += sprintf(*out, "\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) /* Sysfs entry to show port status */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) static ssize_t status_show_vhci(int pdev_nr, char *out)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) struct platform_device *pdev = vhcis[pdev_nr].pdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) struct vhci *vhci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) struct usb_hcd *hcd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) struct vhci_hcd *vhci_hcd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) char *s = out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) if (!pdev || !out) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) usbip_dbg_vhci_sysfs("show status error\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) hcd = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) vhci_hcd = hcd_to_vhci_hcd(hcd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) vhci = vhci_hcd->vhci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) spin_lock_irqsave(&vhci->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) for (i = 0; i < VHCI_HC_PORTS; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) struct vhci_device *vdev = &vhci->vhci_hcd_hs->vdev[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) spin_lock(&vdev->ud.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) port_show_vhci(&out, HUB_SPEED_HIGH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) pdev_nr * VHCI_PORTS + i, vdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) spin_unlock(&vdev->ud.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) for (i = 0; i < VHCI_HC_PORTS; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) struct vhci_device *vdev = &vhci->vhci_hcd_ss->vdev[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) spin_lock(&vdev->ud.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) port_show_vhci(&out, HUB_SPEED_SUPER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) pdev_nr * VHCI_PORTS + VHCI_HC_PORTS + i, vdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) spin_unlock(&vdev->ud.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) spin_unlock_irqrestore(&vhci->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) return out - s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) static ssize_t status_show_not_ready(int pdev_nr, char *out)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) char *s = out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) int i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) for (i = 0; i < VHCI_HC_PORTS; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) out += sprintf(out, "hs %04u %03u ",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) (pdev_nr * VHCI_PORTS) + i,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) VDEV_ST_NOTASSIGNED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) out += sprintf(out, "000 00000000 0000000000000000 0-0");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) out += sprintf(out, "\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) for (i = 0; i < VHCI_HC_PORTS; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) out += sprintf(out, "ss %04u %03u ",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) (pdev_nr * VHCI_PORTS) + VHCI_HC_PORTS + i,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) VDEV_ST_NOTASSIGNED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) out += sprintf(out, "000 00000000 0000000000000000 0-0");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) out += sprintf(out, "\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) return out - s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) static int status_name_to_id(const char *name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) char *c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) long val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) c = strchr(name, '.');
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) if (c == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) ret = kstrtol(c+1, 10, &val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) static ssize_t status_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) struct device_attribute *attr, char *out)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) char *s = out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) int pdev_nr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) out += sprintf(out,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) "hub port sta spd dev sockfd local_busid\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) pdev_nr = status_name_to_id(attr->attr.name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) if (pdev_nr < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) out += status_show_not_ready(pdev_nr, out);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) out += status_show_vhci(pdev_nr, out);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) return out - s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) static ssize_t nports_show(struct device *dev, struct device_attribute *attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) char *out)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) char *s = out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) * Half the ports are for SPEED_HIGH and half for SPEED_SUPER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) * thus the * 2.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) out += sprintf(out, "%d\n", VHCI_PORTS * vhci_num_controllers);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) return out - s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) static DEVICE_ATTR_RO(nports);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) /* Sysfs entry to shutdown a virtual connection */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) static int vhci_port_disconnect(struct vhci_hcd *vhci_hcd, __u32 rhport)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) struct vhci_device *vdev = &vhci_hcd->vdev[rhport];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) struct vhci *vhci = vhci_hcd->vhci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) usbip_dbg_vhci_sysfs("enter\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) mutex_lock(&vdev->ud.sysfs_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) /* lock */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) spin_lock_irqsave(&vhci->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) spin_lock(&vdev->ud.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) if (vdev->ud.status == VDEV_ST_NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) pr_err("not connected %d\n", vdev->ud.status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) /* unlock */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) spin_unlock(&vdev->ud.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) spin_unlock_irqrestore(&vhci->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) mutex_unlock(&vdev->ud.sysfs_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) /* unlock */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) spin_unlock(&vdev->ud.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) spin_unlock_irqrestore(&vhci->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) usbip_event_add(&vdev->ud, VDEV_EVENT_DOWN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) mutex_unlock(&vdev->ud.sysfs_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) static int valid_port(__u32 *pdev_nr, __u32 *rhport)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) if (*pdev_nr >= vhci_num_controllers) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) pr_err("pdev %u\n", *pdev_nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) *pdev_nr = array_index_nospec(*pdev_nr, vhci_num_controllers);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) if (*rhport >= VHCI_HC_PORTS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) pr_err("rhport %u\n", *rhport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) *rhport = array_index_nospec(*rhport, VHCI_HC_PORTS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) static ssize_t detach_store(struct device *dev, struct device_attribute *attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) const char *buf, size_t count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) __u32 port = 0, pdev_nr = 0, rhport = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) struct usb_hcd *hcd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) struct vhci_hcd *vhci_hcd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) if (kstrtoint(buf, 10, &port) < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) pdev_nr = port_to_pdev_nr(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) rhport = port_to_rhport(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) if (!valid_port(&pdev_nr, &rhport))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) hcd = platform_get_drvdata(vhcis[pdev_nr].pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) if (hcd == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) dev_err(dev, "port is not ready %u\n", port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) usbip_dbg_vhci_sysfs("rhport %d\n", rhport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) if ((port / VHCI_HC_PORTS) % 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) vhci_hcd = hcd_to_vhci_hcd(hcd)->vhci->vhci_hcd_ss;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) vhci_hcd = hcd_to_vhci_hcd(hcd)->vhci->vhci_hcd_hs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) ret = vhci_port_disconnect(vhci_hcd, rhport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) usbip_dbg_vhci_sysfs("Leave\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) return count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) static DEVICE_ATTR_WO(detach);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) static int valid_args(__u32 *pdev_nr, __u32 *rhport,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) enum usb_device_speed speed)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) if (!valid_port(pdev_nr, rhport)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) switch (speed) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) case USB_SPEED_LOW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) case USB_SPEED_FULL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) case USB_SPEED_HIGH:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) case USB_SPEED_WIRELESS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) case USB_SPEED_SUPER:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) pr_err("Failed attach request for unsupported USB speed: %s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) usb_speed_string(speed));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) /* Sysfs entry to establish a virtual connection */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) * To start a new USB/IP attachment, a userland program needs to setup a TCP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) * connection and then write its socket descriptor with remote device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) * information into this sysfs file.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) * A remote device is virtually attached to the root-hub port of @rhport with
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) * @speed. @devid is embedded into a request to specify the remote device in a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) * server host.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) * write() returns 0 on success, else negative errno.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) static ssize_t attach_store(struct device *dev, struct device_attribute *attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) const char *buf, size_t count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) struct socket *socket;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) int sockfd = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) __u32 port = 0, pdev_nr = 0, rhport = 0, devid = 0, speed = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) struct usb_hcd *hcd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) struct vhci_hcd *vhci_hcd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) struct vhci_device *vdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) struct vhci *vhci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) struct task_struct *tcp_rx = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) struct task_struct *tcp_tx = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) * @rhport: port number of vhci_hcd
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) * @sockfd: socket descriptor of an established TCP connection
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) * @devid: unique device identifier in a remote host
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) * @speed: usb device speed in a remote host
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) if (sscanf(buf, "%u %u %u %u", &port, &sockfd, &devid, &speed) != 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) pdev_nr = port_to_pdev_nr(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) rhport = port_to_rhport(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) usbip_dbg_vhci_sysfs("port(%u) pdev(%d) rhport(%u)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) port, pdev_nr, rhport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) usbip_dbg_vhci_sysfs("sockfd(%u) devid(%u) speed(%u)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) sockfd, devid, speed);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) /* check received parameters */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) if (!valid_args(&pdev_nr, &rhport, speed))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) hcd = platform_get_drvdata(vhcis[pdev_nr].pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) if (hcd == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) dev_err(dev, "port %d is not ready\n", port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) vhci_hcd = hcd_to_vhci_hcd(hcd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) vhci = vhci_hcd->vhci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) if (speed == USB_SPEED_SUPER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) vdev = &vhci->vhci_hcd_ss->vdev[rhport];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) vdev = &vhci->vhci_hcd_hs->vdev[rhport];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) mutex_lock(&vdev->ud.sysfs_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) /* Extract socket from fd. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) socket = sockfd_lookup(sockfd, &err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) if (!socket) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) dev_err(dev, "failed to lookup sock");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) goto unlock_mutex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) if (socket->type != SOCK_STREAM) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) dev_err(dev, "Expecting SOCK_STREAM - found %d",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) socket->type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) sockfd_put(socket);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) goto unlock_mutex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) /* create threads before locking */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) tcp_rx = kthread_create(vhci_rx_loop, &vdev->ud, "vhci_rx");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) if (IS_ERR(tcp_rx)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) sockfd_put(socket);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) goto unlock_mutex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) tcp_tx = kthread_create(vhci_tx_loop, &vdev->ud, "vhci_tx");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) if (IS_ERR(tcp_tx)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) kthread_stop(tcp_rx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) sockfd_put(socket);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) goto unlock_mutex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) /* get task structs now */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) get_task_struct(tcp_rx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) get_task_struct(tcp_tx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) /* now begin lock until setting vdev status set */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) spin_lock_irqsave(&vhci->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) spin_lock(&vdev->ud.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) if (vdev->ud.status != VDEV_ST_NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) /* end of the lock */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) spin_unlock(&vdev->ud.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) spin_unlock_irqrestore(&vhci->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) sockfd_put(socket);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) kthread_stop_put(tcp_rx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) kthread_stop_put(tcp_tx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) dev_err(dev, "port %d already used\n", rhport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) * Will be retried from userspace
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) * if there's another free port.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) err = -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) goto unlock_mutex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) dev_info(dev, "pdev(%u) rhport(%u) sockfd(%d)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) pdev_nr, rhport, sockfd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) dev_info(dev, "devid(%u) speed(%u) speed_str(%s)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) devid, speed, usb_speed_string(speed));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) vdev->devid = devid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) vdev->speed = speed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) vdev->ud.sockfd = sockfd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) vdev->ud.tcp_socket = socket;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) vdev->ud.tcp_rx = tcp_rx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) vdev->ud.tcp_tx = tcp_tx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) vdev->ud.status = VDEV_ST_NOTASSIGNED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) spin_unlock(&vdev->ud.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) spin_unlock_irqrestore(&vhci->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) /* end the lock */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) wake_up_process(vdev->ud.tcp_rx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) wake_up_process(vdev->ud.tcp_tx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) rh_port_connect(vdev, speed);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) dev_info(dev, "Device attached\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) mutex_unlock(&vdev->ud.sysfs_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) return count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) unlock_mutex:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) mutex_unlock(&vdev->ud.sysfs_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) static DEVICE_ATTR_WO(attach);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) #define MAX_STATUS_NAME 16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) struct status_attr {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) struct device_attribute attr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) char name[MAX_STATUS_NAME+1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) static struct status_attr *status_attrs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) static void set_status_attr(int id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) struct status_attr *status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) status = status_attrs + id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) if (id == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) strcpy(status->name, "status");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) snprintf(status->name, MAX_STATUS_NAME+1, "status.%d", id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) status->attr.attr.name = status->name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) status->attr.attr.mode = S_IRUGO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) status->attr.show = status_show;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) sysfs_attr_init(&status->attr.attr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) static int init_status_attrs(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) int id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) status_attrs = kcalloc(vhci_num_controllers, sizeof(struct status_attr),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) if (status_attrs == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) for (id = 0; id < vhci_num_controllers; id++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) set_status_attr(id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) static void finish_status_attrs(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) kfree(status_attrs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) struct attribute_group vhci_attr_group = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) .attrs = NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) int vhci_init_attr_group(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) struct attribute **attrs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) int ret, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) attrs = kcalloc((vhci_num_controllers + 5), sizeof(struct attribute *),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) if (attrs == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) ret = init_status_attrs();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) kfree(attrs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) *attrs = &dev_attr_nports.attr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) *(attrs + 1) = &dev_attr_detach.attr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) *(attrs + 2) = &dev_attr_attach.attr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) *(attrs + 3) = &dev_attr_usbip_debug.attr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) for (i = 0; i < vhci_num_controllers; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) *(attrs + i + 4) = &((status_attrs + i)->attr.attr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) vhci_attr_group.attrs = attrs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) void vhci_finish_attr_group(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) finish_status_attrs();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) kfree(vhci_attr_group.attrs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags