1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright (C) 2011 matt mooney <mfm@muteddisk.com>
4*4882a593Smuzhiyun * 2005-2007 Takahiro Hirofuchi
5*4882a593Smuzhiyun */
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun #include <ctype.h>
8*4882a593Smuzhiyun #include <limits.h>
9*4882a593Smuzhiyun #include <stdint.h>
10*4882a593Smuzhiyun #include <stdio.h>
11*4882a593Smuzhiyun #include <stdlib.h>
12*4882a593Smuzhiyun #include <string.h>
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun #include <getopt.h>
15*4882a593Smuzhiyun #include <unistd.h>
16*4882a593Smuzhiyun
17*4882a593Smuzhiyun #include "vhci_driver.h"
18*4882a593Smuzhiyun #include "usbip_common.h"
19*4882a593Smuzhiyun #include "usbip_network.h"
20*4882a593Smuzhiyun #include "usbip.h"
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun static const char usbip_detach_usage_string[] =
23*4882a593Smuzhiyun "usbip detach <args>\n"
24*4882a593Smuzhiyun " -p, --port=<port> " USBIP_VHCI_DRV_NAME
25*4882a593Smuzhiyun " port the device is on\n";
26*4882a593Smuzhiyun
usbip_detach_usage(void)27*4882a593Smuzhiyun void usbip_detach_usage(void)
28*4882a593Smuzhiyun {
29*4882a593Smuzhiyun printf("usage: %s", usbip_detach_usage_string);
30*4882a593Smuzhiyun }
31*4882a593Smuzhiyun
detach_port(char * port)32*4882a593Smuzhiyun static int detach_port(char *port)
33*4882a593Smuzhiyun {
34*4882a593Smuzhiyun int ret = 0;
35*4882a593Smuzhiyun uint8_t portnum;
36*4882a593Smuzhiyun char path[PATH_MAX+1];
37*4882a593Smuzhiyun int i;
38*4882a593Smuzhiyun struct usbip_imported_device *idev;
39*4882a593Smuzhiyun int found = 0;
40*4882a593Smuzhiyun
41*4882a593Smuzhiyun unsigned int port_len = strlen(port);
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun for (unsigned int i = 0; i < port_len; i++)
44*4882a593Smuzhiyun if (!isdigit(port[i])) {
45*4882a593Smuzhiyun err("invalid port %s", port);
46*4882a593Smuzhiyun return -1;
47*4882a593Smuzhiyun }
48*4882a593Smuzhiyun
49*4882a593Smuzhiyun portnum = atoi(port);
50*4882a593Smuzhiyun
51*4882a593Smuzhiyun ret = usbip_vhci_driver_open();
52*4882a593Smuzhiyun if (ret < 0) {
53*4882a593Smuzhiyun err("open vhci_driver");
54*4882a593Smuzhiyun return -1;
55*4882a593Smuzhiyun }
56*4882a593Smuzhiyun
57*4882a593Smuzhiyun /* check for invalid port */
58*4882a593Smuzhiyun for (i = 0; i < vhci_driver->nports; i++) {
59*4882a593Smuzhiyun idev = &vhci_driver->idev[i];
60*4882a593Smuzhiyun
61*4882a593Smuzhiyun if (idev->port == portnum) {
62*4882a593Smuzhiyun found = 1;
63*4882a593Smuzhiyun if (idev->status != VDEV_ST_NULL)
64*4882a593Smuzhiyun break;
65*4882a593Smuzhiyun info("Port %d is already detached!\n", idev->port);
66*4882a593Smuzhiyun goto call_driver_close;
67*4882a593Smuzhiyun }
68*4882a593Smuzhiyun }
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun if (!found) {
71*4882a593Smuzhiyun err("Invalid port %s > maxports %d",
72*4882a593Smuzhiyun port, vhci_driver->nports);
73*4882a593Smuzhiyun goto call_driver_close;
74*4882a593Smuzhiyun }
75*4882a593Smuzhiyun
76*4882a593Smuzhiyun /* remove the port state file */
77*4882a593Smuzhiyun snprintf(path, PATH_MAX, VHCI_STATE_PATH"/port%d", portnum);
78*4882a593Smuzhiyun
79*4882a593Smuzhiyun remove(path);
80*4882a593Smuzhiyun rmdir(VHCI_STATE_PATH);
81*4882a593Smuzhiyun
82*4882a593Smuzhiyun ret = usbip_vhci_detach_device(portnum);
83*4882a593Smuzhiyun if (ret < 0) {
84*4882a593Smuzhiyun ret = -1;
85*4882a593Smuzhiyun err("Port %d detach request failed!\n", portnum);
86*4882a593Smuzhiyun goto call_driver_close;
87*4882a593Smuzhiyun }
88*4882a593Smuzhiyun info("Port %d is now detached!\n", portnum);
89*4882a593Smuzhiyun
90*4882a593Smuzhiyun call_driver_close:
91*4882a593Smuzhiyun usbip_vhci_driver_close();
92*4882a593Smuzhiyun
93*4882a593Smuzhiyun return ret;
94*4882a593Smuzhiyun }
95*4882a593Smuzhiyun
usbip_detach(int argc,char * argv[])96*4882a593Smuzhiyun int usbip_detach(int argc, char *argv[])
97*4882a593Smuzhiyun {
98*4882a593Smuzhiyun static const struct option opts[] = {
99*4882a593Smuzhiyun { "port", required_argument, NULL, 'p' },
100*4882a593Smuzhiyun { NULL, 0, NULL, 0 }
101*4882a593Smuzhiyun };
102*4882a593Smuzhiyun int opt;
103*4882a593Smuzhiyun int ret = -1;
104*4882a593Smuzhiyun
105*4882a593Smuzhiyun for (;;) {
106*4882a593Smuzhiyun opt = getopt_long(argc, argv, "p:", opts, NULL);
107*4882a593Smuzhiyun
108*4882a593Smuzhiyun if (opt == -1)
109*4882a593Smuzhiyun break;
110*4882a593Smuzhiyun
111*4882a593Smuzhiyun switch (opt) {
112*4882a593Smuzhiyun case 'p':
113*4882a593Smuzhiyun ret = detach_port(optarg);
114*4882a593Smuzhiyun goto out;
115*4882a593Smuzhiyun default:
116*4882a593Smuzhiyun goto err_out;
117*4882a593Smuzhiyun }
118*4882a593Smuzhiyun }
119*4882a593Smuzhiyun
120*4882a593Smuzhiyun err_out:
121*4882a593Smuzhiyun usbip_detach_usage();
122*4882a593Smuzhiyun out:
123*4882a593Smuzhiyun return ret;
124*4882a593Smuzhiyun }
125