Home | History | Annotate | Line # | Download | only in usb
umidi.c revision 1.25
      1  1.25  christos /*	$NetBSD: umidi.c,v 1.25 2006/04/14 22:25:42 christos 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  christos __KERNEL_RCSID(0, "$NetBSD: umidi.c,v 1.25 2006/04/14 22:25:42 christos 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.22      yamt const 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.23  augustss 	char *devinfop;
    168   1.1  tshiozak 
    169   1.1  tshiozak 	DPRINTFN(1,("umidi_attach\n"));
    170   1.1  tshiozak 
    171  1.23  augustss 	devinfop = usbd_devinfo_alloc(uaa->device, 0);
    172  1.23  augustss 	printf("\n%s: %s\n", USBDEVNAME(sc->sc_dev), devinfop);
    173  1.23  augustss 	usbd_devinfo_free(devinfop);
    174   1.1  tshiozak 
    175   1.1  tshiozak 	sc->sc_iface = uaa->iface;
    176   1.1  tshiozak 	sc->sc_udev = uaa->device;
    177   1.1  tshiozak 
    178   1.1  tshiozak 	sc->sc_quirk =
    179   1.1  tshiozak 	    umidi_search_quirk(uaa->vendor, uaa->product, uaa->ifaceno);
    180   1.1  tshiozak 	printf("%s: ", USBDEVNAME(sc->sc_dev));
    181   1.1  tshiozak 	umidi_print_quirk(sc->sc_quirk);
    182   1.1  tshiozak 
    183   1.1  tshiozak 
    184   1.1  tshiozak 	err = alloc_all_endpoints(sc);
    185   1.1  tshiozak 	if (err!=USBD_NORMAL_COMPLETION) {
    186   1.1  tshiozak 		printf("%s: alloc_all_endpoints failed. (err=%d)\n",
    187   1.1  tshiozak 		       USBDEVNAME(sc->sc_dev), err);
    188   1.1  tshiozak 		goto error;
    189   1.1  tshiozak 	}
    190   1.1  tshiozak 	err = alloc_all_jacks(sc);
    191   1.1  tshiozak 	if (err!=USBD_NORMAL_COMPLETION) {
    192   1.1  tshiozak 		free_all_endpoints(sc);
    193   1.1  tshiozak 		printf("%s: alloc_all_jacks failed. (err=%d)\n",
    194   1.1  tshiozak 		       USBDEVNAME(sc->sc_dev), err);
    195   1.1  tshiozak 		goto error;
    196   1.1  tshiozak 	}
    197   1.1  tshiozak 	printf("%s: out=%d, in=%d\n",
    198   1.1  tshiozak 	       USBDEVNAME(sc->sc_dev),
    199   1.1  tshiozak 	       sc->sc_out_num_jacks, sc->sc_in_num_jacks);
    200   1.1  tshiozak 
    201   1.1  tshiozak 	err = assign_all_jacks_automatically(sc);
    202   1.1  tshiozak 	if (err!=USBD_NORMAL_COMPLETION) {
    203   1.1  tshiozak 		unbind_all_jacks(sc);
    204   1.1  tshiozak 		free_all_jacks(sc);
    205   1.1  tshiozak 		free_all_endpoints(sc);
    206   1.1  tshiozak 		printf("%s: assign_all_jacks_automatically failed. (err=%d)\n",
    207   1.1  tshiozak 		       USBDEVNAME(sc->sc_dev), err);
    208   1.1  tshiozak 		goto error;
    209   1.1  tshiozak 	}
    210   1.1  tshiozak 	err = attach_all_mididevs(sc);
    211   1.1  tshiozak 	if (err!=USBD_NORMAL_COMPLETION) {
    212   1.1  tshiozak 		free_all_jacks(sc);
    213   1.1  tshiozak 		free_all_endpoints(sc);
    214   1.1  tshiozak 		printf("%s: attach_all_mididevs failed. (err=%d)\n",
    215   1.1  tshiozak 		       USBDEVNAME(sc->sc_dev), err);
    216   1.1  tshiozak 	}
    217   1.1  tshiozak 
    218   1.1  tshiozak #ifdef UMIDI_DEBUG
    219   1.1  tshiozak 	dump_sc(sc);
    220   1.1  tshiozak #endif
    221   1.1  tshiozak 
    222   1.1  tshiozak 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH,
    223   1.1  tshiozak 			   sc->sc_udev, USBDEV(sc->sc_dev));
    224  1.16  augustss 
    225   1.1  tshiozak 	USB_ATTACH_SUCCESS_RETURN;
    226   1.1  tshiozak error:
    227   1.1  tshiozak 	printf("%s: disabled.\n", USBDEVNAME(sc->sc_dev));
    228   1.1  tshiozak 	sc->sc_dying = 1;
    229   1.1  tshiozak 	USB_ATTACH_ERROR_RETURN;
    230   1.1  tshiozak }
    231   1.1  tshiozak 
    232   1.1  tshiozak int
    233   1.1  tshiozak umidi_activate(device_ptr_t self, enum devact act)
    234   1.1  tshiozak {
    235   1.3  tshiozak 	struct umidi_softc *sc = (struct umidi_softc *)self;
    236   1.1  tshiozak 
    237   1.1  tshiozak 	switch (act) {
    238   1.1  tshiozak 	case DVACT_ACTIVATE:
    239   1.1  tshiozak 		DPRINTFN(1,("umidi_activate (activate)\n"));
    240   1.1  tshiozak 
    241   1.1  tshiozak 		return EOPNOTSUPP;
    242   1.1  tshiozak 		break;
    243   1.1  tshiozak 	case DVACT_DEACTIVATE:
    244   1.1  tshiozak 		DPRINTFN(1,("umidi_activate (deactivate)\n"));
    245   1.1  tshiozak 		sc->sc_dying = 1;
    246   1.1  tshiozak 		deactivate_all_mididevs(sc);
    247   1.1  tshiozak 		break;
    248   1.1  tshiozak 	}
    249   1.1  tshiozak 	return 0;
    250   1.1  tshiozak }
    251   1.1  tshiozak 
    252   1.1  tshiozak USB_DETACH(umidi)
    253   1.1  tshiozak {
    254   1.3  tshiozak 	USB_DETACH_START(umidi, sc);
    255   1.1  tshiozak 
    256   1.1  tshiozak 	DPRINTFN(1,("umidi_detach\n"));
    257   1.1  tshiozak 
    258   1.1  tshiozak 	sc->sc_dying = 1;
    259   1.1  tshiozak 	detach_all_mididevs(sc, flags);
    260   1.1  tshiozak 	free_all_mididevs(sc);
    261   1.1  tshiozak 	free_all_jacks(sc);
    262   1.1  tshiozak 	free_all_endpoints(sc);
    263   1.1  tshiozak 
    264   1.3  tshiozak 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
    265   1.3  tshiozak 			   USBDEV(sc->sc_dev));
    266   1.1  tshiozak 
    267   1.1  tshiozak 	return 0;
    268   1.1  tshiozak }
    269   1.1  tshiozak 
    270   1.1  tshiozak 
    271   1.4  tshiozak /*
    272   1.4  tshiozak  * midi_if stuffs
    273   1.4  tshiozak  */
    274   1.1  tshiozak int
    275   1.1  tshiozak umidi_open(void *addr,
    276   1.1  tshiozak 	   int flags,
    277  1.12  augustss 	   void (*iintr)(void *, int),
    278  1.12  augustss 	   void (*ointr)(void *),
    279   1.1  tshiozak 	   void *arg)
    280   1.1  tshiozak {
    281   1.3  tshiozak 	struct umidi_mididev *mididev = addr;
    282   1.3  tshiozak 	struct umidi_softc *sc = mididev->sc;
    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.1  tshiozak 	if ((mididev->flags & FWRITE) && mididev->out_jack)
    296   1.4  tshiozak 		open_out_jack(mididev->out_jack, arg, ointr);
    297   1.3  tshiozak 	if ((mididev->flags & FREAD) && mididev->in_jack) {
    298   1.4  tshiozak 		open_in_jack(mididev->in_jack, arg, iintr);
    299   1.3  tshiozak 	}
    300   1.1  tshiozak 
    301   1.1  tshiozak 	return 0;
    302   1.1  tshiozak }
    303   1.1  tshiozak 
    304   1.1  tshiozak void
    305   1.1  tshiozak umidi_close(void *addr)
    306   1.1  tshiozak {
    307   1.1  tshiozak 	int s;
    308   1.3  tshiozak 	struct umidi_mididev *mididev = addr;
    309   1.1  tshiozak 
    310   1.1  tshiozak 	s = splusb();
    311   1.1  tshiozak 	if ((mididev->flags & FWRITE) && mididev->out_jack)
    312   1.4  tshiozak 		close_out_jack(mididev->out_jack);
    313   1.1  tshiozak 	if ((mididev->flags & FREAD) && mididev->in_jack)
    314   1.4  tshiozak 		close_in_jack(mididev->in_jack);
    315   1.1  tshiozak 	mididev->opened = 0;
    316   1.1  tshiozak 	splx(s);
    317   1.1  tshiozak }
    318   1.1  tshiozak 
    319   1.1  tshiozak int
    320   1.1  tshiozak umidi_output(void *addr, int d)
    321   1.1  tshiozak {
    322   1.3  tshiozak 	struct umidi_mididev *mididev = addr;
    323   1.1  tshiozak 
    324   1.4  tshiozak 	if (!mididev->out_jack || !mididev->opened)
    325   1.1  tshiozak 		return EIO;
    326   1.1  tshiozak 
    327   1.4  tshiozak 	return out_jack_output(mididev->out_jack, d);
    328   1.1  tshiozak }
    329   1.1  tshiozak 
    330   1.1  tshiozak void
    331   1.1  tshiozak umidi_getinfo(void *addr, struct midi_info *mi)
    332   1.1  tshiozak {
    333   1.3  tshiozak 	struct umidi_mididev *mididev = addr;
    334   1.3  tshiozak /*	struct umidi_softc *sc = mididev->sc; */
    335   1.1  tshiozak 
    336   1.3  tshiozak 	mi->name = "USB MIDI I/F"; /* XXX: model name */
    337   1.3  tshiozak 	mi->props = MIDI_PROP_OUT_INTR;
    338   1.1  tshiozak 	if (mididev->in_jack)
    339   1.1  tshiozak 		mi->props |= MIDI_PROP_CAN_INPUT;
    340   1.1  tshiozak }
    341   1.1  tshiozak 
    342   1.1  tshiozak 
    343   1.4  tshiozak /*
    344   1.4  tshiozak  * each endpoint stuffs
    345   1.4  tshiozak  */
    346   1.1  tshiozak 
    347   1.3  tshiozak /* alloc/free pipe */
    348   1.1  tshiozak static usbd_status
    349   1.3  tshiozak alloc_pipe(struct umidi_endpoint *ep)
    350   1.1  tshiozak {
    351   1.1  tshiozak 	struct umidi_softc *sc = ep->sc;
    352   1.1  tshiozak 	usbd_status err;
    353   1.1  tshiozak 
    354   1.3  tshiozak 	DPRINTF(("%s: alloc_pipe %p\n", USBDEVNAME(sc->sc_dev), ep));
    355   1.4  tshiozak 	LIST_INIT(&ep->queue_head);
    356   1.3  tshiozak 	ep->xfer = usbd_alloc_xfer(sc->sc_udev);
    357  1.11  augustss 	if (ep->xfer == NULL) {
    358   1.3  tshiozak 	    err = USBD_NOMEM;
    359   1.3  tshiozak 	    goto quit;
    360   1.3  tshiozak 	}
    361   1.3  tshiozak 	ep->buffer = usbd_alloc_buffer(ep->xfer, UMIDI_PACKET_SIZE);
    362  1.11  augustss 	if (ep->buffer == NULL) {
    363   1.3  tshiozak 	    usbd_free_xfer(ep->xfer);
    364   1.3  tshiozak 	    err = USBD_NOMEM;
    365   1.3  tshiozak 	    goto quit;
    366   1.3  tshiozak 	}
    367   1.3  tshiozak 	err = usbd_open_pipe(sc->sc_iface, ep->addr, 0, &ep->pipe);
    368   1.3  tshiozak 	if (err)
    369   1.3  tshiozak 	    usbd_free_xfer(ep->xfer);
    370   1.1  tshiozak quit:
    371   1.1  tshiozak 	return err;
    372   1.1  tshiozak }
    373   1.1  tshiozak 
    374   1.1  tshiozak static void
    375   1.3  tshiozak free_pipe(struct umidi_endpoint *ep)
    376   1.1  tshiozak {
    377   1.3  tshiozak 	DPRINTF(("%s: free_pipe %p\n", USBDEVNAME(ep->sc->sc_dev), ep));
    378   1.3  tshiozak 	usbd_abort_pipe(ep->pipe);
    379   1.3  tshiozak 	usbd_close_pipe(ep->pipe);
    380   1.3  tshiozak 	usbd_free_xfer(ep->xfer);
    381   1.1  tshiozak }
    382   1.1  tshiozak 
    383   1.1  tshiozak 
    384   1.1  tshiozak /* alloc/free the array of endpoint structures */
    385   1.1  tshiozak 
    386   1.1  tshiozak static usbd_status alloc_all_endpoints_fixed_ep(struct umidi_softc *);
    387   1.1  tshiozak static usbd_status alloc_all_endpoints_yamaha(struct umidi_softc *);
    388   1.1  tshiozak static usbd_status alloc_all_endpoints_genuine(struct umidi_softc *);
    389   1.1  tshiozak 
    390   1.1  tshiozak static usbd_status
    391   1.1  tshiozak alloc_all_endpoints(struct umidi_softc *sc)
    392   1.1  tshiozak {
    393   1.3  tshiozak 	usbd_status err;
    394   1.3  tshiozak 	struct umidi_endpoint *ep;
    395   1.3  tshiozak 	int i;
    396   1.9  tshiozak 
    397   1.3  tshiozak 	if (UMQ_ISTYPE(sc, UMQ_TYPE_FIXED_EP)) {
    398   1.3  tshiozak 		err = alloc_all_endpoints_fixed_ep(sc);
    399   1.3  tshiozak 	} else if (UMQ_ISTYPE(sc, UMQ_TYPE_YAMAHA)) {
    400   1.3  tshiozak 		err = alloc_all_endpoints_yamaha(sc);
    401   1.1  tshiozak 	} else {
    402   1.3  tshiozak 		err = alloc_all_endpoints_genuine(sc);
    403   1.1  tshiozak 	}
    404   1.3  tshiozak 	if (err!=USBD_NORMAL_COMPLETION)
    405   1.3  tshiozak 		return err;
    406   1.3  tshiozak 
    407   1.3  tshiozak 	ep = sc->sc_endpoints;
    408   1.8  tshiozak 	for (i=sc->sc_out_num_endpoints+sc->sc_in_num_endpoints; i>0; i--) {
    409   1.3  tshiozak 		err = alloc_pipe(ep++);
    410   1.3  tshiozak 		if (err!=USBD_NORMAL_COMPLETION) {
    411   1.3  tshiozak 			for (; ep!=sc->sc_endpoints; ep--)
    412   1.3  tshiozak 				free_pipe(ep-1);
    413   1.3  tshiozak 			free(sc->sc_endpoints, M_USBDEV);
    414   1.3  tshiozak 			sc->sc_endpoints = sc->sc_out_ep = sc->sc_in_ep = NULL;
    415   1.3  tshiozak 			break;
    416   1.3  tshiozak 		}
    417   1.3  tshiozak 	}
    418   1.3  tshiozak 	return err;
    419   1.1  tshiozak }
    420   1.1  tshiozak 
    421   1.1  tshiozak static void
    422   1.1  tshiozak free_all_endpoints(struct umidi_softc *sc)
    423   1.1  tshiozak {
    424   1.3  tshiozak 	int i;
    425   1.8  tshiozak 	for (i=0; i<sc->sc_in_num_endpoints+sc->sc_out_num_endpoints; i++)
    426   1.3  tshiozak 	    free_pipe(&sc->sc_endpoints[i]);
    427  1.14      kent 	if (sc->sc_endpoints != NULL)
    428  1.14      kent 		free(sc->sc_endpoints, M_USBDEV);
    429   1.1  tshiozak 	sc->sc_endpoints = sc->sc_out_ep = sc->sc_in_ep = NULL;
    430   1.1  tshiozak }
    431   1.1  tshiozak 
    432   1.1  tshiozak static usbd_status
    433   1.1  tshiozak alloc_all_endpoints_fixed_ep(struct umidi_softc *sc)
    434   1.1  tshiozak {
    435   1.3  tshiozak 	usbd_status err;
    436   1.1  tshiozak 	struct umq_fixed_ep_desc *fp;
    437   1.3  tshiozak 	struct umidi_endpoint *ep;
    438   1.1  tshiozak 	usb_endpoint_descriptor_t *epd;
    439   1.1  tshiozak 	int i;
    440   1.1  tshiozak 
    441   1.1  tshiozak 	fp = umidi_get_quirk_data_from_type(sc->sc_quirk,
    442   1.1  tshiozak 					    UMQ_TYPE_FIXED_EP);
    443   1.1  tshiozak 	sc->sc_out_num_jacks = 0;
    444   1.1  tshiozak 	sc->sc_in_num_jacks = 0;
    445   1.1  tshiozak 	sc->sc_out_num_endpoints = fp->num_out_ep;
    446   1.1  tshiozak 	sc->sc_in_num_endpoints = fp->num_in_ep;
    447   1.1  tshiozak 	sc->sc_endpoints = malloc(sizeof(*sc->sc_out_ep)*
    448   1.1  tshiozak 				  (sc->sc_out_num_endpoints+
    449   1.1  tshiozak 				   sc->sc_in_num_endpoints),
    450   1.1  tshiozak 				  M_USBDEV, M_WAITOK);
    451   1.1  tshiozak 	if (!sc->sc_endpoints) {
    452   1.1  tshiozak 		return USBD_NOMEM;
    453   1.1  tshiozak 	}
    454   1.1  tshiozak 	sc->sc_out_ep = sc->sc_out_num_endpoints ? sc->sc_endpoints : NULL;
    455   1.1  tshiozak 	sc->sc_in_ep =
    456   1.1  tshiozak 	    sc->sc_in_num_endpoints ?
    457   1.1  tshiozak 		sc->sc_endpoints+sc->sc_out_num_endpoints : NULL;
    458   1.3  tshiozak 
    459   1.3  tshiozak 	ep = &sc->sc_out_ep[0];
    460   1.1  tshiozak 	for (i=0; i<sc->sc_out_num_endpoints; i++) {
    461   1.1  tshiozak 		epd = usbd_interface2endpoint_descriptor(
    462   1.1  tshiozak 			sc->sc_iface,
    463   1.1  tshiozak 			fp->out_ep[i].ep);
    464   1.1  tshiozak 		if (!epd) {
    465   1.1  tshiozak 			printf("%s: cannot get endpoint descriptor(out:%d)\n",
    466   1.1  tshiozak 			       USBDEVNAME(sc->sc_dev), fp->out_ep[i].ep);
    467   1.3  tshiozak 			err = USBD_INVAL;
    468   1.1  tshiozak 			goto error;
    469   1.1  tshiozak 		}
    470   1.1  tshiozak 		if (UE_GET_XFERTYPE(epd->bmAttributes)!=UE_BULK ||
    471   1.1  tshiozak 		    UE_GET_DIR(epd->bEndpointAddress)!=UE_DIR_OUT) {
    472   1.1  tshiozak 			printf("%s: illegal endpoint(out:%d)\n",
    473   1.1  tshiozak 			       USBDEVNAME(sc->sc_dev), fp->out_ep[i].ep);
    474   1.3  tshiozak 			err = USBD_INVAL;
    475   1.1  tshiozak 			goto error;
    476   1.1  tshiozak 		}
    477   1.3  tshiozak 		ep->sc = sc;
    478   1.3  tshiozak 		ep->addr = epd->bEndpointAddress;
    479   1.3  tshiozak 		ep->num_jacks = fp->out_ep[i].num_jacks;
    480   1.1  tshiozak 		sc->sc_out_num_jacks += fp->out_ep[i].num_jacks;
    481   1.3  tshiozak 		ep->num_open = 0;
    482   1.3  tshiozak 		memset(ep->jacks, 0, sizeof(ep->jacks));
    483   1.4  tshiozak 		LIST_INIT(&ep->queue_head);
    484   1.3  tshiozak 		ep++;
    485   1.1  tshiozak 	}
    486   1.3  tshiozak 	ep = &sc->sc_in_ep[0];
    487   1.1  tshiozak 	for (i=0; i<sc->sc_in_num_endpoints; i++) {
    488   1.1  tshiozak 		epd = usbd_interface2endpoint_descriptor(
    489   1.1  tshiozak 			sc->sc_iface,
    490   1.1  tshiozak 			fp->in_ep[i].ep);
    491   1.1  tshiozak 		if (!epd) {
    492   1.1  tshiozak 			printf("%s: cannot get endpoint descriptor(in:%d)\n",
    493   1.1  tshiozak 			       USBDEVNAME(sc->sc_dev), fp->in_ep[i].ep);
    494   1.3  tshiozak 			err = USBD_INVAL;
    495   1.1  tshiozak 			goto error;
    496   1.1  tshiozak 		}
    497   1.1  tshiozak 		if (UE_GET_XFERTYPE(epd->bmAttributes)!=UE_BULK ||
    498   1.1  tshiozak 		    UE_GET_DIR(epd->bEndpointAddress)!=UE_DIR_IN) {
    499   1.1  tshiozak 			printf("%s: illegal endpoint(in:%d)\n",
    500   1.1  tshiozak 			       USBDEVNAME(sc->sc_dev), fp->in_ep[i].ep);
    501   1.3  tshiozak 			err = USBD_INVAL;
    502   1.1  tshiozak 			goto error;
    503   1.1  tshiozak 		}
    504   1.3  tshiozak 		ep->sc = sc;
    505   1.3  tshiozak 		ep->addr = epd->bEndpointAddress;
    506   1.3  tshiozak 		ep->num_jacks = fp->in_ep[i].num_jacks;
    507   1.1  tshiozak 		sc->sc_in_num_jacks += fp->in_ep[i].num_jacks;
    508   1.3  tshiozak 		ep->num_open = 0;
    509   1.3  tshiozak 		memset(ep->jacks, 0, sizeof(ep->jacks));
    510   1.3  tshiozak 		ep++;
    511   1.1  tshiozak 	}
    512   1.1  tshiozak 
    513   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    514   1.1  tshiozak error:
    515   1.1  tshiozak 	free(sc->sc_endpoints, M_USBDEV);
    516   1.1  tshiozak 	sc->sc_endpoints = NULL;
    517   1.3  tshiozak 	return err;
    518   1.1  tshiozak }
    519   1.1  tshiozak 
    520   1.1  tshiozak static usbd_status
    521   1.1  tshiozak alloc_all_endpoints_yamaha(struct umidi_softc *sc)
    522   1.1  tshiozak {
    523   1.1  tshiozak 	/* This driver currently supports max 1in/1out bulk endpoints */
    524   1.1  tshiozak 	usb_descriptor_t *desc;
    525   1.8  tshiozak 	usb_endpoint_descriptor_t *epd;
    526   1.8  tshiozak 	int out_addr, in_addr, i;
    527   1.8  tshiozak 	int dir;
    528   1.1  tshiozak 	size_t remain, descsize;
    529   1.1  tshiozak 
    530   1.8  tshiozak 	sc->sc_out_num_jacks = sc->sc_in_num_jacks = 0;
    531   1.8  tshiozak 	out_addr = in_addr = 0;
    532   1.8  tshiozak 
    533   1.8  tshiozak 	/* detect endpoints */
    534   1.1  tshiozak 	desc = TO_D(usbd_get_interface_descriptor(sc->sc_iface));
    535   1.8  tshiozak 	for (i=(int)TO_IFD(desc)->bNumEndpoints-1; i>=0; i--) {
    536   1.8  tshiozak 		epd = usbd_interface2endpoint_descriptor(sc->sc_iface, i);
    537  1.25  christos 		KASSERT(epd != NULL);
    538   1.8  tshiozak 		if (UE_GET_XFERTYPE(epd->bmAttributes) == UE_BULK) {
    539   1.8  tshiozak 			dir = UE_GET_DIR(epd->bEndpointAddress);
    540   1.8  tshiozak 			if (dir==UE_DIR_OUT && !out_addr)
    541   1.8  tshiozak 				out_addr = epd->bEndpointAddress;
    542   1.8  tshiozak 			else if (dir==UE_DIR_IN && !in_addr)
    543   1.8  tshiozak 				in_addr = epd->bEndpointAddress;
    544   1.8  tshiozak 		}
    545   1.8  tshiozak 	}
    546   1.3  tshiozak 	desc = NEXT_D(desc);
    547   1.1  tshiozak 
    548   1.8  tshiozak 	/* count jacks */
    549   1.8  tshiozak 	if (!(desc->bDescriptorType==UDESC_CS_INTERFACE &&
    550   1.8  tshiozak 	      desc->bDescriptorSubtype==UMIDI_MS_HEADER))
    551   1.8  tshiozak 		return USBD_INVAL;
    552   1.8  tshiozak 	remain = (size_t)UGETW(TO_CSIFD(desc)->wTotalLength) -
    553   1.8  tshiozak 		(size_t)desc->bLength;
    554   1.8  tshiozak 	desc = NEXT_D(desc);
    555   1.1  tshiozak 
    556   1.1  tshiozak 	while (remain>=sizeof(usb_descriptor_t)) {
    557   1.1  tshiozak 		descsize = desc->bLength;
    558   1.1  tshiozak 		if (descsize>remain || descsize==0)
    559   1.1  tshiozak 			break;
    560   1.1  tshiozak 		if (desc->bDescriptorType==UDESC_CS_INTERFACE &&
    561   1.1  tshiozak 		    remain>=UMIDI_JACK_DESCRIPTOR_SIZE) {
    562   1.1  tshiozak 			if (desc->bDescriptorSubtype==UMIDI_OUT_JACK)
    563   1.1  tshiozak 				sc->sc_out_num_jacks++;
    564   1.1  tshiozak 			else if (desc->bDescriptorSubtype==UMIDI_IN_JACK)
    565   1.1  tshiozak 				sc->sc_in_num_jacks++;
    566   1.1  tshiozak 		}
    567   1.1  tshiozak 		desc = NEXT_D(desc);
    568   1.1  tshiozak 		remain-=descsize;
    569   1.1  tshiozak 	}
    570   1.1  tshiozak 
    571   1.8  tshiozak 	/* validate some parameters */
    572   1.1  tshiozak 	if (sc->sc_out_num_jacks>UMIDI_MAX_EPJACKS)
    573   1.1  tshiozak 		sc->sc_out_num_jacks = UMIDI_MAX_EPJACKS;
    574   1.1  tshiozak 	if (sc->sc_in_num_jacks>UMIDI_MAX_EPJACKS)
    575   1.1  tshiozak 		sc->sc_in_num_jacks = UMIDI_MAX_EPJACKS;
    576   1.8  tshiozak 	if (sc->sc_out_num_jacks && out_addr) {
    577   1.1  tshiozak 		sc->sc_out_num_endpoints = 1;
    578   1.1  tshiozak 	} else {
    579   1.1  tshiozak 		sc->sc_out_num_endpoints = 0;
    580   1.1  tshiozak 		sc->sc_out_num_jacks = 0;
    581   1.1  tshiozak 	}
    582   1.8  tshiozak 	if (sc->sc_in_num_jacks && in_addr) {
    583   1.1  tshiozak 		sc->sc_in_num_endpoints = 1;
    584   1.1  tshiozak 	} else {
    585   1.1  tshiozak 		sc->sc_in_num_endpoints = 0;
    586   1.1  tshiozak 		sc->sc_in_num_jacks = 0;
    587   1.1  tshiozak 	}
    588   1.1  tshiozak 	sc->sc_endpoints = malloc(sizeof(struct umidi_endpoint)*
    589   1.1  tshiozak 				  (sc->sc_out_num_endpoints+
    590   1.1  tshiozak 				   sc->sc_in_num_endpoints),
    591   1.1  tshiozak 				  M_USBDEV, M_WAITOK);
    592   1.1  tshiozak 	if (!sc->sc_endpoints)
    593   1.1  tshiozak 		return USBD_NOMEM;
    594   1.1  tshiozak 	if (sc->sc_out_num_endpoints) {
    595   1.1  tshiozak 		sc->sc_out_ep = sc->sc_endpoints;
    596   1.1  tshiozak 		sc->sc_out_ep->sc = sc;
    597   1.1  tshiozak 		sc->sc_out_ep->addr = out_addr;
    598   1.1  tshiozak 		sc->sc_out_ep->num_jacks = sc->sc_out_num_jacks;
    599   1.1  tshiozak 		sc->sc_out_ep->num_open = 0;
    600   1.1  tshiozak 		memset(sc->sc_out_ep->jacks, 0, sizeof(sc->sc_out_ep->jacks));
    601   1.1  tshiozak 	} else
    602   1.1  tshiozak 		sc->sc_out_ep = NULL;
    603   1.1  tshiozak 
    604   1.1  tshiozak 	if (sc->sc_in_num_endpoints) {
    605   1.1  tshiozak 		sc->sc_in_ep = sc->sc_endpoints+sc->sc_out_num_endpoints;
    606   1.1  tshiozak 		sc->sc_in_ep->sc = sc;
    607   1.1  tshiozak 		sc->sc_in_ep->addr = in_addr;
    608   1.1  tshiozak 		sc->sc_in_ep->num_jacks = sc->sc_in_num_jacks;
    609   1.1  tshiozak 		sc->sc_in_ep->num_open = 0;
    610   1.1  tshiozak 		memset(sc->sc_in_ep->jacks, 0, sizeof(sc->sc_in_ep->jacks));
    611   1.1  tshiozak 	} else
    612   1.1  tshiozak 		sc->sc_in_ep = NULL;
    613   1.1  tshiozak 
    614   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    615   1.1  tshiozak }
    616   1.1  tshiozak 
    617   1.1  tshiozak static usbd_status
    618   1.1  tshiozak alloc_all_endpoints_genuine(struct umidi_softc *sc)
    619   1.1  tshiozak {
    620  1.20      gson 	usb_interface_descriptor_t *interface_desc;
    621  1.20      gson 	usb_config_descriptor_t *config_desc;
    622   1.1  tshiozak 	usb_descriptor_t *desc;
    623   1.7  tshiozak 	int num_ep;
    624   1.1  tshiozak 	size_t remain, descsize;
    625   1.1  tshiozak 	struct umidi_endpoint *p, *q, *lowest, *endep, tmpep;
    626   1.1  tshiozak 	int epaddr;
    627   1.1  tshiozak 
    628  1.20      gson 	interface_desc = usbd_get_interface_descriptor(sc->sc_iface);
    629  1.20      gson 	num_ep = interface_desc->bNumEndpoints;
    630  1.20      gson 	sc->sc_endpoints = p = malloc(sizeof(struct umidi_endpoint) * num_ep,
    631   1.1  tshiozak 				      M_USBDEV, M_WAITOK);
    632   1.1  tshiozak 	if (!p)
    633   1.1  tshiozak 		return USBD_NOMEM;
    634   1.1  tshiozak 
    635   1.1  tshiozak 	sc->sc_out_num_jacks = sc->sc_in_num_jacks = 0;
    636   1.1  tshiozak 	sc->sc_out_num_endpoints = sc->sc_in_num_endpoints = 0;
    637   1.1  tshiozak 	epaddr = -1;
    638   1.1  tshiozak 
    639   1.1  tshiozak 	/* get the list of endpoints for midi stream */
    640  1.20      gson 	config_desc = usbd_get_config_descriptor(sc->sc_udev);
    641  1.20      gson 	desc = (usb_descriptor_t *) config_desc;
    642  1.20      gson 	remain = (size_t)UGETW(config_desc->wTotalLength);
    643   1.1  tshiozak 	while (remain>=sizeof(usb_descriptor_t)) {
    644   1.1  tshiozak 		descsize = desc->bLength;
    645   1.1  tshiozak 		if (descsize>remain || descsize==0)
    646   1.1  tshiozak 			break;
    647   1.1  tshiozak 		if (desc->bDescriptorType==UDESC_ENDPOINT &&
    648   1.1  tshiozak 		    remain>=USB_ENDPOINT_DESCRIPTOR_SIZE &&
    649   1.1  tshiozak 		    UE_GET_XFERTYPE(TO_EPD(desc)->bmAttributes) == UE_BULK) {
    650   1.1  tshiozak 			epaddr = TO_EPD(desc)->bEndpointAddress;
    651   1.1  tshiozak 		} else if (desc->bDescriptorType==UDESC_CS_ENDPOINT &&
    652   1.1  tshiozak 			   remain>=UMIDI_CS_ENDPOINT_DESCRIPTOR_SIZE &&
    653   1.1  tshiozak 			   epaddr!=-1) {
    654   1.1  tshiozak 			if (num_ep>0) {
    655   1.9  tshiozak 				num_ep--;
    656   1.1  tshiozak 				p->sc = sc;
    657   1.1  tshiozak 				p->addr = epaddr;
    658   1.1  tshiozak 				p->num_jacks = TO_CSEPD(desc)->bNumEmbMIDIJack;
    659   1.1  tshiozak 				if (UE_GET_DIR(epaddr)==UE_DIR_OUT) {
    660   1.1  tshiozak 					sc->sc_out_num_endpoints++;
    661   1.1  tshiozak 					sc->sc_out_num_jacks += p->num_jacks;
    662   1.1  tshiozak 				} else {
    663   1.1  tshiozak 					sc->sc_in_num_endpoints++;
    664   1.1  tshiozak 					sc->sc_in_num_jacks += p->num_jacks;
    665   1.1  tshiozak 				}
    666   1.1  tshiozak 				p++;
    667   1.1  tshiozak 			}
    668   1.1  tshiozak 		} else
    669   1.1  tshiozak 			epaddr = -1;
    670   1.1  tshiozak 		desc = NEXT_D(desc);
    671   1.1  tshiozak 		remain-=descsize;
    672   1.1  tshiozak 	}
    673   1.1  tshiozak 
    674   1.1  tshiozak 	/* sort endpoints */
    675   1.1  tshiozak 	num_ep = sc->sc_out_num_endpoints + sc->sc_in_num_endpoints;
    676   1.1  tshiozak 	p = sc->sc_endpoints;
    677   1.1  tshiozak 	endep = p + num_ep;
    678   1.1  tshiozak 	while (p<endep) {
    679   1.1  tshiozak 		lowest = p;
    680   1.1  tshiozak 		for (q=p+1; q<endep; q++) {
    681   1.1  tshiozak 			if ((UE_GET_DIR(lowest->addr)==UE_DIR_IN &&
    682   1.1  tshiozak 			     UE_GET_DIR(q->addr)==UE_DIR_OUT) ||
    683   1.1  tshiozak 			    ((UE_GET_DIR(lowest->addr)==
    684   1.1  tshiozak 			      UE_GET_DIR(q->addr)) &&
    685   1.1  tshiozak 			     (UE_GET_ADDR(lowest->addr)>
    686   1.1  tshiozak 			      UE_GET_ADDR(q->addr))))
    687   1.1  tshiozak 				lowest = q;
    688   1.1  tshiozak 		}
    689   1.1  tshiozak 		if (lowest != p) {
    690   1.1  tshiozak 			memcpy((void *)&tmpep, (void *)p, sizeof(tmpep));
    691   1.1  tshiozak 			memcpy((void *)p, (void *)lowest, sizeof(tmpep));
    692   1.1  tshiozak 			memcpy((void *)lowest, (void *)&tmpep, sizeof(tmpep));
    693   1.1  tshiozak 		}
    694   1.7  tshiozak 		p->num_open = 0;
    695   1.7  tshiozak 		p++;
    696   1.1  tshiozak 	}
    697  1.16  augustss 
    698   1.1  tshiozak 	sc->sc_out_ep = sc->sc_out_num_endpoints ? sc->sc_endpoints : NULL;
    699   1.1  tshiozak 	sc->sc_in_ep =
    700   1.1  tshiozak 	    sc->sc_in_num_endpoints ?
    701   1.1  tshiozak 		sc->sc_endpoints+sc->sc_out_num_endpoints : NULL;
    702   1.1  tshiozak 
    703   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    704   1.1  tshiozak }
    705   1.1  tshiozak 
    706   1.1  tshiozak 
    707   1.4  tshiozak /*
    708   1.4  tshiozak  * jack stuffs
    709   1.4  tshiozak  */
    710   1.4  tshiozak 
    711   1.1  tshiozak static usbd_status
    712   1.1  tshiozak alloc_all_jacks(struct umidi_softc *sc)
    713   1.1  tshiozak {
    714   1.1  tshiozak 	int i, j;
    715   1.1  tshiozak 	struct umidi_endpoint *ep;
    716   1.1  tshiozak 	struct umidi_jack *jack, **rjack;
    717   1.1  tshiozak 
    718   1.1  tshiozak 	/* allocate/initialize structures */
    719   1.1  tshiozak 	sc->sc_jacks =
    720   1.1  tshiozak 	    malloc(sizeof(*sc->sc_out_jacks)*(sc->sc_in_num_jacks+
    721   1.1  tshiozak 					      sc->sc_out_num_jacks),
    722   1.1  tshiozak 		   M_USBDEV, M_WAITOK);
    723   1.1  tshiozak 	if (!sc->sc_jacks)
    724   1.1  tshiozak 		return USBD_NOMEM;
    725   1.1  tshiozak 	sc->sc_out_jacks =
    726   1.1  tshiozak 	    sc->sc_out_num_jacks ? sc->sc_jacks : NULL;
    727   1.1  tshiozak 	sc->sc_in_jacks =
    728   1.1  tshiozak 	    sc->sc_in_num_jacks ? sc->sc_jacks+sc->sc_out_num_jacks : NULL;
    729   1.1  tshiozak 
    730   1.1  tshiozak 	jack = &sc->sc_out_jacks[0];
    731   1.1  tshiozak 	for (i=0; i<sc->sc_out_num_jacks; i++) {
    732   1.4  tshiozak 		jack->opened = 0;
    733   1.4  tshiozak 		jack->binded = 0;
    734   1.4  tshiozak 		jack->arg = NULL;
    735   1.4  tshiozak 		jack->u.out.intr = NULL;
    736   1.1  tshiozak 		jack->cable_number = i;
    737   1.1  tshiozak 		jack++;
    738   1.1  tshiozak 	}
    739   1.1  tshiozak 	jack = &sc->sc_in_jacks[0];
    740   1.1  tshiozak 	for (i=0; i<sc->sc_in_num_jacks; i++) {
    741   1.4  tshiozak 		jack->opened = 0;
    742   1.4  tshiozak 		jack->binded = 0;
    743   1.4  tshiozak 		jack->arg = NULL;
    744   1.4  tshiozak 		jack->u.in.intr = NULL;
    745   1.1  tshiozak 		jack->cable_number = i;
    746   1.1  tshiozak 		jack++;
    747   1.1  tshiozak 	}
    748   1.1  tshiozak 
    749   1.1  tshiozak 	/* assign each jacks to each endpoints */
    750   1.1  tshiozak 	jack = &sc->sc_out_jacks[0];
    751   1.1  tshiozak 	ep = &sc->sc_out_ep[0];
    752   1.1  tshiozak 	for (i=0; i<sc->sc_out_num_endpoints; i++) {
    753   1.1  tshiozak 		rjack = &ep->jacks[0];
    754   1.1  tshiozak 		for (j=0; j<ep->num_jacks; j++) {
    755   1.1  tshiozak 			*rjack = jack;
    756   1.1  tshiozak 			jack->endpoint = ep;
    757   1.1  tshiozak 			jack++;
    758   1.1  tshiozak 			rjack++;
    759   1.1  tshiozak 		}
    760   1.1  tshiozak 		ep++;
    761   1.1  tshiozak 	}
    762   1.1  tshiozak 	jack = &sc->sc_in_jacks[0];
    763   1.1  tshiozak 	ep = &sc->sc_in_ep[0];
    764   1.1  tshiozak 	for (i=0; i<sc->sc_in_num_endpoints; i++) {
    765   1.1  tshiozak 		rjack = &ep->jacks[0];
    766   1.1  tshiozak 		for (j=0; j<ep->num_jacks; j++) {
    767   1.1  tshiozak 			*rjack = jack;
    768   1.1  tshiozak 			jack->endpoint = ep;
    769   1.1  tshiozak 			jack++;
    770   1.1  tshiozak 			rjack++;
    771   1.1  tshiozak 		}
    772   1.1  tshiozak 		ep++;
    773   1.1  tshiozak 	}
    774   1.1  tshiozak 
    775   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    776   1.1  tshiozak }
    777   1.1  tshiozak 
    778   1.1  tshiozak static void
    779   1.1  tshiozak free_all_jacks(struct umidi_softc *sc)
    780   1.1  tshiozak {
    781   1.1  tshiozak 	int s;
    782   1.1  tshiozak 
    783   1.1  tshiozak 	s = splaudio();
    784   1.1  tshiozak 	if (sc->sc_out_jacks) {
    785   1.1  tshiozak 		free(sc->sc_jacks, M_USBDEV);
    786   1.1  tshiozak 		sc->sc_jacks = sc->sc_in_jacks = sc->sc_out_jacks = NULL;
    787   1.1  tshiozak 	}
    788   1.1  tshiozak 	splx(s);
    789   1.1  tshiozak }
    790   1.1  tshiozak 
    791   1.1  tshiozak static usbd_status
    792   1.1  tshiozak bind_jacks_to_mididev(struct umidi_softc *sc,
    793   1.1  tshiozak 		      struct umidi_jack *out_jack,
    794   1.1  tshiozak 		      struct umidi_jack *in_jack,
    795   1.1  tshiozak 		      struct umidi_mididev *mididev)
    796   1.1  tshiozak {
    797   1.8  tshiozak 	if ((out_jack && out_jack->binded) || (in_jack && in_jack->binded))
    798   1.4  tshiozak 		return USBD_IN_USE;
    799   1.4  tshiozak 	if (mididev->out_jack || mididev->in_jack)
    800   1.1  tshiozak 		return USBD_IN_USE;
    801   1.1  tshiozak 
    802   1.4  tshiozak 	if (out_jack)
    803   1.4  tshiozak 		out_jack->binded = 1;
    804   1.4  tshiozak 	if (in_jack)
    805   1.4  tshiozak 		in_jack->binded = 1;
    806   1.1  tshiozak 	mididev->in_jack = in_jack;
    807   1.1  tshiozak 	mididev->out_jack = out_jack;
    808   1.1  tshiozak 
    809   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    810   1.1  tshiozak }
    811   1.1  tshiozak 
    812   1.4  tshiozak static void
    813   1.1  tshiozak unbind_jacks_from_mididev(struct umidi_mididev *mididev)
    814   1.1  tshiozak {
    815  1.15  tshiozak 	if ((mididev->flags & FWRITE) && mididev->out_jack)
    816   1.4  tshiozak 		close_out_jack(mididev->out_jack);
    817  1.15  tshiozak 	if ((mididev->flags & FREAD) && mididev->in_jack)
    818   1.4  tshiozak 		close_in_jack(mididev->in_jack);
    819   1.1  tshiozak 
    820   1.4  tshiozak 	if (mididev->out_jack)
    821   1.4  tshiozak 		mididev->out_jack->binded = 0;
    822   1.4  tshiozak 	if (mididev->in_jack)
    823   1.4  tshiozak 		mididev->in_jack->binded = 0;
    824   1.4  tshiozak 	mididev->out_jack = mididev->in_jack = NULL;
    825   1.1  tshiozak }
    826   1.1  tshiozak 
    827   1.4  tshiozak static void
    828   1.1  tshiozak unbind_all_jacks(struct umidi_softc *sc)
    829   1.1  tshiozak {
    830   1.1  tshiozak 	int i;
    831   1.1  tshiozak 
    832   1.1  tshiozak 	if (sc->sc_mididevs)
    833   1.1  tshiozak 		for (i=0; i<sc->sc_num_mididevs; i++) {
    834   1.4  tshiozak 			unbind_jacks_from_mididev(&sc->sc_mididevs[i]);
    835   1.1  tshiozak 		}
    836   1.1  tshiozak }
    837   1.1  tshiozak 
    838   1.1  tshiozak static usbd_status
    839   1.1  tshiozak assign_all_jacks_automatically(struct umidi_softc *sc)
    840   1.1  tshiozak {
    841   1.1  tshiozak 	usbd_status err;
    842   1.1  tshiozak 	int i;
    843   1.1  tshiozak 	struct umidi_jack *out, *in;
    844   1.1  tshiozak 
    845   1.1  tshiozak 	err =
    846   1.1  tshiozak 	    alloc_all_mididevs(sc,
    847   1.1  tshiozak 			       max(sc->sc_out_num_jacks, sc->sc_in_num_jacks));
    848   1.1  tshiozak 	if (err!=USBD_NORMAL_COMPLETION)
    849   1.1  tshiozak 		return err;
    850   1.1  tshiozak 
    851   1.1  tshiozak 	for (i=0; i<sc->sc_num_mididevs; i++) {
    852   1.1  tshiozak 		out = (i<sc->sc_out_num_jacks) ? &sc->sc_out_jacks[i]:NULL;
    853   1.1  tshiozak 		in = (i<sc->sc_in_num_jacks) ? &sc->sc_in_jacks[i]:NULL;
    854   1.1  tshiozak 		err = bind_jacks_to_mididev(sc, out, in, &sc->sc_mididevs[i]);
    855   1.1  tshiozak 		if (err!=USBD_NORMAL_COMPLETION) {
    856   1.1  tshiozak 			free_all_mididevs(sc);
    857   1.1  tshiozak 			return err;
    858   1.1  tshiozak 		}
    859   1.1  tshiozak 	}
    860   1.1  tshiozak 
    861   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    862   1.1  tshiozak }
    863   1.1  tshiozak 
    864   1.1  tshiozak static usbd_status
    865   1.4  tshiozak open_out_jack(struct umidi_jack *jack, void *arg, void (*intr)(void *))
    866   1.4  tshiozak {
    867   1.4  tshiozak 	struct umidi_endpoint *ep = jack->endpoint;
    868   1.4  tshiozak 
    869   1.4  tshiozak 	if (jack->opened)
    870   1.4  tshiozak 		return USBD_IN_USE;
    871   1.4  tshiozak 
    872   1.4  tshiozak 	jack->arg = arg;
    873   1.4  tshiozak 	jack->u.out.intr = intr;
    874   1.4  tshiozak 	init_packet(&jack->packet);
    875   1.4  tshiozak 	jack->opened = 1;
    876   1.4  tshiozak 	ep->num_open++;
    877   1.4  tshiozak 
    878   1.4  tshiozak 	return USBD_NORMAL_COMPLETION;
    879   1.4  tshiozak }
    880   1.4  tshiozak 
    881   1.4  tshiozak static usbd_status
    882   1.4  tshiozak open_in_jack(struct umidi_jack *jack, void *arg, void (*intr)(void *, int))
    883   1.1  tshiozak {
    884   1.3  tshiozak 	usbd_status err = USBD_NORMAL_COMPLETION;
    885   1.3  tshiozak 	struct umidi_endpoint *ep = jack->endpoint;
    886   1.3  tshiozak 
    887   1.4  tshiozak 	if (jack->opened)
    888   1.4  tshiozak 		return USBD_IN_USE;
    889   1.4  tshiozak 
    890   1.4  tshiozak 	jack->arg = arg;
    891   1.4  tshiozak 	jack->u.in.intr = intr;
    892   1.4  tshiozak 	jack->opened = 1;
    893   1.3  tshiozak 	if (ep->num_open++==0 && UE_GET_DIR(ep->addr)==UE_DIR_IN) {
    894   1.3  tshiozak 		err = start_input_transfer(ep);
    895  1.18      gson 		if (err != USBD_NORMAL_COMPLETION &&
    896  1.18      gson 		    err != USBD_IN_PROGRESS) {
    897   1.3  tshiozak 			ep->num_open--;
    898   1.3  tshiozak 		}
    899   1.3  tshiozak 	}
    900   1.3  tshiozak 
    901   1.3  tshiozak 	return err;
    902   1.1  tshiozak }
    903   1.1  tshiozak 
    904   1.1  tshiozak static void
    905   1.4  tshiozak close_out_jack(struct umidi_jack *jack)
    906   1.1  tshiozak {
    907   1.3  tshiozak 	struct umidi_jack *tail;
    908   1.3  tshiozak 	int s;
    909   1.4  tshiozak 
    910   1.4  tshiozak 	if (jack->opened) {
    911   1.4  tshiozak 		s = splusb();
    912  1.15  tshiozak 		LIST_FOREACH(tail,
    913  1.15  tshiozak 			     &jack->endpoint->queue_head,
    914  1.15  tshiozak 			     u.out.queue_entry)
    915  1.15  tshiozak 			if (tail == jack) {
    916  1.15  tshiozak 				LIST_REMOVE(jack, u.out.queue_entry);
    917  1.15  tshiozak 				break;
    918  1.15  tshiozak 			}
    919  1.15  tshiozak 		if (jack == jack->endpoint->queue_tail) {
    920   1.4  tshiozak 			/* find tail */
    921   1.4  tshiozak 			LIST_FOREACH(tail,
    922   1.4  tshiozak 				     &jack->endpoint->queue_head,
    923   1.4  tshiozak 				     u.out.queue_entry) {
    924   1.4  tshiozak 				if (!LIST_NEXT(tail, u.out.queue_entry)) {
    925   1.4  tshiozak 					jack->endpoint->queue_tail = tail;
    926   1.4  tshiozak 				}
    927   1.3  tshiozak 			}
    928   1.3  tshiozak 		}
    929   1.4  tshiozak 		splx(s);
    930   1.4  tshiozak 		jack->opened = 0;
    931   1.4  tshiozak 		jack->endpoint->num_open--;
    932   1.3  tshiozak 	}
    933   1.1  tshiozak }
    934   1.1  tshiozak 
    935   1.4  tshiozak static void
    936   1.4  tshiozak close_in_jack(struct umidi_jack *jack)
    937   1.4  tshiozak {
    938   1.4  tshiozak 	if (jack->opened) {
    939   1.4  tshiozak 		jack->opened = 0;
    940  1.19      gson 		if (--jack->endpoint->num_open == 0) {
    941  1.19      gson 		    usbd_abort_pipe(jack->endpoint->pipe);
    942  1.19      gson 		}
    943   1.4  tshiozak 	}
    944   1.4  tshiozak }
    945   1.1  tshiozak 
    946   1.1  tshiozak static usbd_status
    947   1.1  tshiozak attach_mididev(struct umidi_softc *sc, struct umidi_mididev *mididev)
    948   1.1  tshiozak {
    949   1.1  tshiozak 	if (mididev->sc)
    950   1.1  tshiozak 		return USBD_IN_USE;
    951   1.1  tshiozak 
    952   1.1  tshiozak 	mididev->sc = sc;
    953   1.1  tshiozak 
    954   1.1  tshiozak 	mididev->mdev = midi_attach_mi(&umidi_hw_if, mididev, &sc->sc_dev);
    955   1.1  tshiozak 
    956   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    957   1.1  tshiozak }
    958   1.1  tshiozak 
    959   1.1  tshiozak static usbd_status
    960   1.1  tshiozak detach_mididev(struct umidi_mididev *mididev, int flags)
    961   1.1  tshiozak {
    962   1.1  tshiozak 	if (!mididev->sc)
    963   1.1  tshiozak 		return USBD_NO_ADDR;
    964   1.1  tshiozak 
    965   1.1  tshiozak 	if (mididev->opened) {
    966   1.1  tshiozak 		umidi_close(mididev);
    967   1.1  tshiozak 	}
    968   1.4  tshiozak 	unbind_jacks_from_mididev(mididev);
    969   1.1  tshiozak 
    970   1.1  tshiozak 	if (mididev->mdev)
    971   1.1  tshiozak 		config_detach(mididev->mdev, flags);
    972   1.1  tshiozak 
    973   1.1  tshiozak 	mididev->sc = NULL;
    974   1.1  tshiozak 
    975   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    976   1.1  tshiozak }
    977   1.1  tshiozak 
    978   1.1  tshiozak static usbd_status
    979   1.1  tshiozak deactivate_mididev(struct umidi_mididev *mididev)
    980   1.1  tshiozak {
    981   1.4  tshiozak 	if (mididev->out_jack)
    982   1.4  tshiozak 		mididev->out_jack->binded = 0;
    983   1.4  tshiozak 	if (mididev->in_jack)
    984   1.4  tshiozak 		mididev->in_jack->binded = 0;
    985   1.1  tshiozak 	config_deactivate(mididev->mdev);
    986   1.1  tshiozak 
    987   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
    988   1.1  tshiozak }
    989   1.1  tshiozak 
    990   1.1  tshiozak static usbd_status
    991   1.1  tshiozak alloc_all_mididevs(struct umidi_softc *sc, int nmidi)
    992   1.1  tshiozak {
    993   1.1  tshiozak 	sc->sc_num_mididevs = nmidi;
    994   1.1  tshiozak 	sc->sc_mididevs = malloc(sizeof(*sc->sc_mididevs)*nmidi,
    995  1.13   tsutsui 				 M_USBDEV, M_WAITOK|M_ZERO);
    996   1.1  tshiozak 	if (!sc->sc_mididevs)
    997   1.1  tshiozak 		return USBD_NOMEM;
    998   1.1  tshiozak 
    999   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
   1000   1.1  tshiozak }
   1001   1.1  tshiozak 
   1002   1.1  tshiozak static void
   1003   1.1  tshiozak free_all_mididevs(struct umidi_softc *sc)
   1004   1.1  tshiozak {
   1005   1.1  tshiozak 	sc->sc_num_mididevs = 0;
   1006   1.1  tshiozak 	if (sc->sc_mididevs)
   1007   1.1  tshiozak 		free(sc->sc_mididevs, M_USBDEV);
   1008   1.1  tshiozak }
   1009   1.1  tshiozak 
   1010   1.1  tshiozak static usbd_status
   1011   1.1  tshiozak attach_all_mididevs(struct umidi_softc *sc)
   1012   1.1  tshiozak {
   1013   1.1  tshiozak 	usbd_status err;
   1014   1.1  tshiozak 	int i;
   1015   1.1  tshiozak 
   1016   1.1  tshiozak 	if (sc->sc_mididevs)
   1017   1.1  tshiozak 		for (i=0; i<sc->sc_num_mididevs; i++) {
   1018   1.1  tshiozak 			err = attach_mididev(sc, &sc->sc_mididevs[i]);
   1019   1.1  tshiozak 			if (err!=USBD_NORMAL_COMPLETION)
   1020   1.1  tshiozak 				return err;
   1021   1.1  tshiozak 		}
   1022   1.1  tshiozak 
   1023   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
   1024   1.1  tshiozak }
   1025   1.1  tshiozak 
   1026   1.1  tshiozak static usbd_status
   1027   1.1  tshiozak detach_all_mididevs(struct umidi_softc *sc, int flags)
   1028   1.1  tshiozak {
   1029   1.1  tshiozak 	usbd_status err;
   1030   1.1  tshiozak 	int i;
   1031   1.1  tshiozak 
   1032   1.1  tshiozak 	if (sc->sc_mididevs)
   1033   1.1  tshiozak 		for (i=0; i<sc->sc_num_mididevs; i++) {
   1034   1.1  tshiozak 			err = detach_mididev(&sc->sc_mididevs[i], flags);
   1035   1.1  tshiozak 			if (err!=USBD_NORMAL_COMPLETION)
   1036   1.1  tshiozak 				return err;
   1037   1.1  tshiozak 		}
   1038   1.1  tshiozak 
   1039   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
   1040   1.1  tshiozak }
   1041   1.1  tshiozak 
   1042   1.1  tshiozak static usbd_status
   1043   1.1  tshiozak deactivate_all_mididevs(struct umidi_softc *sc)
   1044   1.1  tshiozak {
   1045   1.1  tshiozak 	usbd_status err;
   1046   1.1  tshiozak 	int i;
   1047   1.1  tshiozak 
   1048   1.1  tshiozak 	if (sc->sc_mididevs)
   1049   1.1  tshiozak 		for (i=0; i<sc->sc_num_mididevs; i++) {
   1050   1.1  tshiozak 			err = deactivate_mididev(&sc->sc_mididevs[i]);
   1051   1.1  tshiozak 			if (err!=USBD_NORMAL_COMPLETION)
   1052   1.1  tshiozak 				return err;
   1053   1.1  tshiozak 		}
   1054   1.1  tshiozak 
   1055   1.1  tshiozak 	return USBD_NORMAL_COMPLETION;
   1056   1.1  tshiozak }
   1057   1.1  tshiozak 
   1058   1.1  tshiozak #ifdef UMIDI_DEBUG
   1059   1.1  tshiozak static void
   1060   1.1  tshiozak dump_sc(struct umidi_softc *sc)
   1061   1.1  tshiozak {
   1062   1.1  tshiozak 	int i;
   1063   1.1  tshiozak 
   1064   1.1  tshiozak 	DPRINTFN(10, ("%s: dump_sc\n", USBDEVNAME(sc->sc_dev)));
   1065   1.1  tshiozak 	for (i=0; i<sc->sc_out_num_endpoints; i++) {
   1066   1.1  tshiozak 		DPRINTFN(10, ("\tout_ep(%p):\n", &sc->sc_out_ep[i]));
   1067   1.1  tshiozak 		dump_ep(&sc->sc_out_ep[i]);
   1068   1.1  tshiozak 	}
   1069   1.1  tshiozak 	for (i=0; i<sc->sc_in_num_endpoints; i++) {
   1070   1.1  tshiozak 		DPRINTFN(10, ("\tin_ep(%p):\n", &sc->sc_in_ep[i]));
   1071   1.1  tshiozak 		dump_ep(&sc->sc_in_ep[i]);
   1072   1.1  tshiozak 	}
   1073   1.1  tshiozak }
   1074   1.1  tshiozak 
   1075   1.1  tshiozak static void
   1076   1.1  tshiozak dump_ep(struct umidi_endpoint *ep)
   1077   1.1  tshiozak {
   1078   1.1  tshiozak 	int i;
   1079   1.1  tshiozak 	for (i=0; i<ep->num_jacks; i++) {
   1080   1.1  tshiozak 		DPRINTFN(10, ("\t\tjack(%p):\n", ep->jacks[i]));
   1081   1.1  tshiozak 		dump_jack(ep->jacks[i]);
   1082   1.1  tshiozak 	}
   1083   1.1  tshiozak }
   1084   1.1  tshiozak static void
   1085   1.1  tshiozak dump_jack(struct umidi_jack *jack)
   1086   1.1  tshiozak {
   1087  1.15  tshiozak 	DPRINTFN(10, ("\t\t\tep=%p\n",
   1088  1.15  tshiozak 		      jack->endpoint));
   1089   1.1  tshiozak }
   1090   1.1  tshiozak 
   1091   1.1  tshiozak #endif /* UMIDI_DEBUG */
   1092   1.1  tshiozak 
   1093   1.1  tshiozak 
   1094   1.1  tshiozak 
   1095   1.1  tshiozak /*
   1096   1.1  tshiozak  * MUX MIDI PACKET
   1097   1.1  tshiozak  */
   1098   1.1  tshiozak 
   1099   1.5  jdolecek static const int packet_length[16] = {
   1100   1.1  tshiozak 	/*0*/	-1,
   1101   1.1  tshiozak 	/*1*/	-1,
   1102   1.1  tshiozak 	/*2*/	2,
   1103   1.1  tshiozak 	/*3*/	3,
   1104   1.1  tshiozak 	/*4*/	3,
   1105   1.1  tshiozak 	/*5*/	1,
   1106   1.1  tshiozak 	/*6*/	2,
   1107   1.1  tshiozak 	/*7*/	3,
   1108   1.1  tshiozak 	/*8*/	3,
   1109   1.1  tshiozak 	/*9*/	3,
   1110   1.1  tshiozak 	/*A*/	3,
   1111   1.1  tshiozak 	/*B*/	3,
   1112   1.1  tshiozak 	/*C*/	2,
   1113   1.1  tshiozak 	/*D*/	2,
   1114   1.1  tshiozak 	/*E*/	3,
   1115   1.1  tshiozak 	/*F*/	1,
   1116   1.1  tshiozak };
   1117   1.1  tshiozak 
   1118   1.5  jdolecek static const struct {
   1119   1.1  tshiozak 	int		cin;
   1120   1.1  tshiozak 	packet_state_t	next;
   1121   1.1  tshiozak } packet_0xFX[16] = {
   1122   1.1  tshiozak 	/*F0: SysEx */	{ 0x04, PS_EXCL_1 },
   1123   1.1  tshiozak 	/*F1: MTC */	{ 0x02, PS_NORMAL_1OF2 },
   1124   1.1  tshiozak 	/*F2: S.POS */	{ 0x03, PS_NORMAL_1OF3 },
   1125   1.1  tshiozak 	/*F3: S.SEL */	{ 0x02, PS_NORMAL_1OF2 },
   1126   1.1  tshiozak 	/*F4: UNDEF */	{ 0x00, PS_INITIAL },
   1127   1.1  tshiozak 	/*F5: UNDEF */	{ 0x00, PS_INITIAL },
   1128   1.1  tshiozak 	/*F6: Tune */	{ 0x0F, PS_END },
   1129   1.1  tshiozak 	/*F7: EofEx */	{ 0x00, PS_INITIAL },
   1130   1.1  tshiozak 	/*F8: Timing */	{ 0x0F, PS_END },
   1131   1.1  tshiozak 	/*F9: UNDEF */	{ 0x00, PS_INITIAL },
   1132   1.1  tshiozak 	/*FA: Start */	{ 0x0F, PS_END },
   1133   1.1  tshiozak 	/*FB: Cont */	{ 0x0F, PS_END },
   1134   1.1  tshiozak 	/*FC: Stop */	{ 0x0F, PS_END },
   1135   1.1  tshiozak 	/*FD: UNDEF */	{ 0x00, PS_INITIAL },
   1136   1.1  tshiozak 	/*FE: ActS */	{ 0x0F, PS_END },
   1137   1.1  tshiozak 	/*FF: Reset */	{ 0x0F, PS_END },
   1138   1.1  tshiozak };
   1139   1.1  tshiozak 
   1140   1.1  tshiozak #define	GET_CN(p)		(((unsigned char)(p)>>4)&0x0F)
   1141   1.1  tshiozak #define GET_CIN(p)		((unsigned char)(p)&0x0F)
   1142   1.1  tshiozak #define MIX_CN_CIN(cn, cin) \
   1143   1.1  tshiozak 	((unsigned char)((((unsigned char)(cn)&0x0F)<<4)| \
   1144   1.3  tshiozak 			  ((unsigned char)(cin)&0x0F)))
   1145   1.1  tshiozak 
   1146   1.1  tshiozak static void
   1147   1.1  tshiozak init_packet(struct umidi_packet *packet)
   1148   1.1  tshiozak {
   1149   1.1  tshiozak 	memset(packet->buffer, 0, UMIDI_PACKET_SIZE);
   1150   1.1  tshiozak 	packet->state = PS_INITIAL;
   1151   1.1  tshiozak }
   1152   1.1  tshiozak 
   1153   1.1  tshiozak static usbd_status
   1154   1.1  tshiozak start_input_transfer(struct umidi_endpoint *ep)
   1155   1.1  tshiozak {
   1156   1.1  tshiozak 	usbd_setup_xfer(ep->xfer, ep->pipe,
   1157   1.1  tshiozak 			(usbd_private_handle)ep,
   1158   1.1  tshiozak 			ep->buffer, UMIDI_PACKET_SIZE,
   1159  1.11  augustss 			USBD_NO_COPY, USBD_NO_TIMEOUT, in_intr);
   1160   1.1  tshiozak 	return usbd_transfer(ep->xfer);
   1161   1.1  tshiozak }
   1162   1.1  tshiozak 
   1163   1.1  tshiozak static usbd_status
   1164   1.1  tshiozak start_output_transfer(struct umidi_endpoint *ep)
   1165   1.1  tshiozak {
   1166   1.1  tshiozak 	usbd_setup_xfer(ep->xfer, ep->pipe,
   1167   1.1  tshiozak 			(usbd_private_handle)ep,
   1168   1.1  tshiozak 			ep->buffer, UMIDI_PACKET_SIZE,
   1169  1.11  augustss 			USBD_NO_COPY, USBD_NO_TIMEOUT, out_intr);
   1170   1.1  tshiozak 	return usbd_transfer(ep->xfer);
   1171   1.1  tshiozak }
   1172   1.1  tshiozak 
   1173   1.4  tshiozak #ifdef UMIDI_DEBUG
   1174   1.4  tshiozak #define DPR_PACKET(dir, sc, p)						\
   1175   1.4  tshiozak if ((unsigned char)(p)->buffer[1]!=0xFE)				\
   1176   1.4  tshiozak 	DPRINTFN(500,							\
   1177   1.4  tshiozak 		 ("%s: umidi packet(" #dir "): %02X %02X %02X %02X\n",	\
   1178   1.4  tshiozak 		  USBDEVNAME(sc->sc_dev),				\
   1179   1.4  tshiozak 		  (unsigned char)(p)->buffer[0],			\
   1180   1.4  tshiozak 		  (unsigned char)(p)->buffer[1],			\
   1181   1.4  tshiozak 		  (unsigned char)(p)->buffer[2],			\
   1182   1.4  tshiozak 		  (unsigned char)(p)->buffer[3]));
   1183   1.4  tshiozak #else
   1184   1.4  tshiozak #define DPR_PACKET(dir, sc, p)
   1185   1.4  tshiozak #endif
   1186   1.4  tshiozak 
   1187   1.4  tshiozak static int
   1188   1.4  tshiozak out_jack_output(struct umidi_jack *out_jack, int d)
   1189   1.4  tshiozak {
   1190   1.4  tshiozak 	struct umidi_endpoint *ep = out_jack->endpoint;
   1191   1.4  tshiozak 	struct umidi_softc *sc = ep->sc;
   1192   1.4  tshiozak 	int error;
   1193   1.4  tshiozak 	int s;
   1194   1.4  tshiozak 
   1195   1.4  tshiozak 	if (sc->sc_dying)
   1196   1.4  tshiozak 		return EIO;
   1197   1.4  tshiozak 
   1198   1.4  tshiozak 	error = 0;
   1199   1.4  tshiozak 	if (out_jack->opened) {
   1200   1.4  tshiozak 		DPRINTFN(1000, ("umidi_output: ep=%p 0x%02x\n", ep, d));
   1201   1.4  tshiozak 		out_build_packet(out_jack->cable_number, &out_jack->packet, d);
   1202   1.4  tshiozak 		switch (out_jack->packet.state) {
   1203   1.4  tshiozak 		case PS_EXCL_0:
   1204   1.4  tshiozak 		case PS_END:
   1205   1.4  tshiozak 			DPR_PACKET(out, sc, &out_jack->packet);
   1206   1.4  tshiozak 			s = splusb();
   1207   1.4  tshiozak 			if (LIST_EMPTY(&ep->queue_head)) {
   1208   1.4  tshiozak 				memcpy(ep->buffer,
   1209   1.4  tshiozak 				       out_jack->packet.buffer,
   1210   1.4  tshiozak 				       UMIDI_PACKET_SIZE);
   1211   1.4  tshiozak 				start_output_transfer(ep);
   1212   1.4  tshiozak 			}
   1213   1.4  tshiozak 			if (LIST_EMPTY(&ep->queue_head))
   1214   1.4  tshiozak 				LIST_INSERT_HEAD(&ep->queue_head,
   1215   1.4  tshiozak 						 out_jack, u.out.queue_entry);
   1216   1.4  tshiozak 			else
   1217   1.4  tshiozak 				LIST_INSERT_AFTER(ep->queue_tail,
   1218   1.4  tshiozak 						  out_jack, u.out.queue_entry);
   1219   1.4  tshiozak 			ep->queue_tail = out_jack;
   1220   1.4  tshiozak 			splx(s);
   1221   1.4  tshiozak 			break;
   1222   1.4  tshiozak 		default:
   1223   1.4  tshiozak 			error = EINPROGRESS;
   1224   1.4  tshiozak 		}
   1225   1.4  tshiozak 	} else
   1226   1.4  tshiozak 		error = ENODEV;
   1227   1.4  tshiozak 
   1228   1.4  tshiozak 	return error;
   1229   1.4  tshiozak }
   1230   1.4  tshiozak 
   1231   1.1  tshiozak static void
   1232   1.1  tshiozak in_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
   1233   1.1  tshiozak {
   1234   1.4  tshiozak 	int cn, len, i;
   1235   1.1  tshiozak 	struct umidi_endpoint *ep = (struct umidi_endpoint *)priv;
   1236   1.4  tshiozak 	struct umidi_jack *jack;
   1237   1.1  tshiozak 
   1238   1.3  tshiozak 	if (ep->sc->sc_dying || !ep->num_open)
   1239   1.1  tshiozak 		return;
   1240   1.1  tshiozak 
   1241   1.4  tshiozak 	cn = GET_CN(ep->buffer[0]);
   1242   1.4  tshiozak 	len = packet_length[GET_CIN(ep->buffer[0])];
   1243   1.4  tshiozak 	jack = ep->jacks[cn];
   1244   1.4  tshiozak 	if (cn>=ep->num_jacks || !jack) {
   1245   1.4  tshiozak 		DPRINTF(("%s: stray umidi packet (in): %02X %02X %02X %02X\n",
   1246   1.4  tshiozak 			 USBDEVNAME(ep->sc->sc_dev),
   1247   1.4  tshiozak 			 (unsigned)ep->buffer[0],
   1248   1.4  tshiozak 			 (unsigned)ep->buffer[1],
   1249   1.4  tshiozak 			 (unsigned)ep->buffer[2],
   1250   1.4  tshiozak 			 (unsigned)ep->buffer[3]));
   1251   1.4  tshiozak 		return;
   1252   1.4  tshiozak 	}
   1253   1.4  tshiozak 	if (!jack->binded || !jack->opened)
   1254   1.4  tshiozak 		return;
   1255  1.15  tshiozak 	DPR_PACKET(in, ep->sc, &jack->packet);
   1256   1.4  tshiozak 	if (jack->u.in.intr) {
   1257   1.4  tshiozak 		for (i=0; i<len; i++) {
   1258   1.4  tshiozak 			(*jack->u.in.intr)(jack->arg, ep->buffer[i+1]);
   1259   1.4  tshiozak 		}
   1260   1.4  tshiozak 	}
   1261   1.1  tshiozak 
   1262   1.1  tshiozak 	(void)start_input_transfer(ep);
   1263   1.1  tshiozak }
   1264   1.1  tshiozak 
   1265   1.1  tshiozak static void
   1266   1.1  tshiozak out_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
   1267   1.1  tshiozak {
   1268   1.1  tshiozak 	struct umidi_endpoint *ep = (struct umidi_endpoint *)priv;
   1269   1.1  tshiozak 	struct umidi_softc *sc = ep->sc;
   1270   1.1  tshiozak 	struct umidi_jack *jack;
   1271   1.1  tshiozak 
   1272   1.3  tshiozak 	if (sc->sc_dying || !ep->num_open)
   1273   1.1  tshiozak 		return;
   1274   1.1  tshiozak 
   1275   1.4  tshiozak 	jack = LIST_FIRST(&ep->queue_head);
   1276   1.4  tshiozak 	if (jack && jack->opened) {
   1277   1.4  tshiozak 		LIST_REMOVE(jack, u.out.queue_entry);
   1278   1.4  tshiozak 		if (!LIST_EMPTY(&ep->queue_head)) {
   1279   1.3  tshiozak 			memcpy(ep->buffer,
   1280   1.4  tshiozak 			       LIST_FIRST(&ep->queue_head)->packet.buffer,
   1281   1.3  tshiozak 			       UMIDI_PACKET_SIZE);
   1282   1.3  tshiozak 			(void)start_output_transfer(ep);
   1283   1.3  tshiozak 		}
   1284   1.4  tshiozak 		if (jack->u.out.intr) {
   1285   1.4  tshiozak 			(*jack->u.out.intr)(jack->arg);
   1286   1.3  tshiozak 		}
   1287   1.1  tshiozak 	}
   1288   1.1  tshiozak }
   1289   1.1  tshiozak 
   1290   1.1  tshiozak static void
   1291   1.1  tshiozak out_build_packet(int cable_number, struct umidi_packet *packet, uByte in)
   1292   1.1  tshiozak {
   1293   1.1  tshiozak 	int cin;
   1294   1.6  tshiozak 	uByte prev;
   1295   1.1  tshiozak 
   1296   1.1  tshiozak retry:
   1297   1.1  tshiozak 	switch (packet->state) {
   1298   1.1  tshiozak 	case PS_END:
   1299   1.1  tshiozak 	case PS_INITIAL:
   1300   1.6  tshiozak 		prev = packet->buffer[1];
   1301   1.1  tshiozak 		memset(packet->buffer, 0, UMIDI_PACKET_SIZE);
   1302   1.1  tshiozak 		if (in<0x80) {
   1303   1.6  tshiozak 			if (prev>=0x80 && prev<0xf0) {
   1304   1.6  tshiozak 				/* running status */
   1305   1.6  tshiozak 				out_build_packet(cable_number, packet, prev);
   1306   1.6  tshiozak 				goto retry;
   1307   1.6  tshiozak 			}
   1308   1.1  tshiozak 			/* ??? */
   1309   1.1  tshiozak 			break;
   1310   1.1  tshiozak 		}
   1311   1.1  tshiozak 		if (in>=0xf0) {
   1312   1.1  tshiozak 			cin=packet_0xFX[in&0x0F].cin;
   1313   1.1  tshiozak 			packet->state=packet_0xFX[in&0x0F].next;
   1314   1.1  tshiozak 		} else {
   1315   1.1  tshiozak 			cin=(unsigned char)in>>4;
   1316   1.1  tshiozak 			switch (packet_length[cin]) {
   1317   1.1  tshiozak 			case 2:
   1318   1.1  tshiozak 				packet->state = PS_NORMAL_1OF2;
   1319   1.1  tshiozak 				break;
   1320   1.1  tshiozak 			case 3:
   1321   1.1  tshiozak 				packet->state = PS_NORMAL_1OF3;
   1322   1.1  tshiozak 				break;
   1323   1.1  tshiozak 			default:
   1324   1.1  tshiozak 				/* ??? */
   1325   1.1  tshiozak 				packet->state = PS_INITIAL;
   1326   1.1  tshiozak 			}
   1327   1.1  tshiozak 		}
   1328   1.1  tshiozak 		packet->buffer[0] = MIX_CN_CIN(cable_number, cin);
   1329   1.1  tshiozak 		packet->buffer[1] = in;
   1330   1.1  tshiozak 		break;
   1331   1.1  tshiozak 	case PS_NORMAL_1OF3:
   1332   1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1333   1.1  tshiozak 		packet->buffer[2] = in;
   1334   1.1  tshiozak 		packet->state = PS_NORMAL_2OF3;
   1335   1.1  tshiozak 		break;
   1336   1.1  tshiozak 	case PS_NORMAL_2OF3:
   1337   1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1338   1.1  tshiozak 		packet->buffer[3] = in;
   1339   1.1  tshiozak 		packet->state = PS_END;
   1340   1.1  tshiozak 		break;
   1341   1.1  tshiozak 	case PS_NORMAL_1OF2:
   1342   1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1343   1.1  tshiozak 		packet->buffer[2] = in;
   1344   1.1  tshiozak 		packet->state = PS_END;
   1345   1.1  tshiozak 		break;
   1346   1.1  tshiozak 	case PS_EXCL_0:
   1347   1.1  tshiozak 		memset(packet->buffer, 0, UMIDI_PACKET_SIZE);
   1348   1.1  tshiozak 		if (in==0xF7) {
   1349   1.1  tshiozak 			packet->buffer[0] = MIX_CN_CIN(cable_number, 0x05);
   1350   1.1  tshiozak 			packet->buffer[1] = 0xF7;
   1351   1.1  tshiozak 			packet->state = PS_END;
   1352   1.1  tshiozak 			break;
   1353   1.1  tshiozak 		}
   1354   1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1355   1.1  tshiozak 		packet->buffer[1] = in;
   1356   1.1  tshiozak 		packet->state = PS_EXCL_1;
   1357   1.1  tshiozak 		break;
   1358   1.1  tshiozak 	case PS_EXCL_1:
   1359   1.1  tshiozak 		if (in==0xF7) {
   1360   1.1  tshiozak 			packet->buffer[0] = MIX_CN_CIN(cable_number, 0x06);
   1361   1.1  tshiozak 			packet->buffer[2] = 0xF7;
   1362   1.1  tshiozak 			packet->state = PS_END;
   1363   1.1  tshiozak 			break;
   1364   1.1  tshiozak 		}
   1365   1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1366   1.1  tshiozak 		packet->buffer[2] = in;
   1367   1.1  tshiozak 		packet->state = PS_EXCL_2;
   1368   1.1  tshiozak 		break;
   1369   1.1  tshiozak 	case PS_EXCL_2:
   1370   1.1  tshiozak 		if (in==0xF7) {
   1371   1.1  tshiozak 			packet->buffer[0] = MIX_CN_CIN(cable_number, 0x07);
   1372   1.1  tshiozak 			packet->buffer[3] = 0xF7;
   1373   1.1  tshiozak 			packet->state = PS_END;
   1374   1.1  tshiozak 			break;
   1375   1.1  tshiozak 		}
   1376   1.1  tshiozak 		if (in>=0x80) { /* ??? */ packet->state = PS_END; break; }
   1377   1.2  tshiozak 		packet->buffer[0] = MIX_CN_CIN(cable_number, 0x04);
   1378   1.1  tshiozak 		packet->buffer[3] = in;
   1379   1.1  tshiozak 		packet->state = PS_EXCL_0;
   1380   1.1  tshiozak 		break;
   1381   1.1  tshiozak 	default:
   1382   1.1  tshiozak 		printf("umidi: ambiguous state.\n");
   1383   1.1  tshiozak 		packet->state = PS_INITIAL;
   1384   1.1  tshiozak 		goto retry;
   1385   1.1  tshiozak 	}
   1386   1.1  tshiozak }
   1387   1.4  tshiozak 
   1388