umidi.c revision 1.25.2.11 1 1.25.2.11 chap /* $NetBSD: umidi.c,v 1.25.2.11 2006/05/20 03:41:28 chap Exp $ */
2 1.1 tshiozak /*
3 1.1 tshiozak * Copyright (c) 2001 The NetBSD Foundation, Inc.
4 1.1 tshiozak * All rights reserved.
5 1.1 tshiozak *
6 1.1 tshiozak * This code is derived from software contributed to The NetBSD Foundation
7 1.25.2.10 chap * by Takuya SHIOZAKI (tshiozak (at) NetBSD.org) and (full-size transfers, extended
8 1.25.2.10 chap * hw_if) Chapman Flack (nblists (at) anastigmatix.net).
9 1.1 tshiozak *
10 1.1 tshiozak * Redistribution and use in source and binary forms, with or without
11 1.1 tshiozak * modification, are permitted provided that the following conditions
12 1.1 tshiozak * are met:
13 1.1 tshiozak * 1. Redistributions of source code must retain the above copyright
14 1.1 tshiozak * notice, this list of conditions and the following disclaimer.
15 1.1 tshiozak * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 tshiozak * notice, this list of conditions and the following disclaimer in the
17 1.1 tshiozak * documentation and/or other materials provided with the distribution.
18 1.1 tshiozak * 3. All advertising materials mentioning features or use of this software
19 1.1 tshiozak * must display the following acknowledgement:
20 1.1 tshiozak * This product includes software developed by the NetBSD
21 1.1 tshiozak * Foundation, Inc. and its contributors.
22 1.1 tshiozak * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1 tshiozak * contributors may be used to endorse or promote products derived
24 1.1 tshiozak * from this software without specific prior written permission.
25 1.1 tshiozak *
26 1.1 tshiozak * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1 tshiozak * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 tshiozak * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1 tshiozak * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.1 tshiozak * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 tshiozak * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 tshiozak * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 tshiozak * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 tshiozak * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 tshiozak * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 tshiozak * POSSIBILITY OF SUCH DAMAGE.
37 1.1 tshiozak */
38 1.10 lukem
39 1.10 lukem #include <sys/cdefs.h>
40 1.25.2.11 chap __KERNEL_RCSID(0, "$NetBSD: umidi.c,v 1.25.2.11 2006/05/20 03:41:28 chap Exp $");
41 1.1 tshiozak
42 1.25.2.10 chap #include <sys/types.h>
43 1.1 tshiozak #include <sys/param.h>
44 1.1 tshiozak #include <sys/systm.h>
45 1.1 tshiozak #include <sys/kernel.h>
46 1.1 tshiozak #include <sys/malloc.h>
47 1.1 tshiozak #include <sys/device.h>
48 1.1 tshiozak #include <sys/ioctl.h>
49 1.1 tshiozak #include <sys/conf.h>
50 1.1 tshiozak #include <sys/file.h>
51 1.1 tshiozak #include <sys/select.h>
52 1.1 tshiozak #include <sys/proc.h>
53 1.1 tshiozak #include <sys/vnode.h>
54 1.1 tshiozak #include <sys/poll.h>
55 1.1 tshiozak #include <sys/lock.h>
56 1.1 tshiozak
57 1.25.2.10 chap #ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
58 1.25.2.10 chap #include <machine/intr.h>
59 1.25.2.10 chap #endif
60 1.25.2.10 chap
61 1.1 tshiozak #include <dev/usb/usb.h>
62 1.1 tshiozak #include <dev/usb/usbdi.h>
63 1.1 tshiozak #include <dev/usb/usbdi_util.h>
64 1.1 tshiozak
65 1.1 tshiozak #include <dev/usb/usbdevs.h>
66 1.1 tshiozak #include <dev/usb/uaudioreg.h>
67 1.1 tshiozak #include <dev/usb/umidireg.h>
68 1.1 tshiozak #include <dev/usb/umidivar.h>
69 1.1 tshiozak #include <dev/usb/umidi_quirks.h>
70 1.1 tshiozak
71 1.1 tshiozak #include <dev/midi_if.h>
72 1.1 tshiozak
73 1.1 tshiozak #ifdef UMIDI_DEBUG
74 1.1 tshiozak #define DPRINTF(x) if (umididebug) printf x
75 1.1 tshiozak #define DPRINTFN(n,x) if (umididebug >= (n)) printf x
76 1.25.2.10 chap #include <sys/time.h>
77 1.25.2.10 chap static struct timeval umidi_tv;
78 1.1 tshiozak int umididebug = 0;
79 1.1 tshiozak #else
80 1.1 tshiozak #define DPRINTF(x)
81 1.1 tshiozak #define DPRINTFN(n,x)
82 1.1 tshiozak #endif
83 1.1 tshiozak
84 1.1 tshiozak
85 1.1 tshiozak static int umidi_open(void *, int,
86 1.1 tshiozak void (*)(void *, int), void (*)(void *), void *);
87 1.1 tshiozak static void umidi_close(void *);
88 1.25.2.5 chap static int umidi_channelmsg(void *, int, int, u_char *, int);
89 1.25.2.5 chap static int umidi_commonmsg(void *, int, u_char *, int);
90 1.25.2.5 chap static int umidi_sysex(void *, u_char *, int);
91 1.25.2.5 chap static int umidi_rtmsg(void *, int);
92 1.1 tshiozak static void umidi_getinfo(void *, struct midi_info *);
93 1.1 tshiozak
94 1.3 tshiozak static usbd_status alloc_pipe(struct umidi_endpoint *);
95 1.3 tshiozak static void free_pipe(struct umidi_endpoint *);
96 1.1 tshiozak
97 1.1 tshiozak static usbd_status alloc_all_endpoints(struct umidi_softc *);
98 1.1 tshiozak static void free_all_endpoints(struct umidi_softc *);
99 1.1 tshiozak
100 1.1 tshiozak static usbd_status alloc_all_jacks(struct umidi_softc *);
101 1.1 tshiozak static void free_all_jacks(struct umidi_softc *);
102 1.1 tshiozak static usbd_status bind_jacks_to_mididev(struct umidi_softc *,
103 1.1 tshiozak struct umidi_jack *,
104 1.1 tshiozak struct umidi_jack *,
105 1.1 tshiozak struct umidi_mididev *);
106 1.4 tshiozak static void unbind_jacks_from_mididev(struct umidi_mididev *);
107 1.4 tshiozak static void unbind_all_jacks(struct umidi_softc *);
108 1.1 tshiozak static usbd_status assign_all_jacks_automatically(struct umidi_softc *);
109 1.4 tshiozak static usbd_status open_out_jack(struct umidi_jack *, void *,
110 1.4 tshiozak void (*)(void *));
111 1.4 tshiozak static usbd_status open_in_jack(struct umidi_jack *, void *,
112 1.4 tshiozak void (*)(void *, int));
113 1.4 tshiozak static void close_out_jack(struct umidi_jack *);
114 1.4 tshiozak static void close_in_jack(struct umidi_jack *);
115 1.1 tshiozak
116 1.1 tshiozak static usbd_status attach_mididev(struct umidi_softc *,
117 1.1 tshiozak struct umidi_mididev *);
118 1.1 tshiozak static usbd_status detach_mididev(struct umidi_mididev *, int);
119 1.1 tshiozak static usbd_status deactivate_mididev(struct umidi_mididev *);
120 1.1 tshiozak static usbd_status alloc_all_mididevs(struct umidi_softc *, int);
121 1.1 tshiozak static void free_all_mididevs(struct umidi_softc *);
122 1.1 tshiozak static usbd_status attach_all_mididevs(struct umidi_softc *);
123 1.1 tshiozak static usbd_status detach_all_mididevs(struct umidi_softc *, int);
124 1.1 tshiozak static usbd_status deactivate_all_mididevs(struct umidi_softc *);
125 1.1 tshiozak
126 1.1 tshiozak #ifdef UMIDI_DEBUG
127 1.1 tshiozak static void dump_sc(struct umidi_softc *);
128 1.1 tshiozak static void dump_ep(struct umidi_endpoint *);
129 1.1 tshiozak static void dump_jack(struct umidi_jack *);
130 1.1 tshiozak #endif
131 1.1 tshiozak
132 1.1 tshiozak static usbd_status start_input_transfer(struct umidi_endpoint *);
133 1.1 tshiozak static usbd_status start_output_transfer(struct umidi_endpoint *);
134 1.25.2.5 chap static int out_jack_output(struct umidi_jack *, u_char *, int, int);
135 1.1 tshiozak static void in_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
136 1.1 tshiozak static void out_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
137 1.25.2.10 chap static void out_solicit(void *); /* struct umidi_endpoint* for softintr */
138 1.1 tshiozak
139 1.1 tshiozak
140 1.25.2.1 chap struct midi_hw_if umidi_hw_if = {
141 1.1 tshiozak umidi_open,
142 1.1 tshiozak umidi_close,
143 1.25.2.5 chap umidi_rtmsg,
144 1.1 tshiozak umidi_getinfo,
145 1.1 tshiozak 0, /* ioctl */
146 1.1 tshiozak };
147 1.1 tshiozak
148 1.25.2.5 chap struct midi_hw_if_ext umidi_hw_if_ext = {
149 1.25.2.5 chap .channel = umidi_channelmsg,
150 1.25.2.5 chap .common = umidi_commonmsg,
151 1.25.2.5 chap .sysex = umidi_sysex,
152 1.25.2.5 chap };
153 1.25.2.5 chap
154 1.1 tshiozak USB_DECLARE_DRIVER(umidi);
155 1.1 tshiozak
156 1.1 tshiozak USB_MATCH(umidi)
157 1.1 tshiozak {
158 1.1 tshiozak USB_MATCH_START(umidi, uaa);
159 1.1 tshiozak usb_interface_descriptor_t *id;
160 1.1 tshiozak
161 1.1 tshiozak DPRINTFN(1,("umidi_match\n"));
162 1.1 tshiozak
163 1.1 tshiozak if (uaa->iface == NULL)
164 1.1 tshiozak return UMATCH_NONE;
165 1.1 tshiozak
166 1.3 tshiozak if (umidi_search_quirk(uaa->vendor, uaa->product, uaa->ifaceno))
167 1.3 tshiozak return UMATCH_IFACECLASS_IFACESUBCLASS;
168 1.1 tshiozak
169 1.1 tshiozak id = usbd_get_interface_descriptor(uaa->iface);
170 1.16 augustss if (id!=NULL &&
171 1.1 tshiozak id->bInterfaceClass==UICLASS_AUDIO &&
172 1.3 tshiozak id->bInterfaceSubClass==UISUBCLASS_MIDISTREAM)
173 1.3 tshiozak return UMATCH_IFACECLASS_IFACESUBCLASS;
174 1.1 tshiozak
175 1.3 tshiozak return UMATCH_NONE;
176 1.1 tshiozak }
177 1.1 tshiozak
178 1.1 tshiozak USB_ATTACH(umidi)
179 1.1 tshiozak {
180 1.1 tshiozak usbd_status err;
181 1.1 tshiozak USB_ATTACH_START(umidi, sc, uaa);
182 1.25.2.1 chap char devinfo[1024];
183 1.1 tshiozak
184 1.1 tshiozak DPRINTFN(1,("umidi_attach\n"));
185 1.1 tshiozak
186 1.25.2.1 chap usbd_devinfo(uaa->device, 0, devinfo);
187 1.25.2.1 chap printf("\n%s: %s\n", USBDEVNAME(sc->sc_dev), devinfo);
188 1.1 tshiozak
189 1.1 tshiozak sc->sc_iface = uaa->iface;
190 1.1 tshiozak sc->sc_udev = uaa->device;
191 1.1 tshiozak
192 1.1 tshiozak sc->sc_quirk =
193 1.1 tshiozak umidi_search_quirk(uaa->vendor, uaa->product, uaa->ifaceno);
194 1.1 tshiozak printf("%s: ", USBDEVNAME(sc->sc_dev));
195 1.1 tshiozak umidi_print_quirk(sc->sc_quirk);
196 1.1 tshiozak
197 1.1 tshiozak
198 1.1 tshiozak err = alloc_all_endpoints(sc);
199 1.1 tshiozak if (err!=USBD_NORMAL_COMPLETION) {
200 1.1 tshiozak printf("%s: alloc_all_endpoints failed. (err=%d)\n",
201 1.1 tshiozak USBDEVNAME(sc->sc_dev), err);
202 1.1 tshiozak goto error;
203 1.1 tshiozak }
204 1.1 tshiozak err = alloc_all_jacks(sc);
205 1.1 tshiozak if (err!=USBD_NORMAL_COMPLETION) {
206 1.1 tshiozak free_all_endpoints(sc);
207 1.1 tshiozak printf("%s: alloc_all_jacks failed. (err=%d)\n",
208 1.1 tshiozak USBDEVNAME(sc->sc_dev), err);
209 1.1 tshiozak goto error;
210 1.1 tshiozak }
211 1.1 tshiozak printf("%s: out=%d, in=%d\n",
212 1.1 tshiozak USBDEVNAME(sc->sc_dev),
213 1.1 tshiozak sc->sc_out_num_jacks, sc->sc_in_num_jacks);
214 1.1 tshiozak
215 1.1 tshiozak err = assign_all_jacks_automatically(sc);
216 1.1 tshiozak if (err!=USBD_NORMAL_COMPLETION) {
217 1.1 tshiozak unbind_all_jacks(sc);
218 1.1 tshiozak free_all_jacks(sc);
219 1.1 tshiozak free_all_endpoints(sc);
220 1.1 tshiozak printf("%s: assign_all_jacks_automatically failed. (err=%d)\n",
221 1.1 tshiozak USBDEVNAME(sc->sc_dev), err);
222 1.1 tshiozak goto error;
223 1.1 tshiozak }
224 1.1 tshiozak err = attach_all_mididevs(sc);
225 1.1 tshiozak if (err!=USBD_NORMAL_COMPLETION) {
226 1.1 tshiozak free_all_jacks(sc);
227 1.1 tshiozak free_all_endpoints(sc);
228 1.1 tshiozak printf("%s: attach_all_mididevs failed. (err=%d)\n",
229 1.1 tshiozak USBDEVNAME(sc->sc_dev), err);
230 1.1 tshiozak }
231 1.1 tshiozak
232 1.1 tshiozak #ifdef UMIDI_DEBUG
233 1.1 tshiozak dump_sc(sc);
234 1.1 tshiozak #endif
235 1.1 tshiozak
236 1.1 tshiozak usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH,
237 1.1 tshiozak sc->sc_udev, USBDEV(sc->sc_dev));
238 1.16 augustss
239 1.1 tshiozak USB_ATTACH_SUCCESS_RETURN;
240 1.1 tshiozak error:
241 1.1 tshiozak printf("%s: disabled.\n", USBDEVNAME(sc->sc_dev));
242 1.1 tshiozak sc->sc_dying = 1;
243 1.1 tshiozak USB_ATTACH_ERROR_RETURN;
244 1.1 tshiozak }
245 1.1 tshiozak
246 1.1 tshiozak int
247 1.1 tshiozak umidi_activate(device_ptr_t self, enum devact act)
248 1.1 tshiozak {
249 1.3 tshiozak struct umidi_softc *sc = (struct umidi_softc *)self;
250 1.1 tshiozak
251 1.1 tshiozak switch (act) {
252 1.1 tshiozak case DVACT_ACTIVATE:
253 1.1 tshiozak DPRINTFN(1,("umidi_activate (activate)\n"));
254 1.1 tshiozak
255 1.1 tshiozak return EOPNOTSUPP;
256 1.1 tshiozak break;
257 1.1 tshiozak case DVACT_DEACTIVATE:
258 1.1 tshiozak DPRINTFN(1,("umidi_activate (deactivate)\n"));
259 1.1 tshiozak sc->sc_dying = 1;
260 1.1 tshiozak deactivate_all_mididevs(sc);
261 1.1 tshiozak break;
262 1.1 tshiozak }
263 1.1 tshiozak return 0;
264 1.1 tshiozak }
265 1.1 tshiozak
266 1.1 tshiozak USB_DETACH(umidi)
267 1.1 tshiozak {
268 1.3 tshiozak USB_DETACH_START(umidi, sc);
269 1.1 tshiozak
270 1.1 tshiozak DPRINTFN(1,("umidi_detach\n"));
271 1.1 tshiozak
272 1.1 tshiozak sc->sc_dying = 1;
273 1.1 tshiozak detach_all_mididevs(sc, flags);
274 1.1 tshiozak free_all_mididevs(sc);
275 1.1 tshiozak free_all_jacks(sc);
276 1.1 tshiozak free_all_endpoints(sc);
277 1.1 tshiozak
278 1.3 tshiozak usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
279 1.3 tshiozak USBDEV(sc->sc_dev));
280 1.1 tshiozak
281 1.1 tshiozak return 0;
282 1.1 tshiozak }
283 1.1 tshiozak
284 1.1 tshiozak
285 1.4 tshiozak /*
286 1.4 tshiozak * midi_if stuffs
287 1.4 tshiozak */
288 1.1 tshiozak int
289 1.1 tshiozak umidi_open(void *addr,
290 1.1 tshiozak int flags,
291 1.12 augustss void (*iintr)(void *, int),
292 1.12 augustss void (*ointr)(void *),
293 1.1 tshiozak void *arg)
294 1.1 tshiozak {
295 1.3 tshiozak struct umidi_mididev *mididev = addr;
296 1.3 tshiozak struct umidi_softc *sc = mididev->sc;
297 1.25.2.2 chap usbd_status err;
298 1.1 tshiozak
299 1.1 tshiozak DPRINTF(("umidi_open: sc=%p\n", sc));
300 1.1 tshiozak
301 1.1 tshiozak if (!sc)
302 1.1 tshiozak return ENXIO;
303 1.1 tshiozak if (mididev->opened)
304 1.1 tshiozak return EBUSY;
305 1.4 tshiozak if (sc->sc_dying)
306 1.1 tshiozak return EIO;
307 1.1 tshiozak
308 1.4 tshiozak mididev->opened = 1;
309 1.1 tshiozak mididev->flags = flags;
310 1.25.2.2 chap if ((mididev->flags & FWRITE) && mididev->out_jack) {
311 1.25.2.2 chap err = open_out_jack(mididev->out_jack, arg, ointr);
312 1.25.2.2 chap if ( err != USBD_NORMAL_COMPLETION )
313 1.25.2.2 chap goto bad;
314 1.25.2.2 chap }
315 1.3 tshiozak if ((mididev->flags & FREAD) && mididev->in_jack) {
316 1.25.2.2 chap err = open_in_jack(mididev->in_jack, arg, iintr);
317 1.25.2.2 chap if ( err != USBD_NORMAL_COMPLETION
318 1.25.2.2 chap && err != USBD_IN_PROGRESS )
319 1.25.2.2 chap goto bad;
320 1.3 tshiozak }
321 1.1 tshiozak
322 1.1 tshiozak return 0;
323 1.25.2.2 chap bad:
324 1.25.2.2 chap mididev->opened = 0;
325 1.25.2.2 chap DPRINTF(("umidi_open: usbd_status %d\n", err));
326 1.25.2.2 chap return USBD_IN_USE == err ? EBUSY : EIO;
327 1.1 tshiozak }
328 1.1 tshiozak
329 1.1 tshiozak void
330 1.1 tshiozak umidi_close(void *addr)
331 1.1 tshiozak {
332 1.1 tshiozak int s;
333 1.3 tshiozak struct umidi_mididev *mididev = addr;
334 1.1 tshiozak
335 1.1 tshiozak s = splusb();
336 1.1 tshiozak if ((mididev->flags & FWRITE) && mididev->out_jack)
337 1.4 tshiozak close_out_jack(mididev->out_jack);
338 1.1 tshiozak if ((mididev->flags & FREAD) && mididev->in_jack)
339 1.4 tshiozak close_in_jack(mididev->in_jack);
340 1.1 tshiozak mididev->opened = 0;
341 1.1 tshiozak splx(s);
342 1.1 tshiozak }
343 1.1 tshiozak
344 1.1 tshiozak int
345 1.25.2.5 chap umidi_channelmsg(void *addr, int status, int channel, u_char *msg, int len)
346 1.25.2.5 chap {
347 1.25.2.5 chap struct umidi_mididev *mididev = addr;
348 1.25.2.5 chap
349 1.25.2.5 chap if (!mididev->out_jack || !mididev->opened)
350 1.25.2.5 chap return EIO;
351 1.25.2.5 chap
352 1.25.2.5 chap return out_jack_output(mididev->out_jack, msg, len, (status>>4)&0xf);
353 1.25.2.5 chap }
354 1.25.2.5 chap
355 1.25.2.5 chap int
356 1.25.2.5 chap umidi_commonmsg(void *addr, int status, u_char *msg, int len)
357 1.25.2.5 chap {
358 1.25.2.5 chap struct umidi_mididev *mididev = addr;
359 1.25.2.5 chap int cin;
360 1.25.2.5 chap
361 1.25.2.5 chap if (!mididev->out_jack || !mididev->opened)
362 1.25.2.5 chap return EIO;
363 1.25.2.5 chap
364 1.25.2.5 chap switch ( len ) {
365 1.25.2.5 chap case 1: cin = 5; break;
366 1.25.2.5 chap case 2: cin = 2; break;
367 1.25.2.5 chap case 3: cin = 3; break;
368 1.25.2.5 chap default: return EIO; /* or gcc warns of cin uninitialized */
369 1.25.2.5 chap }
370 1.25.2.5 chap
371 1.25.2.5 chap return out_jack_output(mididev->out_jack, msg, len, cin);
372 1.25.2.5 chap }
373 1.25.2.5 chap
374 1.25.2.5 chap int
375 1.25.2.5 chap umidi_sysex(void *addr, u_char *msg, int len)
376 1.1 tshiozak {
377 1.3 tshiozak struct umidi_mididev *mididev = addr;
378 1.25.2.5 chap int cin;
379 1.1 tshiozak
380 1.4 tshiozak if (!mididev->out_jack || !mididev->opened)
381 1.1 tshiozak return EIO;
382 1.1 tshiozak
383 1.25.2.5 chap switch ( len ) {
384 1.25.2.5 chap case 1: cin = 5; break;
385 1.25.2.5 chap case 2: cin = 6; break;
386 1.25.2.5 chap case 3: cin = (msg[2] == 0xf7) ? 7 : 4; break;
387 1.25.2.5 chap default: return EIO; /* or gcc warns of cin uninitialized */
388 1.25.2.5 chap }
389 1.25.2.5 chap
390 1.25.2.5 chap return out_jack_output(mididev->out_jack, msg, len, cin);
391 1.25.2.5 chap }
392 1.25.2.5 chap
393 1.25.2.5 chap int
394 1.25.2.5 chap umidi_rtmsg(void *addr, int d)
395 1.25.2.5 chap {
396 1.25.2.5 chap struct umidi_mididev *mididev = addr;
397 1.25.2.5 chap u_char msg = d;
398 1.25.2.5 chap
399 1.25.2.5 chap if (!mididev->out_jack || !mididev->opened)
400 1.25.2.5 chap return EIO;
401 1.25.2.5 chap
402 1.25.2.5 chap return out_jack_output(mididev->out_jack, &msg, 1, 0xf);
403 1.1 tshiozak }
404 1.1 tshiozak
405 1.1 tshiozak void
406 1.1 tshiozak umidi_getinfo(void *addr, struct midi_info *mi)
407 1.1 tshiozak {
408 1.3 tshiozak struct umidi_mididev *mididev = addr;
409 1.3 tshiozak /* struct umidi_softc *sc = mididev->sc; */
410 1.1 tshiozak
411 1.3 tshiozak mi->name = "USB MIDI I/F"; /* XXX: model name */
412 1.3 tshiozak mi->props = MIDI_PROP_OUT_INTR;
413 1.1 tshiozak if (mididev->in_jack)
414 1.1 tshiozak mi->props |= MIDI_PROP_CAN_INPUT;
415 1.25.2.5 chap midi_register_hw_if_ext(&umidi_hw_if_ext);
416 1.1 tshiozak }
417 1.1 tshiozak
418 1.1 tshiozak
419 1.4 tshiozak /*
420 1.4 tshiozak * each endpoint stuffs
421 1.4 tshiozak */
422 1.1 tshiozak
423 1.3 tshiozak /* alloc/free pipe */
424 1.1 tshiozak static usbd_status
425 1.3 tshiozak alloc_pipe(struct umidi_endpoint *ep)
426 1.1 tshiozak {
427 1.1 tshiozak struct umidi_softc *sc = ep->sc;
428 1.1 tshiozak usbd_status err;
429 1.25.2.4 chap usb_endpoint_descriptor_t *epd;
430 1.25.2.4 chap
431 1.25.2.10 chap epd = usbd_get_endpoint_descriptor(sc->sc_iface, ep->addr);
432 1.25.2.10 chap /*
433 1.25.2.10 chap * For output, an improvement would be to have a buffer bigger than
434 1.25.2.10 chap * wMaxPacketSize by num_jacks-1 additional packet slots; that would
435 1.25.2.10 chap * allow out_solicit to fill the buffer to the full packet size in
436 1.25.2.10 chap * all cases. But to use usbd_alloc_buffer to get a slightly larger
437 1.25.2.10 chap * buffer would not be a good way to do that, because if the addition
438 1.25.2.10 chap * would make the buffer exceed USB_MEM_SMALL then a substantially
439 1.25.2.10 chap * larger block may be wastefully allocated. Some flavor of double
440 1.25.2.10 chap * buffering could serve the same purpose, but would increase the
441 1.25.2.10 chap * code complexity, so for now I will live with the current slight
442 1.25.2.10 chap * penalty of reducing max transfer size by (num_open-num_scheduled)
443 1.25.2.10 chap * packet slots.
444 1.25.2.10 chap */
445 1.25.2.10 chap ep->buffer_size = UGETW(epd->wMaxPacketSize);
446 1.25.2.10 chap ep->buffer_size -= ep->buffer_size % UMIDI_PACKET_SIZE;
447 1.1 tshiozak
448 1.25.2.4 chap DPRINTF(("%s: alloc_pipe %p, buffer size %u\n",
449 1.25.2.4 chap USBDEVNAME(sc->sc_dev), ep, ep->buffer_size));
450 1.25.2.10 chap ep->num_scheduled = 0;
451 1.25.2.10 chap ep->this_schedule = 0;
452 1.25.2.10 chap ep->next_schedule = 0;
453 1.25.2.10 chap ep->soliciting = 0;
454 1.25.2.10 chap ep->armed = 0;
455 1.3 tshiozak ep->xfer = usbd_alloc_xfer(sc->sc_udev);
456 1.11 augustss if (ep->xfer == NULL) {
457 1.3 tshiozak err = USBD_NOMEM;
458 1.3 tshiozak goto quit;
459 1.3 tshiozak }
460 1.25.2.4 chap ep->buffer = usbd_alloc_buffer(ep->xfer, ep->buffer_size);
461 1.11 augustss if (ep->buffer == NULL) {
462 1.3 tshiozak usbd_free_xfer(ep->xfer);
463 1.3 tshiozak err = USBD_NOMEM;
464 1.3 tshiozak goto quit;
465 1.3 tshiozak }
466 1.25.2.10 chap ep->next_slot = ep->buffer;
467 1.3 tshiozak err = usbd_open_pipe(sc->sc_iface, ep->addr, 0, &ep->pipe);
468 1.3 tshiozak if (err)
469 1.3 tshiozak usbd_free_xfer(ep->xfer);
470 1.25.2.10 chap #ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
471 1.25.2.10 chap ep->solicit_cookie = softintr_establish(IPL_SOFTCLOCK,out_solicit,ep);
472 1.25.2.10 chap #endif
473 1.1 tshiozak quit:
474 1.1 tshiozak return err;
475 1.1 tshiozak }
476 1.1 tshiozak
477 1.1 tshiozak static void
478 1.3 tshiozak free_pipe(struct umidi_endpoint *ep)
479 1.1 tshiozak {
480 1.3 tshiozak DPRINTF(("%s: free_pipe %p\n", USBDEVNAME(ep->sc->sc_dev), ep));
481 1.3 tshiozak usbd_abort_pipe(ep->pipe);
482 1.3 tshiozak usbd_close_pipe(ep->pipe);
483 1.3 tshiozak usbd_free_xfer(ep->xfer);
484 1.25.2.10 chap #ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
485 1.25.2.10 chap softintr_disestablish(ep->solicit_cookie);
486 1.25.2.10 chap #endif
487 1.1 tshiozak }
488 1.1 tshiozak
489 1.1 tshiozak
490 1.1 tshiozak /* alloc/free the array of endpoint structures */
491 1.1 tshiozak
492 1.1 tshiozak static usbd_status alloc_all_endpoints_fixed_ep(struct umidi_softc *);
493 1.1 tshiozak static usbd_status alloc_all_endpoints_yamaha(struct umidi_softc *);
494 1.1 tshiozak static usbd_status alloc_all_endpoints_genuine(struct umidi_softc *);
495 1.1 tshiozak
496 1.1 tshiozak static usbd_status
497 1.1 tshiozak alloc_all_endpoints(struct umidi_softc *sc)
498 1.1 tshiozak {
499 1.3 tshiozak usbd_status err;
500 1.3 tshiozak struct umidi_endpoint *ep;
501 1.3 tshiozak int i;
502 1.9 tshiozak
503 1.3 tshiozak if (UMQ_ISTYPE(sc, UMQ_TYPE_FIXED_EP)) {
504 1.3 tshiozak err = alloc_all_endpoints_fixed_ep(sc);
505 1.3 tshiozak } else if (UMQ_ISTYPE(sc, UMQ_TYPE_YAMAHA)) {
506 1.3 tshiozak err = alloc_all_endpoints_yamaha(sc);
507 1.1 tshiozak } else {
508 1.3 tshiozak err = alloc_all_endpoints_genuine(sc);
509 1.1 tshiozak }
510 1.3 tshiozak if (err!=USBD_NORMAL_COMPLETION)
511 1.3 tshiozak return err;
512 1.3 tshiozak
513 1.3 tshiozak ep = sc->sc_endpoints;
514 1.8 tshiozak for (i=sc->sc_out_num_endpoints+sc->sc_in_num_endpoints; i>0; i--) {
515 1.3 tshiozak err = alloc_pipe(ep++);
516 1.3 tshiozak if (err!=USBD_NORMAL_COMPLETION) {
517 1.3 tshiozak for (; ep!=sc->sc_endpoints; ep--)
518 1.3 tshiozak free_pipe(ep-1);
519 1.3 tshiozak free(sc->sc_endpoints, M_USBDEV);
520 1.3 tshiozak sc->sc_endpoints = sc->sc_out_ep = sc->sc_in_ep = NULL;
521 1.3 tshiozak break;
522 1.3 tshiozak }
523 1.3 tshiozak }
524 1.3 tshiozak return err;
525 1.1 tshiozak }
526 1.1 tshiozak
527 1.1 tshiozak static void
528 1.1 tshiozak free_all_endpoints(struct umidi_softc *sc)
529 1.1 tshiozak {
530 1.3 tshiozak int i;
531 1.8 tshiozak for (i=0; i<sc->sc_in_num_endpoints+sc->sc_out_num_endpoints; i++)
532 1.3 tshiozak free_pipe(&sc->sc_endpoints[i]);
533 1.14 kent if (sc->sc_endpoints != NULL)
534 1.14 kent free(sc->sc_endpoints, M_USBDEV);
535 1.1 tshiozak sc->sc_endpoints = sc->sc_out_ep = sc->sc_in_ep = NULL;
536 1.1 tshiozak }
537 1.1 tshiozak
538 1.1 tshiozak static usbd_status
539 1.1 tshiozak alloc_all_endpoints_fixed_ep(struct umidi_softc *sc)
540 1.1 tshiozak {
541 1.3 tshiozak usbd_status err;
542 1.1 tshiozak struct umq_fixed_ep_desc *fp;
543 1.3 tshiozak struct umidi_endpoint *ep;
544 1.1 tshiozak usb_endpoint_descriptor_t *epd;
545 1.1 tshiozak int i;
546 1.1 tshiozak
547 1.1 tshiozak fp = umidi_get_quirk_data_from_type(sc->sc_quirk,
548 1.1 tshiozak UMQ_TYPE_FIXED_EP);
549 1.1 tshiozak sc->sc_out_num_jacks = 0;
550 1.1 tshiozak sc->sc_in_num_jacks = 0;
551 1.1 tshiozak sc->sc_out_num_endpoints = fp->num_out_ep;
552 1.1 tshiozak sc->sc_in_num_endpoints = fp->num_in_ep;
553 1.1 tshiozak sc->sc_endpoints = malloc(sizeof(*sc->sc_out_ep)*
554 1.1 tshiozak (sc->sc_out_num_endpoints+
555 1.1 tshiozak sc->sc_in_num_endpoints),
556 1.1 tshiozak M_USBDEV, M_WAITOK);
557 1.1 tshiozak if (!sc->sc_endpoints) {
558 1.1 tshiozak return USBD_NOMEM;
559 1.1 tshiozak }
560 1.1 tshiozak sc->sc_out_ep = sc->sc_out_num_endpoints ? sc->sc_endpoints : NULL;
561 1.1 tshiozak sc->sc_in_ep =
562 1.1 tshiozak sc->sc_in_num_endpoints ?
563 1.1 tshiozak sc->sc_endpoints+sc->sc_out_num_endpoints : NULL;
564 1.3 tshiozak
565 1.3 tshiozak ep = &sc->sc_out_ep[0];
566 1.1 tshiozak for (i=0; i<sc->sc_out_num_endpoints; i++) {
567 1.1 tshiozak epd = usbd_interface2endpoint_descriptor(
568 1.1 tshiozak sc->sc_iface,
569 1.1 tshiozak fp->out_ep[i].ep);
570 1.1 tshiozak if (!epd) {
571 1.1 tshiozak printf("%s: cannot get endpoint descriptor(out:%d)\n",
572 1.1 tshiozak USBDEVNAME(sc->sc_dev), fp->out_ep[i].ep);
573 1.3 tshiozak err = USBD_INVAL;
574 1.1 tshiozak goto error;
575 1.1 tshiozak }
576 1.1 tshiozak if (UE_GET_XFERTYPE(epd->bmAttributes)!=UE_BULK ||
577 1.1 tshiozak UE_GET_DIR(epd->bEndpointAddress)!=UE_DIR_OUT) {
578 1.1 tshiozak printf("%s: illegal endpoint(out:%d)\n",
579 1.1 tshiozak USBDEVNAME(sc->sc_dev), fp->out_ep[i].ep);
580 1.3 tshiozak err = USBD_INVAL;
581 1.1 tshiozak goto error;
582 1.1 tshiozak }
583 1.3 tshiozak ep->sc = sc;
584 1.3 tshiozak ep->addr = epd->bEndpointAddress;
585 1.3 tshiozak ep->num_jacks = fp->out_ep[i].num_jacks;
586 1.1 tshiozak sc->sc_out_num_jacks += fp->out_ep[i].num_jacks;
587 1.3 tshiozak ep->num_open = 0;
588 1.3 tshiozak memset(ep->jacks, 0, sizeof(ep->jacks));
589 1.3 tshiozak ep++;
590 1.1 tshiozak }
591 1.3 tshiozak ep = &sc->sc_in_ep[0];
592 1.1 tshiozak for (i=0; i<sc->sc_in_num_endpoints; i++) {
593 1.1 tshiozak epd = usbd_interface2endpoint_descriptor(
594 1.1 tshiozak sc->sc_iface,
595 1.1 tshiozak fp->in_ep[i].ep);
596 1.1 tshiozak if (!epd) {
597 1.1 tshiozak printf("%s: cannot get endpoint descriptor(in:%d)\n",
598 1.1 tshiozak USBDEVNAME(sc->sc_dev), fp->in_ep[i].ep);
599 1.3 tshiozak err = USBD_INVAL;
600 1.1 tshiozak goto error;
601 1.1 tshiozak }
602 1.25.2.2 chap /*
603 1.25.2.2 chap * MIDISPORT_2X4 inputs on an interrupt rather than a bulk
604 1.25.2.2 chap * endpoint. The existing input logic in this driver seems
605 1.25.2.2 chap * to work successfully if we just stop treating an interrupt
606 1.25.2.2 chap * endpoint as illegal (or the in_progress status we get on
607 1.25.2.2 chap * the initial transfer). It does not seem necessary to
608 1.25.2.2 chap * actually use the interrupt flavor of alloc_pipe or make
609 1.25.2.2 chap * other serious rearrangements of logic. I like that.
610 1.25.2.2 chap */
611 1.25.2.2 chap switch ( UE_GET_XFERTYPE(epd->bmAttributes) ) {
612 1.25.2.2 chap case UE_BULK:
613 1.25.2.2 chap case UE_INTERRUPT:
614 1.25.2.2 chap if ( UE_DIR_IN == UE_GET_DIR(epd->bEndpointAddress) )
615 1.25.2.2 chap break;
616 1.25.2.2 chap /*FALLTHROUGH*/
617 1.25.2.2 chap default:
618 1.1 tshiozak printf("%s: illegal endpoint(in:%d)\n",
619 1.1 tshiozak USBDEVNAME(sc->sc_dev), fp->in_ep[i].ep);
620 1.3 tshiozak err = USBD_INVAL;
621 1.1 tshiozak goto error;
622 1.1 tshiozak }
623 1.25.2.2 chap
624 1.3 tshiozak ep->sc = sc;
625 1.3 tshiozak ep->addr = epd->bEndpointAddress;
626 1.3 tshiozak ep->num_jacks = fp->in_ep[i].num_jacks;
627 1.1 tshiozak sc->sc_in_num_jacks += fp->in_ep[i].num_jacks;
628 1.3 tshiozak ep->num_open = 0;
629 1.3 tshiozak memset(ep->jacks, 0, sizeof(ep->jacks));
630 1.3 tshiozak ep++;
631 1.1 tshiozak }
632 1.1 tshiozak
633 1.1 tshiozak return USBD_NORMAL_COMPLETION;
634 1.1 tshiozak error:
635 1.1 tshiozak free(sc->sc_endpoints, M_USBDEV);
636 1.1 tshiozak sc->sc_endpoints = NULL;
637 1.3 tshiozak return err;
638 1.1 tshiozak }
639 1.1 tshiozak
640 1.1 tshiozak static usbd_status
641 1.1 tshiozak alloc_all_endpoints_yamaha(struct umidi_softc *sc)
642 1.1 tshiozak {
643 1.1 tshiozak /* This driver currently supports max 1in/1out bulk endpoints */
644 1.1 tshiozak usb_descriptor_t *desc;
645 1.8 tshiozak usb_endpoint_descriptor_t *epd;
646 1.8 tshiozak int out_addr, in_addr, i;
647 1.8 tshiozak int dir;
648 1.1 tshiozak size_t remain, descsize;
649 1.1 tshiozak
650 1.8 tshiozak sc->sc_out_num_jacks = sc->sc_in_num_jacks = 0;
651 1.8 tshiozak out_addr = in_addr = 0;
652 1.8 tshiozak
653 1.8 tshiozak /* detect endpoints */
654 1.1 tshiozak desc = TO_D(usbd_get_interface_descriptor(sc->sc_iface));
655 1.8 tshiozak for (i=(int)TO_IFD(desc)->bNumEndpoints-1; i>=0; i--) {
656 1.8 tshiozak epd = usbd_interface2endpoint_descriptor(sc->sc_iface, i);
657 1.8 tshiozak if (UE_GET_XFERTYPE(epd->bmAttributes) == UE_BULK) {
658 1.8 tshiozak dir = UE_GET_DIR(epd->bEndpointAddress);
659 1.8 tshiozak if (dir==UE_DIR_OUT && !out_addr)
660 1.8 tshiozak out_addr = epd->bEndpointAddress;
661 1.8 tshiozak else if (dir==UE_DIR_IN && !in_addr)
662 1.8 tshiozak in_addr = epd->bEndpointAddress;
663 1.8 tshiozak }
664 1.8 tshiozak }
665 1.3 tshiozak desc = NEXT_D(desc);
666 1.1 tshiozak
667 1.8 tshiozak /* count jacks */
668 1.8 tshiozak if (!(desc->bDescriptorType==UDESC_CS_INTERFACE &&
669 1.8 tshiozak desc->bDescriptorSubtype==UMIDI_MS_HEADER))
670 1.8 tshiozak return USBD_INVAL;
671 1.8 tshiozak remain = (size_t)UGETW(TO_CSIFD(desc)->wTotalLength) -
672 1.8 tshiozak (size_t)desc->bLength;
673 1.8 tshiozak desc = NEXT_D(desc);
674 1.1 tshiozak
675 1.1 tshiozak while (remain>=sizeof(usb_descriptor_t)) {
676 1.1 tshiozak descsize = desc->bLength;
677 1.1 tshiozak if (descsize>remain || descsize==0)
678 1.1 tshiozak break;
679 1.1 tshiozak if (desc->bDescriptorType==UDESC_CS_INTERFACE &&
680 1.1 tshiozak remain>=UMIDI_JACK_DESCRIPTOR_SIZE) {
681 1.1 tshiozak if (desc->bDescriptorSubtype==UMIDI_OUT_JACK)
682 1.1 tshiozak sc->sc_out_num_jacks++;
683 1.1 tshiozak else if (desc->bDescriptorSubtype==UMIDI_IN_JACK)
684 1.1 tshiozak sc->sc_in_num_jacks++;
685 1.1 tshiozak }
686 1.1 tshiozak desc = NEXT_D(desc);
687 1.1 tshiozak remain-=descsize;
688 1.1 tshiozak }
689 1.1 tshiozak
690 1.8 tshiozak /* validate some parameters */
691 1.1 tshiozak if (sc->sc_out_num_jacks>UMIDI_MAX_EPJACKS)
692 1.1 tshiozak sc->sc_out_num_jacks = UMIDI_MAX_EPJACKS;
693 1.1 tshiozak if (sc->sc_in_num_jacks>UMIDI_MAX_EPJACKS)
694 1.1 tshiozak sc->sc_in_num_jacks = UMIDI_MAX_EPJACKS;
695 1.8 tshiozak if (sc->sc_out_num_jacks && out_addr) {
696 1.1 tshiozak sc->sc_out_num_endpoints = 1;
697 1.1 tshiozak } else {
698 1.1 tshiozak sc->sc_out_num_endpoints = 0;
699 1.1 tshiozak sc->sc_out_num_jacks = 0;
700 1.1 tshiozak }
701 1.8 tshiozak if (sc->sc_in_num_jacks && in_addr) {
702 1.1 tshiozak sc->sc_in_num_endpoints = 1;
703 1.1 tshiozak } else {
704 1.1 tshiozak sc->sc_in_num_endpoints = 0;
705 1.1 tshiozak sc->sc_in_num_jacks = 0;
706 1.1 tshiozak }
707 1.1 tshiozak sc->sc_endpoints = malloc(sizeof(struct umidi_endpoint)*
708 1.1 tshiozak (sc->sc_out_num_endpoints+
709 1.1 tshiozak sc->sc_in_num_endpoints),
710 1.1 tshiozak M_USBDEV, M_WAITOK);
711 1.1 tshiozak if (!sc->sc_endpoints)
712 1.1 tshiozak return USBD_NOMEM;
713 1.1 tshiozak if (sc->sc_out_num_endpoints) {
714 1.1 tshiozak sc->sc_out_ep = sc->sc_endpoints;
715 1.1 tshiozak sc->sc_out_ep->sc = sc;
716 1.1 tshiozak sc->sc_out_ep->addr = out_addr;
717 1.1 tshiozak sc->sc_out_ep->num_jacks = sc->sc_out_num_jacks;
718 1.1 tshiozak sc->sc_out_ep->num_open = 0;
719 1.1 tshiozak memset(sc->sc_out_ep->jacks, 0, sizeof(sc->sc_out_ep->jacks));
720 1.1 tshiozak } else
721 1.1 tshiozak sc->sc_out_ep = NULL;
722 1.1 tshiozak
723 1.1 tshiozak if (sc->sc_in_num_endpoints) {
724 1.1 tshiozak sc->sc_in_ep = sc->sc_endpoints+sc->sc_out_num_endpoints;
725 1.1 tshiozak sc->sc_in_ep->sc = sc;
726 1.1 tshiozak sc->sc_in_ep->addr = in_addr;
727 1.1 tshiozak sc->sc_in_ep->num_jacks = sc->sc_in_num_jacks;
728 1.1 tshiozak sc->sc_in_ep->num_open = 0;
729 1.1 tshiozak memset(sc->sc_in_ep->jacks, 0, sizeof(sc->sc_in_ep->jacks));
730 1.1 tshiozak } else
731 1.1 tshiozak sc->sc_in_ep = NULL;
732 1.1 tshiozak
733 1.1 tshiozak return USBD_NORMAL_COMPLETION;
734 1.1 tshiozak }
735 1.1 tshiozak
736 1.1 tshiozak static usbd_status
737 1.1 tshiozak alloc_all_endpoints_genuine(struct umidi_softc *sc)
738 1.1 tshiozak {
739 1.20 gson usb_interface_descriptor_t *interface_desc;
740 1.20 gson usb_config_descriptor_t *config_desc;
741 1.1 tshiozak usb_descriptor_t *desc;
742 1.7 tshiozak int num_ep;
743 1.1 tshiozak size_t remain, descsize;
744 1.1 tshiozak struct umidi_endpoint *p, *q, *lowest, *endep, tmpep;
745 1.1 tshiozak int epaddr;
746 1.1 tshiozak
747 1.20 gson interface_desc = usbd_get_interface_descriptor(sc->sc_iface);
748 1.20 gson num_ep = interface_desc->bNumEndpoints;
749 1.20 gson sc->sc_endpoints = p = malloc(sizeof(struct umidi_endpoint) * num_ep,
750 1.1 tshiozak M_USBDEV, M_WAITOK);
751 1.1 tshiozak if (!p)
752 1.1 tshiozak return USBD_NOMEM;
753 1.1 tshiozak
754 1.1 tshiozak sc->sc_out_num_jacks = sc->sc_in_num_jacks = 0;
755 1.1 tshiozak sc->sc_out_num_endpoints = sc->sc_in_num_endpoints = 0;
756 1.1 tshiozak epaddr = -1;
757 1.1 tshiozak
758 1.1 tshiozak /* get the list of endpoints for midi stream */
759 1.20 gson config_desc = usbd_get_config_descriptor(sc->sc_udev);
760 1.20 gson desc = (usb_descriptor_t *) config_desc;
761 1.20 gson remain = (size_t)UGETW(config_desc->wTotalLength);
762 1.1 tshiozak while (remain>=sizeof(usb_descriptor_t)) {
763 1.1 tshiozak descsize = desc->bLength;
764 1.1 tshiozak if (descsize>remain || descsize==0)
765 1.1 tshiozak break;
766 1.1 tshiozak if (desc->bDescriptorType==UDESC_ENDPOINT &&
767 1.1 tshiozak remain>=USB_ENDPOINT_DESCRIPTOR_SIZE &&
768 1.1 tshiozak UE_GET_XFERTYPE(TO_EPD(desc)->bmAttributes) == UE_BULK) {
769 1.1 tshiozak epaddr = TO_EPD(desc)->bEndpointAddress;
770 1.1 tshiozak } else if (desc->bDescriptorType==UDESC_CS_ENDPOINT &&
771 1.1 tshiozak remain>=UMIDI_CS_ENDPOINT_DESCRIPTOR_SIZE &&
772 1.1 tshiozak epaddr!=-1) {
773 1.1 tshiozak if (num_ep>0) {
774 1.9 tshiozak num_ep--;
775 1.1 tshiozak p->sc = sc;
776 1.1 tshiozak p->addr = epaddr;
777 1.1 tshiozak p->num_jacks = TO_CSEPD(desc)->bNumEmbMIDIJack;
778 1.1 tshiozak if (UE_GET_DIR(epaddr)==UE_DIR_OUT) {
779 1.1 tshiozak sc->sc_out_num_endpoints++;
780 1.1 tshiozak sc->sc_out_num_jacks += p->num_jacks;
781 1.1 tshiozak } else {
782 1.1 tshiozak sc->sc_in_num_endpoints++;
783 1.1 tshiozak sc->sc_in_num_jacks += p->num_jacks;
784 1.1 tshiozak }
785 1.1 tshiozak p++;
786 1.1 tshiozak }
787 1.1 tshiozak } else
788 1.1 tshiozak epaddr = -1;
789 1.1 tshiozak desc = NEXT_D(desc);
790 1.1 tshiozak remain-=descsize;
791 1.1 tshiozak }
792 1.1 tshiozak
793 1.1 tshiozak /* sort endpoints */
794 1.1 tshiozak num_ep = sc->sc_out_num_endpoints + sc->sc_in_num_endpoints;
795 1.1 tshiozak p = sc->sc_endpoints;
796 1.1 tshiozak endep = p + num_ep;
797 1.1 tshiozak while (p<endep) {
798 1.1 tshiozak lowest = p;
799 1.1 tshiozak for (q=p+1; q<endep; q++) {
800 1.1 tshiozak if ((UE_GET_DIR(lowest->addr)==UE_DIR_IN &&
801 1.1 tshiozak UE_GET_DIR(q->addr)==UE_DIR_OUT) ||
802 1.1 tshiozak ((UE_GET_DIR(lowest->addr)==
803 1.1 tshiozak UE_GET_DIR(q->addr)) &&
804 1.1 tshiozak (UE_GET_ADDR(lowest->addr)>
805 1.1 tshiozak UE_GET_ADDR(q->addr))))
806 1.1 tshiozak lowest = q;
807 1.1 tshiozak }
808 1.1 tshiozak if (lowest != p) {
809 1.1 tshiozak memcpy((void *)&tmpep, (void *)p, sizeof(tmpep));
810 1.1 tshiozak memcpy((void *)p, (void *)lowest, sizeof(tmpep));
811 1.1 tshiozak memcpy((void *)lowest, (void *)&tmpep, sizeof(tmpep));
812 1.1 tshiozak }
813 1.7 tshiozak p->num_open = 0;
814 1.7 tshiozak p++;
815 1.1 tshiozak }
816 1.16 augustss
817 1.1 tshiozak sc->sc_out_ep = sc->sc_out_num_endpoints ? sc->sc_endpoints : NULL;
818 1.1 tshiozak sc->sc_in_ep =
819 1.1 tshiozak sc->sc_in_num_endpoints ?
820 1.1 tshiozak sc->sc_endpoints+sc->sc_out_num_endpoints : NULL;
821 1.1 tshiozak
822 1.1 tshiozak return USBD_NORMAL_COMPLETION;
823 1.1 tshiozak }
824 1.1 tshiozak
825 1.1 tshiozak
826 1.4 tshiozak /*
827 1.4 tshiozak * jack stuffs
828 1.4 tshiozak */
829 1.4 tshiozak
830 1.1 tshiozak static usbd_status
831 1.1 tshiozak alloc_all_jacks(struct umidi_softc *sc)
832 1.1 tshiozak {
833 1.1 tshiozak int i, j;
834 1.1 tshiozak struct umidi_endpoint *ep;
835 1.25.2.9 chap struct umidi_jack *jack;
836 1.25.2.8 chap int cnglobal;
837 1.25.2.9 chap unsigned char *cn_spec;
838 1.25.2.8 chap
839 1.25.2.8 chap if (UMQ_ISTYPE(sc, UMQ_TYPE_CN_SEQ_PER_EP))
840 1.25.2.8 chap cnglobal = 0;
841 1.25.2.8 chap else if (UMQ_ISTYPE(sc, UMQ_TYPE_CN_SEQ_GLOBAL))
842 1.25.2.8 chap cnglobal = 1;
843 1.25.2.8 chap else {
844 1.25.2.8 chap /*
845 1.25.2.8 chap * I don't think this default is correct, but it preserves
846 1.25.2.8 chap * the prior behavior of the code. That's why I defined two
847 1.25.2.8 chap * complementary quirks. Any device for which the default
848 1.25.2.8 chap * behavior is wrong can be made to work by giving it an
849 1.25.2.8 chap * explicit quirk, and if a pattern ever develops (as I suspect
850 1.25.2.8 chap * it will) that a lot of otherwise standard USB MIDI devices
851 1.25.2.8 chap * need the CN_SEQ_PER_EP "quirk," then this default can be
852 1.25.2.8 chap * changed to 0, and the only devices that will break are those
853 1.25.2.8 chap * listing neither quirk, and they'll easily be fixed by giving
854 1.25.2.8 chap * them the CN_SEQ_GLOBAL quirk.
855 1.25.2.8 chap */
856 1.25.2.8 chap cnglobal = 1;
857 1.25.2.8 chap }
858 1.25.2.9 chap
859 1.25.2.9 chap if (UMQ_ISTYPE(sc, UMQ_TYPE_CN_FIXED))
860 1.25.2.9 chap cn_spec = umidi_get_quirk_data_from_type(sc->sc_quirk,
861 1.25.2.9 chap UMQ_TYPE_CN_FIXED);
862 1.25.2.9 chap else
863 1.25.2.9 chap cn_spec = NULL;
864 1.1 tshiozak
865 1.1 tshiozak /* allocate/initialize structures */
866 1.1 tshiozak sc->sc_jacks =
867 1.1 tshiozak malloc(sizeof(*sc->sc_out_jacks)*(sc->sc_in_num_jacks+
868 1.1 tshiozak sc->sc_out_num_jacks),
869 1.1 tshiozak M_USBDEV, M_WAITOK);
870 1.1 tshiozak if (!sc->sc_jacks)
871 1.1 tshiozak return USBD_NOMEM;
872 1.1 tshiozak sc->sc_out_jacks =
873 1.1 tshiozak sc->sc_out_num_jacks ? sc->sc_jacks : NULL;
874 1.1 tshiozak sc->sc_in_jacks =
875 1.1 tshiozak sc->sc_in_num_jacks ? sc->sc_jacks+sc->sc_out_num_jacks : NULL;
876 1.1 tshiozak
877 1.1 tshiozak jack = &sc->sc_out_jacks[0];
878 1.1 tshiozak for (i=0; i<sc->sc_out_num_jacks; i++) {
879 1.4 tshiozak jack->opened = 0;
880 1.4 tshiozak jack->binded = 0;
881 1.4 tshiozak jack->arg = NULL;
882 1.4 tshiozak jack->u.out.intr = NULL;
883 1.25.2.8 chap if ( cnglobal )
884 1.25.2.8 chap jack->cable_number = i;
885 1.1 tshiozak jack++;
886 1.1 tshiozak }
887 1.1 tshiozak jack = &sc->sc_in_jacks[0];
888 1.1 tshiozak for (i=0; i<sc->sc_in_num_jacks; i++) {
889 1.4 tshiozak jack->opened = 0;
890 1.4 tshiozak jack->binded = 0;
891 1.4 tshiozak jack->arg = NULL;
892 1.4 tshiozak jack->u.in.intr = NULL;
893 1.25.2.8 chap if ( cnglobal )
894 1.25.2.8 chap jack->cable_number = i;
895 1.1 tshiozak jack++;
896 1.1 tshiozak }
897 1.1 tshiozak
898 1.1 tshiozak /* assign each jacks to each endpoints */
899 1.1 tshiozak jack = &sc->sc_out_jacks[0];
900 1.1 tshiozak ep = &sc->sc_out_ep[0];
901 1.1 tshiozak for (i=0; i<sc->sc_out_num_endpoints; i++) {
902 1.1 tshiozak for (j=0; j<ep->num_jacks; j++) {
903 1.1 tshiozak jack->endpoint = ep;
904 1.25.2.9 chap if ( cn_spec != NULL )
905 1.25.2.9 chap jack->cable_number = *cn_spec++;
906 1.25.2.9 chap else if ( !cnglobal )
907 1.25.2.8 chap jack->cable_number = j;
908 1.25.2.9 chap ep->jacks[jack->cable_number] = jack;
909 1.1 tshiozak jack++;
910 1.1 tshiozak }
911 1.1 tshiozak ep++;
912 1.1 tshiozak }
913 1.1 tshiozak jack = &sc->sc_in_jacks[0];
914 1.1 tshiozak ep = &sc->sc_in_ep[0];
915 1.1 tshiozak for (i=0; i<sc->sc_in_num_endpoints; i++) {
916 1.1 tshiozak for (j=0; j<ep->num_jacks; j++) {
917 1.1 tshiozak jack->endpoint = ep;
918 1.25.2.9 chap if ( cn_spec != NULL )
919 1.25.2.9 chap jack->cable_number = *cn_spec++;
920 1.25.2.9 chap else if ( !cnglobal )
921 1.25.2.8 chap jack->cable_number = j;
922 1.25.2.9 chap ep->jacks[jack->cable_number] = jack;
923 1.1 tshiozak jack++;
924 1.1 tshiozak }
925 1.1 tshiozak ep++;
926 1.1 tshiozak }
927 1.1 tshiozak
928 1.1 tshiozak return USBD_NORMAL_COMPLETION;
929 1.1 tshiozak }
930 1.1 tshiozak
931 1.1 tshiozak static void
932 1.1 tshiozak free_all_jacks(struct umidi_softc *sc)
933 1.1 tshiozak {
934 1.1 tshiozak int s;
935 1.1 tshiozak
936 1.1 tshiozak s = splaudio();
937 1.1 tshiozak if (sc->sc_out_jacks) {
938 1.1 tshiozak free(sc->sc_jacks, M_USBDEV);
939 1.1 tshiozak sc->sc_jacks = sc->sc_in_jacks = sc->sc_out_jacks = NULL;
940 1.1 tshiozak }
941 1.1 tshiozak splx(s);
942 1.1 tshiozak }
943 1.1 tshiozak
944 1.1 tshiozak static usbd_status
945 1.1 tshiozak bind_jacks_to_mididev(struct umidi_softc *sc,
946 1.1 tshiozak struct umidi_jack *out_jack,
947 1.1 tshiozak struct umidi_jack *in_jack,
948 1.1 tshiozak struct umidi_mididev *mididev)
949 1.1 tshiozak {
950 1.8 tshiozak if ((out_jack && out_jack->binded) || (in_jack && in_jack->binded))
951 1.4 tshiozak return USBD_IN_USE;
952 1.4 tshiozak if (mididev->out_jack || mididev->in_jack)
953 1.1 tshiozak return USBD_IN_USE;
954 1.1 tshiozak
955 1.4 tshiozak if (out_jack)
956 1.4 tshiozak out_jack->binded = 1;
957 1.4 tshiozak if (in_jack)
958 1.4 tshiozak in_jack->binded = 1;
959 1.1 tshiozak mididev->in_jack = in_jack;
960 1.1 tshiozak mididev->out_jack = out_jack;
961 1.1 tshiozak
962 1.1 tshiozak return USBD_NORMAL_COMPLETION;
963 1.1 tshiozak }
964 1.1 tshiozak
965 1.4 tshiozak static void
966 1.1 tshiozak unbind_jacks_from_mididev(struct umidi_mididev *mididev)
967 1.1 tshiozak {
968 1.15 tshiozak if ((mididev->flags & FWRITE) && mididev->out_jack)
969 1.4 tshiozak close_out_jack(mididev->out_jack);
970 1.15 tshiozak if ((mididev->flags & FREAD) && mididev->in_jack)
971 1.4 tshiozak close_in_jack(mididev->in_jack);
972 1.1 tshiozak
973 1.4 tshiozak if (mididev->out_jack)
974 1.4 tshiozak mididev->out_jack->binded = 0;
975 1.4 tshiozak if (mididev->in_jack)
976 1.4 tshiozak mididev->in_jack->binded = 0;
977 1.4 tshiozak mididev->out_jack = mididev->in_jack = NULL;
978 1.1 tshiozak }
979 1.1 tshiozak
980 1.4 tshiozak static void
981 1.1 tshiozak unbind_all_jacks(struct umidi_softc *sc)
982 1.1 tshiozak {
983 1.1 tshiozak int i;
984 1.1 tshiozak
985 1.1 tshiozak if (sc->sc_mididevs)
986 1.1 tshiozak for (i=0; i<sc->sc_num_mididevs; i++) {
987 1.4 tshiozak unbind_jacks_from_mididev(&sc->sc_mididevs[i]);
988 1.1 tshiozak }
989 1.1 tshiozak }
990 1.1 tshiozak
991 1.1 tshiozak static usbd_status
992 1.1 tshiozak assign_all_jacks_automatically(struct umidi_softc *sc)
993 1.1 tshiozak {
994 1.1 tshiozak usbd_status err;
995 1.1 tshiozak int i;
996 1.1 tshiozak struct umidi_jack *out, *in;
997 1.25.2.9 chap signed char *asg_spec;
998 1.1 tshiozak
999 1.1 tshiozak err =
1000 1.1 tshiozak alloc_all_mididevs(sc,
1001 1.1 tshiozak max(sc->sc_out_num_jacks, sc->sc_in_num_jacks));
1002 1.1 tshiozak if (err!=USBD_NORMAL_COMPLETION)
1003 1.1 tshiozak return err;
1004 1.1 tshiozak
1005 1.25.2.9 chap if ( UMQ_ISTYPE(sc, UMQ_TYPE_MD_FIXED))
1006 1.25.2.9 chap asg_spec = umidi_get_quirk_data_from_type(sc->sc_quirk,
1007 1.25.2.9 chap UMQ_TYPE_MD_FIXED);
1008 1.25.2.9 chap else
1009 1.25.2.9 chap asg_spec = NULL;
1010 1.25.2.9 chap
1011 1.1 tshiozak for (i=0; i<sc->sc_num_mididevs; i++) {
1012 1.25.2.9 chap if ( asg_spec != NULL ) {
1013 1.25.2.9 chap if ( *asg_spec == -1 )
1014 1.25.2.9 chap out = NULL;
1015 1.25.2.9 chap else
1016 1.25.2.9 chap out = &sc->sc_out_jacks[*asg_spec];
1017 1.25.2.9 chap ++ asg_spec;
1018 1.25.2.9 chap if ( *asg_spec == -1 )
1019 1.25.2.9 chap in = NULL;
1020 1.25.2.9 chap else
1021 1.25.2.9 chap in = &sc->sc_in_jacks[*asg_spec];
1022 1.25.2.9 chap ++ asg_spec;
1023 1.25.2.9 chap } else {
1024 1.25.2.9 chap out = (i<sc->sc_out_num_jacks) ? &sc->sc_out_jacks[i]
1025 1.25.2.9 chap : NULL;
1026 1.25.2.9 chap in = (i<sc->sc_in_num_jacks) ? &sc->sc_in_jacks[i]
1027 1.25.2.9 chap : NULL;
1028 1.25.2.9 chap }
1029 1.1 tshiozak err = bind_jacks_to_mididev(sc, out, in, &sc->sc_mididevs[i]);
1030 1.1 tshiozak if (err!=USBD_NORMAL_COMPLETION) {
1031 1.1 tshiozak free_all_mididevs(sc);
1032 1.1 tshiozak return err;
1033 1.1 tshiozak }
1034 1.1 tshiozak }
1035 1.1 tshiozak
1036 1.1 tshiozak return USBD_NORMAL_COMPLETION;
1037 1.1 tshiozak }
1038 1.1 tshiozak
1039 1.1 tshiozak static usbd_status
1040 1.4 tshiozak open_out_jack(struct umidi_jack *jack, void *arg, void (*intr)(void *))
1041 1.4 tshiozak {
1042 1.4 tshiozak struct umidi_endpoint *ep = jack->endpoint;
1043 1.25.2.10 chap umidi_packet_bufp end;
1044 1.25.2.10 chap int s;
1045 1.25.2.10 chap int err;
1046 1.4 tshiozak
1047 1.4 tshiozak if (jack->opened)
1048 1.4 tshiozak return USBD_IN_USE;
1049 1.4 tshiozak
1050 1.4 tshiozak jack->arg = arg;
1051 1.4 tshiozak jack->u.out.intr = intr;
1052 1.25.2.10 chap end = ep->buffer + ep->buffer_size / sizeof *ep->buffer;
1053 1.25.2.10 chap s = splusb();
1054 1.4 tshiozak jack->opened = 1;
1055 1.4 tshiozak ep->num_open++;
1056 1.25.2.10 chap /*
1057 1.25.2.10 chap * out_solicit maintains an invariant that there will always be
1058 1.25.2.10 chap * (num_open - num_scheduled) slots free in the buffer. as we have
1059 1.25.2.10 chap * just incremented num_open, the buffer may be too full to satisfy
1060 1.25.2.10 chap * the invariant until a transfer completes, for which we must wait.
1061 1.25.2.10 chap */
1062 1.25.2.10 chap while ( end - ep->next_slot < ep->num_open - ep->num_scheduled ) {
1063 1.25.2.10 chap err = tsleep(ep, PWAIT|PCATCH, "umi op", mstohz(10));
1064 1.25.2.10 chap if ( err ) {
1065 1.25.2.10 chap ep->num_open--;
1066 1.25.2.10 chap jack->opened = 0;
1067 1.25.2.10 chap splx(s);
1068 1.25.2.10 chap return USBD_IOERROR;
1069 1.25.2.10 chap }
1070 1.25.2.10 chap }
1071 1.25.2.10 chap splx(s);
1072 1.4 tshiozak
1073 1.4 tshiozak return USBD_NORMAL_COMPLETION;
1074 1.4 tshiozak }
1075 1.4 tshiozak
1076 1.4 tshiozak static usbd_status
1077 1.4 tshiozak open_in_jack(struct umidi_jack *jack, void *arg, void (*intr)(void *, int))
1078 1.1 tshiozak {
1079 1.3 tshiozak usbd_status err = USBD_NORMAL_COMPLETION;
1080 1.3 tshiozak struct umidi_endpoint *ep = jack->endpoint;
1081 1.3 tshiozak
1082 1.4 tshiozak if (jack->opened)
1083 1.4 tshiozak return USBD_IN_USE;
1084 1.4 tshiozak
1085 1.4 tshiozak jack->arg = arg;
1086 1.4 tshiozak jack->u.in.intr = intr;
1087 1.4 tshiozak jack->opened = 1;
1088 1.3 tshiozak if (ep->num_open++==0 && UE_GET_DIR(ep->addr)==UE_DIR_IN) {
1089 1.3 tshiozak err = start_input_transfer(ep);
1090 1.18 gson if (err != USBD_NORMAL_COMPLETION &&
1091 1.18 gson err != USBD_IN_PROGRESS) {
1092 1.3 tshiozak ep->num_open--;
1093 1.3 tshiozak }
1094 1.3 tshiozak }
1095 1.3 tshiozak
1096 1.3 tshiozak return err;
1097 1.1 tshiozak }
1098 1.1 tshiozak
1099 1.1 tshiozak static void
1100 1.4 tshiozak close_out_jack(struct umidi_jack *jack)
1101 1.1 tshiozak {
1102 1.25.2.10 chap struct umidi_endpoint *ep;
1103 1.3 tshiozak int s;
1104 1.25.2.10 chap u_int16_t mask;
1105 1.25.2.10 chap int err;
1106 1.4 tshiozak
1107 1.4 tshiozak if (jack->opened) {
1108 1.25.2.10 chap ep = jack->endpoint;
1109 1.25.2.10 chap mask = 1 << (jack->cable_number);
1110 1.4 tshiozak s = splusb();
1111 1.25.2.10 chap while ( mask & (ep->this_schedule | ep->next_schedule) ) {
1112 1.25.2.10 chap err = tsleep(ep, PWAIT|PCATCH, "umi dr", mstohz(10));
1113 1.25.2.10 chap if ( err )
1114 1.15 tshiozak break;
1115 1.3 tshiozak }
1116 1.4 tshiozak jack->opened = 0;
1117 1.4 tshiozak jack->endpoint->num_open--;
1118 1.25.2.10 chap ep->this_schedule &= ~mask;
1119 1.25.2.10 chap ep->next_schedule &= ~mask;
1120 1.25.2.10 chap splx(s);
1121 1.3 tshiozak }
1122 1.1 tshiozak }
1123 1.1 tshiozak
1124 1.4 tshiozak static void
1125 1.4 tshiozak close_in_jack(struct umidi_jack *jack)
1126 1.4 tshiozak {
1127 1.4 tshiozak if (jack->opened) {
1128 1.4 tshiozak jack->opened = 0;
1129 1.19 gson if (--jack->endpoint->num_open == 0) {
1130 1.19 gson usbd_abort_pipe(jack->endpoint->pipe);
1131 1.19 gson }
1132 1.4 tshiozak }
1133 1.4 tshiozak }
1134 1.1 tshiozak
1135 1.1 tshiozak static usbd_status
1136 1.1 tshiozak attach_mididev(struct umidi_softc *sc, struct umidi_mididev *mididev)
1137 1.1 tshiozak {
1138 1.1 tshiozak if (mididev->sc)
1139 1.1 tshiozak return USBD_IN_USE;
1140 1.1 tshiozak
1141 1.1 tshiozak mididev->sc = sc;
1142 1.1 tshiozak
1143 1.1 tshiozak mididev->mdev = midi_attach_mi(&umidi_hw_if, mididev, &sc->sc_dev);
1144 1.1 tshiozak
1145 1.1 tshiozak return USBD_NORMAL_COMPLETION;
1146 1.1 tshiozak }
1147 1.1 tshiozak
1148 1.1 tshiozak static usbd_status
1149 1.1 tshiozak detach_mididev(struct umidi_mididev *mididev, int flags)
1150 1.1 tshiozak {
1151 1.1 tshiozak if (!mididev->sc)
1152 1.1 tshiozak return USBD_NO_ADDR;
1153 1.1 tshiozak
1154 1.1 tshiozak if (mididev->opened) {
1155 1.1 tshiozak umidi_close(mididev);
1156 1.1 tshiozak }
1157 1.4 tshiozak unbind_jacks_from_mididev(mididev);
1158 1.1 tshiozak
1159 1.1 tshiozak if (mididev->mdev)
1160 1.1 tshiozak config_detach(mididev->mdev, flags);
1161 1.1 tshiozak
1162 1.1 tshiozak mididev->sc = NULL;
1163 1.1 tshiozak
1164 1.1 tshiozak return USBD_NORMAL_COMPLETION;
1165 1.1 tshiozak }
1166 1.1 tshiozak
1167 1.1 tshiozak static usbd_status
1168 1.1 tshiozak deactivate_mididev(struct umidi_mididev *mididev)
1169 1.1 tshiozak {
1170 1.4 tshiozak if (mididev->out_jack)
1171 1.4 tshiozak mididev->out_jack->binded = 0;
1172 1.4 tshiozak if (mididev->in_jack)
1173 1.4 tshiozak mididev->in_jack->binded = 0;
1174 1.1 tshiozak config_deactivate(mididev->mdev);
1175 1.1 tshiozak
1176 1.1 tshiozak return USBD_NORMAL_COMPLETION;
1177 1.1 tshiozak }
1178 1.1 tshiozak
1179 1.1 tshiozak static usbd_status
1180 1.1 tshiozak alloc_all_mididevs(struct umidi_softc *sc, int nmidi)
1181 1.1 tshiozak {
1182 1.1 tshiozak sc->sc_num_mididevs = nmidi;
1183 1.1 tshiozak sc->sc_mididevs = malloc(sizeof(*sc->sc_mididevs)*nmidi,
1184 1.13 tsutsui M_USBDEV, M_WAITOK|M_ZERO);
1185 1.1 tshiozak if (!sc->sc_mididevs)
1186 1.1 tshiozak return USBD_NOMEM;
1187 1.1 tshiozak
1188 1.1 tshiozak return USBD_NORMAL_COMPLETION;
1189 1.1 tshiozak }
1190 1.1 tshiozak
1191 1.1 tshiozak static void
1192 1.1 tshiozak free_all_mididevs(struct umidi_softc *sc)
1193 1.1 tshiozak {
1194 1.1 tshiozak sc->sc_num_mididevs = 0;
1195 1.1 tshiozak if (sc->sc_mididevs)
1196 1.1 tshiozak free(sc->sc_mididevs, M_USBDEV);
1197 1.1 tshiozak }
1198 1.1 tshiozak
1199 1.1 tshiozak static usbd_status
1200 1.1 tshiozak attach_all_mididevs(struct umidi_softc *sc)
1201 1.1 tshiozak {
1202 1.1 tshiozak usbd_status err;
1203 1.1 tshiozak int i;
1204 1.1 tshiozak
1205 1.1 tshiozak if (sc->sc_mididevs)
1206 1.1 tshiozak for (i=0; i<sc->sc_num_mididevs; i++) {
1207 1.1 tshiozak err = attach_mididev(sc, &sc->sc_mididevs[i]);
1208 1.1 tshiozak if (err!=USBD_NORMAL_COMPLETION)
1209 1.1 tshiozak return err;
1210 1.1 tshiozak }
1211 1.1 tshiozak
1212 1.1 tshiozak return USBD_NORMAL_COMPLETION;
1213 1.1 tshiozak }
1214 1.1 tshiozak
1215 1.1 tshiozak static usbd_status
1216 1.1 tshiozak detach_all_mididevs(struct umidi_softc *sc, int flags)
1217 1.1 tshiozak {
1218 1.1 tshiozak usbd_status err;
1219 1.1 tshiozak int i;
1220 1.1 tshiozak
1221 1.1 tshiozak if (sc->sc_mididevs)
1222 1.1 tshiozak for (i=0; i<sc->sc_num_mididevs; i++) {
1223 1.1 tshiozak err = detach_mididev(&sc->sc_mididevs[i], flags);
1224 1.1 tshiozak if (err!=USBD_NORMAL_COMPLETION)
1225 1.1 tshiozak return err;
1226 1.1 tshiozak }
1227 1.1 tshiozak
1228 1.1 tshiozak return USBD_NORMAL_COMPLETION;
1229 1.1 tshiozak }
1230 1.1 tshiozak
1231 1.1 tshiozak static usbd_status
1232 1.1 tshiozak deactivate_all_mididevs(struct umidi_softc *sc)
1233 1.1 tshiozak {
1234 1.1 tshiozak usbd_status err;
1235 1.1 tshiozak int i;
1236 1.1 tshiozak
1237 1.1 tshiozak if (sc->sc_mididevs)
1238 1.1 tshiozak for (i=0; i<sc->sc_num_mididevs; i++) {
1239 1.1 tshiozak err = deactivate_mididev(&sc->sc_mididevs[i]);
1240 1.1 tshiozak if (err!=USBD_NORMAL_COMPLETION)
1241 1.1 tshiozak return err;
1242 1.1 tshiozak }
1243 1.1 tshiozak
1244 1.1 tshiozak return USBD_NORMAL_COMPLETION;
1245 1.1 tshiozak }
1246 1.1 tshiozak
1247 1.1 tshiozak #ifdef UMIDI_DEBUG
1248 1.1 tshiozak static void
1249 1.1 tshiozak dump_sc(struct umidi_softc *sc)
1250 1.1 tshiozak {
1251 1.1 tshiozak int i;
1252 1.1 tshiozak
1253 1.1 tshiozak DPRINTFN(10, ("%s: dump_sc\n", USBDEVNAME(sc->sc_dev)));
1254 1.1 tshiozak for (i=0; i<sc->sc_out_num_endpoints; i++) {
1255 1.1 tshiozak DPRINTFN(10, ("\tout_ep(%p):\n", &sc->sc_out_ep[i]));
1256 1.1 tshiozak dump_ep(&sc->sc_out_ep[i]);
1257 1.1 tshiozak }
1258 1.1 tshiozak for (i=0; i<sc->sc_in_num_endpoints; i++) {
1259 1.1 tshiozak DPRINTFN(10, ("\tin_ep(%p):\n", &sc->sc_in_ep[i]));
1260 1.1 tshiozak dump_ep(&sc->sc_in_ep[i]);
1261 1.1 tshiozak }
1262 1.1 tshiozak }
1263 1.1 tshiozak
1264 1.1 tshiozak static void
1265 1.1 tshiozak dump_ep(struct umidi_endpoint *ep)
1266 1.1 tshiozak {
1267 1.1 tshiozak int i;
1268 1.1 tshiozak for (i=0; i<ep->num_jacks; i++) {
1269 1.1 tshiozak DPRINTFN(10, ("\t\tjack(%p):\n", ep->jacks[i]));
1270 1.1 tshiozak dump_jack(ep->jacks[i]);
1271 1.1 tshiozak }
1272 1.1 tshiozak }
1273 1.1 tshiozak static void
1274 1.1 tshiozak dump_jack(struct umidi_jack *jack)
1275 1.1 tshiozak {
1276 1.15 tshiozak DPRINTFN(10, ("\t\t\tep=%p\n",
1277 1.15 tshiozak jack->endpoint));
1278 1.1 tshiozak }
1279 1.1 tshiozak
1280 1.1 tshiozak #endif /* UMIDI_DEBUG */
1281 1.1 tshiozak
1282 1.1 tshiozak
1283 1.1 tshiozak
1284 1.1 tshiozak /*
1285 1.1 tshiozak * MUX MIDI PACKET
1286 1.1 tshiozak */
1287 1.1 tshiozak
1288 1.5 jdolecek static const int packet_length[16] = {
1289 1.1 tshiozak /*0*/ -1,
1290 1.1 tshiozak /*1*/ -1,
1291 1.1 tshiozak /*2*/ 2,
1292 1.1 tshiozak /*3*/ 3,
1293 1.1 tshiozak /*4*/ 3,
1294 1.1 tshiozak /*5*/ 1,
1295 1.1 tshiozak /*6*/ 2,
1296 1.1 tshiozak /*7*/ 3,
1297 1.1 tshiozak /*8*/ 3,
1298 1.1 tshiozak /*9*/ 3,
1299 1.1 tshiozak /*A*/ 3,
1300 1.1 tshiozak /*B*/ 3,
1301 1.1 tshiozak /*C*/ 2,
1302 1.1 tshiozak /*D*/ 2,
1303 1.1 tshiozak /*E*/ 3,
1304 1.1 tshiozak /*F*/ 1,
1305 1.1 tshiozak };
1306 1.1 tshiozak
1307 1.1 tshiozak #define GET_CN(p) (((unsigned char)(p)>>4)&0x0F)
1308 1.1 tshiozak #define GET_CIN(p) ((unsigned char)(p)&0x0F)
1309 1.1 tshiozak #define MIX_CN_CIN(cn, cin) \
1310 1.1 tshiozak ((unsigned char)((((unsigned char)(cn)&0x0F)<<4)| \
1311 1.3 tshiozak ((unsigned char)(cin)&0x0F)))
1312 1.1 tshiozak
1313 1.1 tshiozak static usbd_status
1314 1.1 tshiozak start_input_transfer(struct umidi_endpoint *ep)
1315 1.1 tshiozak {
1316 1.1 tshiozak usbd_setup_xfer(ep->xfer, ep->pipe,
1317 1.1 tshiozak (usbd_private_handle)ep,
1318 1.25.2.4 chap ep->buffer, ep->buffer_size,
1319 1.25.2.4 chap USBD_SHORT_XFER_OK | USBD_NO_COPY,
1320 1.25.2.4 chap USBD_NO_TIMEOUT, in_intr);
1321 1.1 tshiozak return usbd_transfer(ep->xfer);
1322 1.1 tshiozak }
1323 1.1 tshiozak
1324 1.1 tshiozak static usbd_status
1325 1.1 tshiozak start_output_transfer(struct umidi_endpoint *ep)
1326 1.1 tshiozak {
1327 1.25.2.10 chap u_int32_t length;
1328 1.25.2.10 chap length = (ep->next_slot - ep->buffer) * sizeof *ep->buffer;
1329 1.25.2.10 chap DPRINTFN(200,("umidi out transfer: start %p end %p length %u\n",
1330 1.25.2.10 chap ep->buffer, ep->next_slot, length));
1331 1.1 tshiozak usbd_setup_xfer(ep->xfer, ep->pipe,
1332 1.1 tshiozak (usbd_private_handle)ep,
1333 1.25.2.10 chap ep->buffer, length,
1334 1.11 augustss USBD_NO_COPY, USBD_NO_TIMEOUT, out_intr);
1335 1.1 tshiozak return usbd_transfer(ep->xfer);
1336 1.1 tshiozak }
1337 1.1 tshiozak
1338 1.4 tshiozak #ifdef UMIDI_DEBUG
1339 1.4 tshiozak #define DPR_PACKET(dir, sc, p) \
1340 1.25.2.10 chap if ((unsigned char)(p)[1]!=0xFE) \
1341 1.4 tshiozak DPRINTFN(500, \
1342 1.4 tshiozak ("%s: umidi packet(" #dir "): %02X %02X %02X %02X\n", \
1343 1.4 tshiozak USBDEVNAME(sc->sc_dev), \
1344 1.25.2.10 chap (unsigned char)(p)[0], \
1345 1.25.2.10 chap (unsigned char)(p)[1], \
1346 1.25.2.10 chap (unsigned char)(p)[2], \
1347 1.25.2.10 chap (unsigned char)(p)[3]));
1348 1.4 tshiozak #else
1349 1.4 tshiozak #define DPR_PACKET(dir, sc, p)
1350 1.4 tshiozak #endif
1351 1.4 tshiozak
1352 1.25.2.4 chap /*
1353 1.25.2.4 chap * A 4-byte Midiman packet superficially resembles a 4-byte USB MIDI packet
1354 1.25.2.4 chap * with the cable number and length in the last byte instead of the first,
1355 1.25.2.4 chap * but there the resemblance ends. Where a USB MIDI packet is a semantic
1356 1.25.2.4 chap * unit, a Midiman packet is just a wrapper for 1 to 3 bytes of raw MIDI
1357 1.25.2.4 chap * with a cable nybble and a length nybble (which, unlike the CIN of a
1358 1.25.2.4 chap * real USB MIDI packet, has no semantics at all besides the length).
1359 1.25.2.4 chap * A packet received from a Midiman may contain part of a MIDI message,
1360 1.25.2.4 chap * more than one MIDI message, or parts of more than one MIDI message. A
1361 1.25.2.4 chap * three-byte MIDI message may arrive in three packets of data length 1, and
1362 1.25.2.4 chap * running status may be used. Happily, the midi(4) driver above us will put
1363 1.25.2.4 chap * it all back together, so the only cost is in USB bandwidth. The device
1364 1.25.2.4 chap * has an easier time with what it receives from us, as we'll just take
1365 1.25.2.4 chap * already formed, semantically reasonable USB MIDI packets and munge them
1366 1.25.2.4 chap * into Midiman form.
1367 1.25.2.4 chap */
1368 1.25.2.2 chap
1369 1.4 tshiozak static int
1370 1.25.2.5 chap out_jack_output(struct umidi_jack *out_jack, u_char *src, int len, int cin)
1371 1.4 tshiozak {
1372 1.4 tshiozak struct umidi_endpoint *ep = out_jack->endpoint;
1373 1.4 tshiozak struct umidi_softc *sc = ep->sc;
1374 1.25.2.10 chap unsigned char *packet;
1375 1.4 tshiozak int s;
1376 1.4 tshiozak
1377 1.4 tshiozak if (sc->sc_dying)
1378 1.4 tshiozak return EIO;
1379 1.4 tshiozak
1380 1.25.2.5 chap if (!out_jack->opened)
1381 1.25.2.5 chap return ENODEV; /* XXX as it was, is this the right errno? */
1382 1.25.2.5 chap
1383 1.25.2.10 chap #ifdef UMIDI_DEBUG
1384 1.25.2.10 chap if ( umididebug >= 100 )
1385 1.25.2.10 chap microtime(&umidi_tv);
1386 1.25.2.10 chap #endif
1387 1.25.2.10 chap DPRINTFN(100, ("umidi out: %lu.%06lus ep=%p cn=%d len=%d cin=%#x\n",
1388 1.25.2.10 chap umidi_tv.tv_sec%100, umidi_tv.tv_usec,
1389 1.25.2.10 chap ep, out_jack->cable_number, len, cin));
1390 1.25.2.5 chap
1391 1.25.2.10 chap s = splusb();
1392 1.25.2.10 chap packet = *ep->next_slot++;
1393 1.25.2.10 chap KASSERT(ep->buffer_size >=
1394 1.25.2.10 chap (ep->next_slot - ep->buffer) * sizeof *ep->buffer);
1395 1.25.2.10 chap memset(packet, 0, UMIDI_PACKET_SIZE);
1396 1.25.2.5 chap if (UMQ_ISTYPE(sc, UMQ_TYPE_MIDIMAN_GARBLE)) {
1397 1.25.2.10 chap memcpy(packet, src, len);
1398 1.25.2.10 chap packet[3] = MIX_CN_CIN(out_jack->cable_number, len);
1399 1.25.2.5 chap } else {
1400 1.25.2.10 chap packet[0] = MIX_CN_CIN(out_jack->cable_number, cin);
1401 1.25.2.10 chap memcpy(packet+1, src, len);
1402 1.25.2.5 chap }
1403 1.25.2.10 chap DPR_PACKET(out, sc, packet);
1404 1.25.2.10 chap ep->next_schedule |= 1<<(out_jack->cable_number);
1405 1.25.2.10 chap ++ ep->num_scheduled;
1406 1.25.2.10 chap if ( !ep->armed && !ep->soliciting ) {
1407 1.25.2.10 chap #ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
1408 1.25.2.10 chap /*
1409 1.25.2.10 chap * It would be bad to call out_solicit directly here (the
1410 1.25.2.10 chap * caller need not be reentrant) but a soft interrupt allows
1411 1.25.2.10 chap * solicit to run immediately the caller exits its critical
1412 1.25.2.10 chap * section, and if the caller has more to write we can get it
1413 1.25.2.10 chap * before starting the USB transfer, and send a longer one.
1414 1.25.2.10 chap */
1415 1.25.2.10 chap ep->soliciting = 1;
1416 1.25.2.10 chap softintr_schedule(ep->solicit_cookie);
1417 1.25.2.10 chap #else
1418 1.25.2.10 chap /*
1419 1.25.2.10 chap * This alternative is a little less desirable, because if the
1420 1.25.2.10 chap * writer has several messages to go at once, the first will go
1421 1.25.2.10 chap * in a USB frame all to itself, and the rest in a full-size
1422 1.25.2.10 chap * transfer one frame later (solicited on the first frame's
1423 1.25.2.10 chap * completion interrupt). But it's simple.
1424 1.25.2.10 chap */
1425 1.25.2.10 chap ep->armed = (USBD_IN_PROGRESS == start_output_transfer(ep));
1426 1.25.2.10 chap #endif
1427 1.25.2.5 chap }
1428 1.25.2.5 chap splx(s);
1429 1.25.2.10 chap
1430 1.25.2.10 chap return 0;
1431 1.4 tshiozak }
1432 1.4 tshiozak
1433 1.1 tshiozak static void
1434 1.1 tshiozak in_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
1435 1.1 tshiozak {
1436 1.25.2.9 chap int cn, len, i;
1437 1.1 tshiozak struct umidi_endpoint *ep = (struct umidi_endpoint *)priv;
1438 1.4 tshiozak struct umidi_jack *jack;
1439 1.25.2.4 chap unsigned char *packet;
1440 1.25.2.10 chap umidi_packet_bufp slot;
1441 1.25.2.10 chap umidi_packet_bufp end;
1442 1.25.2.3 chap unsigned char *data;
1443 1.25.2.4 chap u_int32_t count;
1444 1.1 tshiozak
1445 1.3 tshiozak if (ep->sc->sc_dying || !ep->num_open)
1446 1.1 tshiozak return;
1447 1.1 tshiozak
1448 1.25.2.4 chap usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
1449 1.25.2.4 chap if ( 0 == count % UMIDI_PACKET_SIZE ) {
1450 1.25.2.10 chap DPRINTFN(200,("%s: input endpoint %p transfer length %u\n",
1451 1.25.2.4 chap USBDEVNAME(ep->sc->sc_dev), ep, count));
1452 1.25.2.4 chap } else {
1453 1.25.2.4 chap DPRINTF(("%s: input endpoint %p odd transfer length %u\n",
1454 1.25.2.4 chap USBDEVNAME(ep->sc->sc_dev), ep, count));
1455 1.25.2.4 chap }
1456 1.25.2.8 chap
1457 1.25.2.8 chap slot = ep->buffer;
1458 1.25.2.8 chap end = slot + count / sizeof *slot;
1459 1.25.2.4 chap
1460 1.25.2.8 chap for ( packet = *slot; slot < end; packet = *++slot ) {
1461 1.25.2.4 chap
1462 1.25.2.4 chap if ( UMQ_ISTYPE(ep->sc, UMQ_TYPE_MIDIMAN_GARBLE) ) {
1463 1.25.2.4 chap cn = (0xf0&(packet[3]))>>4;
1464 1.25.2.4 chap len = 0x0f&(packet[3]);
1465 1.25.2.4 chap data = packet;
1466 1.25.2.4 chap } else {
1467 1.25.2.4 chap cn = GET_CN(packet[0]);
1468 1.25.2.4 chap len = packet_length[GET_CIN(packet[0])];
1469 1.25.2.4 chap data = packet + 1;
1470 1.25.2.4 chap }
1471 1.25.2.9 chap /* 0 <= cn <= 15 by inspection of above code */
1472 1.25.2.9 chap if (!(jack = ep->jacks[cn]) || cn != jack->cable_number) {
1473 1.25.2.4 chap DPRINTF(("%s: stray input endpoint %p cable %d len %d: "
1474 1.25.2.8 chap "%02X %02X %02X (try CN_SEQ quirk?)\n",
1475 1.25.2.4 chap USBDEVNAME(ep->sc->sc_dev), ep, cn, len,
1476 1.25.2.4 chap (unsigned)data[0],
1477 1.25.2.4 chap (unsigned)data[1],
1478 1.25.2.4 chap (unsigned)data[2]));
1479 1.25.2.4 chap return;
1480 1.25.2.4 chap }
1481 1.25.2.4 chap
1482 1.25.2.4 chap if (!jack->binded || !jack->opened)
1483 1.25.2.4 chap return;
1484 1.25.2.4 chap
1485 1.25.2.4 chap DPRINTFN(500,("%s: input endpoint %p cable %d len %d: "
1486 1.25.2.4 chap "%02X %02X %02X\n",
1487 1.25.2.4 chap USBDEVNAME(ep->sc->sc_dev), ep, cn, len,
1488 1.25.2.4 chap (unsigned)data[0],
1489 1.25.2.4 chap (unsigned)data[1],
1490 1.25.2.4 chap (unsigned)data[2]));
1491 1.25.2.4 chap
1492 1.25.2.4 chap if (jack->u.in.intr) {
1493 1.25.2.4 chap for (i=0; i<len; i++) {
1494 1.25.2.4 chap (*jack->u.in.intr)(jack->arg, data[i]);
1495 1.25.2.4 chap }
1496 1.4 tshiozak }
1497 1.25.2.4 chap
1498 1.4 tshiozak }
1499 1.1 tshiozak
1500 1.1 tshiozak (void)start_input_transfer(ep);
1501 1.1 tshiozak }
1502 1.1 tshiozak
1503 1.1 tshiozak static void
1504 1.1 tshiozak out_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
1505 1.1 tshiozak {
1506 1.1 tshiozak struct umidi_endpoint *ep = (struct umidi_endpoint *)priv;
1507 1.1 tshiozak struct umidi_softc *sc = ep->sc;
1508 1.25.2.10 chap u_int32_t count;
1509 1.1 tshiozak
1510 1.25.2.10 chap if (sc->sc_dying)
1511 1.1 tshiozak return;
1512 1.1 tshiozak
1513 1.25.2.10 chap #ifdef UMIDI_DEBUG
1514 1.25.2.10 chap if ( umididebug >= 200 )
1515 1.25.2.10 chap microtime(&umidi_tv);
1516 1.25.2.10 chap #endif
1517 1.25.2.10 chap usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
1518 1.25.2.10 chap if ( 0 == count % UMIDI_PACKET_SIZE ) {
1519 1.25.2.10 chap DPRINTFN(200,("%s: %lu.%06lus out ep %p xfer length %u\n",
1520 1.25.2.10 chap USBDEVNAME(ep->sc->sc_dev),
1521 1.25.2.10 chap umidi_tv.tv_sec%100, umidi_tv.tv_usec, ep, count));
1522 1.25.2.10 chap } else {
1523 1.25.2.10 chap DPRINTF(("%s: output endpoint %p odd transfer length %u\n",
1524 1.25.2.10 chap USBDEVNAME(ep->sc->sc_dev), ep, count));
1525 1.25.2.10 chap }
1526 1.25.2.10 chap count /= UMIDI_PACKET_SIZE;
1527 1.25.2.10 chap
1528 1.25.2.10 chap /*
1529 1.25.2.10 chap * If while the transfer was pending we buffered any new messages,
1530 1.25.2.10 chap * move them to the start of the buffer.
1531 1.25.2.10 chap */
1532 1.25.2.10 chap ep->next_slot -= count;
1533 1.25.2.10 chap if ( ep->buffer < ep->next_slot ) {
1534 1.25.2.10 chap memcpy(ep->buffer, ep->buffer + count,
1535 1.25.2.10 chap (char *)ep->next_slot - (char *)ep->buffer);
1536 1.25.2.10 chap }
1537 1.25.2.10 chap wakeup(ep);
1538 1.25.2.10 chap /*
1539 1.25.2.10 chap * Do not want anyone else to see armed <- 0 before soliciting <- 1.
1540 1.25.2.10 chap * Running at splusb so the following should happen to be safe.
1541 1.25.2.10 chap */
1542 1.25.2.10 chap ep->armed = 0;
1543 1.25.2.10 chap if ( !ep->soliciting ) {
1544 1.25.2.10 chap ep->soliciting = 1;
1545 1.25.2.10 chap out_solicit(ep);
1546 1.25.2.10 chap }
1547 1.25.2.10 chap }
1548 1.25.2.10 chap
1549 1.25.2.10 chap /*
1550 1.25.2.10 chap * A jack on which we have received a packet must be called back on its
1551 1.25.2.10 chap * out.intr handler before it will send us another; it is considered
1552 1.25.2.10 chap * 'scheduled'. It is nice and predictable - as long as it is scheduled,
1553 1.25.2.10 chap * we need no extra buffer space for it.
1554 1.25.2.10 chap *
1555 1.25.2.10 chap * In contrast, a jack that is open but not scheduled may supply us a packet
1556 1.25.2.10 chap * at any time, driven by the top half, and we must be able to accept it, no
1557 1.25.2.10 chap * excuses. So we must ensure that at any point in time there are at least
1558 1.25.2.10 chap * (num_open - num_scheduled) slots free.
1559 1.25.2.10 chap *
1560 1.25.2.10 chap * As long as there are more slots free than that minimum, we can loop calling
1561 1.25.2.10 chap * scheduled jacks back on their "interrupt" handlers, soliciting more
1562 1.25.2.10 chap * packets, starting the USB transfer only when the buffer space is down to
1563 1.25.2.10 chap * the minimum or no jack has any more to send.
1564 1.25.2.10 chap */
1565 1.25.2.10 chap static void
1566 1.25.2.10 chap out_solicit(void *arg)
1567 1.25.2.10 chap {
1568 1.25.2.10 chap struct umidi_endpoint *ep = arg;
1569 1.25.2.10 chap int s;
1570 1.25.2.10 chap umidi_packet_bufp end;
1571 1.25.2.10 chap u_int16_t which;
1572 1.25.2.10 chap struct umidi_jack *jack;
1573 1.25.2.10 chap
1574 1.25.2.10 chap end = ep->buffer + ep->buffer_size / sizeof *ep->buffer;
1575 1.25.2.10 chap
1576 1.25.2.10 chap for ( ;; ) {
1577 1.25.2.10 chap s = splusb();
1578 1.25.2.10 chap if ( end - ep->next_slot <= ep->num_open - ep->num_scheduled )
1579 1.25.2.10 chap break; /* at splusb */
1580 1.25.2.10 chap if ( ep->this_schedule == 0 ) {
1581 1.25.2.10 chap if ( ep->next_schedule == 0 )
1582 1.25.2.10 chap break; /* at splusb */
1583 1.25.2.10 chap ep->this_schedule = ep->next_schedule;
1584 1.25.2.10 chap ep->next_schedule = 0;
1585 1.3 tshiozak }
1586 1.25.2.10 chap /*
1587 1.25.2.10 chap * At least one jack is scheduled. Find and mask off the least
1588 1.25.2.10 chap * set bit in this_schedule and decrement num_scheduled.
1589 1.25.2.10 chap * Convert mask to bit index to find the corresponding jack,
1590 1.25.2.10 chap * and call its intr handler. If it has a message, it will call
1591 1.25.2.10 chap * back one of the output methods, which will set its bit in
1592 1.25.2.10 chap * next_schedule (not copied into this_schedule until the
1593 1.25.2.10 chap * latter is empty). In this way we round-robin the jacks that
1594 1.25.2.10 chap * have messages to send, until the buffer is as full as we
1595 1.25.2.10 chap * dare, and then start a transfer.
1596 1.25.2.10 chap */
1597 1.25.2.10 chap which = ep->this_schedule;
1598 1.25.2.10 chap which &= (~which)+1; /* now mask of least set bit */
1599 1.25.2.10 chap ep->this_schedule &= ~which;
1600 1.25.2.10 chap -- ep->num_scheduled;
1601 1.25.2.10 chap splx(s);
1602 1.25.2.10 chap
1603 1.25.2.10 chap -- which; /* now 1s below mask - count 1s to get index */
1604 1.25.2.10 chap which -= ((which >> 1) & 0x5555);/* SWAR credit aggregate.org */
1605 1.25.2.10 chap which = (((which >> 2) & 0x3333) + (which & 0x3333));
1606 1.25.2.10 chap which = (((which >> 4) + which) & 0x0f0f);
1607 1.25.2.10 chap which += (which >> 8);
1608 1.25.2.10 chap which &= 0x1f; /* the bit index a/k/a jack number */
1609 1.25.2.10 chap
1610 1.25.2.10 chap jack = ep->jacks[which];
1611 1.25.2.10 chap if (jack->u.out.intr)
1612 1.4 tshiozak (*jack->u.out.intr)(jack->arg);
1613 1.1 tshiozak }
1614 1.25.2.10 chap /* splusb at loop exit */
1615 1.25.2.10 chap if ( !ep->armed && ep->next_slot > ep->buffer )
1616 1.25.2.10 chap ep->armed = (USBD_IN_PROGRESS == start_output_transfer(ep));
1617 1.25.2.10 chap ep->soliciting = 0;
1618 1.25.2.10 chap splx(s);
1619 1.1 tshiozak }
1620