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