root / usb-bsd.c @ 2c277908
History | View | Annotate | Download (16.6 kB)
1 | 68063649 | blueswir1 | /*
|
---|---|---|---|
2 | 68063649 | blueswir1 | * BSD host USB redirector
|
3 | 68063649 | blueswir1 | *
|
4 | 68063649 | blueswir1 | * Copyright (c) 2006 Lonnie Mendez
|
5 | 68063649 | blueswir1 | * Portions of code and concepts borrowed from
|
6 | 68063649 | blueswir1 | * usb-linux.c and libusb's bsd.c and are copyright their respective owners.
|
7 | 68063649 | blueswir1 | *
|
8 | 68063649 | blueswir1 | * Permission is hereby granted, free of charge, to any person obtaining a copy
|
9 | 68063649 | blueswir1 | * of this software and associated documentation files (the "Software"), to deal
|
10 | 68063649 | blueswir1 | * in the Software without restriction, including without limitation the rights
|
11 | 68063649 | blueswir1 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
12 | 68063649 | blueswir1 | * copies of the Software, and to permit persons to whom the Software is
|
13 | 68063649 | blueswir1 | * furnished to do so, subject to the following conditions:
|
14 | 68063649 | blueswir1 | *
|
15 | 68063649 | blueswir1 | * The above copyright notice and this permission notice shall be included in
|
16 | 68063649 | blueswir1 | * all copies or substantial portions of the Software.
|
17 | 68063649 | blueswir1 | *
|
18 | 68063649 | blueswir1 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
19 | 68063649 | blueswir1 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
20 | 68063649 | blueswir1 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
21 | 68063649 | blueswir1 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
22 | 68063649 | blueswir1 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
23 | 68063649 | blueswir1 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
24 | 68063649 | blueswir1 | * THE SOFTWARE.
|
25 | 68063649 | blueswir1 | */
|
26 | 68063649 | blueswir1 | |
27 | 68063649 | blueswir1 | #include "qemu-common.h" |
28 | 68063649 | blueswir1 | #include "console.h" |
29 | 68063649 | blueswir1 | #include "hw/usb.h" |
30 | 68063649 | blueswir1 | |
31 | 68063649 | blueswir1 | /* usb.h declares these */
|
32 | 68063649 | blueswir1 | #undef USB_SPEED_HIGH
|
33 | 68063649 | blueswir1 | #undef USB_SPEED_FULL
|
34 | 68063649 | blueswir1 | #undef USB_SPEED_LOW
|
35 | 68063649 | blueswir1 | |
36 | 68063649 | blueswir1 | #include <sys/ioctl.h> |
37 | 68063649 | blueswir1 | #include <dev/usb/usb.h> |
38 | 68063649 | blueswir1 | #include <signal.h> |
39 | 68063649 | blueswir1 | |
40 | 68063649 | blueswir1 | /* This value has maximum potential at 16.
|
41 | 68063649 | blueswir1 | * You should also set hw.usb.debug to gain
|
42 | 68063649 | blueswir1 | * more detailed view.
|
43 | 68063649 | blueswir1 | */
|
44 | 68063649 | blueswir1 | //#define DEBUG
|
45 | 68063649 | blueswir1 | #define UGEN_DEBUG_LEVEL 0 |
46 | 68063649 | blueswir1 | |
47 | 68063649 | blueswir1 | |
48 | 68063649 | blueswir1 | typedef int USBScanFunc(void *opaque, int bus_num, int addr, int class_id, |
49 | 68063649 | blueswir1 | int vendor_id, int product_id, |
50 | 68063649 | blueswir1 | const char *product_name, int speed); |
51 | 68063649 | blueswir1 | static int usb_host_find_device(int *pbus_num, int *paddr, |
52 | 68063649 | blueswir1 | const char *devname); |
53 | 68063649 | blueswir1 | |
54 | 68063649 | blueswir1 | typedef struct USBHostDevice { |
55 | 68063649 | blueswir1 | USBDevice dev; |
56 | 68063649 | blueswir1 | int ep_fd[USB_MAX_ENDPOINTS];
|
57 | 68063649 | blueswir1 | int devfd;
|
58 | 68063649 | blueswir1 | char devpath[32]; |
59 | 68063649 | blueswir1 | } USBHostDevice; |
60 | 68063649 | blueswir1 | |
61 | 68063649 | blueswir1 | |
62 | 68063649 | blueswir1 | static int ensure_ep_open(USBHostDevice *dev, int ep, int mode) |
63 | 68063649 | blueswir1 | { |
64 | 68063649 | blueswir1 | char buf[32]; |
65 | 68063649 | blueswir1 | int fd;
|
66 | 68063649 | blueswir1 | |
67 | 68063649 | blueswir1 | /* Get the address for this endpoint */
|
68 | 68063649 | blueswir1 | ep = UE_GET_ADDR(ep); |
69 | 68063649 | blueswir1 | |
70 | 68063649 | blueswir1 | if (dev->ep_fd[ep] < 0) { |
71 | a38131b6 | blueswir1 | #ifdef __FreeBSD__
|
72 | 68063649 | blueswir1 | snprintf(buf, sizeof(buf) - 1, "%s.%d", dev->devpath, ep); |
73 | 68063649 | blueswir1 | #else
|
74 | 68063649 | blueswir1 | snprintf(buf, sizeof(buf) - 1, "%s.%02d", dev->devpath, ep); |
75 | 68063649 | blueswir1 | #endif
|
76 | 68063649 | blueswir1 | /* Try to open it O_RDWR first for those devices which have in and out
|
77 | 68063649 | blueswir1 | * endpoints with the same address (eg 0x02 and 0x82)
|
78 | 68063649 | blueswir1 | */
|
79 | 68063649 | blueswir1 | fd = open(buf, O_RDWR); |
80 | 68063649 | blueswir1 | if (fd < 0 && errno == ENXIO) |
81 | 68063649 | blueswir1 | fd = open(buf, mode); |
82 | 68063649 | blueswir1 | if (fd < 0) { |
83 | 68063649 | blueswir1 | #ifdef DEBUG
|
84 | 68063649 | blueswir1 | printf("ensure_ep_open: failed to open device endpoint %s: %s\n",
|
85 | 68063649 | blueswir1 | buf, strerror(errno)); |
86 | 68063649 | blueswir1 | #endif
|
87 | 68063649 | blueswir1 | } |
88 | 68063649 | blueswir1 | dev->ep_fd[ep] = fd; |
89 | 68063649 | blueswir1 | } |
90 | 68063649 | blueswir1 | |
91 | 68063649 | blueswir1 | return dev->ep_fd[ep];
|
92 | 68063649 | blueswir1 | } |
93 | 68063649 | blueswir1 | |
94 | 68063649 | blueswir1 | static void ensure_eps_closed(USBHostDevice *dev) |
95 | 68063649 | blueswir1 | { |
96 | 68063649 | blueswir1 | int epnum = 1; |
97 | 68063649 | blueswir1 | |
98 | 68063649 | blueswir1 | if (!dev)
|
99 | 68063649 | blueswir1 | return;
|
100 | 68063649 | blueswir1 | |
101 | 68063649 | blueswir1 | while (epnum < USB_MAX_ENDPOINTS) {
|
102 | 68063649 | blueswir1 | if (dev->ep_fd[epnum] >= 0) { |
103 | 68063649 | blueswir1 | close(dev->ep_fd[epnum]); |
104 | 68063649 | blueswir1 | dev->ep_fd[epnum] = -1;
|
105 | 68063649 | blueswir1 | } |
106 | 68063649 | blueswir1 | epnum++; |
107 | 68063649 | blueswir1 | } |
108 | 68063649 | blueswir1 | } |
109 | 68063649 | blueswir1 | |
110 | 68063649 | blueswir1 | static void usb_host_handle_reset(USBDevice *dev) |
111 | 68063649 | blueswir1 | { |
112 | 68063649 | blueswir1 | #if 0
|
113 | 68063649 | blueswir1 | USBHostDevice *s = (USBHostDevice *)dev;
|
114 | 68063649 | blueswir1 | #endif
|
115 | 68063649 | blueswir1 | } |
116 | 68063649 | blueswir1 | |
117 | 68063649 | blueswir1 | /* XXX:
|
118 | 68063649 | blueswir1 | * -check device states against transfer requests
|
119 | 68063649 | blueswir1 | * and return appropriate response
|
120 | 68063649 | blueswir1 | */
|
121 | 68063649 | blueswir1 | static int usb_host_handle_control(USBDevice *dev, |
122 | 68063649 | blueswir1 | int request,
|
123 | 68063649 | blueswir1 | int value,
|
124 | 68063649 | blueswir1 | int index,
|
125 | 68063649 | blueswir1 | int length,
|
126 | 68063649 | blueswir1 | uint8_t *data) |
127 | 68063649 | blueswir1 | { |
128 | 68063649 | blueswir1 | USBHostDevice *s = (USBHostDevice *)dev; |
129 | 68063649 | blueswir1 | struct usb_ctl_request req;
|
130 | 68063649 | blueswir1 | struct usb_alt_interface aiface;
|
131 | 68063649 | blueswir1 | int ret, timeout = 50; |
132 | 68063649 | blueswir1 | |
133 | 68063649 | blueswir1 | if ((request >> 8) == UT_WRITE_DEVICE && |
134 | 68063649 | blueswir1 | (request & 0xff) == UR_SET_ADDRESS) {
|
135 | 68063649 | blueswir1 | |
136 | 68063649 | blueswir1 | /* specific SET_ADDRESS support */
|
137 | 68063649 | blueswir1 | dev->addr = value; |
138 | 68063649 | blueswir1 | return 0; |
139 | 68063649 | blueswir1 | } else if ((request >> 8) == UT_WRITE_DEVICE && |
140 | 68063649 | blueswir1 | (request & 0xff) == UR_SET_CONFIG) {
|
141 | 68063649 | blueswir1 | |
142 | 68063649 | blueswir1 | ensure_eps_closed(s); /* can't do this without all eps closed */
|
143 | 68063649 | blueswir1 | |
144 | 68063649 | blueswir1 | ret = ioctl(s->devfd, USB_SET_CONFIG, &value); |
145 | 68063649 | blueswir1 | if (ret < 0) { |
146 | 68063649 | blueswir1 | #ifdef DEBUG
|
147 | 68063649 | blueswir1 | printf("handle_control: failed to set configuration - %s\n",
|
148 | 68063649 | blueswir1 | strerror(errno)); |
149 | 68063649 | blueswir1 | #endif
|
150 | 68063649 | blueswir1 | return USB_RET_STALL;
|
151 | 68063649 | blueswir1 | } |
152 | 68063649 | blueswir1 | |
153 | 68063649 | blueswir1 | return 0; |
154 | 68063649 | blueswir1 | } else if ((request >> 8) == UT_WRITE_INTERFACE && |
155 | 68063649 | blueswir1 | (request & 0xff) == UR_SET_INTERFACE) {
|
156 | 68063649 | blueswir1 | |
157 | 68063649 | blueswir1 | aiface.uai_interface_index = index; |
158 | 68063649 | blueswir1 | aiface.uai_alt_no = value; |
159 | 68063649 | blueswir1 | |
160 | 68063649 | blueswir1 | ensure_eps_closed(s); /* can't do this without all eps closed */
|
161 | 68063649 | blueswir1 | ret = ioctl(s->devfd, USB_SET_ALTINTERFACE, &aiface); |
162 | 68063649 | blueswir1 | if (ret < 0) { |
163 | 68063649 | blueswir1 | #ifdef DEBUG
|
164 | 68063649 | blueswir1 | printf("handle_control: failed to set alternate interface - %s\n",
|
165 | 68063649 | blueswir1 | strerror(errno)); |
166 | 68063649 | blueswir1 | #endif
|
167 | 68063649 | blueswir1 | return USB_RET_STALL;
|
168 | 68063649 | blueswir1 | } |
169 | 68063649 | blueswir1 | |
170 | 68063649 | blueswir1 | return 0; |
171 | 68063649 | blueswir1 | } else {
|
172 | 68063649 | blueswir1 | req.ucr_request.bmRequestType = request >> 8;
|
173 | 68063649 | blueswir1 | req.ucr_request.bRequest = request & 0xff;
|
174 | 68063649 | blueswir1 | USETW(req.ucr_request.wValue, value); |
175 | 68063649 | blueswir1 | USETW(req.ucr_request.wIndex, index); |
176 | 68063649 | blueswir1 | USETW(req.ucr_request.wLength, length); |
177 | 68063649 | blueswir1 | req.ucr_data = data; |
178 | 68063649 | blueswir1 | req.ucr_flags = USBD_SHORT_XFER_OK; |
179 | 68063649 | blueswir1 | |
180 | 68063649 | blueswir1 | ret = ioctl(s->devfd, USB_SET_TIMEOUT, &timeout); |
181 | 68063649 | blueswir1 | #if (__NetBSD__ || __OpenBSD__)
|
182 | 68063649 | blueswir1 | if (ret < 0 && errno != EINVAL) { |
183 | 68063649 | blueswir1 | #else
|
184 | 68063649 | blueswir1 | if (ret < 0) { |
185 | 68063649 | blueswir1 | #endif
|
186 | 68063649 | blueswir1 | #ifdef DEBUG
|
187 | 68063649 | blueswir1 | printf("handle_control: setting timeout failed - %s\n",
|
188 | 68063649 | blueswir1 | strerror(errno)); |
189 | 68063649 | blueswir1 | #endif
|
190 | 68063649 | blueswir1 | } |
191 | 68063649 | blueswir1 | |
192 | 68063649 | blueswir1 | ret = ioctl(s->devfd, USB_DO_REQUEST, &req); |
193 | 68063649 | blueswir1 | /* ugen returns EIO for usbd_do_request_ no matter what
|
194 | 68063649 | blueswir1 | * happens with the transfer */
|
195 | 68063649 | blueswir1 | if (ret < 0) { |
196 | 68063649 | blueswir1 | #ifdef DEBUG
|
197 | 68063649 | blueswir1 | printf("handle_control: error after request - %s\n",
|
198 | 68063649 | blueswir1 | strerror(errno)); |
199 | 68063649 | blueswir1 | #endif
|
200 | 68063649 | blueswir1 | return USB_RET_NAK; // STALL |
201 | 68063649 | blueswir1 | } else {
|
202 | 68063649 | blueswir1 | return req.ucr_actlen;
|
203 | 68063649 | blueswir1 | } |
204 | 68063649 | blueswir1 | } |
205 | 68063649 | blueswir1 | } |
206 | 68063649 | blueswir1 | |
207 | 68063649 | blueswir1 | static int usb_host_handle_data(USBDevice *dev, USBPacket *p) |
208 | 68063649 | blueswir1 | { |
209 | 68063649 | blueswir1 | USBHostDevice *s = (USBHostDevice *)dev; |
210 | 68063649 | blueswir1 | int ret, fd, mode;
|
211 | 68063649 | blueswir1 | int one = 1, shortpacket = 0, timeout = 50; |
212 | 68063649 | blueswir1 | sigset_t new_mask, old_mask; |
213 | 68063649 | blueswir1 | uint8_t devep = p->devep; |
214 | 68063649 | blueswir1 | |
215 | 68063649 | blueswir1 | /* protect data transfers from SIGALRM signal */
|
216 | 68063649 | blueswir1 | sigemptyset(&new_mask); |
217 | 68063649 | blueswir1 | sigaddset(&new_mask, SIGALRM); |
218 | 68063649 | blueswir1 | sigprocmask(SIG_BLOCK, &new_mask, &old_mask); |
219 | 68063649 | blueswir1 | |
220 | 68063649 | blueswir1 | if (p->pid == USB_TOKEN_IN) {
|
221 | 68063649 | blueswir1 | devep |= 0x80;
|
222 | 68063649 | blueswir1 | mode = O_RDONLY; |
223 | 68063649 | blueswir1 | shortpacket = 1;
|
224 | 68063649 | blueswir1 | } else {
|
225 | 68063649 | blueswir1 | mode = O_WRONLY; |
226 | 68063649 | blueswir1 | } |
227 | 68063649 | blueswir1 | |
228 | 68063649 | blueswir1 | fd = ensure_ep_open(s, devep, mode); |
229 | 68063649 | blueswir1 | if (fd < 0) { |
230 | 68063649 | blueswir1 | sigprocmask(SIG_SETMASK, &old_mask, NULL);
|
231 | 68063649 | blueswir1 | return USB_RET_NODEV;
|
232 | 68063649 | blueswir1 | } |
233 | 68063649 | blueswir1 | |
234 | 68063649 | blueswir1 | if (ioctl(fd, USB_SET_TIMEOUT, &timeout) < 0) { |
235 | 68063649 | blueswir1 | #ifdef DEBUG
|
236 | 68063649 | blueswir1 | printf("handle_data: failed to set timeout - %s\n",
|
237 | 68063649 | blueswir1 | strerror(errno)); |
238 | 68063649 | blueswir1 | #endif
|
239 | 68063649 | blueswir1 | } |
240 | 68063649 | blueswir1 | |
241 | 68063649 | blueswir1 | if (shortpacket) {
|
242 | 68063649 | blueswir1 | if (ioctl(fd, USB_SET_SHORT_XFER, &one) < 0) { |
243 | 68063649 | blueswir1 | #ifdef DEBUG
|
244 | 68063649 | blueswir1 | printf("handle_data: failed to set short xfer mode - %s\n",
|
245 | 68063649 | blueswir1 | strerror(errno)); |
246 | 68063649 | blueswir1 | #endif
|
247 | 68063649 | blueswir1 | sigprocmask(SIG_SETMASK, &old_mask, NULL);
|
248 | 68063649 | blueswir1 | } |
249 | 68063649 | blueswir1 | } |
250 | 68063649 | blueswir1 | |
251 | 68063649 | blueswir1 | if (p->pid == USB_TOKEN_IN)
|
252 | 68063649 | blueswir1 | ret = read(fd, p->data, p->len); |
253 | 68063649 | blueswir1 | else
|
254 | 68063649 | blueswir1 | ret = write(fd, p->data, p->len); |
255 | 68063649 | blueswir1 | |
256 | 68063649 | blueswir1 | sigprocmask(SIG_SETMASK, &old_mask, NULL);
|
257 | 68063649 | blueswir1 | |
258 | 68063649 | blueswir1 | if (ret < 0) { |
259 | 68063649 | blueswir1 | #ifdef DEBUG
|
260 | 68063649 | blueswir1 | printf("handle_data: error after %s data - %s\n",
|
261 | 68063649 | blueswir1 | pid == USB_TOKEN_IN ? "reading" : "writing", strerror(errno)); |
262 | 68063649 | blueswir1 | #endif
|
263 | 68063649 | blueswir1 | switch(errno) {
|
264 | 68063649 | blueswir1 | case ETIMEDOUT:
|
265 | 68063649 | blueswir1 | case EINTR:
|
266 | 68063649 | blueswir1 | return USB_RET_NAK;
|
267 | 68063649 | blueswir1 | default:
|
268 | 68063649 | blueswir1 | return USB_RET_STALL;
|
269 | 68063649 | blueswir1 | } |
270 | 68063649 | blueswir1 | } else {
|
271 | 68063649 | blueswir1 | return ret;
|
272 | 68063649 | blueswir1 | } |
273 | 68063649 | blueswir1 | } |
274 | 68063649 | blueswir1 | |
275 | 68063649 | blueswir1 | static void usb_host_handle_destroy(USBDevice *opaque) |
276 | 68063649 | blueswir1 | { |
277 | 68063649 | blueswir1 | USBHostDevice *s = (USBHostDevice *)opaque; |
278 | 68063649 | blueswir1 | int i;
|
279 | 68063649 | blueswir1 | |
280 | 68063649 | blueswir1 | for (i = 0; i < USB_MAX_ENDPOINTS; i++) |
281 | 68063649 | blueswir1 | if (s->ep_fd[i] >= 0) |
282 | 68063649 | blueswir1 | close(s->ep_fd[i]); |
283 | 68063649 | blueswir1 | |
284 | 68063649 | blueswir1 | if (s->devfd < 0) |
285 | 68063649 | blueswir1 | return;
|
286 | 68063649 | blueswir1 | |
287 | 68063649 | blueswir1 | close(s->devfd); |
288 | 68063649 | blueswir1 | |
289 | 68063649 | blueswir1 | qemu_free(s); |
290 | 68063649 | blueswir1 | } |
291 | 68063649 | blueswir1 | |
292 | 68063649 | blueswir1 | USBDevice *usb_host_device_open(const char *devname) |
293 | 68063649 | blueswir1 | { |
294 | 68063649 | blueswir1 | struct usb_device_info bus_info, dev_info;
|
295 | 68063649 | blueswir1 | USBHostDevice *dev; |
296 | 68063649 | blueswir1 | char ctlpath[PATH_MAX + 1]; |
297 | 68063649 | blueswir1 | char buspath[PATH_MAX + 1]; |
298 | 68063649 | blueswir1 | int bfd, dfd, bus, address, i;
|
299 | 68063649 | blueswir1 | int ugendebug = UGEN_DEBUG_LEVEL;
|
300 | 68063649 | blueswir1 | |
301 | 68063649 | blueswir1 | if (usb_host_find_device(&bus, &address, devname) < 0) |
302 | 68063649 | blueswir1 | return NULL; |
303 | 68063649 | blueswir1 | |
304 | 68063649 | blueswir1 | snprintf(buspath, PATH_MAX, "/dev/usb%d", bus);
|
305 | 68063649 | blueswir1 | |
306 | 68063649 | blueswir1 | bfd = open(buspath, O_RDWR); |
307 | 68063649 | blueswir1 | if (bfd < 0) { |
308 | 68063649 | blueswir1 | #ifdef DEBUG
|
309 | 68063649 | blueswir1 | printf("usb_host_device_open: failed to open usb bus - %s\n",
|
310 | 68063649 | blueswir1 | strerror(errno)); |
311 | 68063649 | blueswir1 | #endif
|
312 | 68063649 | blueswir1 | return NULL; |
313 | 68063649 | blueswir1 | } |
314 | 68063649 | blueswir1 | |
315 | 68063649 | blueswir1 | bus_info.udi_addr = address; |
316 | 68063649 | blueswir1 | if (ioctl(bfd, USB_DEVICEINFO, &bus_info) < 0) { |
317 | 68063649 | blueswir1 | #ifdef DEBUG
|
318 | 68063649 | blueswir1 | printf("usb_host_device_open: failed to grab bus information - %s\n",
|
319 | 68063649 | blueswir1 | strerror(errno)); |
320 | 68063649 | blueswir1 | #endif
|
321 | 68063649 | blueswir1 | return NULL; |
322 | 68063649 | blueswir1 | } |
323 | 68063649 | blueswir1 | |
324 | a38131b6 | blueswir1 | #ifdef __FreeBSD__
|
325 | 68063649 | blueswir1 | snprintf(ctlpath, PATH_MAX, "/dev/%s", bus_info.udi_devnames[0]); |
326 | 68063649 | blueswir1 | #else
|
327 | 68063649 | blueswir1 | snprintf(ctlpath, PATH_MAX, "/dev/%s.00", bus_info.udi_devnames[0]); |
328 | 68063649 | blueswir1 | #endif
|
329 | 68063649 | blueswir1 | |
330 | 68063649 | blueswir1 | dfd = open(ctlpath, O_RDWR); |
331 | 68063649 | blueswir1 | if (dfd < 0) { |
332 | 68063649 | blueswir1 | dfd = open(ctlpath, O_RDONLY); |
333 | 68063649 | blueswir1 | if (dfd < 0) { |
334 | 68063649 | blueswir1 | #ifdef DEBUG
|
335 | 68063649 | blueswir1 | printf("usb_host_device_open: failed to open usb device %s - %s\n",
|
336 | 68063649 | blueswir1 | ctlpath, strerror(errno)); |
337 | 68063649 | blueswir1 | #endif
|
338 | 68063649 | blueswir1 | } |
339 | 68063649 | blueswir1 | } |
340 | 68063649 | blueswir1 | |
341 | 68063649 | blueswir1 | if (dfd >= 0) { |
342 | 68063649 | blueswir1 | dev = qemu_mallocz(sizeof(USBHostDevice));
|
343 | 68063649 | blueswir1 | if (!dev)
|
344 | 68063649 | blueswir1 | goto fail;
|
345 | 68063649 | blueswir1 | dev->devfd = dfd; |
346 | 68063649 | blueswir1 | |
347 | 68063649 | blueswir1 | if (ioctl(dfd, USB_GET_DEVICEINFO, &dev_info) < 0) { |
348 | 68063649 | blueswir1 | #ifdef DEBUG
|
349 | 68063649 | blueswir1 | printf("usb_host_device_open: failed to grab device info - %s\n",
|
350 | 68063649 | blueswir1 | strerror(errno)); |
351 | 68063649 | blueswir1 | #endif
|
352 | 68063649 | blueswir1 | goto fail;
|
353 | 68063649 | blueswir1 | } |
354 | 68063649 | blueswir1 | |
355 | 68063649 | blueswir1 | if (dev_info.udi_speed == 1) |
356 | 68063649 | blueswir1 | dev->dev.speed = USB_SPEED_LOW - 1;
|
357 | 68063649 | blueswir1 | else
|
358 | 68063649 | blueswir1 | dev->dev.speed = USB_SPEED_FULL - 1;
|
359 | 68063649 | blueswir1 | |
360 | 68063649 | blueswir1 | dev->dev.handle_packet = usb_generic_handle_packet; |
361 | 68063649 | blueswir1 | |
362 | 68063649 | blueswir1 | dev->dev.handle_reset = usb_host_handle_reset; |
363 | 68063649 | blueswir1 | dev->dev.handle_control = usb_host_handle_control; |
364 | 68063649 | blueswir1 | dev->dev.handle_data = usb_host_handle_data; |
365 | 68063649 | blueswir1 | dev->dev.handle_destroy = usb_host_handle_destroy; |
366 | 68063649 | blueswir1 | |
367 | 68063649 | blueswir1 | if (strncmp(dev_info.udi_product, "product", 7) != 0) |
368 | 68063649 | blueswir1 | pstrcpy(dev->dev.devname, sizeof(dev->dev.devname),
|
369 | 68063649 | blueswir1 | dev_info.udi_product); |
370 | 68063649 | blueswir1 | else
|
371 | 68063649 | blueswir1 | snprintf(dev->dev.devname, sizeof(dev->dev.devname),
|
372 | 68063649 | blueswir1 | "host:%s", devname);
|
373 | 68063649 | blueswir1 | |
374 | 68063649 | blueswir1 | pstrcpy(dev->devpath, sizeof(dev->devpath), "/dev/"); |
375 | 68063649 | blueswir1 | strcat(dev->devpath, dev_info.udi_devnames[0]);
|
376 | 68063649 | blueswir1 | |
377 | 68063649 | blueswir1 | /* Mark the endpoints as not yet open */
|
378 | 68063649 | blueswir1 | for (i = 0; i < USB_MAX_ENDPOINTS; i++) |
379 | 68063649 | blueswir1 | dev->ep_fd[i] = -1;
|
380 | 68063649 | blueswir1 | |
381 | 68063649 | blueswir1 | ioctl(dfd, USB_SETDEBUG, &ugendebug); |
382 | 68063649 | blueswir1 | |
383 | 68063649 | blueswir1 | return (USBDevice *)dev;
|
384 | 68063649 | blueswir1 | } |
385 | 68063649 | blueswir1 | |
386 | 68063649 | blueswir1 | fail:
|
387 | 68063649 | blueswir1 | return NULL; |
388 | 68063649 | blueswir1 | } |
389 | 68063649 | blueswir1 | |
390 | 68063649 | blueswir1 | static int usb_host_scan(void *opaque, USBScanFunc *func) |
391 | 68063649 | blueswir1 | { |
392 | 68063649 | blueswir1 | struct usb_device_info bus_info;
|
393 | 68063649 | blueswir1 | struct usb_device_info dev_info;
|
394 | 68063649 | blueswir1 | uint16_t vendor_id, product_id, class_id, speed; |
395 | 68063649 | blueswir1 | int bfd, dfd, bus, address;
|
396 | 68063649 | blueswir1 | char busbuf[20], devbuf[20], product_name[256]; |
397 | 68063649 | blueswir1 | int ret = 0; |
398 | 68063649 | blueswir1 | |
399 | 68063649 | blueswir1 | for (bus = 0; bus < 10; bus++) { |
400 | 68063649 | blueswir1 | |
401 | 68063649 | blueswir1 | snprintf(busbuf, sizeof(busbuf) - 1, "/dev/usb%d", bus); |
402 | 68063649 | blueswir1 | bfd = open(busbuf, O_RDWR); |
403 | 68063649 | blueswir1 | if (bfd < 0) |
404 | 68063649 | blueswir1 | continue;
|
405 | 68063649 | blueswir1 | |
406 | 68063649 | blueswir1 | for (address = 1; address < 127; address++) { |
407 | 68063649 | blueswir1 | |
408 | 68063649 | blueswir1 | bus_info.udi_addr = address; |
409 | 68063649 | blueswir1 | if (ioctl(bfd, USB_DEVICEINFO, &bus_info) < 0) |
410 | 68063649 | blueswir1 | continue;
|
411 | 68063649 | blueswir1 | |
412 | 68063649 | blueswir1 | /* only list devices that can be used by generic layer */
|
413 | 68063649 | blueswir1 | if (strncmp(bus_info.udi_devnames[0], "ugen", 4) != 0) |
414 | 68063649 | blueswir1 | continue;
|
415 | 68063649 | blueswir1 | |
416 | a38131b6 | blueswir1 | #ifdef __FreeBSD__
|
417 | 68063649 | blueswir1 | snprintf(devbuf, sizeof(devbuf) - 1, "/dev/%s", bus_info.udi_devnames[0]); |
418 | 68063649 | blueswir1 | #else
|
419 | 68063649 | blueswir1 | snprintf(devbuf, sizeof(devbuf) - 1, "/dev/%s.00", bus_info.udi_devnames[0]); |
420 | 68063649 | blueswir1 | #endif
|
421 | 68063649 | blueswir1 | |
422 | 68063649 | blueswir1 | dfd = open(devbuf, O_RDONLY); |
423 | 68063649 | blueswir1 | if (dfd < 0) { |
424 | 68063649 | blueswir1 | #ifdef DEBUG
|
425 | 68063649 | blueswir1 | printf("usb_host_scan: couldn't open device %s - %s\n", devbuf,
|
426 | 68063649 | blueswir1 | strerror(errno)); |
427 | 68063649 | blueswir1 | #endif
|
428 | 68063649 | blueswir1 | continue;
|
429 | 68063649 | blueswir1 | } |
430 | 68063649 | blueswir1 | |
431 | 68063649 | blueswir1 | if (ioctl(dfd, USB_GET_DEVICEINFO, &dev_info) < 0) |
432 | 68063649 | blueswir1 | printf("usb_host_scan: couldn't get device information for %s - %s\n",
|
433 | 68063649 | blueswir1 | devbuf, strerror(errno)); |
434 | 68063649 | blueswir1 | |
435 | 68063649 | blueswir1 | // XXX: might need to fixup endianess of word values before copying over
|
436 | 68063649 | blueswir1 | |
437 | 68063649 | blueswir1 | vendor_id = dev_info.udi_vendorNo; |
438 | 68063649 | blueswir1 | product_id = dev_info.udi_productNo; |
439 | 68063649 | blueswir1 | class_id = dev_info.udi_class; |
440 | 68063649 | blueswir1 | speed = dev_info.udi_speed; |
441 | 68063649 | blueswir1 | |
442 | 68063649 | blueswir1 | if (strncmp(dev_info.udi_product, "product", 7) != 0) |
443 | 68063649 | blueswir1 | pstrcpy(product_name, sizeof(product_name),
|
444 | 68063649 | blueswir1 | dev_info.udi_product); |
445 | 68063649 | blueswir1 | else
|
446 | 68063649 | blueswir1 | product_name[0] = '\0'; |
447 | 68063649 | blueswir1 | |
448 | 68063649 | blueswir1 | ret = func(opaque, bus, address, class_id, vendor_id, |
449 | 68063649 | blueswir1 | product_id, product_name, speed); |
450 | 68063649 | blueswir1 | |
451 | 68063649 | blueswir1 | close(dfd); |
452 | 68063649 | blueswir1 | |
453 | 68063649 | blueswir1 | if (ret)
|
454 | 68063649 | blueswir1 | goto the_end;
|
455 | 68063649 | blueswir1 | } |
456 | 68063649 | blueswir1 | |
457 | 68063649 | blueswir1 | close(bfd); |
458 | 68063649 | blueswir1 | } |
459 | 68063649 | blueswir1 | |
460 | 68063649 | blueswir1 | the_end:
|
461 | 68063649 | blueswir1 | return ret;
|
462 | 68063649 | blueswir1 | } |
463 | 68063649 | blueswir1 | |
464 | 68063649 | blueswir1 | typedef struct FindDeviceState { |
465 | 68063649 | blueswir1 | int vendor_id;
|
466 | 68063649 | blueswir1 | int product_id;
|
467 | 68063649 | blueswir1 | int bus_num;
|
468 | 68063649 | blueswir1 | int addr;
|
469 | 68063649 | blueswir1 | } FindDeviceState; |
470 | 68063649 | blueswir1 | |
471 | 68063649 | blueswir1 | static int usb_host_find_device_scan(void *opaque, int bus_num, int addr, |
472 | 68063649 | blueswir1 | int class_id,
|
473 | 68063649 | blueswir1 | int vendor_id, int product_id, |
474 | 68063649 | blueswir1 | const char *product_name, int speed) |
475 | 68063649 | blueswir1 | { |
476 | 68063649 | blueswir1 | FindDeviceState *s = opaque; |
477 | 68063649 | blueswir1 | if (vendor_id == s->vendor_id &&
|
478 | 68063649 | blueswir1 | product_id == s->product_id) { |
479 | 68063649 | blueswir1 | s->bus_num = bus_num; |
480 | 68063649 | blueswir1 | s->addr = addr; |
481 | 68063649 | blueswir1 | return 1; |
482 | 68063649 | blueswir1 | } else {
|
483 | 68063649 | blueswir1 | return 0; |
484 | 68063649 | blueswir1 | } |
485 | 68063649 | blueswir1 | } |
486 | 68063649 | blueswir1 | |
487 | 68063649 | blueswir1 | |
488 | 68063649 | blueswir1 | /* the syntax is :
|
489 | 68063649 | blueswir1 | 'bus.addr' (decimal numbers) or
|
490 | 68063649 | blueswir1 | 'vendor_id:product_id' (hexa numbers) */
|
491 | 68063649 | blueswir1 | static int usb_host_find_device(int *pbus_num, int *paddr, |
492 | 68063649 | blueswir1 | const char *devname) |
493 | 68063649 | blueswir1 | { |
494 | 68063649 | blueswir1 | const char *p; |
495 | 68063649 | blueswir1 | int ret;
|
496 | 68063649 | blueswir1 | FindDeviceState fs; |
497 | 68063649 | blueswir1 | |
498 | 68063649 | blueswir1 | p = strchr(devname, '.');
|
499 | 68063649 | blueswir1 | if (p) {
|
500 | 68063649 | blueswir1 | *pbus_num = strtoul(devname, NULL, 0); |
501 | 68063649 | blueswir1 | *paddr = strtoul(p + 1, NULL, 0); |
502 | 68063649 | blueswir1 | return 0; |
503 | 68063649 | blueswir1 | } |
504 | 68063649 | blueswir1 | p = strchr(devname, ':');
|
505 | 68063649 | blueswir1 | if (p) {
|
506 | 68063649 | blueswir1 | fs.vendor_id = strtoul(devname, NULL, 16); |
507 | 68063649 | blueswir1 | fs.product_id = strtoul(p + 1, NULL, 16); |
508 | 68063649 | blueswir1 | ret = usb_host_scan(&fs, usb_host_find_device_scan); |
509 | 68063649 | blueswir1 | if (ret) {
|
510 | 68063649 | blueswir1 | *pbus_num = fs.bus_num; |
511 | 68063649 | blueswir1 | *paddr = fs.addr; |
512 | 68063649 | blueswir1 | return 0; |
513 | 68063649 | blueswir1 | } |
514 | 68063649 | blueswir1 | } |
515 | 68063649 | blueswir1 | return -1; |
516 | 68063649 | blueswir1 | } |
517 | 68063649 | blueswir1 | |
518 | 68063649 | blueswir1 | /**********************/
|
519 | 68063649 | blueswir1 | /* USB host device info */
|
520 | 68063649 | blueswir1 | |
521 | 68063649 | blueswir1 | struct usb_class_info {
|
522 | 68063649 | blueswir1 | int class;
|
523 | 68063649 | blueswir1 | const char *class_name; |
524 | 68063649 | blueswir1 | }; |
525 | 68063649 | blueswir1 | |
526 | 68063649 | blueswir1 | static const struct usb_class_info usb_class_info[] = { |
527 | 68063649 | blueswir1 | { USB_CLASS_AUDIO, "Audio"},
|
528 | 68063649 | blueswir1 | { USB_CLASS_COMM, "Communication"},
|
529 | 68063649 | blueswir1 | { USB_CLASS_HID, "HID"},
|
530 | 68063649 | blueswir1 | { USB_CLASS_HUB, "Hub" },
|
531 | 68063649 | blueswir1 | { USB_CLASS_PHYSICAL, "Physical" },
|
532 | 68063649 | blueswir1 | { USB_CLASS_PRINTER, "Printer" },
|
533 | 68063649 | blueswir1 | { USB_CLASS_MASS_STORAGE, "Storage" },
|
534 | 68063649 | blueswir1 | { USB_CLASS_CDC_DATA, "Data" },
|
535 | 68063649 | blueswir1 | { USB_CLASS_APP_SPEC, "Application Specific" },
|
536 | 68063649 | blueswir1 | { USB_CLASS_VENDOR_SPEC, "Vendor Specific" },
|
537 | 68063649 | blueswir1 | { USB_CLASS_STILL_IMAGE, "Still Image" },
|
538 | 68063649 | blueswir1 | { USB_CLASS_CSCID, "Smart Card" },
|
539 | 68063649 | blueswir1 | { USB_CLASS_CONTENT_SEC, "Content Security" },
|
540 | 68063649 | blueswir1 | { -1, NULL } |
541 | 68063649 | blueswir1 | }; |
542 | 68063649 | blueswir1 | |
543 | 68063649 | blueswir1 | static const char *usb_class_str(uint8_t class) |
544 | 68063649 | blueswir1 | { |
545 | 68063649 | blueswir1 | const struct usb_class_info *p; |
546 | 68063649 | blueswir1 | for (p = usb_class_info; p->class != -1; p++) { |
547 | 68063649 | blueswir1 | if (p->class == class)
|
548 | 68063649 | blueswir1 | break;
|
549 | 68063649 | blueswir1 | } |
550 | 68063649 | blueswir1 | return p->class_name;
|
551 | 68063649 | blueswir1 | } |
552 | 68063649 | blueswir1 | |
553 | 68063649 | blueswir1 | void usb_info_device(int bus_num, int addr, int class_id, |
554 | 68063649 | blueswir1 | int vendor_id, int product_id, |
555 | 68063649 | blueswir1 | const char *product_name, |
556 | 68063649 | blueswir1 | int speed)
|
557 | 68063649 | blueswir1 | { |
558 | 68063649 | blueswir1 | const char *class_str, *speed_str; |
559 | 68063649 | blueswir1 | |
560 | 68063649 | blueswir1 | switch(speed) {
|
561 | 68063649 | blueswir1 | case USB_SPEED_LOW:
|
562 | 68063649 | blueswir1 | speed_str = "1.5";
|
563 | 68063649 | blueswir1 | break;
|
564 | 68063649 | blueswir1 | case USB_SPEED_FULL:
|
565 | 68063649 | blueswir1 | speed_str = "12";
|
566 | 68063649 | blueswir1 | break;
|
567 | 68063649 | blueswir1 | case USB_SPEED_HIGH:
|
568 | 68063649 | blueswir1 | speed_str = "480";
|
569 | 68063649 | blueswir1 | break;
|
570 | 68063649 | blueswir1 | default:
|
571 | 68063649 | blueswir1 | speed_str = "?";
|
572 | 68063649 | blueswir1 | break;
|
573 | 68063649 | blueswir1 | } |
574 | 68063649 | blueswir1 | |
575 | 68063649 | blueswir1 | term_printf(" Device %d.%d, speed %s Mb/s\n",
|
576 | 68063649 | blueswir1 | bus_num, addr, speed_str); |
577 | 68063649 | blueswir1 | class_str = usb_class_str(class_id); |
578 | 68063649 | blueswir1 | if (class_str)
|
579 | 68063649 | blueswir1 | term_printf(" %s:", class_str);
|
580 | 68063649 | blueswir1 | else
|
581 | 68063649 | blueswir1 | term_printf(" Class %02x:", class_id);
|
582 | 68063649 | blueswir1 | term_printf(" USB device %04x:%04x", vendor_id, product_id);
|
583 | 68063649 | blueswir1 | if (product_name[0] != '\0') |
584 | 68063649 | blueswir1 | term_printf(", %s", product_name);
|
585 | 68063649 | blueswir1 | term_printf("\n");
|
586 | 68063649 | blueswir1 | } |
587 | 68063649 | blueswir1 | |
588 | 68063649 | blueswir1 | static int usb_host_info_device(void *opaque, int bus_num, int addr, |
589 | 68063649 | blueswir1 | int class_id,
|
590 | 68063649 | blueswir1 | int vendor_id, int product_id, |
591 | 68063649 | blueswir1 | const char *product_name, |
592 | 68063649 | blueswir1 | int speed)
|
593 | 68063649 | blueswir1 | { |
594 | 68063649 | blueswir1 | usb_info_device(bus_num, addr, class_id, vendor_id, product_id, |
595 | 68063649 | blueswir1 | product_name, speed); |
596 | 68063649 | blueswir1 | return 0; |
597 | 68063649 | blueswir1 | } |
598 | 68063649 | blueswir1 | |
599 | 68063649 | blueswir1 | void usb_host_info(void) |
600 | 68063649 | blueswir1 | { |
601 | 68063649 | blueswir1 | usb_host_scan(NULL, usb_host_info_device);
|
602 | 68063649 | blueswir1 | } |
603 | 68063649 | blueswir1 | |
604 | 68063649 | blueswir1 | /* XXX add this */
|
605 | 68063649 | blueswir1 | int usb_host_device_close(const char *devname) |
606 | 68063649 | blueswir1 | { |
607 | 68063649 | blueswir1 | return 0; |
608 | 68063649 | blueswir1 | } |