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