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