Home | History | Annotate | Line # | Download | only in usb
umidi.c revision 1.25.2.12
      1 /*	$NetBSD: umidi.c,v 1.25.2.12 2006/05/20 03:43:58 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.12 2006/05/20 03:43:58 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