Home | History | Annotate | Line # | Download | only in usb
umidi.c revision 1.25.2.3
      1  1.25.2.2      chap /*	$NetBSD: umidi.c,v 1.25.2.3 2006/05/20 03:02:50 chap Exp $	*/
      2       1.1  tshiozak /*
      3       1.1  tshiozak  * Copyright (c) 2001 The NetBSD Foundation, Inc.
      4       1.1  tshiozak  * All rights reserved.
      5       1.1  tshiozak  *
      6       1.1  tshiozak  * This code is derived from software contributed to The NetBSD Foundation
      7      1.17    keihan  * by Takuya SHIOZAKI (tshiozak (at) NetBSD.org).
      8       1.1  tshiozak  *
      9       1.1  tshiozak  * Redistribution and use in source and binary forms, with or without
     10       1.1  tshiozak  * modification, are permitted provided that the following conditions
     11       1.1  tshiozak  * are met:
     12       1.1  tshiozak  * 1. Redistributions of source code must retain the above copyright
     13       1.1  tshiozak  *    notice, this list of conditions and the following disclaimer.
     14       1.1  tshiozak  * 2. Redistributions in binary form must reproduce the above copyright
     15       1.1  tshiozak  *    notice, this list of conditions and the following disclaimer in the
     16       1.1  tshiozak  *    documentation and/or other materials provided with the distribution.
     17       1.1  tshiozak  * 3. All advertising materials mentioning features or use of this software
     18       1.1  tshiozak  *    must display the following acknowledgement:
     19       1.1  tshiozak  *	  This product includes software developed by the NetBSD
     20       1.1  tshiozak  *	  Foundation, Inc. and its contributors.
     21       1.1  tshiozak  * 4. Neither the name of The NetBSD Foundation nor the names of its
     22       1.1  tshiozak  *    contributors may be used to endorse or promote products derived
     23       1.1  tshiozak  *    from this software without specific prior written permission.
     24       1.1  tshiozak  *
     25       1.1  tshiozak  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     26       1.1  tshiozak  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     27       1.1  tshiozak  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     28       1.1  tshiozak  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     29       1.1  tshiozak  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     30       1.1  tshiozak  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     31       1.1  tshiozak  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     32       1.1  tshiozak  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     33       1.1  tshiozak  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     34       1.1  tshiozak  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     35       1.1  tshiozak  * POSSIBILITY OF SUCH DAMAGE.
     36       1.1  tshiozak  */
     37      1.10     lukem 
     38      1.10     lukem #include <sys/cdefs.h>
     39  1.25.2.2      chap __KERNEL_RCSID(0, "$NetBSD: umidi.c,v 1.25.2.3 2006/05/20 03:02:50 chap Exp $");
     40       1.1  tshiozak 
     41       1.1  tshiozak #include <sys/param.h>
     42       1.1  tshiozak #include <sys/systm.h>
     43       1.1  tshiozak #include <sys/kernel.h>
     44       1.1  tshiozak #include <sys/malloc.h>
     45       1.1  tshiozak #include <sys/device.h>
     46       1.1  tshiozak #include <sys/ioctl.h>
     47       1.1  tshiozak #include <sys/conf.h>
     48       1.1  tshiozak #include <sys/file.h>
     49       1.1  tshiozak #include <sys/select.h>
     50       1.1  tshiozak #include <sys/proc.h>
     51       1.1  tshiozak #include <sys/vnode.h>
     52       1.1  tshiozak #include <sys/poll.h>
     53       1.1  tshiozak #include <sys/lock.h>
     54       1.1  tshiozak 
     55       1.1  tshiozak #include <dev/usb/usb.h>
     56       1.1  tshiozak #include <dev/usb/usbdi.h>
     57       1.1  tshiozak #include <dev/usb/usbdi_util.h>
     58       1.1  tshiozak 
     59       1.1  tshiozak #include <dev/usb/usbdevs.h>
     60       1.1  tshiozak #include <dev/usb/uaudioreg.h>
     61       1.1  tshiozak #include <dev/usb/umidireg.h>
     62       1.1  tshiozak #include <dev/usb/umidivar.h>
     63       1.1  tshiozak #include <dev/usb/umidi_quirks.h>
     64       1.1  tshiozak 
     65       1.1  tshiozak #include <dev/midi_if.h>
     66       1.1  tshiozak 
     67       1.1  tshiozak #ifdef UMIDI_DEBUG
     68       1.1  tshiozak #define DPRINTF(x)	if (umididebug) printf x
     69       1.1  tshiozak #define DPRINTFN(n,x)	if (umididebug >= (n)) printf x
     70       1.1  tshiozak int	umididebug = 0;
     71       1.1  tshiozak #else
     72       1.1  tshiozak #define DPRINTF(x)
     73       1.1  tshiozak #define DPRINTFN(n,x)
     74       1.1  tshiozak #endif
     75       1.1  tshiozak 
     76       1.1  tshiozak 
     77       1.1  tshiozak static int umidi_open(void *, int,
     78       1.1  tshiozak 		      void (*)(void *, int), void (*)(void *), void *);
     79       1.1  tshiozak static void umidi_close(void *);
     80       1.1  tshiozak static int umidi_output(void *, int);
     81       1.1  tshiozak static void umidi_getinfo(void *, struct midi_info *);
     82       1.1  tshiozak 
     83       1.3  tshiozak static usbd_status alloc_pipe(struct umidi_endpoint *);
     84       1.3  tshiozak static void free_pipe(struct umidi_endpoint *);
     85       1.1  tshiozak 
     86       1.1  tshiozak static usbd_status alloc_all_endpoints(struct umidi_softc *);
     87       1.1  tshiozak static void free_all_endpoints(struct umidi_softc *);
     88       1.1  tshiozak 
     89       1.1  tshiozak static usbd_status alloc_all_jacks(struct umidi_softc *);
     90       1.1  tshiozak static void free_all_jacks(struct umidi_softc *);
     91       1.1  tshiozak static usbd_status bind_jacks_to_mididev(struct umidi_softc *,
     92       1.1  tshiozak 					 struct umidi_jack *,
     93       1.1  tshiozak 					 struct umidi_jack *,
     94       1.1  tshiozak 					 struct umidi_mididev *);
     95       1.4  tshiozak static void unbind_jacks_from_mididev(struct umidi_mididev *);
     96       1.4  tshiozak static void unbind_all_jacks(struct umidi_softc *);
     97       1.1  tshiozak static usbd_status assign_all_jacks_automatically(struct umidi_softc *);
     98       1.4  tshiozak static usbd_status open_out_jack(struct umidi_jack *, void *,
     99       1.4  tshiozak 				 void (*)(void *));
    100       1.4  tshiozak static usbd_status open_in_jack(struct umidi_jack *, void *,
    101       1.4  tshiozak 				void (*)(void *, int));
    102       1.4  tshiozak static void close_out_jack(struct umidi_jack *);
    103       1.4  tshiozak static void close_in_jack(struct umidi_jack *);
    104       1.1  tshiozak 
    105       1.1  tshiozak static usbd_status attach_mididev(struct umidi_softc *,
    106       1.1  tshiozak 				  struct umidi_mididev *);
    107       1.1  tshiozak static usbd_status detach_mididev(struct umidi_mididev *, int);
    108       1.1  tshiozak static usbd_status deactivate_mididev(struct umidi_mididev *);
    109       1.1  tshiozak static usbd_status alloc_all_mididevs(struct umidi_softc *, int);
    110       1.1  tshiozak static void free_all_mididevs(struct umidi_softc *);
    111       1.1  tshiozak static usbd_status attach_all_mididevs(struct umidi_softc *);
    112       1.1  tshiozak static usbd_status detach_all_mididevs(struct umidi_softc *, int);
    113       1.1  tshiozak static usbd_status deactivate_all_mididevs(struct umidi_softc *);
    114       1.1  tshiozak 
    115       1.1  tshiozak #ifdef UMIDI_DEBUG
    116       1.1  tshiozak static void dump_sc(struct umidi_softc *);
    117       1.1  tshiozak static void dump_ep(struct umidi_endpoint *);
    118       1.1  tshiozak static void dump_jack(struct umidi_jack *);
    119       1.1  tshiozak #endif
    120       1.1  tshiozak 
    121       1.1  tshiozak static void init_packet(struct umidi_packet *);
    122       1.1  tshiozak 
    123       1.1  tshiozak static usbd_status start_input_transfer(struct umidi_endpoint *);
    124       1.1  tshiozak static usbd_status start_output_transfer(struct umidi_endpoint *);
    125       1.4  tshiozak static int out_jack_output(struct umidi_jack *, int);
    126       1.1  tshiozak static void in_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
    127       1.1  tshiozak static void out_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
    128       1.1  tshiozak static void out_build_packet(int, struct umidi_packet *, uByte);
    129       1.1  tshiozak 
    130       1.1  tshiozak 
    131  1.25.2.1      chap struct midi_hw_if umidi_hw_if = {
    132       1.1  tshiozak 	umidi_open,
    133       1.1  tshiozak 	umidi_close,
    134       1.1  tshiozak 	umidi_output,
    135       1.1  tshiozak 	umidi_getinfo,
    136       1.1  tshiozak 	0,		/* ioctl */
    137       1.1  tshiozak };
    138       1.1  tshiozak 
    139       1.1  tshiozak USB_DECLARE_DRIVER(umidi);
    140       1.1  tshiozak 
    141       1.1  tshiozak USB_MATCH(umidi)
    142       1.1  tshiozak {
    143       1.1  tshiozak 	USB_MATCH_START(umidi, uaa);
    144       1.1  tshiozak 	usb_interface_descriptor_t *id;
    145       1.1  tshiozak 
    146       1.1  tshiozak 	DPRINTFN(1,("umidi_match\n"));
    147       1.1  tshiozak 
    148       1.1  tshiozak 	if (uaa->iface == NULL)
    149       1.1  tshiozak 		return UMATCH_NONE;
    150       1.1  tshiozak 
    151       1.3  tshiozak 	if (umidi_search_quirk(uaa->vendor, uaa->product, uaa->ifaceno))
    152       1.3  tshiozak 		return UMATCH_IFACECLASS_IFACESUBCLASS;
    153       1.1  tshiozak 
    154       1.1  tshiozak 	id = usbd_get_interface_descriptor(uaa->iface);
    155      1.16  augustss 	if (id!=NULL &&
    156       1.1  tshiozak 	    id->bInterfaceClass==UICLASS_AUDIO &&
    157       1.3  tshiozak 	    id->bInterfaceSubClass==UISUBCLASS_MIDISTREAM)
    158       1.3  tshiozak 		return UMATCH_IFACECLASS_IFACESUBCLASS;
    159       1.1  tshiozak 
    160       1.3  tshiozak 	return UMATCH_NONE;
    161       1.1  tshiozak }
    162       1.1  tshiozak 
    163       1.1  tshiozak USB_ATTACH(umidi)
    164       1.1  tshiozak {
    165       1.1  tshiozak 	usbd_status err;
    166       1.1  tshiozak 	USB_ATTACH_START(umidi, sc, uaa);
    167  1.25.2.1      chap 	char devinfo[1024];
    168       1.1  tshiozak 
    169       1.1  tshiozak 	DPRINTFN(1,("umidi_attach\n"));
    170       1.1  tshiozak 
    171  1.25.2.1      chap 	usbd_devinfo(uaa->device, 0, devinfo);
    172  1.25.2.1      chap 	printf("\n%s: %s\n", USBDEVNAME(sc->sc_dev), devinfo);
    173       1.1  tshiozak 
    174       1.1  tshiozak 	sc->sc_iface = uaa->iface;
    175       1.1  tshiozak 	sc->sc_udev = uaa->device;
    176       1.1  tshiozak 
    177       1.1  tshiozak 	sc->sc_quirk =
    178       1.1  tshiozak 	    umidi_search_quirk(uaa->vendor, uaa->product, uaa->ifaceno);
    179       1.1  tshiozak 	printf("%s: ", USBDEVNAME(sc->sc_dev));
    180       1.1  tshiozak 	umidi_print_quirk(sc->sc_quirk);
    181       1.1  tshiozak 
    182       1.1  tshiozak 
    183       1.1  tshiozak 	err = alloc_all_endpoints(sc);
    184       1.1  tshiozak 	if (err!=USBD_NORMAL_COMPLETION) {
    185       1.1  tshiozak 		printf("%s: alloc_all_endpoints failed. (err=%d)\n",
    186       1.1  tshiozak 		       USBDEVNAME(sc->sc_dev), err);
    187       1.1  tshiozak 		goto error;
    188       1.1  tshiozak 	}
    189       1.1  tshiozak 	err = alloc_all_jacks(sc);
    190       1.1  tshiozak 	if (err!=USBD_NORMAL_COMPLETION) {
    191       1.1  tshiozak 		free_all_endpoints(sc);
    192       1.1  tshiozak 		printf("%s: alloc_all_jacks failed. (err=%d)\n",
    193       1.1  tshiozak 		       USBDEVNAME(sc->sc_dev), err);
    194       1.1  tshiozak 		goto error;
    195       1.1  tshiozak 	}
    196       1.1  tshiozak 	printf("%s: out=%d, in=%d\n",
    197       1.1  tshiozak 	       USBDEVNAME(sc->sc_dev),
    198       1.1  tshiozak 	       sc->sc_out_num_jacks, sc->sc_in_num_jacks);
    199       1.1  tshiozak 
    200       1.1  tshiozak 	err = assign_all_jacks_automatically(sc);
    201       1.1  tshiozak 	if (err!=USBD_NORMAL_COMPLETION) {
    202       1.1  tshiozak 		unbind_all_jacks(sc);
    203       1.1  tshiozak 		free_all_jacks(sc);
    204       1.1  tshiozak 		free_all_endpoints(sc);
    205       1.1  tshiozak 		printf("%s: assign_all_jacks_automatically failed. (err=%d)\n",
    206       1.1  tshiozak 		       USBDEVNAME(sc->sc_dev), err);
    207       1.1  tshiozak 		goto error;
    208       1.1  tshiozak 	}
    209       1.1  tshiozak 	err = attach_all_mididevs(sc);
    210       1.1  tshiozak 	if (err!=USBD_NORMAL_COMPLETION) {
    211       1.1  tshiozak 		free_all_jacks(sc);
    212       1.1  tshiozak 		free_all_endpoints(sc);
    213       1.1  tshiozak 		printf("%s: attach_all_mididevs failed. (err=%d)\n",
    214       1.1  tshiozak 		       USBDEVNAME(sc->sc_dev), err);
    215       1.1  tshiozak 	}
    216       1.1  tshiozak 
    217       1.1  tshiozak #ifdef UMIDI_DEBUG
    218       1.1  tshiozak 	dump_sc(sc);
    219       1.1  tshiozak #endif
    220       1.1  tshiozak 
    221       1.1  tshiozak 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH,
    222       1.1  tshiozak 			   sc->sc_udev, USBDEV(sc->sc_dev));
    223      1.16  augustss 
    224       1.1  tshiozak 	USB_ATTACH_SUCCESS_RETURN;
    225       1.1  tshiozak error:
    226       1.1  tshiozak 	printf("%s: disabled.\n", USBDEVNAME(sc->sc_dev));
    227       1.1  tshiozak 	sc->sc_dying = 1;
    228       1.1  tshiozak 	USB_ATTACH_ERROR_RETURN;
    229       1.1  tshiozak }
    230       1.1  tshiozak 
    231       1.1  tshiozak int
    232       1.1  tshiozak umidi_activate(device_ptr_t self, enum devact act)
    233       1.1  tshiozak {
    234       1.3  tshiozak 	struct umidi_softc *sc = (struct umidi_softc *)self;
    235       1.1  tshiozak 
    236       1.1  tshiozak 	switch (act) {
    237       1.1  tshiozak 	case DVACT_ACTIVATE:
    238       1.1  tshiozak 		DPRINTFN(1,("umidi_activate (activate)\n"));
    239       1.1  tshiozak 
    240       1.1  tshiozak 		return EOPNOTSUPP;
    241       1.1  tshiozak 		break;
    242       1.1  tshiozak 	case DVACT_DEACTIVATE:
    243       1.1  tshiozak 		DPRINTFN(1,("umidi_activate (deactivate)\n"));
    244       1.1  tshiozak 		sc->sc_dying = 1;
    245       1.1  tshiozak 		deactivate_all_mididevs(sc);
    246       1.1  tshiozak 		break;
    247       1.1  tshiozak 	}
    248       1.1  tshiozak 	return 0;
    249       1.1  tshiozak }
    250       1.1  tshiozak 
    251       1.1  tshiozak USB_DETACH(umidi)
    252       1.1  tshiozak {
    253       1.3  tshiozak 	USB_DETACH_START(umidi, sc);
    254       1.1  tshiozak 
    255       1.1  tshiozak 	DPRINTFN(1,("umidi_detach\n"));
    256       1.1  tshiozak 
    257       1.1  tshiozak 	sc->sc_dying = 1;
    258       1.1  tshiozak 	detach_all_mididevs(sc, flags);
    259       1.1  tshiozak 	free_all_mididevs(sc);
    260       1.1  tshiozak 	free_all_jacks(sc);
    261       1.1  tshiozak 	free_all_endpoints(sc);
    262       1.1  tshiozak 
    263       1.3  tshiozak 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
    264       1.3  tshiozak 			   USBDEV(sc->sc_dev));
    265       1.1  tshiozak 
    266       1.1  tshiozak 	return 0;
    267       1.1  tshiozak }
    268       1.1  tshiozak 
    269       1.1  tshiozak 
    270       1.4  tshiozak /*
    271       1.4  tshiozak  * midi_if stuffs
    272       1.4  tshiozak  */
    273       1.1  tshiozak int
    274       1.1  tshiozak umidi_open(void *addr,
    275       1.1  tshiozak 	   int flags,
    276      1.12  augustss 	   void (*iintr)(void *, int),
    277      1.12  augustss 	   void (*ointr)(void *),
    278       1.1  tshiozak 	   void *arg)
    279       1.1  tshiozak {
    280       1.3  tshiozak 	struct umidi_mididev *mididev = addr;
    281       1.3  tshiozak 	struct umidi_softc *sc = mididev->sc;
    282  1.25.2.2      chap 	usbd_status err;
    283       1.1  tshiozak 
    284       1.1  tshiozak 	DPRINTF(("umidi_open: sc=%p\n", sc));
    285       1.1  tshiozak 
    286       1.1  tshiozak 	if (!sc)
    287       1.1  tshiozak 		return ENXIO;
    288       1.1  tshiozak 	if (mididev->opened)
    289       1.1  tshiozak 		return EBUSY;
    290       1.4  tshiozak 	if (sc->sc_dying)
    291       1.1  tshiozak 		return EIO;
    292       1.1  tshiozak 
    293       1.4  tshiozak 	mididev->opened = 1;
    294       1.1  tshiozak 	mididev->flags = flags;
    295  1.25.2.2      chap 	if ((mididev->flags & FWRITE) && mididev->out_jack) {
    296  1.25.2.2      chap 		err = open_out_jack(mididev->out_jack, arg, ointr);
    297  1.25.2.2      chap 		if ( err != USBD_NORMAL_COMPLETION )
    298  1.25.2.2      chap 			goto bad;
    299  1.25.2.2      chap 	}
    300       1.3  tshiozak 	if ((mididev->flags & FREAD) && mididev->in_jack) {
    301  1.25.2.2      chap 		err = open_in_jack(mididev->in_jack, arg, iintr);
    302  1.25.2.2      chap 		if ( err != USBD_NORMAL_COMPLETION
    303  1.25.2.2      chap 		&&   err != USBD_IN_PROGRESS )
    304  1.25.2.2      chap 			goto bad;
    305       1.3  tshiozak 	}
    306       1.1  tshiozak 
    307       1.1  tshiozak 	return 0;
    308  1.25.2.2      chap bad:
    309  1.25.2.2      chap 	mididev->opened = 0;
    310  1.25.2.2      chap 	DPRINTF(("umidi_open: usbd_status %d\n", err));
    311  1.25.2.2      chap 	return USBD_IN_USE == err ? EBUSY : EIO;
    312       1.1  tshiozak }
    313       1.1  tshiozak 
    314       1.1  tshiozak void
    315       1.1  tshiozak umidi_close(void *addr)
    316       1.1  tshiozak {
    317       1.1  tshiozak 	int s;
    318       1.3  tshiozak 	struct umidi_mididev *mididev = addr;
    319       1.1  tshiozak 
    320       1.1  tshiozak 	s = splusb();
    321       1.1  tshiozak 	if ((mididev->flags & FWRITE) && mididev->out_jack)
    322       1.4  tshiozak 		close_out_jack(mididev->out_jack);
    323       1.1  tshiozak 	if ((mididev->flags & FREAD) && mididev->in_jack)
    324       1.4  tshiozak 		close_in_jack(mididev->in_jack);
    325       1.1  tshiozak 	mididev->opened = 0;
    326       1.1  tshiozak 	splx(s);
    327       1.1  tshiozak }
    328       1.1  tshiozak 
    329       1.1  tshiozak int
    330       1.1  tshiozak umidi_output(void *addr, int d)
    331       1.1  tshiozak {
    332       1.3  tshiozak 	struct umidi_mididev *mididev = addr;
    333       1.1  tshiozak 
    334       1.4  tshiozak 	if (!mididev->out_jack || !mididev->opened)
    335       1.1  tshiozak 		return EIO;
    336       1.1  tshiozak 
    337       1.4  tshiozak 	return out_jack_output(mididev->out_jack, d);
    338       1.1  tshiozak }
    339       1.1  tshiozak 
    340       1.1  tshiozak void
    341       1.1  tshiozak umidi_getinfo(void *addr, struct midi_info *mi)
    342       1.1  tshiozak {
    343       1.3  tshiozak 	struct umidi_mididev *mididev = addr;
    344       1.3  tshiozak /*	struct umidi_softc *sc = mididev->sc; */
    345       1.1  tshiozak 
    346       1.3  tshiozak 	mi->name = "USB MIDI I/F"; /* XXX: model name */
    347       1.3  tshiozak 	mi->props = MIDI_PROP_OUT_INTR;
    348       1.1  tshiozak 	if (mididev->in_jack)
    349       1.1  tshiozak 		mi->props |= MIDI_PROP_CAN_INPUT;
    350       1.1  tshiozak }
    351       1.1  tshiozak 
    352       1.1  tshiozak 
    353       1.4  tshiozak /*
    354       1.4  tshiozak  * each endpoint stuffs
    355       1.4  tshiozak  */
    356       1.1  tshiozak 
    357       1.3  tshiozak /* alloc/free pipe */
    358       1.1  tshiozak static usbd_status
    359       1.3  tshiozak alloc_pipe(struct umidi_endpoint *ep)
    360       1.1  tshiozak {
    361       1.1  tshiozak 	struct umidi_softc *sc = ep->sc;
    362       1.1  tshiozak 	usbd_status err;
    363       1.1  tshiozak 
    364       1.3  tshiozak 	DPRINTF(("%s: alloc_pipe %p\n", USBDEVNAME(sc->sc_dev), ep));
    365       1.4  tshiozak 	LIST_INIT(&ep->queue_head);
    366       1.3  tshiozak 	ep->xfer = usbd_alloc_xfer(sc->sc_udev);
    367      1.11  augustss 	if (ep->xfer == NULL) {
    368       1.3  tshiozak 	    err = USBD_NOMEM;
    369       1.3  tshiozak 	    goto quit;
    370       1.3  tshiozak 	}
    371       1.3  tshiozak 	ep->buffer = usbd_alloc_buffer(ep->xfer, UMIDI_PACKET_SIZE);
    372      1.11  augustss 	if (ep->buffer == NULL) {
    373       1.3  tshiozak 	    usbd_free_xfer(ep->xfer);
    374       1.3  tshiozak 	    err = USBD_NOMEM;
    375       1.3  tshiozak 	    goto quit;
    376       1.3  tshiozak 	}
    377       1.3  tshiozak 	err = usbd_open_pipe(sc->sc_iface, ep->addr, 0, &ep->pipe);
    378       1.3  tshiozak 	if (err)
    379       1.3  tshiozak 	    usbd_free_xfer(ep->xfer);
    380       1.1  tshiozak quit:
    381       1.1  tshiozak 	return err;
    382       1.1  tshiozak }
    383       1.1  tshiozak 
    384       1.1  tshiozak static void
    385       1.3  tshiozak free_pipe(struct umidi_endpoint *ep)
    386       1.1  tshiozak {
    387       1.3  tshiozak 	DPRINTF(("%s: free_pipe %p\n", USBDEVNAME(ep->sc->sc_dev), ep));
    388       1.3  tshiozak 	usbd_abort_pipe(ep->pipe);
    389       1.3  tshiozak 	usbd_close_pipe(ep->pipe);
    390       1.3  tshiozak 	usbd_free_xfer(ep->xfer);
    391       1.1  tshiozak }
    392       1.1  tshiozak 
    393       1.1  tshiozak 
    394       1.1  tshiozak /* alloc/free the array of endpoint structures */
    395       1.1  tshiozak 
    396       1.1  tshiozak static usbd_status alloc_all_endpoints_fixed_ep(struct umidi_softc *);
    397       1.1  tshiozak static usbd_status alloc_all_endpoints_yamaha(struct umidi_softc *);
    398       1.1  tshiozak static usbd_status alloc_all_endpoints_genuine(struct umidi_softc *);
    399       1.1  tshiozak 
    400       1.1  tshiozak static usbd_status
    401       1.1  tshiozak alloc_all_endpoints(struct umidi_softc *sc)
    402       1.1  tshiozak {
    403       1.3  tshiozak 	usbd_status err;
    404       1.3  tshiozak 	struct umidi_endpoint *ep;
    405       1.3  tshiozak 	int i;
    406       1.9  tshiozak 
    407       1.3  tshiozak 	if (UMQ_ISTYPE(sc, UMQ_TYPE_FIXED_EP)) {
    408       1.3  tshiozak 		err = alloc_all_endpoints_fixed_ep(sc);
    409       1.3  tshiozak 	} else if (UMQ_ISTYPE(sc, UMQ_TYPE_YAMAHA)) {
    410       1.3  tshiozak 		err = alloc_all_endpoints_yamaha(sc);
    411       1.1  tshiozak 	} else {
    412       1.3  tshiozak 		err = alloc_all_endpoints_genuine(sc);
    413       1.1  tshiozak 	}
    414       1.3  tshiozak 	if (err!=USBD_NORMAL_COMPLETION)
    415       1.3  tshiozak 		return err;
    416       1.3  tshiozak 
    417       1.3  tshiozak 	ep = sc->sc_endpoints;
    418       1.8  tshiozak 	for (i=sc->sc_out_num_endpoints+sc->sc_in_num_endpoints; i>0; i--) {
    419       1.3  tshiozak 		err = alloc_pipe(ep++);
    420       1.3  tshiozak 		if (err!=USBD_NORMAL_COMPLETION) {
    421       1.3  tshiozak 			for (; ep!=sc->sc_endpoints; ep--)
    422       1.3  tshiozak 				free_pipe(ep-1);
    423       1.3  tshiozak 			free(sc->sc_endpoints, M_USBDEV);
    424       1.3  tshiozak 			sc->sc_endpoints = sc->sc_out_ep = sc->sc_in_ep = NULL;
    425       1.3  tshiozak 			break;
    426       1.3  tshiozak 		}
    427       1.3  tshiozak 	}
    428       1.3  tshiozak 	return err;
    429       1.1  tshiozak }
    430       1.1  tshiozak 
    431       1.1  tshiozak static void
    432       1.1  tshiozak free_all_endpoints(struct umidi_softc *sc)
    433       1.1  tshiozak {
    434       1.3  tshiozak 	int i;
    435       1.8  tshiozak 	for (i=0; i<sc->sc_in_num_endpoints+sc->sc_out_num_endpoints; i++)
    436       1.3  tshiozak 	    free_pipe(&sc->sc_endpoints[i]);
    437      1.14      kent 	if (sc->sc_endpoints != NULL)
    438      1.14      kent 		free(sc->sc_endpoints, M_USBDEV);
    439       1.1  tshiozak 	sc->sc_endpoints = sc->sc_out_ep = sc->sc_in_ep = NULL;
    440       1.1  tshiozak }
    441       1.1  tshiozak 
    442       1.1  tshiozak static usbd_status
    443       1.1  tshiozak alloc_all_endpoints_fixed_ep(struct umidi_softc *sc)
    444       1.1  tshiozak {
    445       1.3  tshiozak 	usbd_status err;
    446       1.1  tshiozak 	struct umq_fixed_ep_desc *fp;
    447       1.3  tshiozak 	struct umidi_endpoint *ep;
    448       1.1  tshiozak 	usb_endpoint_descriptor_t *epd;
    449       1.1  tshiozak 	int i;
    450       1.1  tshiozak 
    451       1.1  tshiozak 	fp = umidi_get_quirk_data_from_type(sc->sc_quirk,
    452       1.1  tshiozak 					    UMQ_TYPE_FIXED_EP);
    453       1.1  tshiozak 	sc->sc_out_num_jacks = 0;
    454       1.1  tshiozak 	sc->sc_in_num_jacks = 0;
    455       1.1  tshiozak 	sc->sc_out_num_endpoints = fp->num_out_ep;
    456       1.1  tshiozak 	sc->sc_in_num_endpoints = fp->num_in_ep;
    457       1.1  tshiozak 	sc->sc_endpoints = malloc(sizeof(*sc->sc_out_ep)*
    458       1.1  tshiozak 				  (sc->sc_out_num_endpoints+
    459       1.1  tshiozak 				   sc->sc_in_num_endpoints),
    460       1.1  tshiozak 				  M_USBDEV, M_WAITOK);
    461       1.1  tshiozak 	if (!sc->sc_endpoints) {
    462       1.1  tshiozak 		return USBD_NOMEM;
    463       1.1  tshiozak 	}
    464       1.1  tshiozak 	sc->sc_out_ep = sc->sc_out_num_endpoints ? sc->sc_endpoints : NULL;
    465       1.1  tshiozak 	sc->sc_in_ep =
    466       1.1  tshiozak 	    sc->sc_in_num_endpoints ?
    467       1.1  tshiozak 		sc->sc_endpoints+sc->sc_out_num_endpoints : NULL;
    468       1.3  tshiozak 
    469       1.3  tshiozak 	ep = &sc->sc_out_ep[0];
    470       1.1  tshiozak 	for (i=0; i<sc->sc_out_num_endpoints; i++) {
    471       1.1  tshiozak 		epd = usbd_interface2endpoint_descriptor(
    472       1.1  tshiozak 			sc->sc_iface,
    473       1.1  tshiozak 			fp->out_ep[i].ep);
    474       1.1  tshiozak 		if (!epd) {
    475       1.1  tshiozak 			printf("%s: cannot get endpoint descriptor(out:%d)\n",
    476       1.1  tshiozak 			       USBDEVNAME(sc->sc_dev), fp->out_ep[i].ep);
    477       1.3  tshiozak 			err = USBD_INVAL;
    478       1.1  tshiozak 			goto error;
    479       1.1  tshiozak 		}
    480       1.1  tshiozak 		if (UE_GET_XFERTYPE(epd->bmAttributes)!=UE_BULK ||
    481       1.1  tshiozak 		    UE_GET_DIR(epd->bEndpointAddress)!=UE_DIR_OUT) {
    482       1.1  tshiozak 			printf("%s: illegal endpoint(out:%d)\n",
    483       1.1  tshiozak 			       USBDEVNAME(sc->sc_dev), fp->out_ep[i].ep);
    484       1.3  tshiozak 			err = USBD_INVAL;
    485       1.1  tshiozak 			goto error;
    486       1.1  tshiozak 		}
    487       1.3  tshiozak 		ep->sc = sc;
    488       1.3  tshiozak 		ep->addr = epd->bEndpointAddress;
    489       1.3  tshiozak 		ep->num_jacks = fp->out_ep[i].num_jacks;
    490       1.1  tshiozak 		sc->sc_out_num_jacks += fp->out_ep[i].num_jacks;
    491       1.3  tshiozak 		ep->num_open = 0;
    492       1.3  tshiozak 		memset(ep->jacks, 0, sizeof(ep->jacks));
    493  1.25.2.2      chap 		/* other ep alloc subrs don't, and alloc_pipe does, anyway: */
    494  1.25.2.2      chap 		/* LIST_INIT(&ep->queue_head); */
    495       1.3  tshiozak 		ep++;
    496       1.1  tshiozak 	}
    497       1.3  tshiozak 	ep = &sc->sc_in_ep[0];
    498       1.1  tshiozak 	for (i=0; i<sc->sc_in_num_endpoints; i++) {
    499       1.1  tshiozak 		epd = usbd_interface2endpoint_descriptor(
    500       1.1  tshiozak 			sc->sc_iface,
    501       1.1  tshiozak 			fp->in_ep[i].ep);
    502       1.1  tshiozak 		if (!epd) {
    503       1.1  tshiozak 			printf("%s: cannot get endpoint descriptor(in:%d)\n",
    504       1.1  tshiozak 			       USBDEVNAME(sc->sc_dev), fp->in_ep[i].ep);
    505       1.3  tshiozak 			err = USBD_INVAL;
    506       1.1  tshiozak 			goto error;
    507       1.1  tshiozak 		}
    508  1.25.2.2      chap 		/*
    509  1.25.2.2      chap 		 * MIDISPORT_2X4 inputs on an interrupt rather than a bulk
    510  1.25.2.2      chap 		 * endpoint.  The existing input logic in this driver seems
    511  1.25.2.2      chap 		 * to work successfully if we just stop treating an interrupt
    512  1.25.2.2      chap 		 * endpoint as illegal (or the in_progress status we get on
    513  1.25.2.2      chap 		 * the initial transfer).  It does not seem necessary to
    514  1.25.2.2      chap 		 * actually use the interrupt flavor of alloc_pipe or make
    515  1.25.2.2      chap 		 * other serious rearrangements of logic.  I like that.
    516  1.25.2.2      chap 		 */
    517  1.25.2.2      chap 		switch ( UE_GET_XFERTYPE(epd->bmAttributes) ) {
    518  1.25.2.2      chap 		case UE_BULK:
    519  1.25.2.2      chap 		case UE_INTERRUPT:
    520  1.25.2.2      chap 			if ( UE_DIR_IN == UE_GET_DIR(epd->bEndpointAddress) )
    521  1.25.2.2      chap 				break;
    522  1.25.2.2      chap 			/*FALLTHROUGH*/
    523  1.25.2.2      chap 		default:
    524       1.1  tshiozak 			printf("%s: illegal endpoint(in:%d)\n",
    525       1.1  tshiozak 			       USBDEVNAME(sc->sc_dev), fp->in_ep[i].ep);
    526       1.3  tshiozak 			err = USBD_INVAL;
    527       1.1  tshiozak 			goto error;
    528       1.1  tshiozak 		}
    529  1.25.2.2      chap 
    530       1.3  tshiozak 		ep->sc = sc;
    531       1.3  tshiozak 		ep->addr = epd->bEndpointAddress;
    532       1.3  tshiozak 		ep->num_jacks = fp->in_ep[i].num_jacks;
    533       1.1  tshiozak 		sc->sc_in_num_jacks += fp->in_ep[i].num_jacks;
    534       1.3  tshiozak 		ep->num_open = 0;
    535       1.3  tshiozak 		memset(ep->jacks, 0, sizeof(ep->jacks));
    536       1.3  tshiozak 		ep++;
    537       1.1  tshiozak 	}
    538       1.1  tshiozak 
    539       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    540       1.1  tshiozak error:
    541       1.1  tshiozak 	free(sc->sc_endpoints, M_USBDEV);
    542       1.1  tshiozak 	sc->sc_endpoints = NULL;
    543       1.3  tshiozak 	return err;
    544       1.1  tshiozak }
    545       1.1  tshiozak 
    546       1.1  tshiozak static usbd_status
    547       1.1  tshiozak alloc_all_endpoints_yamaha(struct umidi_softc *sc)
    548       1.1  tshiozak {
    549       1.1  tshiozak 	/* This driver currently supports max 1in/1out bulk endpoints */
    550       1.1  tshiozak 	usb_descriptor_t *desc;
    551       1.8  tshiozak 	usb_endpoint_descriptor_t *epd;
    552       1.8  tshiozak 	int out_addr, in_addr, i;
    553       1.8  tshiozak 	int dir;
    554       1.1  tshiozak 	size_t remain, descsize;
    555       1.1  tshiozak 
    556       1.8  tshiozak 	sc->sc_out_num_jacks = sc->sc_in_num_jacks = 0;
    557       1.8  tshiozak 	out_addr = in_addr = 0;
    558       1.8  tshiozak 
    559       1.8  tshiozak 	/* detect endpoints */
    560       1.1  tshiozak 	desc = TO_D(usbd_get_interface_descriptor(sc->sc_iface));
    561       1.8  tshiozak 	for (i=(int)TO_IFD(desc)->bNumEndpoints-1; i>=0; i--) {
    562       1.8  tshiozak 		epd = usbd_interface2endpoint_descriptor(sc->sc_iface, i);
    563       1.8  tshiozak 		if (UE_GET_XFERTYPE(epd->bmAttributes) == UE_BULK) {
    564       1.8  tshiozak 			dir = UE_GET_DIR(epd->bEndpointAddress);
    565       1.8  tshiozak 			if (dir==UE_DIR_OUT && !out_addr)
    566       1.8  tshiozak 				out_addr = epd->bEndpointAddress;
    567       1.8  tshiozak 			else if (dir==UE_DIR_IN && !in_addr)
    568       1.8  tshiozak 				in_addr = epd->bEndpointAddress;
    569       1.8  tshiozak 		}
    570       1.8  tshiozak 	}
    571       1.3  tshiozak 	desc = NEXT_D(desc);
    572       1.1  tshiozak 
    573       1.8  tshiozak 	/* count jacks */
    574       1.8  tshiozak 	if (!(desc->bDescriptorType==UDESC_CS_INTERFACE &&
    575       1.8  tshiozak 	      desc->bDescriptorSubtype==UMIDI_MS_HEADER))
    576       1.8  tshiozak 		return USBD_INVAL;
    577       1.8  tshiozak 	remain = (size_t)UGETW(TO_CSIFD(desc)->wTotalLength) -
    578       1.8  tshiozak 		(size_t)desc->bLength;
    579       1.8  tshiozak 	desc = NEXT_D(desc);
    580       1.1  tshiozak 
    581       1.1  tshiozak 	while (remain>=sizeof(usb_descriptor_t)) {
    582       1.1  tshiozak 		descsize = desc->bLength;
    583       1.1  tshiozak 		if (descsize>remain || descsize==0)
    584       1.1  tshiozak 			break;
    585       1.1  tshiozak 		if (desc->bDescriptorType==UDESC_CS_INTERFACE &&
    586       1.1  tshiozak 		    remain>=UMIDI_JACK_DESCRIPTOR_SIZE) {
    587       1.1  tshiozak 			if (desc->bDescriptorSubtype==UMIDI_OUT_JACK)
    588       1.1  tshiozak 				sc->sc_out_num_jacks++;
    589       1.1  tshiozak 			else if (desc->bDescriptorSubtype==UMIDI_IN_JACK)
    590       1.1  tshiozak 				sc->sc_in_num_jacks++;
    591       1.1  tshiozak 		}
    592       1.1  tshiozak 		desc = NEXT_D(desc);
    593       1.1  tshiozak 		remain-=descsize;
    594       1.1  tshiozak 	}
    595       1.1  tshiozak 
    596       1.8  tshiozak 	/* validate some parameters */
    597       1.1  tshiozak 	if (sc->sc_out_num_jacks>UMIDI_MAX_EPJACKS)
    598       1.1  tshiozak 		sc->sc_out_num_jacks = UMIDI_MAX_EPJACKS;
    599       1.1  tshiozak 	if (sc->sc_in_num_jacks>UMIDI_MAX_EPJACKS)
    600       1.1  tshiozak 		sc->sc_in_num_jacks = UMIDI_MAX_EPJACKS;
    601       1.8  tshiozak 	if (sc->sc_out_num_jacks && out_addr) {
    602       1.1  tshiozak 		sc->sc_out_num_endpoints = 1;
    603       1.1  tshiozak 	} else {
    604       1.1  tshiozak 		sc->sc_out_num_endpoints = 0;
    605       1.1  tshiozak 		sc->sc_out_num_jacks = 0;
    606       1.1  tshiozak 	}
    607       1.8  tshiozak 	if (sc->sc_in_num_jacks && in_addr) {
    608       1.1  tshiozak 		sc->sc_in_num_endpoints = 1;
    609       1.1  tshiozak 	} else {
    610       1.1  tshiozak 		sc->sc_in_num_endpoints = 0;
    611       1.1  tshiozak 		sc->sc_in_num_jacks = 0;
    612       1.1  tshiozak 	}
    613       1.1  tshiozak 	sc->sc_endpoints = malloc(sizeof(struct umidi_endpoint)*
    614       1.1  tshiozak 				  (sc->sc_out_num_endpoints+
    615       1.1  tshiozak 				   sc->sc_in_num_endpoints),
    616       1.1  tshiozak 				  M_USBDEV, M_WAITOK);
    617       1.1  tshiozak 	if (!sc->sc_endpoints)
    618       1.1  tshiozak 		return USBD_NOMEM;
    619       1.1  tshiozak 	if (sc->sc_out_num_endpoints) {
    620       1.1  tshiozak 		sc->sc_out_ep = sc->sc_endpoints;
    621       1.1  tshiozak 		sc->sc_out_ep->sc = sc;
    622       1.1  tshiozak 		sc->sc_out_ep->addr = out_addr;
    623       1.1  tshiozak 		sc->sc_out_ep->num_jacks = sc->sc_out_num_jacks;
    624       1.1  tshiozak 		sc->sc_out_ep->num_open = 0;
    625       1.1  tshiozak 		memset(sc->sc_out_ep->jacks, 0, sizeof(sc->sc_out_ep->jacks));
    626       1.1  tshiozak 	} else
    627       1.1  tshiozak 		sc->sc_out_ep = NULL;
    628       1.1  tshiozak 
    629       1.1  tshiozak 	if (sc->sc_in_num_endpoints) {
    630       1.1  tshiozak 		sc->sc_in_ep = sc->sc_endpoints+sc->sc_out_num_endpoints;
    631       1.1  tshiozak 		sc->sc_in_ep->sc = sc;
    632       1.1  tshiozak 		sc->sc_in_ep->addr = in_addr;
    633       1.1  tshiozak 		sc->sc_in_ep->num_jacks = sc->sc_in_num_jacks;
    634       1.1  tshiozak 		sc->sc_in_ep->num_open = 0;
    635       1.1  tshiozak 		memset(sc->sc_in_ep->jacks, 0, sizeof(sc->sc_in_ep->jacks));
    636       1.1  tshiozak 	} else
    637       1.1  tshiozak 		sc->sc_in_ep = NULL;
    638       1.1  tshiozak 
    639       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    640       1.1  tshiozak }
    641       1.1  tshiozak 
    642       1.1  tshiozak static usbd_status
    643       1.1  tshiozak alloc_all_endpoints_genuine(struct umidi_softc *sc)
    644       1.1  tshiozak {
    645      1.20      gson 	usb_interface_descriptor_t *interface_desc;
    646      1.20      gson 	usb_config_descriptor_t *config_desc;
    647       1.1  tshiozak 	usb_descriptor_t *desc;
    648       1.7  tshiozak 	int num_ep;
    649       1.1  tshiozak 	size_t remain, descsize;
    650       1.1  tshiozak 	struct umidi_endpoint *p, *q, *lowest, *endep, tmpep;
    651       1.1  tshiozak 	int epaddr;
    652       1.1  tshiozak 
    653      1.20      gson 	interface_desc = usbd_get_interface_descriptor(sc->sc_iface);
    654      1.20      gson 	num_ep = interface_desc->bNumEndpoints;
    655      1.20      gson 	sc->sc_endpoints = p = malloc(sizeof(struct umidi_endpoint) * num_ep,
    656       1.1  tshiozak 				      M_USBDEV, M_WAITOK);
    657       1.1  tshiozak 	if (!p)
    658       1.1  tshiozak 		return USBD_NOMEM;
    659       1.1  tshiozak 
    660       1.1  tshiozak 	sc->sc_out_num_jacks = sc->sc_in_num_jacks = 0;
    661       1.1  tshiozak 	sc->sc_out_num_endpoints = sc->sc_in_num_endpoints = 0;
    662       1.1  tshiozak 	epaddr = -1;
    663       1.1  tshiozak 
    664       1.1  tshiozak 	/* get the list of endpoints for midi stream */
    665      1.20      gson 	config_desc = usbd_get_config_descriptor(sc->sc_udev);
    666      1.20      gson 	desc = (usb_descriptor_t *) config_desc;
    667      1.20      gson 	remain = (size_t)UGETW(config_desc->wTotalLength);
    668       1.1  tshiozak 	while (remain>=sizeof(usb_descriptor_t)) {
    669       1.1  tshiozak 		descsize = desc->bLength;
    670       1.1  tshiozak 		if (descsize>remain || descsize==0)
    671       1.1  tshiozak 			break;
    672       1.1  tshiozak 		if (desc->bDescriptorType==UDESC_ENDPOINT &&
    673       1.1  tshiozak 		    remain>=USB_ENDPOINT_DESCRIPTOR_SIZE &&
    674       1.1  tshiozak 		    UE_GET_XFERTYPE(TO_EPD(desc)->bmAttributes) == UE_BULK) {
    675       1.1  tshiozak 			epaddr = TO_EPD(desc)->bEndpointAddress;
    676       1.1  tshiozak 		} else if (desc->bDescriptorType==UDESC_CS_ENDPOINT &&
    677       1.1  tshiozak 			   remain>=UMIDI_CS_ENDPOINT_DESCRIPTOR_SIZE &&
    678       1.1  tshiozak 			   epaddr!=-1) {
    679       1.1  tshiozak 			if (num_ep>0) {
    680       1.9  tshiozak 				num_ep--;
    681       1.1  tshiozak 				p->sc = sc;
    682       1.1  tshiozak 				p->addr = epaddr;
    683       1.1  tshiozak 				p->num_jacks = TO_CSEPD(desc)->bNumEmbMIDIJack;
    684       1.1  tshiozak 				if (UE_GET_DIR(epaddr)==UE_DIR_OUT) {
    685       1.1  tshiozak 					sc->sc_out_num_endpoints++;
    686       1.1  tshiozak 					sc->sc_out_num_jacks += p->num_jacks;
    687       1.1  tshiozak 				} else {
    688       1.1  tshiozak 					sc->sc_in_num_endpoints++;
    689       1.1  tshiozak 					sc->sc_in_num_jacks += p->num_jacks;
    690       1.1  tshiozak 				}
    691       1.1  tshiozak 				p++;
    692       1.1  tshiozak 			}
    693       1.1  tshiozak 		} else
    694       1.1  tshiozak 			epaddr = -1;
    695       1.1  tshiozak 		desc = NEXT_D(desc);
    696       1.1  tshiozak 		remain-=descsize;
    697       1.1  tshiozak 	}
    698       1.1  tshiozak 
    699       1.1  tshiozak 	/* sort endpoints */
    700       1.1  tshiozak 	num_ep = sc->sc_out_num_endpoints + sc->sc_in_num_endpoints;
    701       1.1  tshiozak 	p = sc->sc_endpoints;
    702       1.1  tshiozak 	endep = p + num_ep;
    703       1.1  tshiozak 	while (p<endep) {
    704       1.1  tshiozak 		lowest = p;
    705       1.1  tshiozak 		for (q=p+1; q<endep; q++) {
    706       1.1  tshiozak 			if ((UE_GET_DIR(lowest->addr)==UE_DIR_IN &&
    707       1.1  tshiozak 			     UE_GET_DIR(q->addr)==UE_DIR_OUT) ||
    708       1.1  tshiozak 			    ((UE_GET_DIR(lowest->addr)==
    709       1.1  tshiozak 			      UE_GET_DIR(q->addr)) &&
    710       1.1  tshiozak 			     (UE_GET_ADDR(lowest->addr)>
    711       1.1  tshiozak 			      UE_GET_ADDR(q->addr))))
    712       1.1  tshiozak 				lowest = q;
    713       1.1  tshiozak 		}
    714       1.1  tshiozak 		if (lowest != p) {
    715       1.1  tshiozak 			memcpy((void *)&tmpep, (void *)p, sizeof(tmpep));
    716       1.1  tshiozak 			memcpy((void *)p, (void *)lowest, sizeof(tmpep));
    717       1.1  tshiozak 			memcpy((void *)lowest, (void *)&tmpep, sizeof(tmpep));
    718       1.1  tshiozak 		}
    719       1.7  tshiozak 		p->num_open = 0;
    720       1.7  tshiozak 		p++;
    721       1.1  tshiozak 	}
    722      1.16  augustss 
    723       1.1  tshiozak 	sc->sc_out_ep = sc->sc_out_num_endpoints ? sc->sc_endpoints : NULL;
    724       1.1  tshiozak 	sc->sc_in_ep =
    725       1.1  tshiozak 	    sc->sc_in_num_endpoints ?
    726       1.1  tshiozak 		sc->sc_endpoints+sc->sc_out_num_endpoints : NULL;
    727       1.1  tshiozak 
    728       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    729       1.1  tshiozak }
    730       1.1  tshiozak 
    731       1.1  tshiozak 
    732       1.4  tshiozak /*
    733       1.4  tshiozak  * jack stuffs
    734       1.4  tshiozak  */
    735       1.4  tshiozak 
    736       1.1  tshiozak static usbd_status
    737       1.1  tshiozak alloc_all_jacks(struct umidi_softc *sc)
    738       1.1  tshiozak {
    739       1.1  tshiozak 	int i, j;
    740       1.1  tshiozak 	struct umidi_endpoint *ep;
    741       1.1  tshiozak 	struct umidi_jack *jack, **rjack;
    742       1.1  tshiozak 
    743       1.1  tshiozak 	/* allocate/initialize structures */
    744       1.1  tshiozak 	sc->sc_jacks =
    745       1.1  tshiozak 	    malloc(sizeof(*sc->sc_out_jacks)*(sc->sc_in_num_jacks+
    746       1.1  tshiozak 					      sc->sc_out_num_jacks),
    747       1.1  tshiozak 		   M_USBDEV, M_WAITOK);
    748       1.1  tshiozak 	if (!sc->sc_jacks)
    749       1.1  tshiozak 		return USBD_NOMEM;
    750       1.1  tshiozak 	sc->sc_out_jacks =
    751       1.1  tshiozak 	    sc->sc_out_num_jacks ? sc->sc_jacks : NULL;
    752       1.1  tshiozak 	sc->sc_in_jacks =
    753       1.1  tshiozak 	    sc->sc_in_num_jacks ? sc->sc_jacks+sc->sc_out_num_jacks : NULL;
    754       1.1  tshiozak 
    755       1.1  tshiozak 	jack = &sc->sc_out_jacks[0];
    756       1.1  tshiozak 	for (i=0; i<sc->sc_out_num_jacks; i++) {
    757       1.4  tshiozak 		jack->opened = 0;
    758       1.4  tshiozak 		jack->binded = 0;
    759       1.4  tshiozak 		jack->arg = NULL;
    760       1.4  tshiozak 		jack->u.out.intr = NULL;
    761       1.1  tshiozak 		jack->cable_number = i;
    762       1.1  tshiozak 		jack++;
    763       1.1  tshiozak 	}
    764       1.1  tshiozak 	jack = &sc->sc_in_jacks[0];
    765       1.1  tshiozak 	for (i=0; i<sc->sc_in_num_jacks; i++) {
    766       1.4  tshiozak 		jack->opened = 0;
    767       1.4  tshiozak 		jack->binded = 0;
    768       1.4  tshiozak 		jack->arg = NULL;
    769       1.4  tshiozak 		jack->u.in.intr = NULL;
    770       1.1  tshiozak 		jack->cable_number = i;
    771       1.1  tshiozak 		jack++;
    772       1.1  tshiozak 	}
    773       1.1  tshiozak 
    774       1.1  tshiozak 	/* assign each jacks to each endpoints */
    775       1.1  tshiozak 	jack = &sc->sc_out_jacks[0];
    776       1.1  tshiozak 	ep = &sc->sc_out_ep[0];
    777       1.1  tshiozak 	for (i=0; i<sc->sc_out_num_endpoints; i++) {
    778       1.1  tshiozak 		rjack = &ep->jacks[0];
    779       1.1  tshiozak 		for (j=0; j<ep->num_jacks; j++) {
    780       1.1  tshiozak 			*rjack = jack;
    781       1.1  tshiozak 			jack->endpoint = ep;
    782       1.1  tshiozak 			jack++;
    783       1.1  tshiozak 			rjack++;
    784       1.1  tshiozak 		}
    785       1.1  tshiozak 		ep++;
    786       1.1  tshiozak 	}
    787       1.1  tshiozak 	jack = &sc->sc_in_jacks[0];
    788       1.1  tshiozak 	ep = &sc->sc_in_ep[0];
    789       1.1  tshiozak 	for (i=0; i<sc->sc_in_num_endpoints; i++) {
    790       1.1  tshiozak 		rjack = &ep->jacks[0];
    791       1.1  tshiozak 		for (j=0; j<ep->num_jacks; j++) {
    792       1.1  tshiozak 			*rjack = jack;
    793       1.1  tshiozak 			jack->endpoint = ep;
    794       1.1  tshiozak 			jack++;
    795       1.1  tshiozak 			rjack++;
    796       1.1  tshiozak 		}
    797       1.1  tshiozak 		ep++;
    798       1.1  tshiozak 	}
    799       1.1  tshiozak 
    800       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    801       1.1  tshiozak }
    802       1.1  tshiozak 
    803       1.1  tshiozak static void
    804       1.1  tshiozak free_all_jacks(struct umidi_softc *sc)
    805       1.1  tshiozak {
    806       1.1  tshiozak 	int s;
    807       1.1  tshiozak 
    808       1.1  tshiozak 	s = splaudio();
    809       1.1  tshiozak 	if (sc->sc_out_jacks) {
    810       1.1  tshiozak 		free(sc->sc_jacks, M_USBDEV);
    811       1.1  tshiozak 		sc->sc_jacks = sc->sc_in_jacks = sc->sc_out_jacks = NULL;
    812       1.1  tshiozak 	}
    813       1.1  tshiozak 	splx(s);
    814       1.1  tshiozak }
    815       1.1  tshiozak 
    816       1.1  tshiozak static usbd_status
    817       1.1  tshiozak bind_jacks_to_mididev(struct umidi_softc *sc,
    818       1.1  tshiozak 		      struct umidi_jack *out_jack,
    819       1.1  tshiozak 		      struct umidi_jack *in_jack,
    820       1.1  tshiozak 		      struct umidi_mididev *mididev)
    821       1.1  tshiozak {
    822       1.8  tshiozak 	if ((out_jack && out_jack->binded) || (in_jack && in_jack->binded))
    823       1.4  tshiozak 		return USBD_IN_USE;
    824       1.4  tshiozak 	if (mididev->out_jack || mididev->in_jack)
    825       1.1  tshiozak 		return USBD_IN_USE;
    826       1.1  tshiozak 
    827       1.4  tshiozak 	if (out_jack)
    828       1.4  tshiozak 		out_jack->binded = 1;
    829       1.4  tshiozak 	if (in_jack)
    830       1.4  tshiozak 		in_jack->binded = 1;
    831       1.1  tshiozak 	mididev->in_jack = in_jack;
    832       1.1  tshiozak 	mididev->out_jack = out_jack;
    833       1.1  tshiozak 
    834       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    835       1.1  tshiozak }
    836       1.1  tshiozak 
    837       1.4  tshiozak static void
    838       1.1  tshiozak unbind_jacks_from_mididev(struct umidi_mididev *mididev)
    839       1.1  tshiozak {
    840      1.15  tshiozak 	if ((mididev->flags & FWRITE) && mididev->out_jack)
    841       1.4  tshiozak 		close_out_jack(mididev->out_jack);
    842      1.15  tshiozak 	if ((mididev->flags & FREAD) && mididev->in_jack)
    843       1.4  tshiozak 		close_in_jack(mididev->in_jack);
    844       1.1  tshiozak 
    845       1.4  tshiozak 	if (mididev->out_jack)
    846       1.4  tshiozak 		mididev->out_jack->binded = 0;
    847       1.4  tshiozak 	if (mididev->in_jack)
    848       1.4  tshiozak 		mididev->in_jack->binded = 0;
    849       1.4  tshiozak 	mididev->out_jack = mididev->in_jack = NULL;
    850       1.1  tshiozak }
    851       1.1  tshiozak 
    852       1.4  tshiozak static void
    853       1.1  tshiozak unbind_all_jacks(struct umidi_softc *sc)
    854       1.1  tshiozak {
    855       1.1  tshiozak 	int i;
    856       1.1  tshiozak 
    857       1.1  tshiozak 	if (sc->sc_mididevs)
    858       1.1  tshiozak 		for (i=0; i<sc->sc_num_mididevs; i++) {
    859       1.4  tshiozak 			unbind_jacks_from_mididev(&sc->sc_mididevs[i]);
    860       1.1  tshiozak 		}
    861       1.1  tshiozak }
    862       1.1  tshiozak 
    863       1.1  tshiozak static usbd_status
    864       1.1  tshiozak assign_all_jacks_automatically(struct umidi_softc *sc)
    865       1.1  tshiozak {
    866       1.1  tshiozak 	usbd_status err;
    867       1.1  tshiozak 	int i;
    868       1.1  tshiozak 	struct umidi_jack *out, *in;
    869       1.1  tshiozak 
    870       1.1  tshiozak 	err =
    871       1.1  tshiozak 	    alloc_all_mididevs(sc,
    872       1.1  tshiozak 			       max(sc->sc_out_num_jacks, sc->sc_in_num_jacks));
    873       1.1  tshiozak 	if (err!=USBD_NORMAL_COMPLETION)
    874       1.1  tshiozak 		return err;
    875       1.1  tshiozak 
    876       1.1  tshiozak 	for (i=0; i<sc->sc_num_mididevs; i++) {
    877       1.1  tshiozak 		out = (i<sc->sc_out_num_jacks) ? &sc->sc_out_jacks[i]:NULL;
    878       1.1  tshiozak 		in = (i<sc->sc_in_num_jacks) ? &sc->sc_in_jacks[i]:NULL;
    879       1.1  tshiozak 		err = bind_jacks_to_mididev(sc, out, in, &sc->sc_mididevs[i]);
    880       1.1  tshiozak 		if (err!=USBD_NORMAL_COMPLETION) {
    881       1.1  tshiozak 			free_all_mididevs(sc);
    882       1.1  tshiozak 			return err;
    883       1.1  tshiozak 		}
    884       1.1  tshiozak 	}
    885       1.1  tshiozak 
    886       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    887       1.1  tshiozak }
    888       1.1  tshiozak 
    889       1.1  tshiozak static usbd_status
    890       1.4  tshiozak open_out_jack(struct umidi_jack *jack, void *arg, void (*intr)(void *))
    891       1.4  tshiozak {
    892       1.4  tshiozak 	struct umidi_endpoint *ep = jack->endpoint;
    893       1.4  tshiozak 
    894       1.4  tshiozak 	if (jack->opened)
    895       1.4  tshiozak 		return USBD_IN_USE;
    896       1.4  tshiozak 
    897       1.4  tshiozak 	jack->arg = arg;
    898       1.4  tshiozak 	jack->u.out.intr = intr;
    899       1.4  tshiozak 	init_packet(&jack->packet);
    900       1.4  tshiozak 	jack->opened = 1;
    901       1.4  tshiozak 	ep->num_open++;
    902       1.4  tshiozak 
    903       1.4  tshiozak 	return USBD_NORMAL_COMPLETION;
    904       1.4  tshiozak }
    905       1.4  tshiozak 
    906       1.4  tshiozak static usbd_status
    907       1.4  tshiozak open_in_jack(struct umidi_jack *jack, void *arg, void (*intr)(void *, int))
    908       1.1  tshiozak {
    909       1.3  tshiozak 	usbd_status err = USBD_NORMAL_COMPLETION;
    910       1.3  tshiozak 	struct umidi_endpoint *ep = jack->endpoint;
    911       1.3  tshiozak 
    912       1.4  tshiozak 	if (jack->opened)
    913       1.4  tshiozak 		return USBD_IN_USE;
    914       1.4  tshiozak 
    915       1.4  tshiozak 	jack->arg = arg;
    916       1.4  tshiozak 	jack->u.in.intr = intr;
    917       1.4  tshiozak 	jack->opened = 1;
    918       1.3  tshiozak 	if (ep->num_open++==0 && UE_GET_DIR(ep->addr)==UE_DIR_IN) {
    919       1.3  tshiozak 		err = start_input_transfer(ep);
    920      1.18      gson 		if (err != USBD_NORMAL_COMPLETION &&
    921      1.18      gson 		    err != USBD_IN_PROGRESS) {
    922       1.3  tshiozak 			ep->num_open--;
    923       1.3  tshiozak 		}
    924       1.3  tshiozak 	}
    925       1.3  tshiozak 
    926       1.3  tshiozak 	return err;
    927       1.1  tshiozak }
    928       1.1  tshiozak 
    929       1.1  tshiozak static void
    930       1.4  tshiozak close_out_jack(struct umidi_jack *jack)
    931       1.1  tshiozak {
    932       1.3  tshiozak 	struct umidi_jack *tail;
    933       1.3  tshiozak 	int s;
    934       1.4  tshiozak 
    935       1.4  tshiozak 	if (jack->opened) {
    936       1.4  tshiozak 		s = splusb();
    937      1.15  tshiozak 		LIST_FOREACH(tail,
    938      1.15  tshiozak 			     &jack->endpoint->queue_head,
    939      1.15  tshiozak 			     u.out.queue_entry)
    940      1.15  tshiozak 			if (tail == jack) {
    941      1.15  tshiozak 				LIST_REMOVE(jack, u.out.queue_entry);
    942      1.15  tshiozak 				break;
    943      1.15  tshiozak 			}
    944      1.15  tshiozak 		if (jack == jack->endpoint->queue_tail) {
    945       1.4  tshiozak 			/* find tail */
    946       1.4  tshiozak 			LIST_FOREACH(tail,
    947       1.4  tshiozak 				     &jack->endpoint->queue_head,
    948       1.4  tshiozak 				     u.out.queue_entry) {
    949       1.4  tshiozak 				if (!LIST_NEXT(tail, u.out.queue_entry)) {
    950       1.4  tshiozak 					jack->endpoint->queue_tail = tail;
    951       1.4  tshiozak 				}
    952       1.3  tshiozak 			}
    953       1.3  tshiozak 		}
    954       1.4  tshiozak 		splx(s);
    955       1.4  tshiozak 		jack->opened = 0;
    956       1.4  tshiozak 		jack->endpoint->num_open--;
    957       1.3  tshiozak 	}
    958       1.1  tshiozak }
    959       1.1  tshiozak 
    960       1.4  tshiozak static void
    961       1.4  tshiozak close_in_jack(struct umidi_jack *jack)
    962       1.4  tshiozak {
    963       1.4  tshiozak 	if (jack->opened) {
    964       1.4  tshiozak 		jack->opened = 0;
    965      1.19      gson 		if (--jack->endpoint->num_open == 0) {
    966      1.19      gson 		    usbd_abort_pipe(jack->endpoint->pipe);
    967      1.19      gson 		}
    968       1.4  tshiozak 	}
    969       1.4  tshiozak }
    970       1.1  tshiozak 
    971       1.1  tshiozak static usbd_status
    972       1.1  tshiozak attach_mididev(struct umidi_softc *sc, struct umidi_mididev *mididev)
    973       1.1  tshiozak {
    974       1.1  tshiozak 	if (mididev->sc)
    975       1.1  tshiozak 		return USBD_IN_USE;
    976       1.1  tshiozak 
    977       1.1  tshiozak 	mididev->sc = sc;
    978       1.1  tshiozak 
    979       1.1  tshiozak 	mididev->mdev = midi_attach_mi(&umidi_hw_if, mididev, &sc->sc_dev);
    980       1.1  tshiozak 
    981       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    982       1.1  tshiozak }
    983       1.1  tshiozak 
    984       1.1  tshiozak static usbd_status
    985       1.1  tshiozak detach_mididev(struct umidi_mididev *mididev, int flags)
    986       1.1  tshiozak {
    987       1.1  tshiozak 	if (!mididev->sc)
    988       1.1  tshiozak 		return USBD_NO_ADDR;
    989       1.1  tshiozak 
    990       1.1  tshiozak 	if (mididev->opened) {
    991       1.1  tshiozak 		umidi_close(mididev);
    992       1.1  tshiozak 	}
    993       1.4  tshiozak 	unbind_jacks_from_mididev(mididev);
    994       1.1  tshiozak 
    995       1.1  tshiozak 	if (mididev->mdev)
    996       1.1  tshiozak 		config_detach(mididev->mdev, flags);
    997       1.1  tshiozak 
    998       1.1  tshiozak 	mididev->sc = NULL;
    999       1.1  tshiozak 
   1000       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
   1001       1.1  tshiozak }
   1002       1.1  tshiozak 
   1003       1.1  tshiozak static usbd_status
   1004       1.1  tshiozak deactivate_mididev(struct umidi_mididev *mididev)
   1005       1.1  tshiozak {
   1006       1.4  tshiozak 	if (mididev->out_jack)
   1007       1.4  tshiozak 		mididev->out_jack->binded = 0;
   1008       1.4  tshiozak 	if (mididev->in_jack)
   1009       1.4  tshiozak 		mididev->in_jack->binded = 0;
   1010       1.1  tshiozak 	config_deactivate(mididev->mdev);
   1011       1.1  tshiozak 
   1012       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
   1013       1.1  tshiozak }
   1014       1.1  tshiozak 
   1015       1.1  tshiozak static usbd_status
   1016       1.1  tshiozak alloc_all_mididevs(struct umidi_softc *sc, int nmidi)
   1017       1.1  tshiozak {
   1018       1.1  tshiozak 	sc->sc_num_mididevs = nmidi;
   1019       1.1  tshiozak 	sc->sc_mididevs = malloc(sizeof(*sc->sc_mididevs)*nmidi,
   1020      1.13   tsutsui 				 M_USBDEV, M_WAITOK|M_ZERO);
   1021       1.1  tshiozak 	if (!sc->sc_mididevs)
   1022       1.1  tshiozak 		return USBD_NOMEM;
   1023       1.1  tshiozak 
   1024       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
   1025       1.1  tshiozak }
   1026       1.1  tshiozak 
   1027       1.1  tshiozak static void
   1028       1.1  tshiozak free_all_mididevs(struct umidi_softc *sc)
   1029       1.1  tshiozak {
   1030       1.1  tshiozak 	sc->sc_num_mididevs = 0;
   1031       1.1  tshiozak 	if (sc->sc_mididevs)
   1032       1.1  tshiozak 		free(sc->sc_mididevs, M_USBDEV);
   1033       1.1  tshiozak }
   1034       1.1  tshiozak 
   1035       1.1  tshiozak static usbd_status
   1036       1.1  tshiozak attach_all_mididevs(struct umidi_softc *sc)
   1037       1.1  tshiozak {
   1038       1.1  tshiozak 	usbd_status err;
   1039       1.1  tshiozak 	int i;
   1040       1.1  tshiozak 
   1041       1.1  tshiozak 	if (sc->sc_mididevs)
   1042       1.1  tshiozak 		for (i=0; i<sc->sc_num_mididevs; i++) {
   1043       1.1  tshiozak 			err = attach_mididev(sc, &sc->sc_mididevs[i]);
   1044       1.1  tshiozak 			if (err!=USBD_NORMAL_COMPLETION)
   1045       1.1  tshiozak 				return err;
   1046       1.1  tshiozak 		}
   1047       1.1  tshiozak 
   1048       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
   1049       1.1  tshiozak }
   1050       1.1  tshiozak 
   1051       1.1  tshiozak static usbd_status
   1052       1.1  tshiozak detach_all_mididevs(struct umidi_softc *sc, int flags)
   1053       1.1  tshiozak {
   1054       1.1  tshiozak 	usbd_status err;
   1055       1.1  tshiozak 	int i;
   1056       1.1  tshiozak 
   1057       1.1  tshiozak 	if (sc->sc_mididevs)
   1058       1.1  tshiozak 		for (i=0; i<sc->sc_num_mididevs; i++) {
   1059       1.1  tshiozak 			err = detach_mididev(&sc->sc_mididevs[i], flags);
   1060       1.1  tshiozak 			if (err!=USBD_NORMAL_COMPLETION)
   1061       1.1  tshiozak 				return err;
   1062       1.1  tshiozak 		}
   1063       1.1  tshiozak 
   1064       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
   1065       1.1  tshiozak }
   1066       1.1  tshiozak 
   1067       1.1  tshiozak static usbd_status
   1068       1.1  tshiozak deactivate_all_mididevs(struct umidi_softc *sc)
   1069       1.1  tshiozak {
   1070       1.1  tshiozak 	usbd_status err;
   1071       1.1  tshiozak 	int i;
   1072       1.1  tshiozak 
   1073       1.1  tshiozak 	if (sc->sc_mididevs)
   1074       1.1  tshiozak 		for (i=0; i<sc->sc_num_mididevs; i++) {
   1075       1.1  tshiozak 			err = deactivate_mididev(&sc->sc_mididevs[i]);
   1076       1.1  tshiozak 			if (err!=USBD_NORMAL_COMPLETION)
   1077       1.1  tshiozak 				return err;
   1078       1.1  tshiozak 		}
   1079       1.1  tshiozak 
   1080       1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
   1081       1.1  tshiozak }
   1082       1.1  tshiozak 
   1083       1.1  tshiozak #ifdef UMIDI_DEBUG
   1084       1.1  tshiozak static void
   1085       1.1  tshiozak dump_sc(struct umidi_softc *sc)
   1086       1.1  tshiozak {
   1087       1.1  tshiozak 	int i;
   1088       1.1  tshiozak 
   1089       1.1  tshiozak 	DPRINTFN(10, ("%s: dump_sc\n", USBDEVNAME(sc->sc_dev)));
   1090       1.1  tshiozak 	for (i=0; i<sc->sc_out_num_endpoints; i++) {
   1091       1.1  tshiozak 		DPRINTFN(10, ("\tout_ep(%p):\n", &sc->sc_out_ep[i]));
   1092       1.1  tshiozak 		dump_ep(&sc->sc_out_ep[i]);
   1093       1.1  tshiozak 	}
   1094       1.1  tshiozak 	for (i=0; i<sc->sc_in_num_endpoints; i++) {
   1095       1.1  tshiozak 		DPRINTFN(10, ("\tin_ep(%p):\n", &sc->sc_in_ep[i]));
   1096       1.1  tshiozak 		dump_ep(&sc->sc_in_ep[i]);
   1097       1.1  tshiozak 	}
   1098       1.1  tshiozak }
   1099       1.1  tshiozak 
   1100       1.1  tshiozak static void
   1101       1.1  tshiozak dump_ep(struct umidi_endpoint *ep)
   1102       1.1  tshiozak {
   1103       1.1  tshiozak 	int i;
   1104       1.1  tshiozak 	for (i=0; i<ep->num_jacks; i++) {
   1105       1.1  tshiozak 		DPRINTFN(10, ("\t\tjack(%p):\n", ep->jacks[i]));
   1106       1.1  tshiozak 		dump_jack(ep->jacks[i]);
   1107       1.1  tshiozak 	}
   1108       1.1  tshiozak }
   1109       1.1  tshiozak static void
   1110       1.1  tshiozak dump_jack(struct umidi_jack *jack)
   1111       1.1  tshiozak {
   1112      1.15  tshiozak 	DPRINTFN(10, ("\t\t\tep=%p\n",
   1113      1.15  tshiozak 		      jack->endpoint));
   1114       1.1  tshiozak }
   1115       1.1  tshiozak 
   1116       1.1  tshiozak #endif /* UMIDI_DEBUG */
   1117       1.1  tshiozak 
   1118       1.1  tshiozak 
   1119       1.1  tshiozak 
   1120       1.1  tshiozak /*
   1121       1.1  tshiozak  * MUX MIDI PACKET
   1122       1.1  tshiozak  */
   1123       1.1  tshiozak 
   1124       1.5  jdolecek static const int packet_length[16] = {
   1125       1.1  tshiozak 	/*0*/	-1,
   1126       1.1  tshiozak 	/*1*/	-1,
   1127       1.1  tshiozak 	/*2*/	2,
   1128       1.1  tshiozak 	/*3*/	3,
   1129       1.1  tshiozak 	/*4*/	3,
   1130       1.1  tshiozak 	/*5*/	1,
   1131       1.1  tshiozak 	/*6*/	2,
   1132       1.1  tshiozak 	/*7*/	3,
   1133       1.1  tshiozak 	/*8*/	3,
   1134       1.1  tshiozak 	/*9*/	3,
   1135       1.1  tshiozak 	/*A*/	3,
   1136       1.1  tshiozak 	/*B*/	3,
   1137       1.1  tshiozak 	/*C*/	2,
   1138       1.1  tshiozak 	/*D*/	2,
   1139       1.1  tshiozak 	/*E*/	3,
   1140       1.1  tshiozak 	/*F*/	1,
   1141       1.1  tshiozak };
   1142       1.1  tshiozak 
   1143       1.5  jdolecek static const struct {
   1144       1.1  tshiozak 	int		cin;
   1145       1.1  tshiozak 	packet_state_t	next;
   1146       1.1  tshiozak } packet_0xFX[16] = {
   1147       1.1  tshiozak 	/*F0: SysEx */	{ 0x04, PS_EXCL_1 },
   1148       1.1  tshiozak 	/*F1: MTC */	{ 0x02, PS_NORMAL_1OF2 },
   1149       1.1  tshiozak 	/*F2: S.POS */	{ 0x03, PS_NORMAL_1OF3 },
   1150       1.1  tshiozak 	/*F3: S.SEL */	{ 0x02, PS_NORMAL_1OF2 },
   1151       1.1  tshiozak 	/*F4: UNDEF */	{ 0x00, PS_INITIAL },
   1152       1.1  tshiozak 	/*F5: UNDEF */	{ 0x00, PS_INITIAL },
   1153       1.1  tshiozak 	/*F6: Tune */	{ 0x0F, PS_END },
   1154       1.1  tshiozak 	/*F7: EofEx */	{ 0x00, PS_INITIAL },
   1155       1.1  tshiozak 	/*F8: Timing */	{ 0x0F, PS_END },
   1156       1.1  tshiozak 	/*F9: UNDEF */	{ 0x00, PS_INITIAL },
   1157       1.1  tshiozak 	/*FA: Start */	{ 0x0F, PS_END },
   1158       1.1  tshiozak 	/*FB: Cont */	{ 0x0F, PS_END },
   1159       1.1  tshiozak 	/*FC: Stop */	{ 0x0F, PS_END },
   1160       1.1  tshiozak 	/*FD: UNDEF */	{ 0x00, PS_INITIAL },
   1161       1.1  tshiozak 	/*FE: ActS */	{ 0x0F, PS_END },
   1162       1.1  tshiozak 	/*FF: Reset */	{ 0x0F, PS_END },
   1163       1.1  tshiozak };
   1164       1.1  tshiozak 
   1165       1.1  tshiozak #define	GET_CN(p)		(((unsigned char)(p)>>4)&0x0F)
   1166       1.1  tshiozak #define GET_CIN(p)		((unsigned char)(p)&0x0F)
   1167       1.1  tshiozak #define MIX_CN_CIN(cn, cin) \
   1168       1.1  tshiozak 	((unsigned char)((((unsigned char)(cn)&0x0F)<<4)| \
   1169       1.3  tshiozak 			  ((unsigned char)(cin)&0x0F)))
   1170       1.1  tshiozak 
   1171       1.1  tshiozak static void
   1172       1.1  tshiozak init_packet(struct umidi_packet *packet)
   1173       1.1  tshiozak {
   1174       1.1  tshiozak 	memset(packet->buffer, 0, UMIDI_PACKET_SIZE);
   1175       1.1  tshiozak 	packet->state = PS_INITIAL;
   1176       1.1  tshiozak }
   1177       1.1  tshiozak 
   1178       1.1  tshiozak static usbd_status
   1179       1.1  tshiozak start_input_transfer(struct umidi_endpoint *ep)
   1180       1.1  tshiozak {
   1181       1.1  tshiozak 	usbd_setup_xfer(ep->xfer, ep->pipe,
   1182       1.1  tshiozak 			(usbd_private_handle)ep,
   1183       1.1  tshiozak 			ep->buffer, UMIDI_PACKET_SIZE,
   1184      1.11  augustss 			USBD_NO_COPY, USBD_NO_TIMEOUT, in_intr);
   1185       1.1  tshiozak 	return usbd_transfer(ep->xfer);
   1186       1.1  tshiozak }
   1187       1.1  tshiozak 
   1188       1.1  tshiozak static usbd_status
   1189       1.1  tshiozak start_output_transfer(struct umidi_endpoint *ep)
   1190       1.1  tshiozak {
   1191       1.1  tshiozak 	usbd_setup_xfer(ep->xfer, ep->pipe,
   1192       1.1  tshiozak 			(usbd_private_handle)ep,
   1193       1.1  tshiozak 			ep->buffer, UMIDI_PACKET_SIZE,
   1194      1.11  augustss 			USBD_NO_COPY, USBD_NO_TIMEOUT, out_intr);
   1195       1.1  tshiozak 	return usbd_transfer(ep->xfer);
   1196       1.1  tshiozak }
   1197       1.1  tshiozak 
   1198       1.4  tshiozak #ifdef UMIDI_DEBUG
   1199       1.4  tshiozak #define DPR_PACKET(dir, sc, p)						\
   1200       1.4  tshiozak if ((unsigned char)(p)->buffer[1]!=0xFE)				\
   1201       1.4  tshiozak 	DPRINTFN(500,							\
   1202       1.4  tshiozak 		 ("%s: umidi packet(" #dir "): %02X %02X %02X %02X\n",	\
   1203       1.4  tshiozak 		  USBDEVNAME(sc->sc_dev),				\
   1204       1.4  tshiozak 		  (unsigned char)(p)->buffer[0],			\
   1205       1.4  tshiozak 		  (unsigned char)(p)->buffer[1],			\
   1206       1.4  tshiozak 		  (unsigned char)(p)->buffer[2],			\
   1207       1.4  tshiozak 		  (unsigned char)(p)->buffer[3]));
   1208       1.4  tshiozak #else
   1209       1.4  tshiozak #define DPR_PACKET(dir, sc, p)
   1210       1.4  tshiozak #endif
   1211       1.4  tshiozak 
   1212  1.25.2.2      chap static void *
   1213  1.25.2.2      chap midiman_garble( void *dst, const void *src, size_t len) {
   1214  1.25.2.2      chap 	unsigned char *cd = dst;
   1215  1.25.2.2      chap 	unsigned char const *cs = src;
   1216  1.25.2.2      chap 	unsigned char *end = cd + len;
   1217  1.25.2.2      chap 
   1218  1.25.2.2      chap 	while ( cd < end ) {
   1219  1.25.2.2      chap 		cd[3] = (0xf0&*cs) | (packet_length[0x0f&*cs]);
   1220  1.25.2.2      chap 		*(cd++) = *(++cs);
   1221  1.25.2.2      chap 		*(cd++) = *(++cs);
   1222  1.25.2.2      chap 		*(cd++) = *(++cs);
   1223  1.25.2.2      chap 		++cd, ++cs;
   1224  1.25.2.2      chap 	}
   1225  1.25.2.2      chap 	return dst;
   1226  1.25.2.2      chap }
   1227  1.25.2.2      chap 
   1228       1.4  tshiozak static int
   1229       1.4  tshiozak out_jack_output(struct umidi_jack *out_jack, int d)
   1230       1.4  tshiozak {
   1231       1.4  tshiozak 	struct umidi_endpoint *ep = out_jack->endpoint;
   1232       1.4  tshiozak 	struct umidi_softc *sc = ep->sc;
   1233       1.4  tshiozak 	int error;
   1234       1.4  tshiozak 	int s;
   1235       1.4  tshiozak 
   1236       1.4  tshiozak 	if (sc->sc_dying)
   1237       1.4  tshiozak 		return EIO;
   1238       1.4  tshiozak 
   1239       1.4  tshiozak 	error = 0;
   1240       1.4  tshiozak 	if (out_jack->opened) {
   1241       1.4  tshiozak 		DPRINTFN(1000, ("umidi_output: ep=%p 0x%02x\n", ep, d));
   1242       1.4  tshiozak 		out_build_packet(out_jack->cable_number, &out_jack->packet, d);
   1243       1.4  tshiozak 		switch (out_jack->packet.state) {
   1244       1.4  tshiozak 		case PS_EXCL_0:
   1245       1.4  tshiozak 		case PS_END:
   1246       1.4  tshiozak 			DPR_PACKET(out, sc, &out_jack->packet);
   1247       1.4  tshiozak 			s = splusb();
   1248       1.4  tshiozak 			if (LIST_EMPTY(&ep->queue_head)) {
   1249  1.25.2.2      chap 				(UMQ_ISTYPE(sc, UMQ_TYPE_MIDIMAN_GARBLE)
   1250  1.25.2.2      chap 				? midiman_garble
   1251  1.25.2.2      chap 				: memcpy
   1252  1.25.2.2      chap 				)
   1253  1.25.2.2      chap 				(ep->buffer,
   1254       1.4  tshiozak 				       out_jack->packet.buffer,
   1255       1.4  tshiozak 				       UMIDI_PACKET_SIZE);
   1256       1.4  tshiozak 				start_output_transfer(ep);
   1257       1.4  tshiozak 			}
   1258       1.4  tshiozak 			if (LIST_EMPTY(&ep->queue_head))
   1259       1.4  tshiozak 				LIST_INSERT_HEAD(&ep->queue_head,
   1260       1.4  tshiozak 						 out_jack, u.out.queue_entry);
   1261       1.4  tshiozak 			else
   1262       1.4  tshiozak 				LIST_INSERT_AFTER(ep->queue_tail,
   1263       1.4  tshiozak 						  out_jack, u.out.queue_entry);
   1264       1.4  tshiozak 			ep->queue_tail = out_jack;
   1265       1.4  tshiozak 			splx(s);
   1266       1.4  tshiozak 			break;
   1267       1.4  tshiozak 		default:
   1268       1.4  tshiozak 			error = EINPROGRESS;
   1269       1.4  tshiozak 		}
   1270       1.4  tshiozak 	} else
   1271       1.4  tshiozak 		error = ENODEV;
   1272       1.4  tshiozak 
   1273       1.4  tshiozak 	return error;
   1274       1.4  tshiozak }
   1275       1.4  tshiozak 
   1276       1.1  tshiozak static void
   1277       1.1  tshiozak in_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
   1278       1.1  tshiozak {
   1279       1.4  tshiozak 	int cn, len, i;
   1280       1.1  tshiozak 	struct umidi_endpoint *ep = (struct umidi_endpoint *)priv;
   1281       1.4  tshiozak 	struct umidi_jack *jack;
   1282  1.25.2.3      chap 	unsigned char *data;
   1283       1.1  tshiozak 
   1284       1.3  tshiozak 	if (ep->sc->sc_dying || !ep->num_open)
   1285       1.1  tshiozak 		return;
   1286       1.1  tshiozak 
   1287  1.25.2.2      chap 	if ( UMQ_ISTYPE(ep->sc, UMQ_TYPE_MIDIMAN_GARBLE) ) {
   1288  1.25.2.3      chap 		cn = (0xf0&(ep->buffer[3]))>>4;
   1289  1.25.2.2      chap 		len = 0x0f&(ep->buffer[3]);
   1290  1.25.2.2      chap 		data = ep->buffer;
   1291  1.25.2.2      chap 	} else {
   1292  1.25.2.2      chap 		cn = GET_CN(ep->buffer[0]);
   1293  1.25.2.2      chap 		len = packet_length[GET_CIN(ep->buffer[0])];
   1294  1.25.2.2      chap 		data = ep->buffer + 1;
   1295  1.25.2.2      chap 	}
   1296       1.4  tshiozak 	jack = ep->jacks[cn];
   1297       1.4  tshiozak 	if (cn>=ep->num_jacks || !jack) {
   1298       1.4  tshiozak 		DPRINTF(("%s: stray umidi packet (in): %02X %02X %02X %02X\n",
   1299       1.4  tshiozak 			 USBDEVNAME(ep->sc->sc_dev),
   1300       1.4  tshiozak 			 (unsigned)ep->buffer[0],
   1301       1.4  tshiozak 			 (unsigned)ep->buffer[1],
   1302       1.4  tshiozak 			 (unsigned)ep->buffer[2],
   1303       1.4  tshiozak 			 (unsigned)ep->buffer[3]));
   1304       1.4  tshiozak 		return;
   1305       1.4  tshiozak 	}
   1306       1.4  tshiozak 	if (!jack->binded || !jack->opened)
   1307       1.4  tshiozak 		return;
   1308  1.25.2.3      chap 	DPRINTFN(500,("%s: midi data (in) cable %d len %d: %02X %02X %02X\n",
   1309  1.25.2.3      chap 		USBDEVNAME(ep->sc->sc_dev), cn, len,
   1310  1.25.2.3      chap 		(unsigned)data[0],
   1311  1.25.2.3      chap 		(unsigned)data[1],
   1312  1.25.2.3      chap 		(unsigned)data[2]));
   1313       1.4  tshiozak 	if (jack->u.in.intr) {
   1314       1.4  tshiozak 		for (i=0; i<len; i++) {
   1315  1.25.2.3      chap 			(*jack->u.in.intr)(jack->arg, data[i]);
   1316       1.4  tshiozak 		}
   1317       1.4  tshiozak 	}
   1318       1.1  tshiozak 
   1319       1.1  tshiozak 	(void)start_input_transfer(ep);
   1320       1.1  tshiozak }
   1321       1.1  tshiozak 
   1322       1.1  tshiozak static void
   1323       1.1  tshiozak out_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
   1324       1.1  tshiozak {
   1325       1.1  tshiozak 	struct umidi_endpoint *ep = (struct umidi_endpoint *)priv;
   1326       1.1  tshiozak 	struct umidi_softc *sc = ep->sc;
   1327       1.1  tshiozak 	struct umidi_jack *jack;
   1328       1.1  tshiozak 
   1329       1.3  tshiozak 	if (sc->sc_dying || !ep->num_open)
   1330       1.1  tshiozak 		return;
   1331       1.1  tshiozak 
   1332       1.4  tshiozak 	jack = LIST_FIRST(&ep->queue_head);
   1333       1.4  tshiozak 	if (jack && jack->opened) {
   1334       1.4  tshiozak 		LIST_REMOVE(jack, u.out.queue_entry);
   1335       1.4  tshiozak 		if (!LIST_EMPTY(&ep->queue_head)) {
   1336  1.25.2.2      chap 			(UMQ_ISTYPE(sc, UMQ_TYPE_MIDIMAN_GARBLE)
   1337  1.25.2.2      chap 			? midiman_garble
   1338  1.25.2.2      chap 			: memcpy
   1339  1.25.2.2      chap 			)
   1340  1.25.2.2      chap 			(ep->buffer,
   1341       1.4  tshiozak 			       LIST_FIRST(&ep->queue_head)->packet.buffer,
   1342       1.3  tshiozak 			       UMIDI_PACKET_SIZE);
   1343       1.3  tshiozak 			(void)start_output_transfer(ep);
   1344       1.3  tshiozak 		}
   1345       1.4  tshiozak 		if (jack->u.out.intr) {
   1346       1.4  tshiozak 			(*jack->u.out.intr)(jack->arg);
   1347       1.3  tshiozak 		}
   1348       1.1  tshiozak 	}
   1349       1.1  tshiozak }
   1350       1.1  tshiozak 
   1351       1.1  tshiozak static void
   1352       1.1  tshiozak out_build_packet(int cable_number, struct umidi_packet *packet, uByte in)
   1353       1.1  tshiozak {
   1354       1.1  tshiozak 	int cin;
   1355       1.6  tshiozak 	uByte prev;
   1356       1.1  tshiozak 
   1357       1.1  tshiozak retry:
   1358       1.1  tshiozak 	switch (packet->state) {
   1359       1.1  tshiozak 	case PS_END:
   1360       1.1  tshiozak 	case PS_INITIAL:
   1361       1.6  tshiozak 		prev = packet->buffer[1];
   1362       1.1  tshiozak 		memset(packet->buffer, 0, UMIDI_PACKET_SIZE);
   1363       1.1  tshiozak 		if (in<0x80) {
   1364       1.6  tshiozak 			if (prev>=0x80 && prev<0xf0) {
   1365       1.6  tshiozak 				/* running status */
   1366       1.6  tshiozak 				out_build_packet(cable_number, packet, prev);
   1367       1.6  tshiozak 				goto retry;
   1368       1.6  tshiozak 			}
   1369       1.1  tshiozak 			/* ??? */
   1370       1.1  tshiozak 			break;
   1371       1.1  tshiozak 		}
   1372       1.1  tshiozak 		if (in>=0xf0) {
   1373       1.1  tshiozak 			cin=packet_0xFX[in&0x0F].cin;
   1374       1.1  tshiozak 			packet->state=packet_0xFX[in&0x0F].next;
   1375       1.1  tshiozak 		} else {
   1376       1.1  tshiozak 			cin=(unsigned char)in>>4;
   1377       1.1  tshiozak 			switch (packet_length[cin]) {
   1378       1.1  tshiozak 			case 2:
   1379       1.1  tshiozak 				packet->state = PS_NORMAL_1OF2;
   1380       1.1  tshiozak 				break;
   1381       1.1  tshiozak 			case 3:
   1382       1.1  tshiozak 				packet->state = PS_NORMAL_1OF3;
   1383       1.1  tshiozak 				break;
   1384       1.1  tshiozak 			default:
   1385       1.1  tshiozak 				/* ??? */
   1386       1.1  tshiozak 				packet->state = PS_INITIAL;
   1387       1.1  tshiozak 			}
   1388       1.1  tshiozak 		}
   1389       1.1  tshiozak 		packet->buffer[0] = MIX_CN_CIN(cable_number, cin);
   1390       1.1  tshiozak 		packet->buffer[1] = in;
   1391       1.1  tshiozak 		break;
   1392       1.1  tshiozak 	case PS_NORMAL_1OF3:
   1393       1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1394       1.1  tshiozak 		packet->buffer[2] = in;
   1395       1.1  tshiozak 		packet->state = PS_NORMAL_2OF3;
   1396       1.1  tshiozak 		break;
   1397       1.1  tshiozak 	case PS_NORMAL_2OF3:
   1398       1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1399       1.1  tshiozak 		packet->buffer[3] = in;
   1400       1.1  tshiozak 		packet->state = PS_END;
   1401       1.1  tshiozak 		break;
   1402       1.1  tshiozak 	case PS_NORMAL_1OF2:
   1403       1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1404       1.1  tshiozak 		packet->buffer[2] = in;
   1405       1.1  tshiozak 		packet->state = PS_END;
   1406       1.1  tshiozak 		break;
   1407       1.1  tshiozak 	case PS_EXCL_0:
   1408       1.1  tshiozak 		memset(packet->buffer, 0, UMIDI_PACKET_SIZE);
   1409       1.1  tshiozak 		if (in==0xF7) {
   1410       1.1  tshiozak 			packet->buffer[0] = MIX_CN_CIN(cable_number, 0x05);
   1411       1.1  tshiozak 			packet->buffer[1] = 0xF7;
   1412       1.1  tshiozak 			packet->state = PS_END;
   1413       1.1  tshiozak 			break;
   1414       1.1  tshiozak 		}
   1415       1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1416       1.1  tshiozak 		packet->buffer[1] = in;
   1417       1.1  tshiozak 		packet->state = PS_EXCL_1;
   1418       1.1  tshiozak 		break;
   1419       1.1  tshiozak 	case PS_EXCL_1:
   1420       1.1  tshiozak 		if (in==0xF7) {
   1421       1.1  tshiozak 			packet->buffer[0] = MIX_CN_CIN(cable_number, 0x06);
   1422       1.1  tshiozak 			packet->buffer[2] = 0xF7;
   1423       1.1  tshiozak 			packet->state = PS_END;
   1424       1.1  tshiozak 			break;
   1425       1.1  tshiozak 		}
   1426       1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1427       1.1  tshiozak 		packet->buffer[2] = in;
   1428       1.1  tshiozak 		packet->state = PS_EXCL_2;
   1429       1.1  tshiozak 		break;
   1430       1.1  tshiozak 	case PS_EXCL_2:
   1431       1.1  tshiozak 		if (in==0xF7) {
   1432       1.1  tshiozak 			packet->buffer[0] = MIX_CN_CIN(cable_number, 0x07);
   1433       1.1  tshiozak 			packet->buffer[3] = 0xF7;
   1434       1.1  tshiozak 			packet->state = PS_END;
   1435       1.1  tshiozak 			break;
   1436       1.1  tshiozak 		}
   1437       1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1438       1.2  tshiozak 		packet->buffer[0] = MIX_CN_CIN(cable_number, 0x04);
   1439       1.1  tshiozak 		packet->buffer[3] = in;
   1440       1.1  tshiozak 		packet->state = PS_EXCL_0;
   1441       1.1  tshiozak 		break;
   1442       1.1  tshiozak 	default:
   1443       1.1  tshiozak 		printf("umidi: ambiguous state.\n");
   1444       1.1  tshiozak 		packet->state = PS_INITIAL;
   1445       1.1  tshiozak 		goto retry;
   1446       1.1  tshiozak 	}
   1447       1.1  tshiozak }
   1448       1.4  tshiozak 
   1449