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