Blame view

kernel/linux-rt-4.4.41/tools/usb/usbip/src/usbip_detach.c 2.27 KB
5113f6f70   김현기   kernel add
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
  /*
   * Copyright (C) 2011 matt mooney <mfm@muteddisk.com>
   *               2005-2007 Takahiro Hirofuchi
   *
   * This program is free software: you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation, either version 2 of the License, or
   * (at your option) any later version.
   *
   * This program is distributed in the hope that it will be useful,
   * but WITHOUT ANY WARRANTY; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
   * GNU General Public License for more details.
   *
   * You should have received a copy of the GNU General Public License
   * along with this program. If not, see <http://www.gnu.org/licenses/>.
   */
  
  #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>
  "
  	"    -p, --port=<port>    " USBIP_VHCI_DRV_NAME
  	" port the device is on
  ";
  
  void usbip_detach_usage(void)
  {
  	printf("usage: %s", usbip_detach_usage_string);
  }
  
  static int detach_port(char *port)
  {
  	int ret;
  	uint8_t portnum;
  	char path[PATH_MAX+1];
  
  	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;
  		}
  
  	/* 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;
  	}
  
  	ret = usbip_vhci_detach_device(portnum);
  	if (ret < 0)
  		return -1;
  
  	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;
  }