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