xref: /openbmc/linux/tools/usb/usbip/src/usbip_detach.c (revision d2574c33)
1 /*
2  * Copyright (C) 2011 matt mooney <mfm@muteddisk.com>
3  *               2005-2007 Takahiro Hirofuchi
4  *
5  * This program is free software: you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation, either version 2 of the License, or
8  * (at your option) any later version.
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13  * GNU General Public License for more details.
14  *
15  * You should have received a copy of the GNU General Public License
16  * along with this program. If not, see <http://www.gnu.org/licenses/>.
17  */
18 
19 #include <ctype.h>
20 #include <limits.h>
21 #include <stdint.h>
22 #include <stdio.h>
23 #include <stdlib.h>
24 #include <string.h>
25 
26 #include <getopt.h>
27 #include <unistd.h>
28 
29 #include "vhci_driver.h"
30 #include "usbip_common.h"
31 #include "usbip_network.h"
32 #include "usbip.h"
33 
34 static const char usbip_detach_usage_string[] =
35 	"usbip detach <args>\n"
36 	"    -p, --port=<port>    " USBIP_VHCI_DRV_NAME
37 	" port the device is on\n";
38 
39 void usbip_detach_usage(void)
40 {
41 	printf("usage: %s", usbip_detach_usage_string);
42 }
43 
44 static int detach_port(char *port)
45 {
46 	int ret = 0;
47 	uint8_t portnum;
48 	char path[PATH_MAX+1];
49 	int i;
50 	struct usbip_imported_device *idev;
51 	int found = 0;
52 
53 	unsigned int port_len = strlen(port);
54 
55 	for (unsigned int i = 0; i < port_len; i++)
56 		if (!isdigit(port[i])) {
57 			err("invalid port %s", port);
58 			return -1;
59 		}
60 
61 	portnum = atoi(port);
62 
63 	ret = usbip_vhci_driver_open();
64 	if (ret < 0) {
65 		err("open vhci_driver");
66 		return -1;
67 	}
68 
69 	/* check for invalid port */
70 	for (i = 0; i < vhci_driver->nports; i++) {
71 		idev = &vhci_driver->idev[i];
72 
73 		if (idev->port == portnum) {
74 			found = 1;
75 			if (idev->status != VDEV_ST_NULL)
76 				break;
77 			info("Port %d is already detached!\n", idev->port);
78 			goto call_driver_close;
79 		}
80 	}
81 
82 	if (!found) {
83 		err("Invalid port %s > maxports %d",
84 			port, vhci_driver->nports);
85 		goto call_driver_close;
86 	}
87 
88 	/* remove the port state file */
89 	snprintf(path, PATH_MAX, VHCI_STATE_PATH"/port%d", portnum);
90 
91 	remove(path);
92 	rmdir(VHCI_STATE_PATH);
93 
94 	ret = usbip_vhci_detach_device(portnum);
95 	if (ret < 0) {
96 		ret = -1;
97 		err("Port %d detach request failed!\n", portnum);
98 		goto call_driver_close;
99 	}
100 	info("Port %d is now detached!\n", portnum);
101 
102 call_driver_close:
103 	usbip_vhci_driver_close();
104 
105 	return ret;
106 }
107 
108 int usbip_detach(int argc, char *argv[])
109 {
110 	static const struct option opts[] = {
111 		{ "port", required_argument, NULL, 'p' },
112 		{ NULL, 0, NULL, 0 }
113 	};
114 	int opt;
115 	int ret = -1;
116 
117 	for (;;) {
118 		opt = getopt_long(argc, argv, "p:", opts, NULL);
119 
120 		if (opt == -1)
121 			break;
122 
123 		switch (opt) {
124 		case 'p':
125 			ret = detach_port(optarg);
126 			goto out;
127 		default:
128 			goto err_out;
129 		}
130 	}
131 
132 err_out:
133 	usbip_detach_usage();
134 out:
135 	return ret;
136 }
137