umidi.c revision 1.25.2.11 1 /* $NetBSD: umidi.c,v 1.25.2.11 2006/05/20 03:41:28 chap Exp $ */
2 /*
3 * Copyright (c) 2001 The NetBSD Foundation, Inc.
4 * All rights reserved.
5 *
6 * This code is derived from software contributed to The NetBSD Foundation
7 * by Takuya SHIOZAKI (tshiozak (at) NetBSD.org) and (full-size transfers, extended
8 * hw_if) Chapman Flack (nblists (at) anastigmatix.net).
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 * 3. All advertising materials mentioning features or use of this software
19 * must display the following acknowledgement:
20 * This product includes software developed by the NetBSD
21 * Foundation, Inc. and its contributors.
22 * 4. Neither the name of The NetBSD Foundation nor the names of its
23 * contributors may be used to endorse or promote products derived
24 * from this software without specific prior written permission.
25 *
26 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 * POSSIBILITY OF SUCH DAMAGE.
37 */
38
39 #include <sys/cdefs.h>
40 __KERNEL_RCSID(0, "$NetBSD: umidi.c,v 1.25.2.11 2006/05/20 03:41:28 chap Exp $");
41
42 #include <sys/types.h>
43 #include <sys/param.h>
44 #include <sys/systm.h>
45 #include <sys/kernel.h>
46 #include <sys/malloc.h>
47 #include <sys/device.h>
48 #include <sys/ioctl.h>
49 #include <sys/conf.h>
50 #include <sys/file.h>
51 #include <sys/select.h>
52 #include <sys/proc.h>
53 #include <sys/vnode.h>
54 #include <sys/poll.h>
55 #include <sys/lock.h>
56
57 #ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
58 #include <machine/intr.h>
59 #endif
60
61 #include <dev/usb/usb.h>
62 #include <dev/usb/usbdi.h>
63 #include <dev/usb/usbdi_util.h>
64
65 #include <dev/usb/usbdevs.h>
66 #include <dev/usb/uaudioreg.h>
67 #include <dev/usb/umidireg.h>
68 #include <dev/usb/umidivar.h>
69 #include <dev/usb/umidi_quirks.h>
70
71 #include <dev/midi_if.h>
72
73 #ifdef UMIDI_DEBUG
74 #define DPRINTF(x) if (umididebug) printf x
75 #define DPRINTFN(n,x) if (umididebug >= (n)) printf x
76 #include <sys/time.h>
77 static struct timeval umidi_tv;
78 int umididebug = 0;
79 #else
80 #define DPRINTF(x)
81 #define DPRINTFN(n,x)
82 #endif
83
84
85 static int umidi_open(void *, int,
86 void (*)(void *, int), void (*)(void *), void *);
87 static void umidi_close(void *);
88 static int umidi_channelmsg(void *, int, int, u_char *, int);
89 static int umidi_commonmsg(void *, int, u_char *, int);
90 static int umidi_sysex(void *, u_char *, int);
91 static int umidi_rtmsg(void *, int);
92 static void umidi_getinfo(void *, struct midi_info *);
93
94 static usbd_status alloc_pipe(struct umidi_endpoint *);
95 static void free_pipe(struct umidi_endpoint *);
96
97 static usbd_status alloc_all_endpoints(struct umidi_softc *);
98 static void free_all_endpoints(struct umidi_softc *);
99
100 static usbd_status alloc_all_jacks(struct umidi_softc *);
101 static void free_all_jacks(struct umidi_softc *);
102 static usbd_status bind_jacks_to_mididev(struct umidi_softc *,
103 struct umidi_jack *,
104 struct umidi_jack *,
105 struct umidi_mididev *);
106 static void unbind_jacks_from_mididev(struct umidi_mididev *);
107 static void unbind_all_jacks(struct umidi_softc *);
108 static usbd_status assign_all_jacks_automatically(struct umidi_softc *);
109 static usbd_status open_out_jack(struct umidi_jack *, void *,
110 void (*)(void *));
111 static usbd_status open_in_jack(struct umidi_jack *, void *,
112 void (*)(void *, int));
113 static void close_out_jack(struct umidi_jack *);
114 static void close_in_jack(struct umidi_jack *);
115
116 static usbd_status attach_mididev(struct umidi_softc *,
117 struct umidi_mididev *);
118 static usbd_status detach_mididev(struct umidi_mididev *, int);
119 static usbd_status deactivate_mididev(struct umidi_mididev *);
120 static usbd_status alloc_all_mididevs(struct umidi_softc *, int);
121 static void free_all_mididevs(struct umidi_softc *);
122 static usbd_status attach_all_mididevs(struct umidi_softc *);
123 static usbd_status detach_all_mididevs(struct umidi_softc *, int);
124 static usbd_status deactivate_all_mididevs(struct umidi_softc *);
125
126 #ifdef UMIDI_DEBUG
127 static void dump_sc(struct umidi_softc *);
128 static void dump_ep(struct umidi_endpoint *);
129 static void dump_jack(struct umidi_jack *);
130 #endif
131
132 static usbd_status start_input_transfer(struct umidi_endpoint *);
133 static usbd_status start_output_transfer(struct umidi_endpoint *);
134 static int out_jack_output(struct umidi_jack *, u_char *, int, int);
135 static void in_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
136 static void out_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
137 static void out_solicit(void *); /* struct umidi_endpoint* for softintr */
138
139
140 struct midi_hw_if umidi_hw_if = {
141 umidi_open,
142 umidi_close,
143 umidi_rtmsg,
144 umidi_getinfo,
145 0, /* ioctl */
146 };
147
148 struct midi_hw_if_ext umidi_hw_if_ext = {
149 .channel = umidi_channelmsg,
150 .common = umidi_commonmsg,
151 .sysex = umidi_sysex,
152 };
153
154 USB_DECLARE_DRIVER(umidi);
155
156 USB_MATCH(umidi)
157 {
158 USB_MATCH_START(umidi, uaa);
159 usb_interface_descriptor_t *id;
160
161 DPRINTFN(1,("umidi_match\n"));
162
163 if (uaa->iface == NULL)
164 return UMATCH_NONE;
165
166 if (umidi_search_quirk(uaa->vendor, uaa->product, uaa->ifaceno))
167 return UMATCH_IFACECLASS_IFACESUBCLASS;
168
169 id = usbd_get_interface_descriptor(uaa->iface);
170 if (id!=NULL &&
171 id->bInterfaceClass==UICLASS_AUDIO &&
172 id->bInterfaceSubClass==UISUBCLASS_MIDISTREAM)
173 return UMATCH_IFACECLASS_IFACESUBCLASS;
174
175 return UMATCH_NONE;
176 }
177
178 USB_ATTACH(umidi)
179 {
180 usbd_status err;
181 USB_ATTACH_START(umidi, sc, uaa);
182 char devinfo[1024];
183
184 DPRINTFN(1,("umidi_attach\n"));
185
186 usbd_devinfo(uaa->device, 0, devinfo);
187 printf("\n%s: %s\n", USBDEVNAME(sc->sc_dev), devinfo);
188
189 sc->sc_iface = uaa->iface;
190 sc->sc_udev = uaa->device;
191
192 sc->sc_quirk =
193 umidi_search_quirk(uaa->vendor, uaa->product, uaa->ifaceno);
194 printf("%s: ", USBDEVNAME(sc->sc_dev));
195 umidi_print_quirk(sc->sc_quirk);
196
197
198 err = alloc_all_endpoints(sc);
199 if (err!=USBD_NORMAL_COMPLETION) {
200 printf("%s: alloc_all_endpoints failed. (err=%d)\n",
201 USBDEVNAME(sc->sc_dev), err);
202 goto error;
203 }
204 err = alloc_all_jacks(sc);
205 if (err!=USBD_NORMAL_COMPLETION) {
206 free_all_endpoints(sc);
207 printf("%s: alloc_all_jacks failed. (err=%d)\n",
208 USBDEVNAME(sc->sc_dev), err);
209 goto error;
210 }
211 printf("%s: out=%d, in=%d\n",
212 USBDEVNAME(sc->sc_dev),
213 sc->sc_out_num_jacks, sc->sc_in_num_jacks);
214
215 err = assign_all_jacks_automatically(sc);
216 if (err!=USBD_NORMAL_COMPLETION) {
217 unbind_all_jacks(sc);
218 free_all_jacks(sc);
219 free_all_endpoints(sc);
220 printf("%s: assign_all_jacks_automatically failed. (err=%d)\n",
221 USBDEVNAME(sc->sc_dev), err);
222 goto error;
223 }
224 err = attach_all_mididevs(sc);
225 if (err!=USBD_NORMAL_COMPLETION) {
226 free_all_jacks(sc);
227 free_all_endpoints(sc);
228 printf("%s: attach_all_mididevs failed. (err=%d)\n",
229 USBDEVNAME(sc->sc_dev), err);
230 }
231
232 #ifdef UMIDI_DEBUG
233 dump_sc(sc);
234 #endif
235
236 usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH,
237 sc->sc_udev, USBDEV(sc->sc_dev));
238
239 USB_ATTACH_SUCCESS_RETURN;
240 error:
241 printf("%s: disabled.\n", USBDEVNAME(sc->sc_dev));
242 sc->sc_dying = 1;
243 USB_ATTACH_ERROR_RETURN;
244 }
245
246 int
247 umidi_activate(device_ptr_t self, enum devact act)
248 {
249 struct umidi_softc *sc = (struct umidi_softc *)self;
250
251 switch (act) {
252 case DVACT_ACTIVATE:
253 DPRINTFN(1,("umidi_activate (activate)\n"));
254
255 return EOPNOTSUPP;
256 break;
257 case DVACT_DEACTIVATE:
258 DPRINTFN(1,("umidi_activate (deactivate)\n"));
259 sc->sc_dying = 1;
260 deactivate_all_mididevs(sc);
261 break;
262 }
263 return 0;
264 }
265
266 USB_DETACH(umidi)
267 {
268 USB_DETACH_START(umidi, sc);
269
270 DPRINTFN(1,("umidi_detach\n"));
271
272 sc->sc_dying = 1;
273 detach_all_mididevs(sc, flags);
274 free_all_mididevs(sc);
275 free_all_jacks(sc);
276 free_all_endpoints(sc);
277
278 usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
279 USBDEV(sc->sc_dev));
280
281 return 0;
282 }
283
284
285 /*
286 * midi_if stuffs
287 */
288 int
289 umidi_open(void *addr,
290 int flags,
291 void (*iintr)(void *, int),
292 void (*ointr)(void *),
293 void *arg)
294 {
295 struct umidi_mididev *mididev = addr;
296 struct umidi_softc *sc = mididev->sc;
297 usbd_status err;
298
299 DPRINTF(("umidi_open: sc=%p\n", sc));
300
301 if (!sc)
302 return ENXIO;
303 if (mididev->opened)
304 return EBUSY;
305 if (sc->sc_dying)
306 return EIO;
307
308 mididev->opened = 1;
309 mididev->flags = flags;
310 if ((mididev->flags & FWRITE) && mididev->out_jack) {
311 err = open_out_jack(mididev->out_jack, arg, ointr);
312 if ( err != USBD_NORMAL_COMPLETION )
313 goto bad;
314 }
315 if ((mididev->flags & FREAD) && mididev->in_jack) {
316 err = open_in_jack(mididev->in_jack, arg, iintr);
317 if ( err != USBD_NORMAL_COMPLETION
318 && err != USBD_IN_PROGRESS )
319 goto bad;
320 }
321
322 return 0;
323 bad:
324 mididev->opened = 0;
325 DPRINTF(("umidi_open: usbd_status %d\n", err));
326 return USBD_IN_USE == err ? EBUSY : EIO;
327 }
328
329 void
330 umidi_close(void *addr)
331 {
332 int s;
333 struct umidi_mididev *mididev = addr;
334
335 s = splusb();
336 if ((mididev->flags & FWRITE) && mididev->out_jack)
337 close_out_jack(mididev->out_jack);
338 if ((mididev->flags & FREAD) && mididev->in_jack)
339 close_in_jack(mididev->in_jack);
340 mididev->opened = 0;
341 splx(s);
342 }
343
344 int
345 umidi_channelmsg(void *addr, int status, int channel, u_char *msg, int len)
346 {
347 struct umidi_mididev *mididev = addr;
348
349 if (!mididev->out_jack || !mididev->opened)
350 return EIO;
351
352 return out_jack_output(mididev->out_jack, msg, len, (status>>4)&0xf);
353 }
354
355 int
356 umidi_commonmsg(void *addr, int status, u_char *msg, int len)
357 {
358 struct umidi_mididev *mididev = addr;
359 int cin;
360
361 if (!mididev->out_jack || !mididev->opened)
362 return EIO;
363
364 switch ( len ) {
365 case 1: cin = 5; break;
366 case 2: cin = 2; break;
367 case 3: cin = 3; break;
368 default: return EIO; /* or gcc warns of cin uninitialized */
369 }
370
371 return out_jack_output(mididev->out_jack, msg, len, cin);
372 }
373
374 int
375 umidi_sysex(void *addr, u_char *msg, int len)
376 {
377 struct umidi_mididev *mididev = addr;
378 int cin;
379
380 if (!mididev->out_jack || !mididev->opened)
381 return EIO;
382
383 switch ( len ) {
384 case 1: cin = 5; break;
385 case 2: cin = 6; break;
386 case 3: cin = (msg[2] == 0xf7) ? 7 : 4; break;
387 default: return EIO; /* or gcc warns of cin uninitialized */
388 }
389
390 return out_jack_output(mididev->out_jack, msg, len, cin);
391 }
392
393 int
394 umidi_rtmsg(void *addr, int d)
395 {
396 struct umidi_mididev *mididev = addr;
397 u_char msg = d;
398
399 if (!mididev->out_jack || !mididev->opened)
400 return EIO;
401
402 return out_jack_output(mididev->out_jack, &msg, 1, 0xf);
403 }
404
405 void
406 umidi_getinfo(void *addr, struct midi_info *mi)
407 {
408 struct umidi_mididev *mididev = addr;
409 /* struct umidi_softc *sc = mididev->sc; */
410
411 mi->name = "USB MIDI I/F"; /* XXX: model name */
412 mi->props = MIDI_PROP_OUT_INTR;
413 if (mididev->in_jack)
414 mi->props |= MIDI_PROP_CAN_INPUT;
415 midi_register_hw_if_ext(&umidi_hw_if_ext);
416 }
417
418
419 /*
420 * each endpoint stuffs
421 */
422
423 /* alloc/free pipe */
424 static usbd_status
425 alloc_pipe(struct umidi_endpoint *ep)
426 {
427 struct umidi_softc *sc = ep->sc;
428 usbd_status err;
429 usb_endpoint_descriptor_t *epd;
430
431 epd = usbd_get_endpoint_descriptor(sc->sc_iface, ep->addr);
432 /*
433 * For output, an improvement would be to have a buffer bigger than
434 * wMaxPacketSize by num_jacks-1 additional packet slots; that would
435 * allow out_solicit to fill the buffer to the full packet size in
436 * all cases. But to use usbd_alloc_buffer to get a slightly larger
437 * buffer would not be a good way to do that, because if the addition
438 * would make the buffer exceed USB_MEM_SMALL then a substantially
439 * larger block may be wastefully allocated. Some flavor of double
440 * buffering could serve the same purpose, but would increase the
441 * code complexity, so for now I will live with the current slight
442 * penalty of reducing max transfer size by (num_open-num_scheduled)
443 * packet slots.
444 */
445 ep->buffer_size = UGETW(epd->wMaxPacketSize);
446 ep->buffer_size -= ep->buffer_size % UMIDI_PACKET_SIZE;
447
448 DPRINTF(("%s: alloc_pipe %p, buffer size %u\n",
449 USBDEVNAME(sc->sc_dev), ep, ep->buffer_size));
450 ep->num_scheduled = 0;
451 ep->this_schedule = 0;
452 ep->next_schedule = 0;
453 ep->soliciting = 0;
454 ep->armed = 0;
455 ep->xfer = usbd_alloc_xfer(sc->sc_udev);
456 if (ep->xfer == NULL) {
457 err = USBD_NOMEM;
458 goto quit;
459 }
460 ep->buffer = usbd_alloc_buffer(ep->xfer, ep->buffer_size);
461 if (ep->buffer == NULL) {
462 usbd_free_xfer(ep->xfer);
463 err = USBD_NOMEM;
464 goto quit;
465 }
466 ep->next_slot = ep->buffer;
467 err = usbd_open_pipe(sc->sc_iface, ep->addr, 0, &ep->pipe);
468 if (err)
469 usbd_free_xfer(ep->xfer);
470 #ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
471 ep->solicit_cookie = softintr_establish(IPL_SOFTCLOCK,out_solicit,ep);
472 #endif
473 quit:
474 return err;
475 }
476
477 static void
478 free_pipe(struct umidi_endpoint *ep)
479 {
480 DPRINTF(("%s: free_pipe %p\n", USBDEVNAME(ep->sc->sc_dev), ep));
481 usbd_abort_pipe(ep->pipe);
482 usbd_close_pipe(ep->pipe);
483 usbd_free_xfer(ep->xfer);
484 #ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
485 softintr_disestablish(ep->solicit_cookie);
486 #endif
487 }
488
489
490 /* alloc/free the array of endpoint structures */
491
492 static usbd_status alloc_all_endpoints_fixed_ep(struct umidi_softc *);
493 static usbd_status alloc_all_endpoints_yamaha(struct umidi_softc *);
494 static usbd_status alloc_all_endpoints_genuine(struct umidi_softc *);
495
496 static usbd_status
497 alloc_all_endpoints(struct umidi_softc *sc)
498 {
499 usbd_status err;
500 struct umidi_endpoint *ep;
501 int i;
502
503 if (UMQ_ISTYPE(sc, UMQ_TYPE_FIXED_EP)) {
504 err = alloc_all_endpoints_fixed_ep(sc);
505 } else if (UMQ_ISTYPE(sc, UMQ_TYPE_YAMAHA)) {
506 err = alloc_all_endpoints_yamaha(sc);
507 } else {
508 err = alloc_all_endpoints_genuine(sc);
509 }
510 if (err!=USBD_NORMAL_COMPLETION)
511 return err;
512
513 ep = sc->sc_endpoints;
514 for (i=sc->sc_out_num_endpoints+sc->sc_in_num_endpoints; i>0; i--) {
515 err = alloc_pipe(ep++);
516 if (err!=USBD_NORMAL_COMPLETION) {
517 for (; ep!=sc->sc_endpoints; ep--)
518 free_pipe(ep-1);
519 free(sc->sc_endpoints, M_USBDEV);
520 sc->sc_endpoints = sc->sc_out_ep = sc->sc_in_ep = NULL;
521 break;
522 }
523 }
524 return err;
525 }
526
527 static void
528 free_all_endpoints(struct umidi_softc *sc)
529 {
530 int i;
531 for (i=0; i<sc->sc_in_num_endpoints+sc->sc_out_num_endpoints; i++)
532 free_pipe(&sc->sc_endpoints[i]);
533 if (sc->sc_endpoints != NULL)
534 free(sc->sc_endpoints, M_USBDEV);
535 sc->sc_endpoints = sc->sc_out_ep = sc->sc_in_ep = NULL;
536 }
537
538 static usbd_status
539 alloc_all_endpoints_fixed_ep(struct umidi_softc *sc)
540 {
541 usbd_status err;
542 struct umq_fixed_ep_desc *fp;
543 struct umidi_endpoint *ep;
544 usb_endpoint_descriptor_t *epd;
545 int i;
546
547 fp = umidi_get_quirk_data_from_type(sc->sc_quirk,
548 UMQ_TYPE_FIXED_EP);
549 sc->sc_out_num_jacks = 0;
550 sc->sc_in_num_jacks = 0;
551 sc->sc_out_num_endpoints = fp->num_out_ep;
552 sc->sc_in_num_endpoints = fp->num_in_ep;
553 sc->sc_endpoints = malloc(sizeof(*sc->sc_out_ep)*
554 (sc->sc_out_num_endpoints+
555 sc->sc_in_num_endpoints),
556 M_USBDEV, M_WAITOK);
557 if (!sc->sc_endpoints) {
558 return USBD_NOMEM;
559 }
560 sc->sc_out_ep = sc->sc_out_num_endpoints ? sc->sc_endpoints : NULL;
561 sc->sc_in_ep =
562 sc->sc_in_num_endpoints ?
563 sc->sc_endpoints+sc->sc_out_num_endpoints : NULL;
564
565 ep = &sc->sc_out_ep[0];
566 for (i=0; i<sc->sc_out_num_endpoints; i++) {
567 epd = usbd_interface2endpoint_descriptor(
568 sc->sc_iface,
569 fp->out_ep[i].ep);
570 if (!epd) {
571 printf("%s: cannot get endpoint descriptor(out:%d)\n",
572 USBDEVNAME(sc->sc_dev), fp->out_ep[i].ep);
573 err = USBD_INVAL;
574 goto error;
575 }
576 if (UE_GET_XFERTYPE(epd->bmAttributes)!=UE_BULK ||
577 UE_GET_DIR(epd->bEndpointAddress)!=UE_DIR_OUT) {
578 printf("%s: illegal endpoint(out:%d)\n",
579 USBDEVNAME(sc->sc_dev), fp->out_ep[i].ep);
580 err = USBD_INVAL;
581 goto error;
582 }
583 ep->sc = sc;
584 ep->addr = epd->bEndpointAddress;
585 ep->num_jacks = fp->out_ep[i].num_jacks;
586 sc->sc_out_num_jacks += fp->out_ep[i].num_jacks;
587 ep->num_open = 0;
588 memset(ep->jacks, 0, sizeof(ep->jacks));
589 ep++;
590 }
591 ep = &sc->sc_in_ep[0];
592 for (i=0; i<sc->sc_in_num_endpoints; i++) {
593 epd = usbd_interface2endpoint_descriptor(
594 sc->sc_iface,
595 fp->in_ep[i].ep);
596 if (!epd) {
597 printf("%s: cannot get endpoint descriptor(in:%d)\n",
598 USBDEVNAME(sc->sc_dev), fp->in_ep[i].ep);
599 err = USBD_INVAL;
600 goto error;
601 }
602 /*
603 * MIDISPORT_2X4 inputs on an interrupt rather than a bulk
604 * endpoint. The existing input logic in this driver seems
605 * to work successfully if we just stop treating an interrupt
606 * endpoint as illegal (or the in_progress status we get on
607 * the initial transfer). It does not seem necessary to
608 * actually use the interrupt flavor of alloc_pipe or make
609 * other serious rearrangements of logic. I like that.
610 */
611 switch ( UE_GET_XFERTYPE(epd->bmAttributes) ) {
612 case UE_BULK:
613 case UE_INTERRUPT:
614 if ( UE_DIR_IN == UE_GET_DIR(epd->bEndpointAddress) )
615 break;
616 /*FALLTHROUGH*/
617 default:
618 printf("%s: illegal endpoint(in:%d)\n",
619 USBDEVNAME(sc->sc_dev), fp->in_ep[i].ep);
620 err = USBD_INVAL;
621 goto error;
622 }
623
624 ep->sc = sc;
625 ep->addr = epd->bEndpointAddress;
626 ep->num_jacks = fp->in_ep[i].num_jacks;
627 sc->sc_in_num_jacks += fp->in_ep[i].num_jacks;
628 ep->num_open = 0;
629 memset(ep->jacks, 0, sizeof(ep->jacks));
630 ep++;
631 }
632
633 return USBD_NORMAL_COMPLETION;
634 error:
635 free(sc->sc_endpoints, M_USBDEV);
636 sc->sc_endpoints = NULL;
637 return err;
638 }
639
640 static usbd_status
641 alloc_all_endpoints_yamaha(struct umidi_softc *sc)
642 {
643 /* This driver currently supports max 1in/1out bulk endpoints */
644 usb_descriptor_t *desc;
645 usb_endpoint_descriptor_t *epd;
646 int out_addr, in_addr, i;
647 int dir;
648 size_t remain, descsize;
649
650 sc->sc_out_num_jacks = sc->sc_in_num_jacks = 0;
651 out_addr = in_addr = 0;
652
653 /* detect endpoints */
654 desc = TO_D(usbd_get_interface_descriptor(sc->sc_iface));
655 for (i=(int)TO_IFD(desc)->bNumEndpoints-1; i>=0; i--) {
656 epd = usbd_interface2endpoint_descriptor(sc->sc_iface, i);
657 if (UE_GET_XFERTYPE(epd->bmAttributes) == UE_BULK) {
658 dir = UE_GET_DIR(epd->bEndpointAddress);
659 if (dir==UE_DIR_OUT && !out_addr)
660 out_addr = epd->bEndpointAddress;
661 else if (dir==UE_DIR_IN && !in_addr)
662 in_addr = epd->bEndpointAddress;
663 }
664 }
665 desc = NEXT_D(desc);
666
667 /* count jacks */
668 if (!(desc->bDescriptorType==UDESC_CS_INTERFACE &&
669 desc->bDescriptorSubtype==UMIDI_MS_HEADER))
670 return USBD_INVAL;
671 remain = (size_t)UGETW(TO_CSIFD(desc)->wTotalLength) -
672 (size_t)desc->bLength;
673 desc = NEXT_D(desc);
674
675 while (remain>=sizeof(usb_descriptor_t)) {
676 descsize = desc->bLength;
677 if (descsize>remain || descsize==0)
678 break;
679 if (desc->bDescriptorType==UDESC_CS_INTERFACE &&
680 remain>=UMIDI_JACK_DESCRIPTOR_SIZE) {
681 if (desc->bDescriptorSubtype==UMIDI_OUT_JACK)
682 sc->sc_out_num_jacks++;
683 else if (desc->bDescriptorSubtype==UMIDI_IN_JACK)
684 sc->sc_in_num_jacks++;
685 }
686 desc = NEXT_D(desc);
687 remain-=descsize;
688 }
689
690 /* validate some parameters */
691 if (sc->sc_out_num_jacks>UMIDI_MAX_EPJACKS)
692 sc->sc_out_num_jacks = UMIDI_MAX_EPJACKS;
693 if (sc->sc_in_num_jacks>UMIDI_MAX_EPJACKS)
694 sc->sc_in_num_jacks = UMIDI_MAX_EPJACKS;
695 if (sc->sc_out_num_jacks && out_addr) {
696 sc->sc_out_num_endpoints = 1;
697 } else {
698 sc->sc_out_num_endpoints = 0;
699 sc->sc_out_num_jacks = 0;
700 }
701 if (sc->sc_in_num_jacks && in_addr) {
702 sc->sc_in_num_endpoints = 1;
703 } else {
704 sc->sc_in_num_endpoints = 0;
705 sc->sc_in_num_jacks = 0;
706 }
707 sc->sc_endpoints = malloc(sizeof(struct umidi_endpoint)*
708 (sc->sc_out_num_endpoints+
709 sc->sc_in_num_endpoints),
710 M_USBDEV, M_WAITOK);
711 if (!sc->sc_endpoints)
712 return USBD_NOMEM;
713 if (sc->sc_out_num_endpoints) {
714 sc->sc_out_ep = sc->sc_endpoints;
715 sc->sc_out_ep->sc = sc;
716 sc->sc_out_ep->addr = out_addr;
717 sc->sc_out_ep->num_jacks = sc->sc_out_num_jacks;
718 sc->sc_out_ep->num_open = 0;
719 memset(sc->sc_out_ep->jacks, 0, sizeof(sc->sc_out_ep->jacks));
720 } else
721 sc->sc_out_ep = NULL;
722
723 if (sc->sc_in_num_endpoints) {
724 sc->sc_in_ep = sc->sc_endpoints+sc->sc_out_num_endpoints;
725 sc->sc_in_ep->sc = sc;
726 sc->sc_in_ep->addr = in_addr;
727 sc->sc_in_ep->num_jacks = sc->sc_in_num_jacks;
728 sc->sc_in_ep->num_open = 0;
729 memset(sc->sc_in_ep->jacks, 0, sizeof(sc->sc_in_ep->jacks));
730 } else
731 sc->sc_in_ep = NULL;
732
733 return USBD_NORMAL_COMPLETION;
734 }
735
736 static usbd_status
737 alloc_all_endpoints_genuine(struct umidi_softc *sc)
738 {
739 usb_interface_descriptor_t *interface_desc;
740 usb_config_descriptor_t *config_desc;
741 usb_descriptor_t *desc;
742 int num_ep;
743 size_t remain, descsize;
744 struct umidi_endpoint *p, *q, *lowest, *endep, tmpep;
745 int epaddr;
746
747 interface_desc = usbd_get_interface_descriptor(sc->sc_iface);
748 num_ep = interface_desc->bNumEndpoints;
749 sc->sc_endpoints = p = malloc(sizeof(struct umidi_endpoint) * num_ep,
750 M_USBDEV, M_WAITOK);
751 if (!p)
752 return USBD_NOMEM;
753
754 sc->sc_out_num_jacks = sc->sc_in_num_jacks = 0;
755 sc->sc_out_num_endpoints = sc->sc_in_num_endpoints = 0;
756 epaddr = -1;
757
758 /* get the list of endpoints for midi stream */
759 config_desc = usbd_get_config_descriptor(sc->sc_udev);
760 desc = (usb_descriptor_t *) config_desc;
761 remain = (size_t)UGETW(config_desc->wTotalLength);
762 while (remain>=sizeof(usb_descriptor_t)) {
763 descsize = desc->bLength;
764 if (descsize>remain || descsize==0)
765 break;
766 if (desc->bDescriptorType==UDESC_ENDPOINT &&
767 remain>=USB_ENDPOINT_DESCRIPTOR_SIZE &&
768 UE_GET_XFERTYPE(TO_EPD(desc)->bmAttributes) == UE_BULK) {
769 epaddr = TO_EPD(desc)->bEndpointAddress;
770 } else if (desc->bDescriptorType==UDESC_CS_ENDPOINT &&
771 remain>=UMIDI_CS_ENDPOINT_DESCRIPTOR_SIZE &&
772 epaddr!=-1) {
773 if (num_ep>0) {
774 num_ep--;
775 p->sc = sc;
776 p->addr = epaddr;
777 p->num_jacks = TO_CSEPD(desc)->bNumEmbMIDIJack;
778 if (UE_GET_DIR(epaddr)==UE_DIR_OUT) {
779 sc->sc_out_num_endpoints++;
780 sc->sc_out_num_jacks += p->num_jacks;
781 } else {
782 sc->sc_in_num_endpoints++;
783 sc->sc_in_num_jacks += p->num_jacks;
784 }
785 p++;
786 }
787 } else
788 epaddr = -1;
789 desc = NEXT_D(desc);
790 remain-=descsize;
791 }
792
793 /* sort endpoints */
794 num_ep = sc->sc_out_num_endpoints + sc->sc_in_num_endpoints;
795 p = sc->sc_endpoints;
796 endep = p + num_ep;
797 while (p<endep) {
798 lowest = p;
799 for (q=p+1; q<endep; q++) {
800 if ((UE_GET_DIR(lowest->addr)==UE_DIR_IN &&
801 UE_GET_DIR(q->addr)==UE_DIR_OUT) ||
802 ((UE_GET_DIR(lowest->addr)==
803 UE_GET_DIR(q->addr)) &&
804 (UE_GET_ADDR(lowest->addr)>
805 UE_GET_ADDR(q->addr))))
806 lowest = q;
807 }
808 if (lowest != p) {
809 memcpy((void *)&tmpep, (void *)p, sizeof(tmpep));
810 memcpy((void *)p, (void *)lowest, sizeof(tmpep));
811 memcpy((void *)lowest, (void *)&tmpep, sizeof(tmpep));
812 }
813 p->num_open = 0;
814 p++;
815 }
816
817 sc->sc_out_ep = sc->sc_out_num_endpoints ? sc->sc_endpoints : NULL;
818 sc->sc_in_ep =
819 sc->sc_in_num_endpoints ?
820 sc->sc_endpoints+sc->sc_out_num_endpoints : NULL;
821
822 return USBD_NORMAL_COMPLETION;
823 }
824
825
826 /*
827 * jack stuffs
828 */
829
830 static usbd_status
831 alloc_all_jacks(struct umidi_softc *sc)
832 {
833 int i, j;
834 struct umidi_endpoint *ep;
835 struct umidi_jack *jack;
836 int cnglobal;
837 unsigned char *cn_spec;
838
839 if (UMQ_ISTYPE(sc, UMQ_TYPE_CN_SEQ_PER_EP))
840 cnglobal = 0;
841 else if (UMQ_ISTYPE(sc, UMQ_TYPE_CN_SEQ_GLOBAL))
842 cnglobal = 1;
843 else {
844 /*
845 * I don't think this default is correct, but it preserves
846 * the prior behavior of the code. That's why I defined two
847 * complementary quirks. Any device for which the default
848 * behavior is wrong can be made to work by giving it an
849 * explicit quirk, and if a pattern ever develops (as I suspect
850 * it will) that a lot of otherwise standard USB MIDI devices
851 * need the CN_SEQ_PER_EP "quirk," then this default can be
852 * changed to 0, and the only devices that will break are those
853 * listing neither quirk, and they'll easily be fixed by giving
854 * them the CN_SEQ_GLOBAL quirk.
855 */
856 cnglobal = 1;
857 }
858
859 if (UMQ_ISTYPE(sc, UMQ_TYPE_CN_FIXED))
860 cn_spec = umidi_get_quirk_data_from_type(sc->sc_quirk,
861 UMQ_TYPE_CN_FIXED);
862 else
863 cn_spec = NULL;
864
865 /* allocate/initialize structures */
866 sc->sc_jacks =
867 malloc(sizeof(*sc->sc_out_jacks)*(sc->sc_in_num_jacks+
868 sc->sc_out_num_jacks),
869 M_USBDEV, M_WAITOK);
870 if (!sc->sc_jacks)
871 return USBD_NOMEM;
872 sc->sc_out_jacks =
873 sc->sc_out_num_jacks ? sc->sc_jacks : NULL;
874 sc->sc_in_jacks =
875 sc->sc_in_num_jacks ? sc->sc_jacks+sc->sc_out_num_jacks : NULL;
876
877 jack = &sc->sc_out_jacks[0];
878 for (i=0; i<sc->sc_out_num_jacks; i++) {
879 jack->opened = 0;
880 jack->binded = 0;
881 jack->arg = NULL;
882 jack->u.out.intr = NULL;
883 if ( cnglobal )
884 jack->cable_number = i;
885 jack++;
886 }
887 jack = &sc->sc_in_jacks[0];
888 for (i=0; i<sc->sc_in_num_jacks; i++) {
889 jack->opened = 0;
890 jack->binded = 0;
891 jack->arg = NULL;
892 jack->u.in.intr = NULL;
893 if ( cnglobal )
894 jack->cable_number = i;
895 jack++;
896 }
897
898 /* assign each jacks to each endpoints */
899 jack = &sc->sc_out_jacks[0];
900 ep = &sc->sc_out_ep[0];
901 for (i=0; i<sc->sc_out_num_endpoints; i++) {
902 for (j=0; j<ep->num_jacks; j++) {
903 jack->endpoint = ep;
904 if ( cn_spec != NULL )
905 jack->cable_number = *cn_spec++;
906 else if ( !cnglobal )
907 jack->cable_number = j;
908 ep->jacks[jack->cable_number] = jack;
909 jack++;
910 }
911 ep++;
912 }
913 jack = &sc->sc_in_jacks[0];
914 ep = &sc->sc_in_ep[0];
915 for (i=0; i<sc->sc_in_num_endpoints; i++) {
916 for (j=0; j<ep->num_jacks; j++) {
917 jack->endpoint = ep;
918 if ( cn_spec != NULL )
919 jack->cable_number = *cn_spec++;
920 else if ( !cnglobal )
921 jack->cable_number = j;
922 ep->jacks[jack->cable_number] = jack;
923 jack++;
924 }
925 ep++;
926 }
927
928 return USBD_NORMAL_COMPLETION;
929 }
930
931 static void
932 free_all_jacks(struct umidi_softc *sc)
933 {
934 int s;
935
936 s = splaudio();
937 if (sc->sc_out_jacks) {
938 free(sc->sc_jacks, M_USBDEV);
939 sc->sc_jacks = sc->sc_in_jacks = sc->sc_out_jacks = NULL;
940 }
941 splx(s);
942 }
943
944 static usbd_status
945 bind_jacks_to_mididev(struct umidi_softc *sc,
946 struct umidi_jack *out_jack,
947 struct umidi_jack *in_jack,
948 struct umidi_mididev *mididev)
949 {
950 if ((out_jack && out_jack->binded) || (in_jack && in_jack->binded))
951 return USBD_IN_USE;
952 if (mididev->out_jack || mididev->in_jack)
953 return USBD_IN_USE;
954
955 if (out_jack)
956 out_jack->binded = 1;
957 if (in_jack)
958 in_jack->binded = 1;
959 mididev->in_jack = in_jack;
960 mididev->out_jack = out_jack;
961
962 return USBD_NORMAL_COMPLETION;
963 }
964
965 static void
966 unbind_jacks_from_mididev(struct umidi_mididev *mididev)
967 {
968 if ((mididev->flags & FWRITE) && mididev->out_jack)
969 close_out_jack(mididev->out_jack);
970 if ((mididev->flags & FREAD) && mididev->in_jack)
971 close_in_jack(mididev->in_jack);
972
973 if (mididev->out_jack)
974 mididev->out_jack->binded = 0;
975 if (mididev->in_jack)
976 mididev->in_jack->binded = 0;
977 mididev->out_jack = mididev->in_jack = NULL;
978 }
979
980 static void
981 unbind_all_jacks(struct umidi_softc *sc)
982 {
983 int i;
984
985 if (sc->sc_mididevs)
986 for (i=0; i<sc->sc_num_mididevs; i++) {
987 unbind_jacks_from_mididev(&sc->sc_mididevs[i]);
988 }
989 }
990
991 static usbd_status
992 assign_all_jacks_automatically(struct umidi_softc *sc)
993 {
994 usbd_status err;
995 int i;
996 struct umidi_jack *out, *in;
997 signed char *asg_spec;
998
999 err =
1000 alloc_all_mididevs(sc,
1001 max(sc->sc_out_num_jacks, sc->sc_in_num_jacks));
1002 if (err!=USBD_NORMAL_COMPLETION)
1003 return err;
1004
1005 if ( UMQ_ISTYPE(sc, UMQ_TYPE_MD_FIXED))
1006 asg_spec = umidi_get_quirk_data_from_type(sc->sc_quirk,
1007 UMQ_TYPE_MD_FIXED);
1008 else
1009 asg_spec = NULL;
1010
1011 for (i=0; i<sc->sc_num_mididevs; i++) {
1012 if ( asg_spec != NULL ) {
1013 if ( *asg_spec == -1 )
1014 out = NULL;
1015 else
1016 out = &sc->sc_out_jacks[*asg_spec];
1017 ++ asg_spec;
1018 if ( *asg_spec == -1 )
1019 in = NULL;
1020 else
1021 in = &sc->sc_in_jacks[*asg_spec];
1022 ++ asg_spec;
1023 } else {
1024 out = (i<sc->sc_out_num_jacks) ? &sc->sc_out_jacks[i]
1025 : NULL;
1026 in = (i<sc->sc_in_num_jacks) ? &sc->sc_in_jacks[i]
1027 : NULL;
1028 }
1029 err = bind_jacks_to_mididev(sc, out, in, &sc->sc_mididevs[i]);
1030 if (err!=USBD_NORMAL_COMPLETION) {
1031 free_all_mididevs(sc);
1032 return err;
1033 }
1034 }
1035
1036 return USBD_NORMAL_COMPLETION;
1037 }
1038
1039 static usbd_status
1040 open_out_jack(struct umidi_jack *jack, void *arg, void (*intr)(void *))
1041 {
1042 struct umidi_endpoint *ep = jack->endpoint;
1043 umidi_packet_bufp end;
1044 int s;
1045 int err;
1046
1047 if (jack->opened)
1048 return USBD_IN_USE;
1049
1050 jack->arg = arg;
1051 jack->u.out.intr = intr;
1052 end = ep->buffer + ep->buffer_size / sizeof *ep->buffer;
1053 s = splusb();
1054 jack->opened = 1;
1055 ep->num_open++;
1056 /*
1057 * out_solicit maintains an invariant that there will always be
1058 * (num_open - num_scheduled) slots free in the buffer. as we have
1059 * just incremented num_open, the buffer may be too full to satisfy
1060 * the invariant until a transfer completes, for which we must wait.
1061 */
1062 while ( end - ep->next_slot < ep->num_open - ep->num_scheduled ) {
1063 err = tsleep(ep, PWAIT|PCATCH, "umi op", mstohz(10));
1064 if ( err ) {
1065 ep->num_open--;
1066 jack->opened = 0;
1067 splx(s);
1068 return USBD_IOERROR;
1069 }
1070 }
1071 splx(s);
1072
1073 return USBD_NORMAL_COMPLETION;
1074 }
1075
1076 static usbd_status
1077 open_in_jack(struct umidi_jack *jack, void *arg, void (*intr)(void *, int))
1078 {
1079 usbd_status err = USBD_NORMAL_COMPLETION;
1080 struct umidi_endpoint *ep = jack->endpoint;
1081
1082 if (jack->opened)
1083 return USBD_IN_USE;
1084
1085 jack->arg = arg;
1086 jack->u.in.intr = intr;
1087 jack->opened = 1;
1088 if (ep->num_open++==0 && UE_GET_DIR(ep->addr)==UE_DIR_IN) {
1089 err = start_input_transfer(ep);
1090 if (err != USBD_NORMAL_COMPLETION &&
1091 err != USBD_IN_PROGRESS) {
1092 ep->num_open--;
1093 }
1094 }
1095
1096 return err;
1097 }
1098
1099 static void
1100 close_out_jack(struct umidi_jack *jack)
1101 {
1102 struct umidi_endpoint *ep;
1103 int s;
1104 u_int16_t mask;
1105 int err;
1106
1107 if (jack->opened) {
1108 ep = jack->endpoint;
1109 mask = 1 << (jack->cable_number);
1110 s = splusb();
1111 while ( mask & (ep->this_schedule | ep->next_schedule) ) {
1112 err = tsleep(ep, PWAIT|PCATCH, "umi dr", mstohz(10));
1113 if ( err )
1114 break;
1115 }
1116 jack->opened = 0;
1117 jack->endpoint->num_open--;
1118 ep->this_schedule &= ~mask;
1119 ep->next_schedule &= ~mask;
1120 splx(s);
1121 }
1122 }
1123
1124 static void
1125 close_in_jack(struct umidi_jack *jack)
1126 {
1127 if (jack->opened) {
1128 jack->opened = 0;
1129 if (--jack->endpoint->num_open == 0) {
1130 usbd_abort_pipe(jack->endpoint->pipe);
1131 }
1132 }
1133 }
1134
1135 static usbd_status
1136 attach_mididev(struct umidi_softc *sc, struct umidi_mididev *mididev)
1137 {
1138 if (mididev->sc)
1139 return USBD_IN_USE;
1140
1141 mididev->sc = sc;
1142
1143 mididev->mdev = midi_attach_mi(&umidi_hw_if, mididev, &sc->sc_dev);
1144
1145 return USBD_NORMAL_COMPLETION;
1146 }
1147
1148 static usbd_status
1149 detach_mididev(struct umidi_mididev *mididev, int flags)
1150 {
1151 if (!mididev->sc)
1152 return USBD_NO_ADDR;
1153
1154 if (mididev->opened) {
1155 umidi_close(mididev);
1156 }
1157 unbind_jacks_from_mididev(mididev);
1158
1159 if (mididev->mdev)
1160 config_detach(mididev->mdev, flags);
1161
1162 mididev->sc = NULL;
1163
1164 return USBD_NORMAL_COMPLETION;
1165 }
1166
1167 static usbd_status
1168 deactivate_mididev(struct umidi_mididev *mididev)
1169 {
1170 if (mididev->out_jack)
1171 mididev->out_jack->binded = 0;
1172 if (mididev->in_jack)
1173 mididev->in_jack->binded = 0;
1174 config_deactivate(mididev->mdev);
1175
1176 return USBD_NORMAL_COMPLETION;
1177 }
1178
1179 static usbd_status
1180 alloc_all_mididevs(struct umidi_softc *sc, int nmidi)
1181 {
1182 sc->sc_num_mididevs = nmidi;
1183 sc->sc_mididevs = malloc(sizeof(*sc->sc_mididevs)*nmidi,
1184 M_USBDEV, M_WAITOK|M_ZERO);
1185 if (!sc->sc_mididevs)
1186 return USBD_NOMEM;
1187
1188 return USBD_NORMAL_COMPLETION;
1189 }
1190
1191 static void
1192 free_all_mididevs(struct umidi_softc *sc)
1193 {
1194 sc->sc_num_mididevs = 0;
1195 if (sc->sc_mididevs)
1196 free(sc->sc_mididevs, M_USBDEV);
1197 }
1198
1199 static usbd_status
1200 attach_all_mididevs(struct umidi_softc *sc)
1201 {
1202 usbd_status err;
1203 int i;
1204
1205 if (sc->sc_mididevs)
1206 for (i=0; i<sc->sc_num_mididevs; i++) {
1207 err = attach_mididev(sc, &sc->sc_mididevs[i]);
1208 if (err!=USBD_NORMAL_COMPLETION)
1209 return err;
1210 }
1211
1212 return USBD_NORMAL_COMPLETION;
1213 }
1214
1215 static usbd_status
1216 detach_all_mididevs(struct umidi_softc *sc, int flags)
1217 {
1218 usbd_status err;
1219 int i;
1220
1221 if (sc->sc_mididevs)
1222 for (i=0; i<sc->sc_num_mididevs; i++) {
1223 err = detach_mididev(&sc->sc_mididevs[i], flags);
1224 if (err!=USBD_NORMAL_COMPLETION)
1225 return err;
1226 }
1227
1228 return USBD_NORMAL_COMPLETION;
1229 }
1230
1231 static usbd_status
1232 deactivate_all_mididevs(struct umidi_softc *sc)
1233 {
1234 usbd_status err;
1235 int i;
1236
1237 if (sc->sc_mididevs)
1238 for (i=0; i<sc->sc_num_mididevs; i++) {
1239 err = deactivate_mididev(&sc->sc_mididevs[i]);
1240 if (err!=USBD_NORMAL_COMPLETION)
1241 return err;
1242 }
1243
1244 return USBD_NORMAL_COMPLETION;
1245 }
1246
1247 #ifdef UMIDI_DEBUG
1248 static void
1249 dump_sc(struct umidi_softc *sc)
1250 {
1251 int i;
1252
1253 DPRINTFN(10, ("%s: dump_sc\n", USBDEVNAME(sc->sc_dev)));
1254 for (i=0; i<sc->sc_out_num_endpoints; i++) {
1255 DPRINTFN(10, ("\tout_ep(%p):\n", &sc->sc_out_ep[i]));
1256 dump_ep(&sc->sc_out_ep[i]);
1257 }
1258 for (i=0; i<sc->sc_in_num_endpoints; i++) {
1259 DPRINTFN(10, ("\tin_ep(%p):\n", &sc->sc_in_ep[i]));
1260 dump_ep(&sc->sc_in_ep[i]);
1261 }
1262 }
1263
1264 static void
1265 dump_ep(struct umidi_endpoint *ep)
1266 {
1267 int i;
1268 for (i=0; i<ep->num_jacks; i++) {
1269 DPRINTFN(10, ("\t\tjack(%p):\n", ep->jacks[i]));
1270 dump_jack(ep->jacks[i]);
1271 }
1272 }
1273 static void
1274 dump_jack(struct umidi_jack *jack)
1275 {
1276 DPRINTFN(10, ("\t\t\tep=%p\n",
1277 jack->endpoint));
1278 }
1279
1280 #endif /* UMIDI_DEBUG */
1281
1282
1283
1284 /*
1285 * MUX MIDI PACKET
1286 */
1287
1288 static const int packet_length[16] = {
1289 /*0*/ -1,
1290 /*1*/ -1,
1291 /*2*/ 2,
1292 /*3*/ 3,
1293 /*4*/ 3,
1294 /*5*/ 1,
1295 /*6*/ 2,
1296 /*7*/ 3,
1297 /*8*/ 3,
1298 /*9*/ 3,
1299 /*A*/ 3,
1300 /*B*/ 3,
1301 /*C*/ 2,
1302 /*D*/ 2,
1303 /*E*/ 3,
1304 /*F*/ 1,
1305 };
1306
1307 #define GET_CN(p) (((unsigned char)(p)>>4)&0x0F)
1308 #define GET_CIN(p) ((unsigned char)(p)&0x0F)
1309 #define MIX_CN_CIN(cn, cin) \
1310 ((unsigned char)((((unsigned char)(cn)&0x0F)<<4)| \
1311 ((unsigned char)(cin)&0x0F)))
1312
1313 static usbd_status
1314 start_input_transfer(struct umidi_endpoint *ep)
1315 {
1316 usbd_setup_xfer(ep->xfer, ep->pipe,
1317 (usbd_private_handle)ep,
1318 ep->buffer, ep->buffer_size,
1319 USBD_SHORT_XFER_OK | USBD_NO_COPY,
1320 USBD_NO_TIMEOUT, in_intr);
1321 return usbd_transfer(ep->xfer);
1322 }
1323
1324 static usbd_status
1325 start_output_transfer(struct umidi_endpoint *ep)
1326 {
1327 u_int32_t length;
1328 length = (ep->next_slot - ep->buffer) * sizeof *ep->buffer;
1329 DPRINTFN(200,("umidi out transfer: start %p end %p length %u\n",
1330 ep->buffer, ep->next_slot, length));
1331 usbd_setup_xfer(ep->xfer, ep->pipe,
1332 (usbd_private_handle)ep,
1333 ep->buffer, length,
1334 USBD_NO_COPY, USBD_NO_TIMEOUT, out_intr);
1335 return usbd_transfer(ep->xfer);
1336 }
1337
1338 #ifdef UMIDI_DEBUG
1339 #define DPR_PACKET(dir, sc, p) \
1340 if ((unsigned char)(p)[1]!=0xFE) \
1341 DPRINTFN(500, \
1342 ("%s: umidi packet(" #dir "): %02X %02X %02X %02X\n", \
1343 USBDEVNAME(sc->sc_dev), \
1344 (unsigned char)(p)[0], \
1345 (unsigned char)(p)[1], \
1346 (unsigned char)(p)[2], \
1347 (unsigned char)(p)[3]));
1348 #else
1349 #define DPR_PACKET(dir, sc, p)
1350 #endif
1351
1352 /*
1353 * A 4-byte Midiman packet superficially resembles a 4-byte USB MIDI packet
1354 * with the cable number and length in the last byte instead of the first,
1355 * but there the resemblance ends. Where a USB MIDI packet is a semantic
1356 * unit, a Midiman packet is just a wrapper for 1 to 3 bytes of raw MIDI
1357 * with a cable nybble and a length nybble (which, unlike the CIN of a
1358 * real USB MIDI packet, has no semantics at all besides the length).
1359 * A packet received from a Midiman may contain part of a MIDI message,
1360 * more than one MIDI message, or parts of more than one MIDI message. A
1361 * three-byte MIDI message may arrive in three packets of data length 1, and
1362 * running status may be used. Happily, the midi(4) driver above us will put
1363 * it all back together, so the only cost is in USB bandwidth. The device
1364 * has an easier time with what it receives from us, as we'll just take
1365 * already formed, semantically reasonable USB MIDI packets and munge them
1366 * into Midiman form.
1367 */
1368
1369 static int
1370 out_jack_output(struct umidi_jack *out_jack, u_char *src, int len, int cin)
1371 {
1372 struct umidi_endpoint *ep = out_jack->endpoint;
1373 struct umidi_softc *sc = ep->sc;
1374 unsigned char *packet;
1375 int s;
1376
1377 if (sc->sc_dying)
1378 return EIO;
1379
1380 if (!out_jack->opened)
1381 return ENODEV; /* XXX as it was, is this the right errno? */
1382
1383 #ifdef UMIDI_DEBUG
1384 if ( umididebug >= 100 )
1385 microtime(&umidi_tv);
1386 #endif
1387 DPRINTFN(100, ("umidi out: %lu.%06lus ep=%p cn=%d len=%d cin=%#x\n",
1388 umidi_tv.tv_sec%100, umidi_tv.tv_usec,
1389 ep, out_jack->cable_number, len, cin));
1390
1391 s = splusb();
1392 packet = *ep->next_slot++;
1393 KASSERT(ep->buffer_size >=
1394 (ep->next_slot - ep->buffer) * sizeof *ep->buffer);
1395 memset(packet, 0, UMIDI_PACKET_SIZE);
1396 if (UMQ_ISTYPE(sc, UMQ_TYPE_MIDIMAN_GARBLE)) {
1397 memcpy(packet, src, len);
1398 packet[3] = MIX_CN_CIN(out_jack->cable_number, len);
1399 } else {
1400 packet[0] = MIX_CN_CIN(out_jack->cable_number, cin);
1401 memcpy(packet+1, src, len);
1402 }
1403 DPR_PACKET(out, sc, packet);
1404 ep->next_schedule |= 1<<(out_jack->cable_number);
1405 ++ ep->num_scheduled;
1406 if ( !ep->armed && !ep->soliciting ) {
1407 #ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
1408 /*
1409 * It would be bad to call out_solicit directly here (the
1410 * caller need not be reentrant) but a soft interrupt allows
1411 * solicit to run immediately the caller exits its critical
1412 * section, and if the caller has more to write we can get it
1413 * before starting the USB transfer, and send a longer one.
1414 */
1415 ep->soliciting = 1;
1416 softintr_schedule(ep->solicit_cookie);
1417 #else
1418 /*
1419 * This alternative is a little less desirable, because if the
1420 * writer has several messages to go at once, the first will go
1421 * in a USB frame all to itself, and the rest in a full-size
1422 * transfer one frame later (solicited on the first frame's
1423 * completion interrupt). But it's simple.
1424 */
1425 ep->armed = (USBD_IN_PROGRESS == start_output_transfer(ep));
1426 #endif
1427 }
1428 splx(s);
1429
1430 return 0;
1431 }
1432
1433 static void
1434 in_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
1435 {
1436 int cn, len, i;
1437 struct umidi_endpoint *ep = (struct umidi_endpoint *)priv;
1438 struct umidi_jack *jack;
1439 unsigned char *packet;
1440 umidi_packet_bufp slot;
1441 umidi_packet_bufp end;
1442 unsigned char *data;
1443 u_int32_t count;
1444
1445 if (ep->sc->sc_dying || !ep->num_open)
1446 return;
1447
1448 usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
1449 if ( 0 == count % UMIDI_PACKET_SIZE ) {
1450 DPRINTFN(200,("%s: input endpoint %p transfer length %u\n",
1451 USBDEVNAME(ep->sc->sc_dev), ep, count));
1452 } else {
1453 DPRINTF(("%s: input endpoint %p odd transfer length %u\n",
1454 USBDEVNAME(ep->sc->sc_dev), ep, count));
1455 }
1456
1457 slot = ep->buffer;
1458 end = slot + count / sizeof *slot;
1459
1460 for ( packet = *slot; slot < end; packet = *++slot ) {
1461
1462 if ( UMQ_ISTYPE(ep->sc, UMQ_TYPE_MIDIMAN_GARBLE) ) {
1463 cn = (0xf0&(packet[3]))>>4;
1464 len = 0x0f&(packet[3]);
1465 data = packet;
1466 } else {
1467 cn = GET_CN(packet[0]);
1468 len = packet_length[GET_CIN(packet[0])];
1469 data = packet + 1;
1470 }
1471 /* 0 <= cn <= 15 by inspection of above code */
1472 if (!(jack = ep->jacks[cn]) || cn != jack->cable_number) {
1473 DPRINTF(("%s: stray input endpoint %p cable %d len %d: "
1474 "%02X %02X %02X (try CN_SEQ quirk?)\n",
1475 USBDEVNAME(ep->sc->sc_dev), ep, cn, len,
1476 (unsigned)data[0],
1477 (unsigned)data[1],
1478 (unsigned)data[2]));
1479 return;
1480 }
1481
1482 if (!jack->binded || !jack->opened)
1483 return;
1484
1485 DPRINTFN(500,("%s: input endpoint %p cable %d len %d: "
1486 "%02X %02X %02X\n",
1487 USBDEVNAME(ep->sc->sc_dev), ep, cn, len,
1488 (unsigned)data[0],
1489 (unsigned)data[1],
1490 (unsigned)data[2]));
1491
1492 if (jack->u.in.intr) {
1493 for (i=0; i<len; i++) {
1494 (*jack->u.in.intr)(jack->arg, data[i]);
1495 }
1496 }
1497
1498 }
1499
1500 (void)start_input_transfer(ep);
1501 }
1502
1503 static void
1504 out_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
1505 {
1506 struct umidi_endpoint *ep = (struct umidi_endpoint *)priv;
1507 struct umidi_softc *sc = ep->sc;
1508 u_int32_t count;
1509
1510 if (sc->sc_dying)
1511 return;
1512
1513 #ifdef UMIDI_DEBUG
1514 if ( umididebug >= 200 )
1515 microtime(&umidi_tv);
1516 #endif
1517 usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
1518 if ( 0 == count % UMIDI_PACKET_SIZE ) {
1519 DPRINTFN(200,("%s: %lu.%06lus out ep %p xfer length %u\n",
1520 USBDEVNAME(ep->sc->sc_dev),
1521 umidi_tv.tv_sec%100, umidi_tv.tv_usec, ep, count));
1522 } else {
1523 DPRINTF(("%s: output endpoint %p odd transfer length %u\n",
1524 USBDEVNAME(ep->sc->sc_dev), ep, count));
1525 }
1526 count /= UMIDI_PACKET_SIZE;
1527
1528 /*
1529 * If while the transfer was pending we buffered any new messages,
1530 * move them to the start of the buffer.
1531 */
1532 ep->next_slot -= count;
1533 if ( ep->buffer < ep->next_slot ) {
1534 memcpy(ep->buffer, ep->buffer + count,
1535 (char *)ep->next_slot - (char *)ep->buffer);
1536 }
1537 wakeup(ep);
1538 /*
1539 * Do not want anyone else to see armed <- 0 before soliciting <- 1.
1540 * Running at splusb so the following should happen to be safe.
1541 */
1542 ep->armed = 0;
1543 if ( !ep->soliciting ) {
1544 ep->soliciting = 1;
1545 out_solicit(ep);
1546 }
1547 }
1548
1549 /*
1550 * A jack on which we have received a packet must be called back on its
1551 * out.intr handler before it will send us another; it is considered
1552 * 'scheduled'. It is nice and predictable - as long as it is scheduled,
1553 * we need no extra buffer space for it.
1554 *
1555 * In contrast, a jack that is open but not scheduled may supply us a packet
1556 * at any time, driven by the top half, and we must be able to accept it, no
1557 * excuses. So we must ensure that at any point in time there are at least
1558 * (num_open - num_scheduled) slots free.
1559 *
1560 * As long as there are more slots free than that minimum, we can loop calling
1561 * scheduled jacks back on their "interrupt" handlers, soliciting more
1562 * packets, starting the USB transfer only when the buffer space is down to
1563 * the minimum or no jack has any more to send.
1564 */
1565 static void
1566 out_solicit(void *arg)
1567 {
1568 struct umidi_endpoint *ep = arg;
1569 int s;
1570 umidi_packet_bufp end;
1571 u_int16_t which;
1572 struct umidi_jack *jack;
1573
1574 end = ep->buffer + ep->buffer_size / sizeof *ep->buffer;
1575
1576 for ( ;; ) {
1577 s = splusb();
1578 if ( end - ep->next_slot <= ep->num_open - ep->num_scheduled )
1579 break; /* at splusb */
1580 if ( ep->this_schedule == 0 ) {
1581 if ( ep->next_schedule == 0 )
1582 break; /* at splusb */
1583 ep->this_schedule = ep->next_schedule;
1584 ep->next_schedule = 0;
1585 }
1586 /*
1587 * At least one jack is scheduled. Find and mask off the least
1588 * set bit in this_schedule and decrement num_scheduled.
1589 * Convert mask to bit index to find the corresponding jack,
1590 * and call its intr handler. If it has a message, it will call
1591 * back one of the output methods, which will set its bit in
1592 * next_schedule (not copied into this_schedule until the
1593 * latter is empty). In this way we round-robin the jacks that
1594 * have messages to send, until the buffer is as full as we
1595 * dare, and then start a transfer.
1596 */
1597 which = ep->this_schedule;
1598 which &= (~which)+1; /* now mask of least set bit */
1599 ep->this_schedule &= ~which;
1600 -- ep->num_scheduled;
1601 splx(s);
1602
1603 -- which; /* now 1s below mask - count 1s to get index */
1604 which -= ((which >> 1) & 0x5555);/* SWAR credit aggregate.org */
1605 which = (((which >> 2) & 0x3333) + (which & 0x3333));
1606 which = (((which >> 4) + which) & 0x0f0f);
1607 which += (which >> 8);
1608 which &= 0x1f; /* the bit index a/k/a jack number */
1609
1610 jack = ep->jacks[which];
1611 if (jack->u.out.intr)
1612 (*jack->u.out.intr)(jack->arg);
1613 }
1614 /* splusb at loop exit */
1615 if ( !ep->armed && ep->next_slot > ep->buffer )
1616 ep->armed = (USBD_IN_PROGRESS == start_output_transfer(ep));
1617 ep->soliciting = 0;
1618 splx(s);
1619 }
1620