|
@@ -46,6 +46,9 @@ static int detach_port(char *port)
|
|
|
int ret = 0;
|
|
|
uint8_t portnum;
|
|
|
char path[PATH_MAX+1];
|
|
|
+ int i;
|
|
|
+ struct usbip_imported_device *idev;
|
|
|
+ int found = 0;
|
|
|
|
|
|
unsigned int port_len = strlen(port);
|
|
|
|
|
@@ -55,28 +58,46 @@ static int detach_port(char *port)
|
|
|
return -1;
|
|
|
}
|
|
|
|
|
|
- /* check max port */
|
|
|
-
|
|
|
portnum = atoi(port);
|
|
|
|
|
|
- /* remove the port state file */
|
|
|
-
|
|
|
- snprintf(path, PATH_MAX, VHCI_STATE_PATH"/port%d", portnum);
|
|
|
-
|
|
|
- remove(path);
|
|
|
- rmdir(VHCI_STATE_PATH);
|
|
|
-
|
|
|
ret = usbip_vhci_driver_open();
|
|
|
if (ret < 0) {
|
|
|
err("open vhci_driver");
|
|
|
return -1;
|
|
|
}
|
|
|
|
|
|
+ /* check for invalid port */
|
|
|
+ for (i = 0; i < vhci_driver->nports; i++) {
|
|
|
+ idev = &vhci_driver->idev[i];
|
|
|
+
|
|
|
+ if (idev->port == portnum) {
|
|
|
+ found = 1;
|
|
|
+ if (idev->status != VDEV_ST_NULL)
|
|
|
+ break;
|
|
|
+ info("Port %d is already detached!\n", idev->port);
|
|
|
+ goto call_driver_close;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!found) {
|
|
|
+ err("Invalid port %s > maxports %d",
|
|
|
+ port, vhci_driver->nports);
|
|
|
+ goto call_driver_close;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* remove the port state file */
|
|
|
+ snprintf(path, PATH_MAX, VHCI_STATE_PATH"/port%d", portnum);
|
|
|
+
|
|
|
+ remove(path);
|
|
|
+ rmdir(VHCI_STATE_PATH);
|
|
|
+
|
|
|
ret = usbip_vhci_detach_device(portnum);
|
|
|
if (ret < 0) {
|
|
|
ret = -1;
|
|
|
+ err("Port %d detach request failed!\n", portnum);
|
|
|
goto call_driver_close;
|
|
|
}
|
|
|
+ info("Port %d is now detached!\n", portnum);
|
|
|
|
|
|
call_driver_close:
|
|
|
usbip_vhci_driver_close();
|