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