ugen.c revision 1.1 1 1.1 augustss /* $NetBSD: ugen.c,v 1.1 1998/12/08 15:39:00 augustss Exp $ */
2 1.1 augustss
3 1.1 augustss /*
4 1.1 augustss * Copyright (c) 1998 The NetBSD Foundation, Inc.
5 1.1 augustss * All rights reserved.
6 1.1 augustss *
7 1.1 augustss * This code is derived from software contributed to The NetBSD Foundation
8 1.1 augustss * by Lennart Augustsson (augustss (at) carlstedt.se) at
9 1.1 augustss * Carlstedt Research & Technology.
10 1.1 augustss *
11 1.1 augustss * Redistribution and use in source and binary forms, with or without
12 1.1 augustss * modification, are permitted provided that the following conditions
13 1.1 augustss * are met:
14 1.1 augustss * 1. Redistributions of source code must retain the above copyright
15 1.1 augustss * notice, this list of conditions and the following disclaimer.
16 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
17 1.1 augustss * notice, this list of conditions and the following disclaimer in the
18 1.1 augustss * documentation and/or other materials provided with the distribution.
19 1.1 augustss * 3. All advertising materials mentioning features or use of this software
20 1.1 augustss * must display the following acknowledgement:
21 1.1 augustss * This product includes software developed by the NetBSD
22 1.1 augustss * Foundation, Inc. and its contributors.
23 1.1 augustss * 4. Neither the name of The NetBSD Foundation nor the names of its
24 1.1 augustss * contributors may be used to endorse or promote products derived
25 1.1 augustss * from this software without specific prior written permission.
26 1.1 augustss *
27 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
28 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
29 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
30 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
31 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
38 1.1 augustss */
39 1.1 augustss
40 1.1 augustss
41 1.1 augustss #include <sys/param.h>
42 1.1 augustss #include <sys/systm.h>
43 1.1 augustss #include <sys/kernel.h>
44 1.1 augustss #include <sys/malloc.h>
45 1.1 augustss #include <sys/device.h>
46 1.1 augustss #include <sys/ioctl.h>
47 1.1 augustss #include <sys/tty.h>
48 1.1 augustss #include <sys/file.h>
49 1.1 augustss #include <sys/select.h>
50 1.1 augustss #include <sys/proc.h>
51 1.1 augustss #include <sys/vnode.h>
52 1.1 augustss #include <sys/device.h>
53 1.1 augustss #include <sys/poll.h>
54 1.1 augustss
55 1.1 augustss #include <dev/usb/usb.h>
56 1.1 augustss #include <dev/usb/usbdi.h>
57 1.1 augustss #include <dev/usb/usbdi_util.h>
58 1.1 augustss
59 1.1 augustss #ifdef USB_DEBUG
60 1.1 augustss #define DPRINTF(x) if (ugendebug) printf x
61 1.1 augustss #define DPRINTFN(n,x) if (ugendebug>(n)) printf x
62 1.1 augustss int ugendebug = 10;
63 1.1 augustss #else
64 1.1 augustss #define DPRINTF(x)
65 1.1 augustss #define DPRINTFN(n,x)
66 1.1 augustss #endif
67 1.1 augustss
68 1.1 augustss struct ugen_endpoint {
69 1.1 augustss struct ugen_softc *sc;
70 1.1 augustss usb_endpoint_descriptor_t *edesc;
71 1.1 augustss usbd_interface_handle iface;
72 1.1 augustss int state;
73 1.1 augustss #define UGEN_OPEN 0x01 /* device is open */
74 1.1 augustss #define UGEN_ASLP 0x02 /* waiting for data */
75 1.1 augustss usbd_pipe_handle pipeh;
76 1.1 augustss struct clist q;
77 1.1 augustss struct selinfo rsel;
78 1.1 augustss void *ibuf;
79 1.1 augustss };
80 1.1 augustss
81 1.1 augustss #define UGEN_CHUNK 128 /* chunk size for read */
82 1.1 augustss #define UGEN_IBSIZE 1020 /* buffer size */
83 1.1 augustss #define UGEN_BBSIZE 1024
84 1.1 augustss
85 1.1 augustss struct ugen_softc {
86 1.1 augustss struct device sc_dev; /* base device */
87 1.1 augustss struct usbd_device *sc_udev;
88 1.1 augustss
89 1.1 augustss struct ugen_endpoint sc_endpoints[USB_MAX_ENDPOINTS][2];
90 1.1 augustss #define OUT 0 /* index order is important, from UE_OUT */
91 1.1 augustss #define IN 1 /* from UE_IN */
92 1.1 augustss
93 1.1 augustss int sc_disconnected; /* device is gone */
94 1.1 augustss };
95 1.1 augustss
96 1.1 augustss int ugen_match __P((struct device *, struct cfdata *, void *));
97 1.1 augustss void ugen_attach __P((struct device *, struct device *, void *));
98 1.1 augustss
99 1.1 augustss int ugenopen __P((dev_t, int, int, struct proc *));
100 1.1 augustss int ugenclose __P((dev_t, int, int, struct proc *p));
101 1.1 augustss int ugenread __P((dev_t, struct uio *uio, int));
102 1.1 augustss int ugenwrite __P((dev_t, struct uio *uio, int));
103 1.1 augustss int ugenioctl __P((dev_t, u_long, caddr_t, int, struct proc *));
104 1.1 augustss int ugenpoll __P((dev_t, int, struct proc *));
105 1.1 augustss void ugenintr __P((usbd_request_handle reqh, usbd_private_handle addr, usbd_status status));
106 1.1 augustss void ugen_disco __P((void *));
107 1.1 augustss
108 1.1 augustss int ugen_set_config __P((struct ugen_softc *sc, int configno));
109 1.1 augustss usb_config_descriptor_t *ugen_get_cdesc __P((struct ugen_softc *sc, int index, int *lenp));
110 1.1 augustss usbd_status ugen_set_interface __P((struct ugen_softc *, int, int));
111 1.1 augustss int ugen_get_alt_index __P((struct ugen_softc *sc, usb_config_descriptor_t *cdesc, int ifaceidx));
112 1.1 augustss
113 1.1 augustss #define UGENUNIT(n) (((n) >> 4) & 0xf)
114 1.1 augustss #define UGENENDPOINT(n) ((n) & 0xf)
115 1.1 augustss
116 1.1 augustss extern struct cfdriver ugen_cd;
117 1.1 augustss
118 1.1 augustss struct cfattach ugen_ca = {
119 1.1 augustss sizeof(struct ugen_softc), ugen_match, ugen_attach
120 1.1 augustss };
121 1.1 augustss
122 1.1 augustss int
123 1.1 augustss ugen_match(parent, match, aux)
124 1.1 augustss struct device *parent;
125 1.1 augustss struct cfdata *match;
126 1.1 augustss void *aux;
127 1.1 augustss {
128 1.1 augustss struct usb_attach_arg *uaa = (struct usb_attach_arg *)aux;
129 1.1 augustss
130 1.1 augustss if (uaa->usegeneric)
131 1.1 augustss return (UMATCH_GENERIC);
132 1.1 augustss else
133 1.1 augustss return (UMATCH_NONE);
134 1.1 augustss }
135 1.1 augustss
136 1.1 augustss void
137 1.1 augustss ugen_attach(parent, self, aux)
138 1.1 augustss struct device *parent;
139 1.1 augustss struct device *self;
140 1.1 augustss void *aux;
141 1.1 augustss {
142 1.1 augustss struct ugen_softc *sc = (struct ugen_softc *)self;
143 1.1 augustss struct usb_attach_arg *uaa = (struct usb_attach_arg *)aux;
144 1.1 augustss char devinfo[1024];
145 1.1 augustss usbd_status r;
146 1.1 augustss
147 1.1 augustss usbd_devinfo(uaa->device, 0, devinfo);
148 1.1 augustss printf(": %s\n", devinfo);
149 1.1 augustss
150 1.1 augustss sc->sc_udev = uaa->device;
151 1.1 augustss r = ugen_set_config(sc, 1);
152 1.1 augustss if (r != USBD_NORMAL_COMPLETION) {
153 1.1 augustss printf("%s: setting configuration 0 failed\n",
154 1.1 augustss sc->sc_dev.dv_xname);
155 1.1 augustss sc->sc_disconnected = 1;
156 1.1 augustss return;
157 1.1 augustss }
158 1.1 augustss }
159 1.1 augustss
160 1.1 augustss int
161 1.1 augustss ugen_set_config(sc, configno)
162 1.1 augustss struct ugen_softc *sc;
163 1.1 augustss int configno;
164 1.1 augustss {
165 1.1 augustss usbd_device_handle dev = sc->sc_udev;
166 1.1 augustss usbd_interface_handle iface;
167 1.1 augustss usb_endpoint_descriptor_t *ed;
168 1.1 augustss struct ugen_endpoint *sce;
169 1.1 augustss u_int8_t niface, nendpt;
170 1.1 augustss int ifaceno, endptno, endpt;
171 1.1 augustss usbd_status r;
172 1.1 augustss
173 1.1 augustss DPRINTFN(1,("ugen_set_config: %s to configno %d, sc=%p\n",
174 1.1 augustss sc->sc_dev.dv_xname, configno, sc));
175 1.1 augustss r = usbd_set_config_no(dev, configno, 0);
176 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
177 1.1 augustss return (r);
178 1.1 augustss
179 1.1 augustss r = usbd_interface_count(dev, &niface);
180 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
181 1.1 augustss return (r);
182 1.1 augustss memset(sc->sc_endpoints, 0, sizeof sc->sc_endpoints);
183 1.1 augustss for (ifaceno = 0; ifaceno < niface; ifaceno++) {
184 1.1 augustss DPRINTFN(1,("ugen_set_config: ifaceno %d\n", ifaceno));
185 1.1 augustss r = usbd_device2interface_handle(dev, ifaceno, &iface);
186 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
187 1.1 augustss return (r);
188 1.1 augustss r = usbd_endpoint_count(iface, &nendpt);
189 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
190 1.1 augustss return (r);
191 1.1 augustss for (endptno = 0; endptno < nendpt; endptno++) {
192 1.1 augustss ed = usbd_interface2endpoint_descriptor(iface,endptno);
193 1.1 augustss endpt = ed->bEndpointAddress;
194 1.1 augustss sce = &sc->sc_endpoints[UE_GET_ADDR(endpt)]
195 1.1 augustss [UE_GET_IN(endpt)];
196 1.1 augustss DPRINTFN(1,("ugen_set_config: endptno %d, endpt=0x%02x(%d,%d), sce=%p\n",
197 1.1 augustss endptno, endpt, UE_GET_ADDR(endpt),
198 1.1 augustss UE_GET_IN(endpt), sce));
199 1.1 augustss sce->sc = sc;
200 1.1 augustss sce->edesc = ed;
201 1.1 augustss sce->iface = iface;
202 1.1 augustss }
203 1.1 augustss }
204 1.1 augustss return (USBD_NORMAL_COMPLETION);
205 1.1 augustss }
206 1.1 augustss
207 1.1 augustss void
208 1.1 augustss ugen_disco(p)
209 1.1 augustss void *p;
210 1.1 augustss {
211 1.1 augustss struct ugen_softc *sc = p;
212 1.1 augustss sc->sc_disconnected = 1;
213 1.1 augustss }
214 1.1 augustss
215 1.1 augustss int
216 1.1 augustss ugenopen(dev, flag, mode, p)
217 1.1 augustss dev_t dev;
218 1.1 augustss int flag;
219 1.1 augustss int mode;
220 1.1 augustss struct proc *p;
221 1.1 augustss {
222 1.1 augustss int unit = UGENUNIT(dev);
223 1.1 augustss int endpt = UGENENDPOINT(dev);
224 1.1 augustss usb_endpoint_descriptor_t *edesc;
225 1.1 augustss struct ugen_softc *sc;
226 1.1 augustss struct ugen_endpoint *sce;
227 1.1 augustss int dir, isize;
228 1.1 augustss usbd_status r;
229 1.1 augustss
230 1.1 augustss DPRINTFN(5, ("ugenopen: flag=%d, unit=%d endpt=%d\n",
231 1.1 augustss flag, unit, endpt));
232 1.1 augustss if (unit >= ugen_cd.cd_ndevs)
233 1.1 augustss return (ENXIO);
234 1.1 augustss sc = ugen_cd.cd_devs[unit];
235 1.1 augustss if (!sc)
236 1.1 augustss return (ENXIO);
237 1.1 augustss
238 1.1 augustss if (sc->sc_disconnected)
239 1.1 augustss return (EIO);
240 1.1 augustss
241 1.1 augustss if (endpt == USB_CONTROL_ENDPOINT) {
242 1.1 augustss /*if ((flag & (FWRITE|FREAD)) != (FWRITE|FREAD))
243 1.1 augustss return (EACCES);*/
244 1.1 augustss sce = &sc->sc_endpoints[USB_CONTROL_ENDPOINT][OUT];
245 1.1 augustss if (sce->state & UGEN_OPEN)
246 1.1 augustss return (EBUSY);
247 1.1 augustss } else {
248 1.1 augustss switch (flag & (FWRITE|FREAD)) {
249 1.1 augustss case FWRITE:
250 1.1 augustss dir = OUT;
251 1.1 augustss break;
252 1.1 augustss case FREAD:
253 1.1 augustss dir = IN;
254 1.1 augustss break;
255 1.1 augustss default:
256 1.1 augustss return (EACCES);
257 1.1 augustss }
258 1.1 augustss sce = &sc->sc_endpoints[endpt][dir];
259 1.1 augustss DPRINTFN(5, ("ugenopen: sc=%p, endpt=%d, dir=%d, sce=%p\n", sc, endpt, dir, sce));
260 1.1 augustss if (sce->state & UGEN_OPEN)
261 1.1 augustss return (EBUSY);
262 1.1 augustss edesc = sce->edesc;
263 1.1 augustss if (!edesc)
264 1.1 augustss return (ENXIO);
265 1.1 augustss switch (edesc->bmAttributes & UE_XFERTYPE) {
266 1.1 augustss case UE_INTERRUPT:
267 1.1 augustss isize = UGETW(edesc->wMaxPacketSize);
268 1.1 augustss if (isize == 0) /* shouldn't happen */
269 1.1 augustss return (EINVAL);
270 1.1 augustss sce->ibuf = malloc(isize, M_USB, M_NOWAIT);
271 1.1 augustss DPRINTFN(5, ("ugenopen: intr endpt=%d,isize=%d\n",
272 1.1 augustss endpt, isize));
273 1.1 augustss if (clalloc(&sce->q, UGEN_IBSIZE, 0) == -1)
274 1.1 augustss return (ENOMEM);
275 1.1 augustss r = usbd_open_pipe_intr(sce->iface,
276 1.1 augustss edesc->bEndpointAddress,
277 1.1 augustss USBD_SHORT_XFER_OK, &sce->pipeh, sce,
278 1.1 augustss sce->ibuf, isize, ugenintr);
279 1.1 augustss if (r != USBD_NORMAL_COMPLETION) {
280 1.1 augustss free(sce->ibuf, M_USB);
281 1.1 augustss clfree(&sce->q);
282 1.1 augustss return (EIO);
283 1.1 augustss }
284 1.1 augustss usbd_set_disco(sce->pipeh, ugen_disco, sc);
285 1.1 augustss DPRINTFN(5, ("ugenopen: interrupt open done\n"));
286 1.1 augustss break;
287 1.1 augustss case UE_BULK:
288 1.1 augustss r = usbd_open_pipe(sce->iface,
289 1.1 augustss edesc->bEndpointAddress, 0,
290 1.1 augustss &sce->pipeh);
291 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
292 1.1 augustss return (EIO);
293 1.1 augustss break;
294 1.1 augustss case UE_CONTROL:
295 1.1 augustss case UE_ISOCHRONOUS:
296 1.1 augustss return (EINVAL);
297 1.1 augustss }
298 1.1 augustss }
299 1.1 augustss sce->state |= UGEN_OPEN;
300 1.1 augustss return (0);
301 1.1 augustss }
302 1.1 augustss
303 1.1 augustss int
304 1.1 augustss ugenclose(dev, flag, mode, p)
305 1.1 augustss dev_t dev;
306 1.1 augustss int flag;
307 1.1 augustss int mode;
308 1.1 augustss struct proc *p;
309 1.1 augustss {
310 1.1 augustss struct ugen_softc *sc = ugen_cd.cd_devs[UGENUNIT(dev)];
311 1.1 augustss int endpt = UGENENDPOINT(dev);
312 1.1 augustss struct ugen_endpoint *sce;
313 1.1 augustss int dir;
314 1.1 augustss
315 1.1 augustss DPRINTFN(5, ("ugenclose\n"));
316 1.1 augustss if (sc->sc_disconnected)
317 1.1 augustss return (EIO);
318 1.1 augustss
319 1.1 augustss if (endpt == USB_CONTROL_ENDPOINT) {
320 1.1 augustss sc->sc_endpoints[endpt][OUT].state &= ~UGEN_OPEN;
321 1.1 augustss return (0);
322 1.1 augustss }
323 1.1 augustss dir = flag & FWRITE ? OUT : IN;
324 1.1 augustss sce = &sc->sc_endpoints[endpt][dir];
325 1.1 augustss sce->state &= ~UGEN_OPEN;
326 1.1 augustss
327 1.1 augustss usbd_abort_pipe(sce->pipeh);
328 1.1 augustss usbd_close_pipe(sce->pipeh);
329 1.1 augustss
330 1.1 augustss if (sce->ibuf) {
331 1.1 augustss free(sce->ibuf, M_USB);
332 1.1 augustss sce->ibuf = 0;
333 1.1 augustss }
334 1.1 augustss
335 1.1 augustss return (0);
336 1.1 augustss }
337 1.1 augustss
338 1.1 augustss int
339 1.1 augustss ugenread(dev, uio, flag)
340 1.1 augustss dev_t dev;
341 1.1 augustss struct uio *uio;
342 1.1 augustss int flag;
343 1.1 augustss {
344 1.1 augustss struct ugen_softc *sc = ugen_cd.cd_devs[UGENUNIT(dev)];
345 1.1 augustss int endpt = UGENENDPOINT(dev);
346 1.1 augustss struct ugen_endpoint *sce = &sc->sc_endpoints[endpt][IN];
347 1.1 augustss size_t n;
348 1.1 augustss char buf[UGEN_BBSIZE];
349 1.1 augustss usbd_request_handle reqh;
350 1.1 augustss usbd_status r;
351 1.1 augustss int s;
352 1.1 augustss int error = 0;
353 1.1 augustss u_char buffer[UGEN_CHUNK];
354 1.1 augustss
355 1.1 augustss DPRINTFN(5, ("ugenread: %d:%d\n", UGENUNIT(dev), UGENENDPOINT(dev)));
356 1.1 augustss if (sc->sc_disconnected)
357 1.1 augustss return (EIO);
358 1.1 augustss
359 1.1 augustss #ifdef DIAGNOSTIC
360 1.1 augustss if (!sce->edesc) {
361 1.1 augustss printf("ugenread: no edesc\n");
362 1.1 augustss return (EIO);
363 1.1 augustss }
364 1.1 augustss #endif
365 1.1 augustss
366 1.1 augustss switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
367 1.1 augustss case UE_INTERRUPT:
368 1.1 augustss /* Block until activity occured. */
369 1.1 augustss s = spltty();
370 1.1 augustss while (sce->q.c_cc == 0) {
371 1.1 augustss if (flag & IO_NDELAY) {
372 1.1 augustss splx(s);
373 1.1 augustss return EWOULDBLOCK;
374 1.1 augustss }
375 1.1 augustss sce->state |= UGEN_ASLP;
376 1.1 augustss DPRINTFN(5, ("ugenread: sleep on %p\n", sc));
377 1.1 augustss error = tsleep((caddr_t)sce, PZERO | PCATCH,
378 1.1 augustss "ugenrea", 0);
379 1.1 augustss DPRINTFN(5, ("ugenread: woke, error=%d\n", error));
380 1.1 augustss if (error) {
381 1.1 augustss sce->state &= ~UGEN_ASLP;
382 1.1 augustss splx(s);
383 1.1 augustss return (error);
384 1.1 augustss }
385 1.1 augustss }
386 1.1 augustss splx(s);
387 1.1 augustss
388 1.1 augustss /* Transfer as many chunks as possible. */
389 1.1 augustss while (sce->q.c_cc > 0 && uio->uio_resid > 0) {
390 1.1 augustss n = min(sce->q.c_cc, uio->uio_resid);
391 1.1 augustss if (n > sizeof(buffer))
392 1.1 augustss n = sizeof(buffer);
393 1.1 augustss
394 1.1 augustss /* Remove a small chunk from the input queue. */
395 1.1 augustss q_to_b(&sce->q, buffer, n);
396 1.1 augustss DPRINTFN(5, ("ugenread: got %d chars\n", n));
397 1.1 augustss
398 1.1 augustss /* Copy the data to the user process. */
399 1.1 augustss error = uiomove(buffer, n, uio);
400 1.1 augustss if (error)
401 1.1 augustss break;
402 1.1 augustss }
403 1.1 augustss break;
404 1.1 augustss case UE_BULK:
405 1.1 augustss reqh = usbd_alloc_request();
406 1.1 augustss if (reqh == 0)
407 1.1 augustss return (ENOMEM);
408 1.1 augustss while ((n = min(UGEN_BBSIZE, uio->uio_resid)) != 0) {
409 1.1 augustss /* XXX use callback to enable interrupt? */
410 1.1 augustss r = usbd_setup_request(reqh, sce->pipeh, 0, buf, n,
411 1.1 augustss 0, USBD_NO_TIMEOUT, 0);
412 1.1 augustss if (r != USBD_NORMAL_COMPLETION) {
413 1.1 augustss error = EIO;
414 1.1 augustss break;
415 1.1 augustss }
416 1.1 augustss DPRINTFN(1, ("ugenread: transfer %d bytes\n", n));
417 1.1 augustss r = usbd_sync_transfer(reqh);
418 1.1 augustss if (r != USBD_NORMAL_COMPLETION) {
419 1.1 augustss DPRINTF(("ugenread: error=%d\n", r));
420 1.1 augustss usbd_clear_endpoint_stall(sce->pipeh);
421 1.1 augustss error = EIO;
422 1.1 augustss break;
423 1.1 augustss }
424 1.1 augustss error = uiomove(buf, n, uio);
425 1.1 augustss if (error)
426 1.1 augustss break;
427 1.1 augustss }
428 1.1 augustss usbd_free_request(reqh);
429 1.1 augustss break;
430 1.1 augustss default:
431 1.1 augustss return (ENXIO);
432 1.1 augustss }
433 1.1 augustss
434 1.1 augustss return (error);
435 1.1 augustss }
436 1.1 augustss
437 1.1 augustss int
438 1.1 augustss ugenwrite(dev, uio, flag)
439 1.1 augustss dev_t dev;
440 1.1 augustss struct uio *uio;
441 1.1 augustss int flag;
442 1.1 augustss {
443 1.1 augustss struct ugen_softc *sc = ugen_cd.cd_devs[UGENUNIT(dev)];
444 1.1 augustss int endpt = UGENENDPOINT(dev);
445 1.1 augustss struct ugen_endpoint *sce = &sc->sc_endpoints[endpt][IN];
446 1.1 augustss size_t n;
447 1.1 augustss int error = 0;
448 1.1 augustss char buf[UGEN_BBSIZE];
449 1.1 augustss usbd_request_handle reqh;
450 1.1 augustss usbd_status r;
451 1.1 augustss
452 1.1 augustss if (sc->sc_disconnected)
453 1.1 augustss return (EIO);
454 1.1 augustss
455 1.1 augustss #ifdef DIAGNOSTIC
456 1.1 augustss if (!sce->edesc) {
457 1.1 augustss printf("ugenwrite: no edesc\n");
458 1.1 augustss return (EIO);
459 1.1 augustss }
460 1.1 augustss #endif
461 1.1 augustss
462 1.1 augustss DPRINTF(("ugenwrite\n"));
463 1.1 augustss switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
464 1.1 augustss case UE_BULK:
465 1.1 augustss reqh = usbd_alloc_request();
466 1.1 augustss if (reqh == 0)
467 1.1 augustss return (EIO);
468 1.1 augustss while ((n = min(UGEN_BBSIZE, uio->uio_resid)) != 0) {
469 1.1 augustss error = uiomove(buf, n, uio);
470 1.1 augustss if (error)
471 1.1 augustss break;
472 1.1 augustss /* XXX use callback to enable interrupt? */
473 1.1 augustss r = usbd_setup_request(reqh, sce->pipeh, 0, buf, n,
474 1.1 augustss 0, USBD_NO_TIMEOUT, 0);
475 1.1 augustss if (r != USBD_NORMAL_COMPLETION) {
476 1.1 augustss error = EIO;
477 1.1 augustss break;
478 1.1 augustss }
479 1.1 augustss DPRINTFN(1, ("ugenwrite: transfer %d bytes\n", n));
480 1.1 augustss r = usbd_sync_transfer(reqh);
481 1.1 augustss if (r != USBD_NORMAL_COMPLETION) {
482 1.1 augustss DPRINTF(("ugenwrite: error=%d\n", r));
483 1.1 augustss usbd_clear_endpoint_stall(sce->pipeh);
484 1.1 augustss error = EIO;
485 1.1 augustss break;
486 1.1 augustss }
487 1.1 augustss }
488 1.1 augustss usbd_free_request(reqh);
489 1.1 augustss break;
490 1.1 augustss default:
491 1.1 augustss return (ENXIO);
492 1.1 augustss }
493 1.1 augustss return (error);
494 1.1 augustss }
495 1.1 augustss
496 1.1 augustss
497 1.1 augustss void
498 1.1 augustss ugenintr(reqh, addr, status)
499 1.1 augustss usbd_request_handle reqh;
500 1.1 augustss usbd_private_handle addr;
501 1.1 augustss usbd_status status;
502 1.1 augustss {
503 1.1 augustss struct ugen_endpoint *sce = addr;
504 1.1 augustss /*struct ugen_softc *sc = sce->sc;*/
505 1.1 augustss u_char *ibuf;
506 1.1 augustss int isize;
507 1.1 augustss
508 1.1 augustss if (status == USBD_CANCELLED)
509 1.1 augustss return;
510 1.1 augustss
511 1.1 augustss if (status != USBD_NORMAL_COMPLETION) {
512 1.1 augustss DPRINTF(("ugenintr: status=%d\n", status));
513 1.1 augustss usbd_clear_endpoint_stall_async(sce->pipeh);
514 1.1 augustss return;
515 1.1 augustss }
516 1.1 augustss
517 1.1 augustss ibuf = sce->ibuf;
518 1.1 augustss isize = UGETW(sce->edesc->wMaxPacketSize);
519 1.1 augustss
520 1.1 augustss /*DPRINTFN(5, ("ugenintr: addr=%d endpt=%d\n",
521 1.1 augustss addr, endpt, isize));
522 1.1 augustss DPRINTFN(5, (" data = %02x %02x %02x\n",
523 1.1 augustss ibuf[0], ibuf[1], ibuf[2]));*/
524 1.1 augustss
525 1.1 augustss (void)b_to_q(ibuf, isize, &sce->q);
526 1.1 augustss
527 1.1 augustss if (sce->state & UGEN_ASLP) {
528 1.1 augustss sce->state &= ~UGEN_ASLP;
529 1.1 augustss DPRINTFN(5, ("ugen_intr: waking %p\n", sce));
530 1.1 augustss wakeup((caddr_t)sce);
531 1.1 augustss }
532 1.1 augustss selwakeup(&sce->rsel);
533 1.1 augustss }
534 1.1 augustss
535 1.1 augustss usbd_status
536 1.1 augustss ugen_set_interface(sc, ifaceidx, altno)
537 1.1 augustss struct ugen_softc *sc;
538 1.1 augustss int ifaceidx, altno;
539 1.1 augustss {
540 1.1 augustss usbd_interface_handle iface;
541 1.1 augustss usb_endpoint_descriptor_t *ed;
542 1.1 augustss usbd_status r;
543 1.1 augustss struct ugen_endpoint *sce;
544 1.1 augustss u_int8_t niface, nendpt, endptno, endpt;
545 1.1 augustss
546 1.1 augustss DPRINTFN(15, ("ugen_set_interface %d %d\n", ifaceidx, altno));
547 1.1 augustss
548 1.1 augustss r = usbd_interface_count(sc->sc_udev, &niface);
549 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
550 1.1 augustss return (r);
551 1.1 augustss if (ifaceidx < 0 || ifaceidx >= niface)
552 1.1 augustss return (USBD_INVAL);
553 1.1 augustss
554 1.1 augustss r = usbd_device2interface_handle(sc->sc_udev, ifaceidx, &iface);
555 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
556 1.1 augustss return (r);
557 1.1 augustss r = usbd_endpoint_count(iface, &nendpt);
558 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
559 1.1 augustss return (r);
560 1.1 augustss for (endptno = 0; endptno < nendpt; endptno++) {
561 1.1 augustss ed = usbd_interface2endpoint_descriptor(iface,endptno);
562 1.1 augustss endpt = ed->bEndpointAddress;
563 1.1 augustss sce = &sc->sc_endpoints[UE_GET_ADDR(endpt)][UE_GET_IN(endpt)];
564 1.1 augustss sce->sc = 0;
565 1.1 augustss sce->edesc = 0;
566 1.1 augustss sce->iface = 0;
567 1.1 augustss }
568 1.1 augustss
569 1.1 augustss /* change setting */
570 1.1 augustss r = usbd_set_interface(iface, altno);
571 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
572 1.1 augustss return (r);
573 1.1 augustss
574 1.1 augustss r = usbd_endpoint_count(iface, &nendpt);
575 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
576 1.1 augustss return (r);
577 1.1 augustss for (endptno = 0; endptno < nendpt; endptno++) {
578 1.1 augustss ed = usbd_interface2endpoint_descriptor(iface,endptno);
579 1.1 augustss endpt = ed->bEndpointAddress;
580 1.1 augustss sce = &sc->sc_endpoints[UE_GET_ADDR(endpt)][UE_GET_IN(endpt)];
581 1.1 augustss sce->sc = sc;
582 1.1 augustss sce->edesc = ed;
583 1.1 augustss sce->iface = iface;
584 1.1 augustss }
585 1.1 augustss return (0);
586 1.1 augustss }
587 1.1 augustss
588 1.1 augustss /* Retrieve a complete descriptor for a certain device and index. */
589 1.1 augustss usb_config_descriptor_t *
590 1.1 augustss ugen_get_cdesc(sc, index, lenp)
591 1.1 augustss struct ugen_softc *sc;
592 1.1 augustss int index;
593 1.1 augustss int *lenp;
594 1.1 augustss {
595 1.1 augustss usb_config_descriptor_t *cdesc, *tdesc, cdescr;
596 1.1 augustss int len;
597 1.1 augustss usbd_status r;
598 1.1 augustss
599 1.1 augustss if (index == USB_CURRENT_CONFIG_INDEX) {
600 1.1 augustss tdesc = usbd_get_config_descriptor(sc->sc_udev);
601 1.1 augustss len = UGETW(tdesc->wTotalLength);
602 1.1 augustss if (lenp)
603 1.1 augustss *lenp = len;
604 1.1 augustss cdesc = malloc(len, M_TEMP, M_WAITOK);
605 1.1 augustss memcpy(cdesc, tdesc, len);
606 1.1 augustss DPRINTFN(5,("ugen_get_cdesc: current, len=%d\n", len));
607 1.1 augustss } else {
608 1.1 augustss r = usbd_get_config_desc(sc->sc_udev, index, &cdescr);
609 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
610 1.1 augustss return (0);
611 1.1 augustss len = UGETW(cdescr.wTotalLength);
612 1.1 augustss DPRINTFN(5,("ugen_get_cdesc: index=%d, len=%d\n", index, len));
613 1.1 augustss if (lenp)
614 1.1 augustss *lenp = len;
615 1.1 augustss cdesc = malloc(len, M_TEMP, M_WAITOK);
616 1.1 augustss r = usbd_get_config_desc_full(sc->sc_udev, index, cdesc, len);
617 1.1 augustss if (r != USBD_NORMAL_COMPLETION) {
618 1.1 augustss free(cdesc, M_TEMP);
619 1.1 augustss return (0);
620 1.1 augustss }
621 1.1 augustss }
622 1.1 augustss return (cdesc);
623 1.1 augustss }
624 1.1 augustss
625 1.1 augustss int
626 1.1 augustss ugen_get_alt_index(sc, cdesc, ifaceidx)
627 1.1 augustss struct ugen_softc *sc;
628 1.1 augustss usb_config_descriptor_t *cdesc;
629 1.1 augustss int ifaceidx;
630 1.1 augustss {
631 1.1 augustss u_int8_t alt;
632 1.1 augustss usbd_interface_handle iface;
633 1.1 augustss usb_interface_descriptor_t *idesc;
634 1.1 augustss int altidx, nalt;
635 1.1 augustss usbd_status r;
636 1.1 augustss
637 1.1 augustss cdesc = usbd_get_config_descriptor(sc->sc_udev);
638 1.1 augustss r = usbd_device2interface_handle(sc->sc_udev, ifaceidx, &iface);
639 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
640 1.1 augustss return (-1);
641 1.1 augustss r = usbd_get_interface(iface, &alt);
642 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
643 1.1 augustss return (-1);
644 1.1 augustss nalt = usbd_get_no_alt(iface);
645 1.1 augustss for (altidx = 0; altidx < nalt; altidx++) {
646 1.1 augustss idesc = usbd_find_idesc(cdesc, ifaceidx, altidx);
647 1.1 augustss if (!idesc) {
648 1.1 augustss DPRINTF(("ugen_get_alt_index: ifaceidx=%d altidx=%d failed\n", ifaceidx, altidx));
649 1.1 augustss return (-1);
650 1.1 augustss }
651 1.1 augustss DPRINTF(("ugen_get_alt_index: ifaceidx=%d altidx=%d alt=%d(%d)\n", ifaceidx, altidx, idesc->bAlternateSetting, alt));
652 1.1 augustss if (idesc->bAlternateSetting == alt)
653 1.1 augustss return (altidx);
654 1.1 augustss }
655 1.1 augustss return (-1);
656 1.1 augustss }
657 1.1 augustss
658 1.1 augustss int
659 1.1 augustss ugenioctl(dev, cmd, addr, flag, p)
660 1.1 augustss dev_t dev;
661 1.1 augustss u_long cmd;
662 1.1 augustss caddr_t addr;
663 1.1 augustss int flag;
664 1.1 augustss struct proc *p;
665 1.1 augustss {
666 1.1 augustss struct ugen_softc *sc = ugen_cd.cd_devs[UGENUNIT(dev)];
667 1.1 augustss int endpt = UGENENDPOINT(dev);
668 1.1 augustss usbd_status r;
669 1.1 augustss usbd_interface_handle iface;
670 1.1 augustss struct usb_config_desc *cd;
671 1.1 augustss usb_config_descriptor_t *cdesc;
672 1.1 augustss struct usb_interface_desc *id;
673 1.1 augustss usb_interface_descriptor_t *idesc;
674 1.1 augustss struct usb_endpoint_desc *ed;
675 1.1 augustss usb_endpoint_descriptor_t *edesc;
676 1.1 augustss struct usb_alt_interface *ai;
677 1.1 augustss u_int8_t conf, alt;
678 1.1 augustss
679 1.1 augustss DPRINTFN(5, ("ugenioctl: cmd=%08lx\n", cmd));
680 1.1 augustss if (sc->sc_disconnected)
681 1.1 augustss return (EIO);
682 1.1 augustss
683 1.1 augustss if (endpt != USB_CONTROL_ENDPOINT)
684 1.1 augustss return (EINVAL);
685 1.1 augustss
686 1.1 augustss switch (cmd) {
687 1.1 augustss case USB_GET_CONFIG:
688 1.1 augustss r = usbd_get_config(sc->sc_udev, &conf);
689 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
690 1.1 augustss return (EIO);
691 1.1 augustss *(int *)addr = conf;
692 1.1 augustss break;
693 1.1 augustss case USB_SET_CONFIG:
694 1.1 augustss r = usbd_set_config_no(sc->sc_udev, *(int *)addr, 0);
695 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
696 1.1 augustss return (EIO);
697 1.1 augustss break;
698 1.1 augustss case USB_GET_ALTINTERFACE:
699 1.1 augustss ai = (struct usb_alt_interface *)addr;
700 1.1 augustss r = usbd_device2interface_handle(sc->sc_udev,
701 1.1 augustss ai->interface_index, &iface);
702 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
703 1.1 augustss return (EINVAL);
704 1.1 augustss idesc = usbd_get_interface_descriptor(iface);
705 1.1 augustss ai->alt_no = idesc->bAlternateSetting;
706 1.1 augustss break;
707 1.1 augustss case USB_SET_ALTINTERFACE:
708 1.1 augustss ai = (struct usb_alt_interface *)addr;
709 1.1 augustss r = usbd_device2interface_handle(sc->sc_udev,
710 1.1 augustss ai->interface_index, &iface);
711 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
712 1.1 augustss return (EINVAL);
713 1.1 augustss r = ugen_set_interface(sc, ai->interface_index, ai->alt_no);
714 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
715 1.1 augustss return (EINVAL);
716 1.1 augustss break;
717 1.1 augustss case USB_GET_NO_ALT:
718 1.1 augustss ai = (struct usb_alt_interface *)addr;
719 1.1 augustss r = usbd_device2interface_handle(sc->sc_udev,
720 1.1 augustss ai->interface_index, &iface);
721 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
722 1.1 augustss return (EINVAL);
723 1.1 augustss ai->alt_no = usbd_get_no_alt(iface);
724 1.1 augustss break;
725 1.1 augustss case USB_GET_DEVICE_DESC:
726 1.1 augustss *(usb_device_descriptor_t *)addr =
727 1.1 augustss *usbd_get_device_descriptor(sc->sc_udev);
728 1.1 augustss break;
729 1.1 augustss case USB_GET_CONFIG_DESC:
730 1.1 augustss cd = (struct usb_config_desc *)addr;
731 1.1 augustss cdesc = ugen_get_cdesc(sc, cd->config_index, 0);
732 1.1 augustss if (!cdesc)
733 1.1 augustss return (EINVAL);
734 1.1 augustss cd->desc = *cdesc;
735 1.1 augustss free(cdesc, M_TEMP);
736 1.1 augustss break;
737 1.1 augustss case USB_GET_INTERFACE_DESC:
738 1.1 augustss id = (struct usb_interface_desc *)addr;
739 1.1 augustss cdesc = ugen_get_cdesc(sc, id->config_index, 0);
740 1.1 augustss if (!cdesc)
741 1.1 augustss return (EINVAL);
742 1.1 augustss if (id->config_index == USB_CURRENT_CONFIG_INDEX &&
743 1.1 augustss id->alt_index == USB_CURRENT_ALT_INDEX)
744 1.1 augustss alt = ugen_get_alt_index(sc, cdesc, id->interface_index);
745 1.1 augustss else
746 1.1 augustss alt = id->alt_index;
747 1.1 augustss idesc = usbd_find_idesc(cdesc, id->interface_index, alt);
748 1.1 augustss if (!idesc) {
749 1.1 augustss free(cdesc, M_TEMP);
750 1.1 augustss return (EINVAL);
751 1.1 augustss }
752 1.1 augustss id->desc = *idesc;
753 1.1 augustss free(cdesc, M_TEMP);
754 1.1 augustss break;
755 1.1 augustss case USB_GET_ENDPOINT_DESC:
756 1.1 augustss ed = (struct usb_endpoint_desc *)addr;
757 1.1 augustss cdesc = ugen_get_cdesc(sc, ed->config_index, 0);
758 1.1 augustss if (!cdesc)
759 1.1 augustss return (EINVAL);
760 1.1 augustss if (ed->config_index == USB_CURRENT_CONFIG_INDEX &&
761 1.1 augustss ed->alt_index == USB_CURRENT_ALT_INDEX)
762 1.1 augustss alt = ugen_get_alt_index(sc, cdesc, ed->interface_index);
763 1.1 augustss else
764 1.1 augustss alt = ed->alt_index;
765 1.1 augustss edesc = usbd_find_edesc(cdesc, ed->interface_index,
766 1.1 augustss alt, ed->endpoint_index);
767 1.1 augustss if (!edesc) {
768 1.1 augustss free(cdesc, M_TEMP);
769 1.1 augustss return (EINVAL);
770 1.1 augustss }
771 1.1 augustss ed->desc = *edesc;
772 1.1 augustss free(cdesc, M_TEMP);
773 1.1 augustss break;
774 1.1 augustss case USB_GET_FULL_DESC:
775 1.1 augustss {
776 1.1 augustss int len;
777 1.1 augustss struct iovec iov;
778 1.1 augustss struct uio uio;
779 1.1 augustss struct usb_full_desc *fd = (struct usb_full_desc *)addr;
780 1.1 augustss int error;
781 1.1 augustss
782 1.1 augustss cdesc = ugen_get_cdesc(sc, fd->config_index, &len);
783 1.1 augustss if (len > fd->size)
784 1.1 augustss len = fd->size;
785 1.1 augustss iov.iov_base = (caddr_t)fd->data;
786 1.1 augustss iov.iov_len = len;
787 1.1 augustss uio.uio_iov = &iov;
788 1.1 augustss uio.uio_iovcnt = 1;
789 1.1 augustss uio.uio_resid = len;
790 1.1 augustss uio.uio_offset = 0;
791 1.1 augustss uio.uio_segflg = UIO_USERSPACE;
792 1.1 augustss uio.uio_rw = UIO_READ;
793 1.1 augustss uio.uio_procp = p;
794 1.1 augustss error = uiomove(cdesc, len, &uio);
795 1.1 augustss free(cdesc, M_TEMP);
796 1.1 augustss return (error);
797 1.1 augustss }
798 1.1 augustss case USB_DO_REQUEST:
799 1.1 augustss {
800 1.1 augustss struct usb_ctl_request *ur = (void *)addr;
801 1.1 augustss int len = UGETW(ur->request.wLength);
802 1.1 augustss struct iovec iov;
803 1.1 augustss struct uio uio;
804 1.1 augustss void *ptr = 0;
805 1.1 augustss usbd_status r;
806 1.1 augustss int error = 0;
807 1.1 augustss
808 1.1 augustss /* Avoid requests that would damage the bus integrity. */
809 1.1 augustss if ((ur->request.bmRequestType == UT_WRITE_DEVICE &&
810 1.1 augustss ur->request.bRequest == UR_SET_ADDRESS) ||
811 1.1 augustss (ur->request.bmRequestType == UT_WRITE_DEVICE &&
812 1.1 augustss ur->request.bRequest == UR_SET_CONFIG) ||
813 1.1 augustss (ur->request.bmRequestType == UT_WRITE_INTERFACE &&
814 1.1 augustss ur->request.bRequest == UR_SET_INTERFACE))
815 1.1 augustss return (EINVAL);
816 1.1 augustss
817 1.1 augustss if (len < 0 || len > 32767)
818 1.1 augustss return (EINVAL);
819 1.1 augustss if (len != 0) {
820 1.1 augustss iov.iov_base = (caddr_t)ur->data;
821 1.1 augustss iov.iov_len = len;
822 1.1 augustss uio.uio_iov = &iov;
823 1.1 augustss uio.uio_iovcnt = 1;
824 1.1 augustss uio.uio_resid = len;
825 1.1 augustss uio.uio_offset = 0;
826 1.1 augustss uio.uio_segflg = UIO_USERSPACE;
827 1.1 augustss uio.uio_rw =
828 1.1 augustss ur->request.bmRequestType & UT_READ ?
829 1.1 augustss UIO_READ : UIO_WRITE;
830 1.1 augustss uio.uio_procp = p;
831 1.1 augustss ptr = malloc(len, M_TEMP, M_WAITOK);
832 1.1 augustss if (uio.uio_rw == UIO_WRITE) {
833 1.1 augustss error = uiomove(ptr, len, &uio);
834 1.1 augustss if (error)
835 1.1 augustss goto ret;
836 1.1 augustss }
837 1.1 augustss }
838 1.1 augustss r = usbd_do_request(sc->sc_udev, &ur->request, ptr);
839 1.1 augustss if (r) {
840 1.1 augustss error = EIO;
841 1.1 augustss goto ret;
842 1.1 augustss }
843 1.1 augustss if (len != 0) {
844 1.1 augustss if (uio.uio_rw == UIO_READ) {
845 1.1 augustss error = uiomove(ptr, len, &uio);
846 1.1 augustss if (error)
847 1.1 augustss goto ret;
848 1.1 augustss }
849 1.1 augustss }
850 1.1 augustss ret:
851 1.1 augustss if (ptr)
852 1.1 augustss free(ptr, M_TEMP);
853 1.1 augustss return (error);
854 1.1 augustss }
855 1.1 augustss default:
856 1.1 augustss return (EINVAL);
857 1.1 augustss }
858 1.1 augustss return (0);
859 1.1 augustss }
860 1.1 augustss
861 1.1 augustss int
862 1.1 augustss ugenpoll(dev, events, p)
863 1.1 augustss dev_t dev;
864 1.1 augustss int events;
865 1.1 augustss struct proc *p;
866 1.1 augustss {
867 1.1 augustss struct ugen_softc *sc = ugen_cd.cd_devs[UGENUNIT(dev)];
868 1.1 augustss /* XXX */
869 1.1 augustss struct ugen_endpoint *sce = &sc->sc_endpoints[UGENENDPOINT(dev)][IN];
870 1.1 augustss int revents = 0;
871 1.1 augustss int s;
872 1.1 augustss
873 1.1 augustss if (sc->sc_disconnected)
874 1.1 augustss return (EIO);
875 1.1 augustss
876 1.1 augustss s = spltty();
877 1.1 augustss switch (0 /*XXXsce->sc_pipekind*/) {
878 1.1 augustss case UE_INTERRUPT:
879 1.1 augustss if (events & (POLLIN | POLLRDNORM)) {
880 1.1 augustss if (sce->q.c_cc > 0)
881 1.1 augustss revents |= events & (POLLIN | POLLRDNORM);
882 1.1 augustss else
883 1.1 augustss selrecord(p, &sce->rsel);
884 1.1 augustss }
885 1.1 augustss break;
886 1.1 augustss }
887 1.1 augustss splx(s);
888 1.1 augustss return (revents);
889 1.1 augustss }
890