uaudio.c revision 1.6 1 1.6 augustss /* $NetBSD: uaudio.c,v 1.6 1999/11/01 18:12:21 augustss Exp $ */
2 1.1 augustss
3 1.1 augustss /*
4 1.1 augustss * Copyright (c) 1999 The NetBSD Foundation, Inc.
5 1.1 augustss * All rights reserved.
6 1.1 augustss *
7 1.5 augustss * This code is derived from software contributed to The NetBSD Foundation
8 1.5 augustss * by Lennart Augustsson (augustss (at) carlstedt.se) at
9 1.5 augustss * Carlstedt Research & Technology.
10 1.1 augustss *
11 1.1 augustss * Redistribution and use in source and binary forms, with or without
12 1.1 augustss * modification, are permitted provided that the following conditions
13 1.1 augustss * are met:
14 1.1 augustss * 1. Redistributions of source code must retain the above copyright
15 1.1 augustss * notice, this list of conditions and the following disclaimer.
16 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
17 1.1 augustss * notice, this list of conditions and the following disclaimer in the
18 1.1 augustss * documentation and/or other materials provided with the distribution.
19 1.1 augustss * 3. All advertising materials mentioning features or use of this software
20 1.1 augustss * must display the following acknowledgement:
21 1.1 augustss * This product includes software developed by the NetBSD
22 1.1 augustss * Foundation, Inc. and its contributors.
23 1.1 augustss * 4. Neither the name of The NetBSD Foundation nor the names of its
24 1.1 augustss * contributors may be used to endorse or promote products derived
25 1.1 augustss * from this software without specific prior written permission.
26 1.1 augustss *
27 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
28 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
29 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
30 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
31 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
38 1.1 augustss */
39 1.1 augustss
40 1.1 augustss /*
41 1.1 augustss * USB audio specs: http://www.teleport.com/~usb/data/Audio10.pdf
42 1.1 augustss * http://www.teleport.com/~usb/data/Frmts10.pdf
43 1.1 augustss * http://www.teleport.com/~usb/data/Termt10.pdf
44 1.1 augustss */
45 1.1 augustss
46 1.1 augustss #include <sys/param.h>
47 1.1 augustss #include <sys/systm.h>
48 1.1 augustss #include <sys/kernel.h>
49 1.1 augustss #include <sys/malloc.h>
50 1.1 augustss #include <sys/device.h>
51 1.1 augustss #include <sys/ioctl.h>
52 1.1 augustss #include <sys/tty.h>
53 1.1 augustss #include <sys/file.h>
54 1.1 augustss #include <sys/select.h>
55 1.1 augustss #include <sys/proc.h>
56 1.1 augustss #include <sys/vnode.h>
57 1.1 augustss #include <sys/device.h>
58 1.1 augustss #include <sys/poll.h>
59 1.1 augustss
60 1.1 augustss #include <sys/audioio.h>
61 1.1 augustss #include <dev/audio_if.h>
62 1.1 augustss #include <dev/mulaw.h>
63 1.1 augustss #include <dev/auconv.h>
64 1.1 augustss
65 1.1 augustss #include <dev/usb/usb.h>
66 1.1 augustss #include <dev/usb/usbdi.h>
67 1.1 augustss #include <dev/usb/usbdi_util.h>
68 1.1 augustss #include <dev/usb/usb_quirks.h>
69 1.1 augustss
70 1.1 augustss #include <dev/usb/uaudioreg.h>
71 1.1 augustss
72 1.4 augustss #ifdef UAUDIO_DEBUG
73 1.1 augustss #define DPRINTF(x) if (uaudiodebug) logprintf x
74 1.1 augustss #define DPRINTFN(n,x) if (uaudiodebug>(n)) logprintf x
75 1.1 augustss int uaudiodebug = 0;
76 1.1 augustss #else
77 1.1 augustss #define DPRINTF(x)
78 1.1 augustss #define DPRINTFN(n,x)
79 1.1 augustss #endif
80 1.1 augustss
81 1.1 augustss #define UAUDIO_NCHANBUFS 5 /* number of outstanding request */
82 1.1 augustss #define UAUDIO_NFRAMES 20 /* ms of sound in each request */
83 1.1 augustss
84 1.1 augustss
85 1.1 augustss #define MIX_MAX_CHAN 8
86 1.1 augustss struct mixerctl {
87 1.1 augustss u_int16_t wValue[MIX_MAX_CHAN]; /* using nchan */
88 1.1 augustss u_int16_t wIndex;
89 1.1 augustss u_int8_t nchan;
90 1.1 augustss u_int8_t type;
91 1.1 augustss #define MIX_ON_OFF 1
92 1.1 augustss #define MIX_SIGNED_16 2
93 1.1 augustss #define MIX_UNSIGNED_16 3
94 1.1 augustss #define MIX_SIGNED_8 4
95 1.1 augustss #define MIX_SIZE(n) ((n) == MIX_SIGNED_16 || (n) == MIX_UNSIGNED_16 ? 2 : 1)
96 1.1 augustss #define MIX_UNSIGNED(n) ((n) == MIX_UNSIGNED_16)
97 1.1 augustss int minval, maxval;
98 1.1 augustss u_int8_t class;
99 1.1 augustss char ctlname[MAX_AUDIO_DEV_LEN];
100 1.1 augustss char *ctlunit;
101 1.1 augustss };
102 1.1 augustss #define MAKE(h,l) (((h) << 8) | (l))
103 1.1 augustss
104 1.1 augustss struct as_info {
105 1.1 augustss u_int8_t alt;
106 1.1 augustss u_int8_t encoding;
107 1.1 augustss usb_interface_descriptor_t *idesc;
108 1.1 augustss usb_endpoint_descriptor_audio_t *edesc;
109 1.1 augustss struct usb_audio_streaming_type1_descriptor *asf1desc;
110 1.1 augustss };
111 1.1 augustss
112 1.1 augustss struct chan {
113 1.1 augustss int terminal; /* terminal id */
114 1.1 augustss void (*intr) __P((void *)); /* dma completion intr handler */
115 1.1 augustss void *arg; /* arg for intr() */
116 1.1 augustss usbd_pipe_handle pipe;
117 1.5 augustss int dir; /* direction, UE_DIR_XXX */
118 1.1 augustss
119 1.1 augustss u_int sample_size;
120 1.1 augustss u_int sample_rate;
121 1.1 augustss u_int bytes_per_frame;
122 1.1 augustss u_int fraction; /* fraction/1000 is the extra samples/frame */
123 1.1 augustss u_int residue; /* accumulates the fractional samples */
124 1.1 augustss
125 1.1 augustss u_char *start; /* upper layer buffer start */
126 1.1 augustss u_char *end; /* upper layer buffer end */
127 1.1 augustss u_char *cur; /* current position in upper layer buffer */
128 1.1 augustss int blksize; /* chunk size to report up */
129 1.1 augustss int transferred; /* transferred bytes not reported up */
130 1.1 augustss
131 1.1 augustss int curchanbuf;
132 1.1 augustss struct chanbuf {
133 1.1 augustss struct chan *chan;
134 1.1 augustss usbd_request_handle reqh;
135 1.1 augustss u_char *buffer;
136 1.1 augustss u_int16_t sizes[UAUDIO_NFRAMES];
137 1.1 augustss u_int16_t size;
138 1.1 augustss } chanbufs[UAUDIO_NCHANBUFS];
139 1.1 augustss };
140 1.1 augustss
141 1.1 augustss struct uaudio_softc {
142 1.1 augustss USBBASEDEVICE sc_dev; /* base device */
143 1.1 augustss usbd_device_handle sc_udev; /* USB device */
144 1.1 augustss
145 1.1 augustss int sc_ac_iface; /* Audio Control interface */
146 1.1 augustss int sc_as_iface; /* Audio Streaming interface */
147 1.1 augustss usbd_interface_handle sc_ac_ifaceh;
148 1.1 augustss usbd_interface_handle sc_as_ifaceh;
149 1.1 augustss
150 1.5 augustss struct chan sc_chan;
151 1.1 augustss
152 1.1 augustss int sc_curaltidx;
153 1.1 augustss
154 1.1 augustss int sc_nullalt;
155 1.1 augustss
156 1.1 augustss struct as_info *sc_alts;
157 1.1 augustss int sc_nalts;
158 1.1 augustss int sc_props;
159 1.1 augustss
160 1.1 augustss int sc_altflags;
161 1.1 augustss #define HAS_8 0x01
162 1.1 augustss #define HAS_16 0x02
163 1.1 augustss #define HAS_8U 0x04
164 1.1 augustss #define HAS_ALAW 0x08
165 1.1 augustss #define HAS_MULAW 0x10
166 1.1 augustss
167 1.1 augustss struct mixerctl *sc_ctls;
168 1.1 augustss int sc_nctls;
169 1.1 augustss
170 1.1 augustss device_ptr_t sc_audiodev;
171 1.1 augustss char sc_dying;
172 1.1 augustss };
173 1.1 augustss
174 1.1 augustss #define UAC_OUTPUT 0
175 1.1 augustss #define UAC_INPUT 1
176 1.1 augustss #define UAC_EQUAL 2
177 1.1 augustss
178 1.1 augustss usbd_status uaudio_identify_ac __P((struct uaudio_softc *sc,
179 1.1 augustss usb_config_descriptor_t *cdesc));
180 1.1 augustss usbd_status uaudio_identify_as __P((struct uaudio_softc *sc,
181 1.1 augustss usb_config_descriptor_t *cdesc));
182 1.1 augustss usbd_status uaudio_process_as __P((struct uaudio_softc *sc, char *buf,
183 1.1 augustss int *offsp, int size,
184 1.1 augustss usb_interface_descriptor_t *id));
185 1.1 augustss
186 1.1 augustss void uaudio_add_alt __P((struct uaudio_softc *sc, struct as_info *ai));
187 1.1 augustss
188 1.1 augustss usb_interface_descriptor_t *uaudio_find_iface
189 1.1 augustss __P((char *buf, int size, int *offsp, int subtype));
190 1.1 augustss
191 1.1 augustss void uaudio_mixer_add_ctl __P((struct uaudio_softc *sc, struct mixerctl *mp));
192 1.1 augustss char *uaudio_id_name __P((struct uaudio_softc *sc, usb_descriptor_t **dps,
193 1.1 augustss int id));
194 1.1 augustss struct usb_audio_cluster uaudio_get_cluster __P((int id,
195 1.1 augustss usb_descriptor_t **dps));
196 1.1 augustss void uaudio_add_input __P((struct uaudio_softc *sc, usb_descriptor_t *v,
197 1.1 augustss usb_descriptor_t **dps));
198 1.1 augustss void uaudio_add_output __P((struct uaudio_softc *sc, usb_descriptor_t *v,
199 1.1 augustss usb_descriptor_t **dps));
200 1.1 augustss void uaudio_add_mixer __P((struct uaudio_softc *sc, usb_descriptor_t *v,
201 1.1 augustss usb_descriptor_t **dps));
202 1.1 augustss void uaudio_add_selector __P((struct uaudio_softc *sc, usb_descriptor_t *v,
203 1.1 augustss usb_descriptor_t **dps));
204 1.1 augustss void uaudio_add_feature __P((struct uaudio_softc *sc, usb_descriptor_t *v,
205 1.1 augustss usb_descriptor_t **dps));
206 1.1 augustss void uaudio_add_processing __P((struct uaudio_softc *sc, usb_descriptor_t *v,
207 1.1 augustss usb_descriptor_t **dps));
208 1.1 augustss void uaudio_add_extension __P((struct uaudio_softc *sc, usb_descriptor_t *v,
209 1.1 augustss usb_descriptor_t **dps));
210 1.1 augustss usbd_status uaudio_identify __P((struct uaudio_softc *sc,
211 1.1 augustss usb_config_descriptor_t *cdesc));
212 1.1 augustss
213 1.1 augustss int uaudio_signext __P((int type, int val));
214 1.1 augustss int uaudio_value2bsd __P((struct mixerctl *mc, int val));
215 1.1 augustss int uaudio_bsd2value __P((struct mixerctl *mc, int val));
216 1.1 augustss int uaudio_get __P((struct uaudio_softc *sc, int type, int which, int wValue,
217 1.1 augustss int wIndex, int len));
218 1.1 augustss int uaudio_ctl_get __P((struct uaudio_softc *sc, int which,
219 1.1 augustss struct mixerctl *mc, int chan));
220 1.1 augustss void uaudio_set __P((struct uaudio_softc *sc, int type, int which, int wValue,
221 1.1 augustss int wIndex, int len, int val));
222 1.1 augustss void uaudio_ctl_set __P((struct uaudio_softc *sc, int which,
223 1.1 augustss struct mixerctl *mc, int chan, int val));
224 1.1 augustss
225 1.1 augustss usbd_status uaudio_set_speed __P((struct uaudio_softc *, int, u_int));
226 1.1 augustss
227 1.1 augustss usbd_status uaudio_chan_open __P((struct uaudio_softc *sc, struct chan *ch));
228 1.1 augustss void uaudio_chan_close __P((struct uaudio_softc *sc, struct chan *ch));
229 1.1 augustss usbd_status uaudio_chan_alloc_buffers __P((struct uaudio_softc *, struct chan *));
230 1.1 augustss void uaudio_chan_free_buffers __P((struct uaudio_softc *, struct chan *));
231 1.1 augustss void uaudio_chan_set_param __P((struct chan *ch, struct audio_params *param,
232 1.1 augustss u_char *start, u_char *end, int blksize));
233 1.5 augustss void uaudio_chan_ptransfer __P((struct chan *ch));
234 1.1 augustss void uaudio_chan_pintr __P((usbd_request_handle reqh,
235 1.1 augustss usbd_private_handle priv, usbd_status status));
236 1.1 augustss
237 1.5 augustss void uaudio_chan_rtransfer __P((struct chan *ch));
238 1.5 augustss void uaudio_chan_rintr __P((usbd_request_handle reqh,
239 1.5 augustss usbd_private_handle priv, usbd_status status));
240 1.5 augustss
241 1.1 augustss
242 1.1 augustss
243 1.1 augustss int uaudio_open __P((void *, int));
244 1.1 augustss void uaudio_close __P((void *));
245 1.1 augustss int uaudio_drain __P((void *));
246 1.1 augustss int uaudio_query_encoding __P((void *, struct audio_encoding *));
247 1.1 augustss int uaudio_set_params __P((void *, int, int,
248 1.1 augustss struct audio_params *, struct audio_params *));
249 1.1 augustss int uaudio_round_blocksize __P((void *, int));
250 1.1 augustss int uaudio_trigger_output __P((void *, void *, void *, int,
251 1.1 augustss void (*)(void *), void *,
252 1.1 augustss struct audio_params *));
253 1.1 augustss int uaudio_trigger_input __P((void *, void *, void *, int,
254 1.1 augustss void (*)(void *), void *,
255 1.1 augustss struct audio_params *));
256 1.1 augustss int uaudio_halt_in_dma __P((void *));
257 1.1 augustss int uaudio_halt_out_dma __P((void *));
258 1.1 augustss int uaudio_getdev __P((void *, struct audio_device *));
259 1.1 augustss int uaudio_mixer_set_port __P((void *, mixer_ctrl_t *));
260 1.1 augustss int uaudio_mixer_get_port __P((void *, mixer_ctrl_t *));
261 1.1 augustss int uaudio_query_devinfo __P((void *, mixer_devinfo_t *));
262 1.1 augustss int uaudio_get_props __P((void *));
263 1.1 augustss
264 1.1 augustss struct audio_hw_if uaudio_hw_if = {
265 1.1 augustss uaudio_open,
266 1.1 augustss uaudio_close,
267 1.1 augustss uaudio_drain,
268 1.1 augustss uaudio_query_encoding,
269 1.1 augustss uaudio_set_params,
270 1.1 augustss uaudio_round_blocksize,
271 1.1 augustss NULL,
272 1.1 augustss NULL,
273 1.1 augustss NULL,
274 1.1 augustss NULL,
275 1.1 augustss NULL,
276 1.1 augustss uaudio_halt_out_dma,
277 1.1 augustss uaudio_halt_in_dma,
278 1.1 augustss NULL,
279 1.1 augustss uaudio_getdev,
280 1.1 augustss NULL,
281 1.1 augustss uaudio_mixer_set_port,
282 1.1 augustss uaudio_mixer_get_port,
283 1.1 augustss uaudio_query_devinfo,
284 1.1 augustss NULL,
285 1.1 augustss NULL,
286 1.1 augustss NULL,
287 1.1 augustss NULL,
288 1.1 augustss uaudio_get_props,
289 1.1 augustss uaudio_trigger_output,
290 1.1 augustss uaudio_trigger_input,
291 1.1 augustss };
292 1.1 augustss
293 1.1 augustss struct audio_device uaudio_device = {
294 1.1 augustss "USB audio",
295 1.1 augustss "",
296 1.1 augustss "uaudio"
297 1.1 augustss };
298 1.1 augustss
299 1.1 augustss USB_DECLARE_DRIVER(uaudio);
300 1.1 augustss
301 1.1 augustss USB_MATCH(uaudio)
302 1.1 augustss {
303 1.1 augustss USB_MATCH_START(uaudio, uaa);
304 1.1 augustss usb_interface_descriptor_t *id;
305 1.1 augustss
306 1.1 augustss if (!uaa->iface)
307 1.1 augustss return (UMATCH_NONE);
308 1.1 augustss
309 1.1 augustss id = usbd_get_interface_descriptor(uaa->iface);
310 1.1 augustss /* Trigger on the control interface. */
311 1.1 augustss if (!id ||
312 1.1 augustss id->bInterfaceClass != UCLASS_AUDIO ||
313 1.1 augustss id->bInterfaceSubClass != USUBCLASS_AUDIOCONTROL)
314 1.1 augustss return (UMATCH_NONE);
315 1.1 augustss
316 1.1 augustss return (UMATCH_IFACECLASS_IFACESUBCLASS);
317 1.1 augustss }
318 1.1 augustss
319 1.1 augustss USB_ATTACH(uaudio)
320 1.1 augustss {
321 1.1 augustss USB_ATTACH_START(uaudio, sc, uaa);
322 1.1 augustss usb_interface_descriptor_t *id;
323 1.1 augustss usb_config_descriptor_t *cdesc;
324 1.1 augustss char devinfo[1024];
325 1.1 augustss usbd_status r;
326 1.1 augustss int i;
327 1.1 augustss
328 1.1 augustss usbd_devinfo(uaa->device, 0, devinfo);
329 1.1 augustss printf(": %s\n", devinfo);
330 1.1 augustss
331 1.1 augustss sc->sc_udev = uaa->device;
332 1.1 augustss
333 1.1 augustss cdesc = usbd_get_config_descriptor(sc->sc_udev);
334 1.1 augustss if (!cdesc)
335 1.1 augustss USB_ATTACH_ERROR_RETURN;
336 1.1 augustss
337 1.1 augustss r = uaudio_identify(sc, cdesc);
338 1.1 augustss if (r != USBD_NORMAL_COMPLETION) {
339 1.1 augustss printf("%s: audio descriptors make no sense, error=%d\n",
340 1.1 augustss USBDEVNAME(sc->sc_dev), r);
341 1.1 augustss USB_ATTACH_ERROR_RETURN;
342 1.1 augustss }
343 1.1 augustss
344 1.1 augustss sc->sc_ac_ifaceh = uaa->iface;
345 1.1 augustss /* Pick up the AS interface. */
346 1.1 augustss for (i = 0; i < uaa->nifaces; i++) {
347 1.1 augustss if (uaa->ifaces[i]) {
348 1.1 augustss id = usbd_get_interface_descriptor(uaa->ifaces[i]);
349 1.1 augustss if (id->bInterfaceNumber == sc->sc_as_iface) {
350 1.1 augustss sc->sc_as_ifaceh = uaa->ifaces[i];
351 1.1 augustss uaa->ifaces[i] = 0;
352 1.1 augustss }
353 1.1 augustss }
354 1.1 augustss }
355 1.1 augustss
356 1.1 augustss if (!sc->sc_as_ifaceh) {
357 1.1 augustss printf("%s: missing AS interface(s)\n",USBDEVNAME(sc->sc_dev));
358 1.1 augustss USB_ATTACH_ERROR_RETURN;
359 1.1 augustss }
360 1.1 augustss
361 1.1 augustss DPRINTF(("uaudio_attach: doing audio_attach_mi\n"));
362 1.1 augustss sc->sc_audiodev = audio_attach_mi(&uaudio_hw_if, sc, &sc->sc_dev);
363 1.1 augustss
364 1.1 augustss USB_ATTACH_SUCCESS_RETURN;
365 1.1 augustss }
366 1.1 augustss
367 1.1 augustss int
368 1.1 augustss uaudio_activate(self, act)
369 1.1 augustss device_ptr_t self;
370 1.1 augustss enum devact act;
371 1.1 augustss {
372 1.1 augustss struct uaudio_softc *sc = (struct uaudio_softc *)self;
373 1.2 augustss int rv = 0;
374 1.1 augustss
375 1.1 augustss switch (act) {
376 1.1 augustss case DVACT_ACTIVATE:
377 1.1 augustss return (EOPNOTSUPP);
378 1.1 augustss break;
379 1.1 augustss
380 1.1 augustss case DVACT_DEACTIVATE:
381 1.2 augustss if (sc->sc_audiodev)
382 1.2 augustss rv = config_deactivate(sc->sc_audiodev);
383 1.1 augustss sc->sc_dying = 1;
384 1.1 augustss break;
385 1.1 augustss }
386 1.2 augustss return (rv);
387 1.1 augustss }
388 1.1 augustss
389 1.1 augustss int
390 1.1 augustss uaudio_detach(self, flags)
391 1.1 augustss device_ptr_t self;
392 1.1 augustss int flags;
393 1.1 augustss {
394 1.1 augustss struct uaudio_softc *sc = (struct uaudio_softc *)self;
395 1.1 augustss int rv = 0;
396 1.1 augustss
397 1.1 augustss if (sc->sc_audiodev)
398 1.1 augustss rv = config_detach(sc->sc_audiodev, flags);
399 1.1 augustss
400 1.1 augustss return (rv);
401 1.1 augustss }
402 1.1 augustss
403 1.1 augustss int
404 1.1 augustss uaudio_query_encoding(addr, fp)
405 1.1 augustss void *addr;
406 1.1 augustss struct audio_encoding *fp;
407 1.1 augustss {
408 1.1 augustss struct uaudio_softc *sc = addr;
409 1.1 augustss int flags = sc->sc_altflags;
410 1.1 augustss int idx;
411 1.1 augustss
412 1.1 augustss if (sc->sc_dying)
413 1.1 augustss return (EIO);
414 1.1 augustss
415 1.1 augustss if (sc->sc_nalts == 0 || flags == 0)
416 1.1 augustss return (ENXIO);
417 1.1 augustss
418 1.1 augustss idx = fp->index;
419 1.1 augustss switch (idx) {
420 1.1 augustss case 0:
421 1.1 augustss strcpy(fp->name, AudioEulinear);
422 1.1 augustss fp->encoding = AUDIO_ENCODING_ULINEAR;
423 1.1 augustss fp->precision = 8;
424 1.1 augustss fp->flags = flags&HAS_8U ? 0 : AUDIO_ENCODINGFLAG_EMULATED;
425 1.1 augustss return (0);
426 1.1 augustss case 1:
427 1.1 augustss strcpy(fp->name, AudioEmulaw);
428 1.1 augustss fp->encoding = AUDIO_ENCODING_ULAW;
429 1.1 augustss fp->precision = 8;
430 1.1 augustss fp->flags = flags&HAS_MULAW ? 0 : AUDIO_ENCODINGFLAG_EMULATED;
431 1.1 augustss return (0);
432 1.1 augustss case 2:
433 1.1 augustss strcpy(fp->name, AudioEalaw);
434 1.1 augustss fp->encoding = AUDIO_ENCODING_ALAW;
435 1.1 augustss fp->precision = 8;
436 1.1 augustss fp->flags = flags&HAS_ALAW ? 0 : AUDIO_ENCODINGFLAG_EMULATED;
437 1.1 augustss return (0);
438 1.1 augustss case 3:
439 1.1 augustss strcpy(fp->name, AudioEslinear);
440 1.1 augustss fp->encoding = AUDIO_ENCODING_SLINEAR;
441 1.1 augustss fp->precision = 8;
442 1.1 augustss fp->flags = flags&HAS_8 ? 0 : AUDIO_ENCODINGFLAG_EMULATED;
443 1.1 augustss return (0);
444 1.1 augustss case 4:
445 1.1 augustss strcpy(fp->name, AudioEslinear_le);
446 1.1 augustss fp->encoding = AUDIO_ENCODING_SLINEAR_LE;
447 1.1 augustss fp->precision = 16;
448 1.1 augustss fp->flags = 0;
449 1.1 augustss return (0);
450 1.1 augustss case 5:
451 1.1 augustss strcpy(fp->name, AudioEulinear_le);
452 1.1 augustss fp->encoding = AUDIO_ENCODING_ULINEAR_LE;
453 1.1 augustss fp->precision = 16;
454 1.1 augustss fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
455 1.1 augustss return (0);
456 1.1 augustss case 6:
457 1.1 augustss strcpy(fp->name, AudioEslinear_be);
458 1.1 augustss fp->encoding = AUDIO_ENCODING_SLINEAR_BE;
459 1.1 augustss fp->precision = 16;
460 1.1 augustss fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
461 1.1 augustss return (0);
462 1.1 augustss case 7:
463 1.1 augustss strcpy(fp->name, AudioEulinear_be);
464 1.1 augustss fp->encoding = AUDIO_ENCODING_ULINEAR_BE;
465 1.1 augustss fp->precision = 16;
466 1.1 augustss fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
467 1.1 augustss return (0);
468 1.1 augustss default:
469 1.1 augustss return (EINVAL);
470 1.1 augustss }
471 1.1 augustss }
472 1.1 augustss
473 1.1 augustss usb_interface_descriptor_t *
474 1.1 augustss uaudio_find_iface(buf, size, offsp, subtype)
475 1.1 augustss char *buf;
476 1.1 augustss int size;
477 1.1 augustss int *offsp;
478 1.1 augustss int subtype;
479 1.1 augustss {
480 1.1 augustss usb_interface_descriptor_t *d;
481 1.1 augustss
482 1.1 augustss while (*offsp < size) {
483 1.1 augustss d = (void *)(buf + *offsp);
484 1.1 augustss *offsp += d->bLength;
485 1.1 augustss if (d->bDescriptorType == UDESC_INTERFACE &&
486 1.1 augustss d->bInterfaceClass == UCLASS_AUDIO &&
487 1.1 augustss d->bInterfaceSubClass == subtype)
488 1.1 augustss return (d);
489 1.1 augustss }
490 1.1 augustss return (0);
491 1.1 augustss }
492 1.1 augustss
493 1.1 augustss void
494 1.1 augustss uaudio_mixer_add_ctl(sc, mc)
495 1.1 augustss struct uaudio_softc *sc;
496 1.1 augustss struct mixerctl *mc;
497 1.1 augustss {
498 1.1 augustss if (sc->sc_nctls == 0)
499 1.1 augustss sc->sc_ctls = malloc(sizeof *mc, M_USBDEV, M_NOWAIT);
500 1.1 augustss else
501 1.1 augustss sc->sc_ctls = realloc(sc->sc_ctls,
502 1.1 augustss (sc->sc_nctls+1) * sizeof *mc,
503 1.1 augustss M_USBDEV, M_NOWAIT);
504 1.1 augustss if (sc->sc_ctls == 0) {
505 1.1 augustss printf("uaudio_mixer_add_ctl: no memory\n");
506 1.1 augustss return;
507 1.1 augustss }
508 1.1 augustss
509 1.1 augustss if (mc->type != MIX_ON_OFF) {
510 1.1 augustss /* Determine min and max values. */
511 1.1 augustss mc->minval = uaudio_signext(mc->type,
512 1.1 augustss uaudio_get(sc, GET_MIN, UT_READ_CLASS_INTERFACE,
513 1.1 augustss mc->wValue[0], mc->wIndex,
514 1.1 augustss MIX_SIZE(mc->type)));
515 1.1 augustss mc->maxval = 1 + uaudio_signext(mc->type,
516 1.1 augustss uaudio_get(sc, GET_MAX, UT_READ_CLASS_INTERFACE,
517 1.1 augustss mc->wValue[0], mc->wIndex,
518 1.1 augustss MIX_SIZE(mc->type)));
519 1.1 augustss } else {
520 1.1 augustss mc->minval = 0;
521 1.1 augustss mc->maxval = 1;
522 1.1 augustss }
523 1.1 augustss
524 1.1 augustss sc->sc_ctls[sc->sc_nctls++] = *mc;
525 1.1 augustss
526 1.4 augustss #ifdef UAUDIO_DEBUG
527 1.1 augustss if (uaudiodebug > 2) {
528 1.1 augustss int i;
529 1.1 augustss DPRINTF(("uaudio_mixer_add_ctl: wValue=%04x",mc->wValue[0]));
530 1.1 augustss for (i = 1; i < mc->nchan; i++)
531 1.1 augustss DPRINTF((",%04x", mc->wValue[i]));
532 1.1 augustss DPRINTF((" wIndex=%04x type=%d name='%s' unit='%s' "
533 1.1 augustss "min=%d max=%d\n",
534 1.1 augustss mc->wIndex, mc->type, mc->ctlname, mc->ctlunit,
535 1.1 augustss mc->minval, mc->maxval));
536 1.1 augustss }
537 1.1 augustss #endif
538 1.1 augustss }
539 1.1 augustss
540 1.1 augustss char *
541 1.1 augustss uaudio_id_name(sc, dps, id)
542 1.1 augustss struct uaudio_softc *sc;
543 1.1 augustss usb_descriptor_t **dps;
544 1.1 augustss int id;
545 1.1 augustss {
546 1.1 augustss static char buf[32];
547 1.1 augustss sprintf(buf, "i%d", id);
548 1.1 augustss return (buf);
549 1.1 augustss }
550 1.1 augustss
551 1.1 augustss struct usb_audio_cluster
552 1.1 augustss uaudio_get_cluster(id, dps)
553 1.1 augustss int id;
554 1.1 augustss usb_descriptor_t **dps;
555 1.1 augustss {
556 1.1 augustss struct usb_audio_cluster r;
557 1.1 augustss usb_descriptor_t *dp;
558 1.1 augustss int i;
559 1.1 augustss
560 1.1 augustss for (i = 0; i < 25; i++) { /* avoid infinite loops */
561 1.1 augustss dp = dps[id];
562 1.1 augustss if (dp == 0)
563 1.1 augustss goto bad;
564 1.1 augustss switch (dp->bDescriptorSubtype) {
565 1.1 augustss case UDESCSUB_AC_INPUT:
566 1.1 augustss #define p ((struct usb_audio_input_terminal *)dp)
567 1.1 augustss r.bNrChannels = p->bNrChannels;
568 1.1 augustss USETW(r.wChannelConfig, UGETW(p->wChannelConfig));
569 1.1 augustss r.iChannelNames = p->iChannelNames;
570 1.1 augustss #undef p
571 1.1 augustss return (r);
572 1.1 augustss case UDESCSUB_AC_OUTPUT:
573 1.1 augustss #define p ((struct usb_audio_output_terminal *)dp)
574 1.1 augustss id = p->bSourceId;
575 1.1 augustss #undef p
576 1.1 augustss break;
577 1.1 augustss case UDESCSUB_AC_MIXER:
578 1.1 augustss #define p ((struct usb_audio_mixer_unit *)dp)
579 1.1 augustss r = *(struct usb_audio_cluster *)
580 1.1 augustss &p->baSourceId[p->bNrInPins];
581 1.1 augustss #undef p
582 1.1 augustss return (r);
583 1.1 augustss case UDESCSUB_AC_SELECTOR:
584 1.1 augustss /* XXX This is not really right */
585 1.1 augustss #define p ((struct usb_audio_selector_unit *)dp)
586 1.1 augustss id = p->baSourceId[0];
587 1.1 augustss #undef p
588 1.1 augustss break;
589 1.1 augustss case UDESCSUB_AC_FEATURE:
590 1.1 augustss #define p ((struct usb_audio_feature_unit *)dp)
591 1.1 augustss id = p->bSourceId;
592 1.1 augustss #undef p
593 1.1 augustss break;
594 1.1 augustss case UDESCSUB_AC_PROCESSING:
595 1.1 augustss #define p ((struct usb_audio_processing_unit *)dp)
596 1.1 augustss r = *(struct usb_audio_cluster *)
597 1.1 augustss &p->baSourceId[p->bNrInPins];
598 1.1 augustss #undef p
599 1.1 augustss return (r);
600 1.1 augustss case UDESCSUB_AC_EXTENSION:
601 1.1 augustss #define p ((struct usb_audio_extension_unit *)dp)
602 1.1 augustss r = *(struct usb_audio_cluster *)
603 1.1 augustss &p->baSourceId[p->bNrInPins];
604 1.1 augustss #undef p
605 1.1 augustss return (r);
606 1.1 augustss default:
607 1.1 augustss goto bad;
608 1.1 augustss }
609 1.1 augustss }
610 1.1 augustss bad:
611 1.1 augustss printf("uaudio_get_cluster: bad data\n");
612 1.1 augustss memset(&r, 0, sizeof r);
613 1.1 augustss return r;
614 1.1 augustss
615 1.1 augustss }
616 1.1 augustss
617 1.1 augustss void
618 1.1 augustss uaudio_add_input(sc, v, dps)
619 1.1 augustss struct uaudio_softc *sc;
620 1.1 augustss usb_descriptor_t *v;
621 1.1 augustss usb_descriptor_t **dps;
622 1.1 augustss {
623 1.4 augustss #ifdef UAUDIO_DEBUG
624 1.1 augustss struct usb_audio_input_terminal *d =
625 1.1 augustss (struct usb_audio_input_terminal *)v;
626 1.1 augustss
627 1.1 augustss DPRINTFN(2,("uaudio_add_input: bTerminalId=%d wTerminalType=0x%04x "
628 1.1 augustss "bAssocTerminal=%d bNrChannels=%d wChannelConfig=%d "
629 1.1 augustss "iChannelNames=%d iTerminal=%d\n",
630 1.1 augustss d->bTerminalId, UGETW(d->wTerminalType), d->bAssocTerminal,
631 1.1 augustss d->bNrChannels, UGETW(d->wChannelConfig),
632 1.1 augustss d->iChannelNames, d->iTerminal));
633 1.1 augustss #endif
634 1.5 augustss printf("uaudio_add_input: not implemented\n");
635 1.1 augustss }
636 1.1 augustss
637 1.1 augustss void
638 1.1 augustss uaudio_add_output(sc, v, dps)
639 1.1 augustss struct uaudio_softc *sc;
640 1.1 augustss usb_descriptor_t *v;
641 1.1 augustss usb_descriptor_t **dps;
642 1.1 augustss {
643 1.4 augustss #ifdef UAUDIO_DEBUG
644 1.1 augustss struct usb_audio_output_terminal *d =
645 1.1 augustss (struct usb_audio_output_terminal *)v;
646 1.1 augustss
647 1.1 augustss DPRINTFN(2,("uaudio_add_output: bTerminalId=%d wTerminalType=0x%04x "
648 1.1 augustss "bAssocTerminal=%d bSourceId=%d iTerminal=%d\n",
649 1.1 augustss d->bTerminalId, UGETW(d->wTerminalType), d->bAssocTerminal,
650 1.1 augustss d->bSourceId, d->iTerminal));
651 1.1 augustss #endif
652 1.1 augustss }
653 1.1 augustss
654 1.1 augustss void
655 1.1 augustss uaudio_add_mixer(sc, v, dps)
656 1.1 augustss struct uaudio_softc *sc;
657 1.1 augustss usb_descriptor_t *v;
658 1.1 augustss usb_descriptor_t **dps;
659 1.1 augustss {
660 1.1 augustss struct usb_audio_mixer_unit *d = (struct usb_audio_mixer_unit *)v;
661 1.1 augustss struct usb_audio_mixer_unit_1 *d1;
662 1.1 augustss int c, chs, ichs, ochs, i, o, bno, p, mo, mc, k;
663 1.1 augustss uByte *bm;
664 1.1 augustss struct mixerctl mix;
665 1.1 augustss
666 1.1 augustss DPRINTFN(2,("uaudio_add_mixer: bUnitId=%d bNrInPins=%d\n",
667 1.1 augustss d->bUnitId, d->bNrInPins));
668 1.1 augustss
669 1.1 augustss /* Compute the number of input channels */
670 1.1 augustss ichs = 0;
671 1.1 augustss for (i = 0; i < d->bNrInPins; i++)
672 1.1 augustss ichs += uaudio_get_cluster(d->baSourceId[i], dps).bNrChannels;
673 1.1 augustss
674 1.1 augustss /* and the number of output channels */
675 1.1 augustss d1 = (struct usb_audio_mixer_unit_1 *)&d->baSourceId[d->bNrInPins];
676 1.1 augustss ochs = d1->bNrChannels;
677 1.1 augustss DPRINTFN(2,("uaudio_add_mixer: ichs=%d ochs=%d\n", ichs, ochs));
678 1.1 augustss
679 1.1 augustss bm = d1->bmControls;
680 1.1 augustss mix.wIndex = MAKE(d->bUnitId, sc->sc_ac_iface);
681 1.1 augustss mix.class = -1;
682 1.1 augustss mix.type = MIX_SIGNED_16;
683 1.1 augustss mix.ctlunit = AudioNvolume;
684 1.1 augustss #define BIT(bno) ((bm[bno / 8] >> (7 - bno % 8)) & 1)
685 1.1 augustss for (p = i = 0; i < d->bNrInPins; i++) {
686 1.1 augustss chs = uaudio_get_cluster(d->baSourceId[i], dps).bNrChannels;
687 1.1 augustss mc = 0;
688 1.1 augustss for (c = 0; c < chs; c++) {
689 1.1 augustss mo = 0;
690 1.1 augustss for (o = 0; o < ochs; o++) {
691 1.1 augustss bno = (p + c) * ochs + o;
692 1.1 augustss if (BIT(bno))
693 1.1 augustss mo++;
694 1.1 augustss }
695 1.1 augustss if (mo == 1)
696 1.1 augustss mc++;
697 1.1 augustss }
698 1.1 augustss if (mc == chs && chs <= MIX_MAX_CHAN) {
699 1.1 augustss k = 0;
700 1.1 augustss for (c = 0; c < chs; c++)
701 1.1 augustss for (o = 0; o < ochs; o++) {
702 1.1 augustss bno = (p + c) * ochs + o;
703 1.1 augustss if (BIT(bno))
704 1.1 augustss mix.wValue[k++] =
705 1.1 augustss MAKE(p+c+1, o+1);
706 1.1 augustss }
707 1.1 augustss sprintf(mix.ctlname, "mix%d-%s", d->bUnitId,
708 1.1 augustss uaudio_id_name(sc, dps, d->baSourceId[i]));
709 1.1 augustss mix.nchan = chs;
710 1.1 augustss uaudio_mixer_add_ctl(sc, &mix);
711 1.1 augustss } else {
712 1.1 augustss /* XXX */
713 1.1 augustss }
714 1.1 augustss #undef BIT
715 1.1 augustss p += chs;
716 1.1 augustss }
717 1.1 augustss
718 1.1 augustss }
719 1.1 augustss
720 1.1 augustss void
721 1.1 augustss uaudio_add_selector(sc, v, dps)
722 1.1 augustss struct uaudio_softc *sc;
723 1.1 augustss usb_descriptor_t *v;
724 1.1 augustss usb_descriptor_t **dps;
725 1.1 augustss {
726 1.4 augustss #ifdef UAUDIO_DEBUG
727 1.1 augustss struct usb_audio_selector_unit *d =
728 1.1 augustss (struct usb_audio_selector_unit *)v;
729 1.1 augustss
730 1.1 augustss DPRINTFN(2,("uaudio_add_selector: bUnitId=%d bNrInPins=%d\n",
731 1.1 augustss d->bUnitId, d->bNrInPins));
732 1.1 augustss #endif
733 1.1 augustss printf("uaudio_add_selector: NOT IMPLEMENTED\n");
734 1.1 augustss }
735 1.1 augustss
736 1.1 augustss void
737 1.1 augustss uaudio_add_feature(sc, v, dps)
738 1.1 augustss struct uaudio_softc *sc;
739 1.1 augustss usb_descriptor_t *v;
740 1.1 augustss usb_descriptor_t **dps;
741 1.1 augustss {
742 1.1 augustss struct usb_audio_feature_unit *d = (struct usb_audio_feature_unit *)v;
743 1.1 augustss uByte *ctls = d->bmaControls;
744 1.1 augustss int ctlsize = d->bControlSize;
745 1.1 augustss int nchan = (d->bLength - 7) / ctlsize;
746 1.1 augustss int srcId = d->bSourceId;
747 1.1 augustss u_int fumask, mmask, cmask;
748 1.1 augustss struct mixerctl mix;
749 1.1 augustss int chan, ctl, i, unit;
750 1.1 augustss
751 1.1 augustss #define GET(i) (ctls[(i)*ctlsize] | \
752 1.1 augustss (ctlsize > 1 ? ctls[(i)*ctlsize+1] << 8 : 0))
753 1.1 augustss
754 1.1 augustss mmask = GET(0);
755 1.1 augustss /* Figure out what we can control */
756 1.1 augustss for (cmask = 0, chan = 1; chan < nchan; chan++) {
757 1.1 augustss DPRINTFN(9,("uaudio_add_feature: chan=%d mask=%x\n",
758 1.1 augustss chan, GET(chan)));
759 1.1 augustss cmask |= GET(chan);
760 1.1 augustss }
761 1.1 augustss
762 1.1 augustss DPRINTFN(1,("uaudio_add_feature: bUnitId=%d bSourceId=%d, "
763 1.1 augustss "%d channels, mmask=0x%04x, cmask=0x%04x\n",
764 1.1 augustss d->bUnitId, srcId, nchan, mmask, cmask));
765 1.1 augustss
766 1.1 augustss if (nchan > MIX_MAX_CHAN)
767 1.1 augustss nchan = MIX_MAX_CHAN;
768 1.1 augustss unit = d->bUnitId;
769 1.1 augustss mix.wIndex = MAKE(unit, sc->sc_ac_iface);
770 1.1 augustss for (ctl = MUTE_CONTROL; ctl < LOUDNESS_CONTROL; ctl++) {
771 1.1 augustss fumask = FU_MASK(ctl);
772 1.1 augustss DPRINTFN(4,("uaudio_add_feature: ctl=%d fumask=0x%04x\n",
773 1.1 augustss ctl, fumask));
774 1.1 augustss if (mmask & fumask) {
775 1.1 augustss mix.nchan = 1;
776 1.1 augustss mix.wValue[0] = MAKE(ctl, 0);
777 1.1 augustss } else if (cmask & fumask) {
778 1.1 augustss mix.nchan = nchan - 1;
779 1.1 augustss for (i = 1; i < nchan; i++) {
780 1.1 augustss if (GET(i) & fumask)
781 1.1 augustss mix.wValue[i-1] = MAKE(ctl, i);
782 1.1 augustss else
783 1.1 augustss mix.wValue[i-1] = -1;
784 1.1 augustss }
785 1.1 augustss } else {
786 1.1 augustss continue;
787 1.1 augustss }
788 1.1 augustss #undef GET
789 1.1 augustss mix.class = -1; /* XXX */
790 1.1 augustss switch (ctl) {
791 1.1 augustss case MUTE_CONTROL:
792 1.1 augustss mix.type = MIX_ON_OFF;
793 1.1 augustss sprintf(mix.ctlname, "fea%d-%s-%s", unit,
794 1.1 augustss uaudio_id_name(sc, dps, srcId),
795 1.1 augustss AudioNmute);
796 1.1 augustss mix.ctlunit = "";
797 1.1 augustss break;
798 1.1 augustss case VOLUME_CONTROL:
799 1.1 augustss mix.type = MIX_SIGNED_16;
800 1.1 augustss sprintf(mix.ctlname, "fea%d-%s-%s", unit,
801 1.1 augustss uaudio_id_name(sc, dps, srcId),
802 1.1 augustss AudioNmaster);
803 1.1 augustss mix.ctlunit = AudioNvolume;
804 1.1 augustss break;
805 1.1 augustss case BASS_CONTROL:
806 1.1 augustss mix.type = MIX_SIGNED_8;
807 1.1 augustss sprintf(mix.ctlname, "fea%d-%s-%s", unit,
808 1.1 augustss uaudio_id_name(sc, dps, srcId),
809 1.1 augustss AudioNbass);
810 1.1 augustss mix.ctlunit = AudioNbass;
811 1.1 augustss break;
812 1.1 augustss case MID_CONTROL:
813 1.1 augustss mix.type = MIX_SIGNED_8;
814 1.1 augustss sprintf(mix.ctlname, "fea%d-%s-%s", unit,
815 1.1 augustss uaudio_id_name(sc, dps, srcId),
816 1.1 augustss AudioNmid);
817 1.1 augustss mix.ctlunit = AudioNmid;
818 1.1 augustss break;
819 1.1 augustss case TREBLE_CONTROL:
820 1.1 augustss mix.type = MIX_SIGNED_8;
821 1.1 augustss sprintf(mix.ctlname, "fea%d-%s-%s", unit,
822 1.1 augustss uaudio_id_name(sc, dps, srcId),
823 1.1 augustss AudioNtreble);
824 1.1 augustss mix.ctlunit = AudioNtreble;
825 1.1 augustss break;
826 1.1 augustss case GRAPHIC_EQUALIZER_CONTROL:
827 1.1 augustss continue; /* don't add anything */
828 1.1 augustss break;
829 1.1 augustss case AGC_CONTROL:
830 1.1 augustss mix.type = MIX_ON_OFF;
831 1.1 augustss sprintf(mix.ctlname, "fea%d-%s-%s", unit,
832 1.1 augustss uaudio_id_name(sc, dps, srcId),
833 1.1 augustss AudioNagc);
834 1.1 augustss mix.ctlunit = "";
835 1.1 augustss break;
836 1.1 augustss case DELAY_CONTROL:
837 1.1 augustss mix.type = MIX_UNSIGNED_16;
838 1.1 augustss sprintf(mix.ctlname, "fea%d-%s-%s", unit,
839 1.1 augustss uaudio_id_name(sc, dps, srcId),
840 1.1 augustss AudioNdelay);
841 1.1 augustss mix.ctlunit = "4 ms";
842 1.1 augustss break;
843 1.1 augustss case BASS_BOOST_CONTROL:
844 1.1 augustss mix.type = MIX_ON_OFF;
845 1.1 augustss sprintf(mix.ctlname, "fea%d-%s-%s", unit,
846 1.1 augustss uaudio_id_name(sc, dps, srcId),
847 1.1 augustss AudioNbassboost);
848 1.1 augustss mix.ctlunit = "";
849 1.1 augustss break;
850 1.1 augustss case LOUDNESS_CONTROL:
851 1.1 augustss mix.type = MIX_ON_OFF;
852 1.1 augustss sprintf(mix.ctlname, "fea%d-%s-%s", unit,
853 1.1 augustss uaudio_id_name(sc, dps, srcId),
854 1.1 augustss AudioNloudness);
855 1.1 augustss mix.ctlunit = "";
856 1.1 augustss break;
857 1.1 augustss }
858 1.1 augustss uaudio_mixer_add_ctl(sc, &mix);
859 1.1 augustss }
860 1.1 augustss }
861 1.1 augustss
862 1.1 augustss void
863 1.1 augustss uaudio_add_processing(sc, v, dps)
864 1.1 augustss struct uaudio_softc *sc;
865 1.1 augustss usb_descriptor_t *v;
866 1.1 augustss usb_descriptor_t **dps;
867 1.1 augustss {
868 1.4 augustss #ifdef UAUDIO_DEBUG
869 1.1 augustss struct usb_audio_processing_unit *d =
870 1.1 augustss (struct usb_audio_processing_unit *)v;
871 1.1 augustss
872 1.1 augustss DPRINTFN(2,("uaudio_add_processing: bUnitId=%d bNrInPins=%d\n",
873 1.1 augustss d->bUnitId, d->bNrInPins));
874 1.1 augustss printf("uaudio_add_processing: NOT IMPLEMENTED\n");
875 1.1 augustss #endif
876 1.1 augustss }
877 1.1 augustss
878 1.1 augustss void
879 1.1 augustss uaudio_add_extension(sc, v, dps)
880 1.1 augustss struct uaudio_softc *sc;
881 1.1 augustss usb_descriptor_t *v;
882 1.1 augustss usb_descriptor_t **dps;
883 1.1 augustss {
884 1.1 augustss struct usb_audio_extension_unit *d =
885 1.1 augustss (struct usb_audio_extension_unit *)v;
886 1.1 augustss struct usb_audio_extension_unit_1 *d1 =
887 1.1 augustss (struct usb_audio_extension_unit_1 *)&d->baSourceId[d->bNrInPins];
888 1.1 augustss struct mixerctl mix;
889 1.1 augustss
890 1.1 augustss DPRINTFN(2,("uaudio_add_extension: bUnitId=%d bNrInPins=%d\n",
891 1.1 augustss d->bUnitId, d->bNrInPins));
892 1.1 augustss
893 1.1 augustss if (d1->bmControls[0] & (1 << UA_EXT_ENABLE)) {
894 1.1 augustss mix.wIndex = MAKE(d->bUnitId, sc->sc_ac_iface);
895 1.1 augustss mix.nchan = 1;
896 1.1 augustss mix.wValue[0] = MAKE(UA_EXT_ENABLE, 0);
897 1.1 augustss mix.class = -1;
898 1.1 augustss mix.type = MIX_ON_OFF;
899 1.1 augustss mix.ctlunit = "";
900 1.1 augustss sprintf(mix.ctlname, "ext%d-enable", d->bUnitId);
901 1.1 augustss uaudio_mixer_add_ctl(sc, &mix);
902 1.1 augustss }
903 1.1 augustss }
904 1.1 augustss
905 1.1 augustss usbd_status
906 1.1 augustss uaudio_identify(sc, cdesc)
907 1.1 augustss struct uaudio_softc *sc;
908 1.1 augustss usb_config_descriptor_t *cdesc;
909 1.1 augustss {
910 1.1 augustss usbd_status r;
911 1.1 augustss
912 1.1 augustss r = uaudio_identify_ac(sc, cdesc);
913 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
914 1.1 augustss return (r);
915 1.1 augustss return (uaudio_identify_as(sc, cdesc));
916 1.1 augustss }
917 1.1 augustss
918 1.1 augustss void
919 1.1 augustss uaudio_add_alt(sc, ai)
920 1.1 augustss struct uaudio_softc *sc;
921 1.1 augustss struct as_info *ai;
922 1.1 augustss {
923 1.1 augustss if (sc->sc_nalts == 0)
924 1.1 augustss sc->sc_alts = malloc(sizeof *ai, M_USBDEV, M_NOWAIT);
925 1.1 augustss else
926 1.1 augustss sc->sc_alts = realloc(sc->sc_alts,
927 1.1 augustss (sc->sc_nalts+1) * sizeof *ai,
928 1.1 augustss M_USBDEV, M_NOWAIT);
929 1.1 augustss if (sc->sc_alts == 0) {
930 1.1 augustss printf("uaudio_add_alt: no memory\n");
931 1.1 augustss return;
932 1.1 augustss }
933 1.1 augustss DPRINTFN(2,("uaudio_add_alt: adding alt=%d, enc=%d\n",
934 1.1 augustss ai->alt, ai->encoding));
935 1.1 augustss sc->sc_alts[sc->sc_nalts++] = *ai;
936 1.1 augustss }
937 1.1 augustss
938 1.1 augustss usbd_status
939 1.1 augustss uaudio_process_as(sc, buf, offsp, size, id)
940 1.1 augustss struct uaudio_softc *sc;
941 1.1 augustss char *buf;
942 1.1 augustss int *offsp;
943 1.1 augustss #define offs (*offsp)
944 1.1 augustss int size;
945 1.1 augustss usb_interface_descriptor_t *id;
946 1.1 augustss {
947 1.1 augustss struct usb_audio_streaming_interface_descriptor *asid;
948 1.1 augustss struct usb_audio_streaming_type1_descriptor *asf1d;
949 1.1 augustss usb_endpoint_descriptor_audio_t *ed;
950 1.1 augustss struct usb_audio_streaming_endpoint_descriptor *sed;
951 1.1 augustss int format, chan, prec, enc;
952 1.5 augustss int dir, type;
953 1.1 augustss struct as_info ai;
954 1.1 augustss
955 1.1 augustss asid = (void *)(buf + offs);
956 1.1 augustss if (asid->bDescriptorType != UDESC_CS_INTERFACE ||
957 1.1 augustss asid->bDescriptorSubtype != AS_GENERAL)
958 1.1 augustss return (USBD_INVAL);
959 1.1 augustss offs += asid->bLength;
960 1.1 augustss if (offs > size)
961 1.1 augustss return (USBD_INVAL);
962 1.1 augustss asf1d = (void *)(buf + offs);
963 1.1 augustss if (asf1d->bDescriptorType != UDESC_CS_INTERFACE ||
964 1.1 augustss asf1d->bDescriptorSubtype != FORMAT_TYPE)
965 1.1 augustss return (USBD_INVAL);
966 1.1 augustss offs += asf1d->bLength;
967 1.1 augustss if (offs > size)
968 1.1 augustss return (USBD_INVAL);
969 1.1 augustss
970 1.3 augustss if (asf1d->bFormatType != FORMAT_TYPE_I) {
971 1.3 augustss printf("%s: ignored setting with type %d format\n",
972 1.3 augustss USBDEVNAME(sc->sc_dev), UGETW(asid->wFormatTag));
973 1.3 augustss return (USBD_NORMAL_COMPLETION);
974 1.3 augustss }
975 1.3 augustss
976 1.1 augustss ed = (void *)(buf + offs);
977 1.1 augustss if (ed->bDescriptorType != UDESC_ENDPOINT)
978 1.1 augustss return (USBD_INVAL);
979 1.5 augustss DPRINTF(("uaudio_process_as: endpoint bLength=%d bDescriptorType=%d "
980 1.5 augustss "bEndpointAddress=%d bmAttributes=0x%x wMaxPacketSize=%d "
981 1.5 augustss "bInterval=%d bRefresh=%d bSynchAddress=%d\n",
982 1.5 augustss ed->bLength, ed->bDescriptorType, ed->bEndpointAddress,
983 1.5 augustss ed->bmAttributes, UGETW(ed->wMaxPacketSize),
984 1.5 augustss ed->bInterval, ed->bRefresh, ed->bSynchAddress));
985 1.1 augustss offs += ed->bLength;
986 1.1 augustss if (offs > size)
987 1.1 augustss return (USBD_INVAL);
988 1.5 augustss if (UE_GET_XFERTYPE(ed->bmAttributes) != UE_ISOCHRONOUS)
989 1.1 augustss return (USBD_INVAL);
990 1.5 augustss
991 1.5 augustss dir = UE_GET_DIR(ed->bEndpointAddress);
992 1.5 augustss type = UE_GET_ISO_TYPE(ed->bmAttributes);
993 1.5 augustss /* We can't handle endpoints that need a sync pipe. */
994 1.5 augustss if (dir == UE_DIR_IN ? type == UE_ISO_ADAPT : type == UE_ISO_ASYNC) {
995 1.5 augustss printf("%s: ignored %sput endpoint of type 0x%x\n",
996 1.1 augustss USBDEVNAME(sc->sc_dev),
997 1.5 augustss dir == UE_DIR_IN ? "in" : "out",
998 1.1 augustss ed->bmAttributes & UE_ISO_TYPE);
999 1.1 augustss return (USBD_NORMAL_COMPLETION);
1000 1.1 augustss }
1001 1.1 augustss
1002 1.1 augustss sed = (void *)(buf + offs);
1003 1.1 augustss if (sed->bDescriptorType != UDESC_CS_ENDPOINT ||
1004 1.1 augustss sed->bDescriptorSubtype != AS_GENERAL)
1005 1.1 augustss return (USBD_INVAL);
1006 1.1 augustss offs += sed->bLength;
1007 1.1 augustss if (offs > size)
1008 1.1 augustss return (USBD_INVAL);
1009 1.1 augustss
1010 1.3 augustss format = UGETW(asid->wFormatTag);
1011 1.1 augustss chan = asf1d->bNrChannels;
1012 1.1 augustss prec = asf1d->bBitResolution;
1013 1.1 augustss if (prec != 8 && prec != 16) {
1014 1.1 augustss #ifdef AUDIO_DEBUG
1015 1.1 augustss printf("%s: ignored setting with precision %d\n",
1016 1.1 augustss USBDEVNAME(sc->sc_dev), prec);
1017 1.1 augustss #endif
1018 1.1 augustss return (USBD_NORMAL_COMPLETION);
1019 1.1 augustss }
1020 1.1 augustss switch (format) {
1021 1.3 augustss case UA_FMT_PCM:
1022 1.1 augustss sc->sc_altflags |= prec == 8 ? HAS_8 : HAS_16;
1023 1.5 augustss enc = AUDIO_ENCODING_SLINEAR_LE;
1024 1.1 augustss break;
1025 1.3 augustss case UA_FMT_PCM8:
1026 1.5 augustss enc = AUDIO_ENCODING_ULINEAR_LE;
1027 1.1 augustss sc->sc_altflags |= HAS_8U;
1028 1.1 augustss break;
1029 1.3 augustss case UA_FMT_ALAW:
1030 1.5 augustss enc = AUDIO_ENCODING_ALAW;
1031 1.1 augustss sc->sc_altflags |= HAS_ALAW;
1032 1.1 augustss break;
1033 1.3 augustss case UA_FMT_MULAW:
1034 1.5 augustss enc = AUDIO_ENCODING_ULAW;
1035 1.1 augustss sc->sc_altflags |= HAS_MULAW;
1036 1.1 augustss break;
1037 1.1 augustss default:
1038 1.1 augustss printf("%s: ignored setting with format %d\n",
1039 1.1 augustss USBDEVNAME(sc->sc_dev), format);
1040 1.1 augustss return (USBD_NORMAL_COMPLETION);
1041 1.1 augustss }
1042 1.1 augustss DPRINTFN(1,("uaudio_identify: alt=%d enc=%d chan=%d prec=%d\n",
1043 1.1 augustss id->bAlternateSetting, enc, chan, prec));
1044 1.1 augustss ai.alt = id->bAlternateSetting;
1045 1.1 augustss ai.encoding = enc;
1046 1.1 augustss ai.idesc = id;
1047 1.1 augustss ai.edesc = ed;
1048 1.1 augustss ai.asf1desc = asf1d;
1049 1.1 augustss uaudio_add_alt(sc, &ai);
1050 1.5 augustss sc->sc_chan.terminal = asid->bTerminalLink; /* XXX */
1051 1.5 augustss sc->sc_chan.dir = dir;
1052 1.1 augustss return (USBD_NORMAL_COMPLETION);
1053 1.1 augustss }
1054 1.1 augustss #undef offs
1055 1.1 augustss
1056 1.1 augustss usbd_status
1057 1.1 augustss uaudio_identify_as(sc, cdesc)
1058 1.1 augustss struct uaudio_softc *sc;
1059 1.1 augustss usb_config_descriptor_t *cdesc;
1060 1.1 augustss {
1061 1.1 augustss usb_interface_descriptor_t *id;
1062 1.1 augustss usbd_status r;
1063 1.1 augustss char *buf;
1064 1.1 augustss int size, offs;
1065 1.1 augustss
1066 1.1 augustss size = UGETW(cdesc->wTotalLength);
1067 1.1 augustss buf = (char *)cdesc;
1068 1.1 augustss
1069 1.1 augustss /* Locate the AudioStreaming interface descriptor. */
1070 1.1 augustss offs = 0;
1071 1.1 augustss id = uaudio_find_iface(buf, size, &offs, USUBCLASS_AUDIOSTREAM);
1072 1.1 augustss if (!id)
1073 1.1 augustss return (USBD_INVAL);
1074 1.1 augustss sc->sc_as_iface = id->bInterfaceNumber;
1075 1.1 augustss DPRINTF(("uaudio_identify_as: AS interface is %d\n", sc->sc_as_iface));
1076 1.1 augustss
1077 1.5 augustss sc->sc_chan.terminal = -1;
1078 1.1 augustss
1079 1.1 augustss /* Loop through all the alternate settings. */
1080 1.1 augustss while (offs <= size) {
1081 1.1 augustss switch (id->bNumEndpoints) {
1082 1.1 augustss case 0:
1083 1.1 augustss DPRINTFN(2, ("uaudio_identify: AS null alt=%d\n",
1084 1.1 augustss id->bAlternateSetting));
1085 1.1 augustss sc->sc_nullalt = id->bAlternateSetting;
1086 1.1 augustss break;
1087 1.1 augustss case 1:
1088 1.1 augustss r = uaudio_process_as(sc, buf, &offs, size, id);
1089 1.1 augustss break;
1090 1.1 augustss default:
1091 1.1 augustss #ifdef AUDIO_DEBUG
1092 1.1 augustss printf("%s: ignored audio interface with %d "
1093 1.1 augustss "endpoints\n",
1094 1.1 augustss USBDEVNAME(sc->sc_dev), id->bNumEndpoints);
1095 1.1 augustss #endif
1096 1.1 augustss break;
1097 1.1 augustss }
1098 1.1 augustss id = uaudio_find_iface(buf, size, &offs,USUBCLASS_AUDIOSTREAM);
1099 1.1 augustss if (!id)
1100 1.1 augustss break;
1101 1.1 augustss }
1102 1.1 augustss if (offs > size)
1103 1.1 augustss return (USBD_INVAL);
1104 1.1 augustss DPRINTF(("uaudio_identify_as: %d alts available\n", sc->sc_nalts));
1105 1.5 augustss if (sc->sc_chan.terminal < 0) {
1106 1.5 augustss printf("%s: no useable endpoint found\n",
1107 1.5 augustss USBDEVNAME(sc->sc_dev));
1108 1.5 augustss return (USBD_INVAL);
1109 1.5 augustss }
1110 1.1 augustss return (USBD_NORMAL_COMPLETION);
1111 1.1 augustss }
1112 1.1 augustss
1113 1.1 augustss usbd_status
1114 1.1 augustss uaudio_identify_ac(sc, cdesc)
1115 1.1 augustss struct uaudio_softc *sc;
1116 1.1 augustss usb_config_descriptor_t *cdesc;
1117 1.1 augustss {
1118 1.1 augustss usb_interface_descriptor_t *id;
1119 1.1 augustss struct usb_audio_control_descriptor *acdp;
1120 1.1 augustss usb_descriptor_t *dp, *dps[256];
1121 1.1 augustss char *buf, *ibuf, *ibufend;
1122 1.1 augustss int size, offs, aclen, ndps, i;
1123 1.1 augustss
1124 1.1 augustss size = UGETW(cdesc->wTotalLength);
1125 1.1 augustss buf = (char *)cdesc;
1126 1.1 augustss
1127 1.1 augustss /* Locate the AudioControl interface descriptor. */
1128 1.1 augustss offs = 0;
1129 1.1 augustss id = uaudio_find_iface(buf, size, &offs, USUBCLASS_AUDIOCONTROL);
1130 1.1 augustss if (!id)
1131 1.1 augustss return (USBD_INVAL);
1132 1.1 augustss if (offs + sizeof *acdp > size)
1133 1.1 augustss return (USBD_INVAL);
1134 1.1 augustss sc->sc_ac_iface = id->bInterfaceNumber;
1135 1.1 augustss DPRINTFN(2,("uaudio_identify: AC interface is %d\n", sc->sc_ac_iface));
1136 1.1 augustss
1137 1.1 augustss /* A class-specific AC interface header should follow. */
1138 1.1 augustss ibuf = buf + offs;
1139 1.1 augustss acdp = (struct usb_audio_control_descriptor *)ibuf;
1140 1.1 augustss if (acdp->bDescriptorType != UDESC_CS_INTERFACE ||
1141 1.1 augustss acdp->bDescriptorSubtype != UDESCSUB_AC_HEADER)
1142 1.1 augustss return (USBD_INVAL);
1143 1.1 augustss aclen = UGETW(acdp->wTotalLength);
1144 1.1 augustss if (offs + aclen > size)
1145 1.1 augustss return (USBD_INVAL);
1146 1.5 augustss
1147 1.1 augustss if (!(usbd_get_quirks(sc->sc_udev)->uq_flags & UQ_BAD_ADC) &&
1148 1.1 augustss UGETW(acdp->bcdADC) != UAUDIO_VERSION)
1149 1.1 augustss return (USBD_INVAL);
1150 1.1 augustss
1151 1.1 augustss DPRINTFN(2,("uaudio_identify: found AC header, vers=%03x, len=%d\n",
1152 1.1 augustss UGETW(acdp->bcdADC), aclen));
1153 1.1 augustss
1154 1.1 augustss sc->sc_nullalt = -1;
1155 1.1 augustss
1156 1.1 augustss /* Scan through all the AC specific descriptors */
1157 1.1 augustss ibufend = ibuf + aclen;
1158 1.1 augustss dp = (usb_descriptor_t *)ibuf;
1159 1.1 augustss ndps = 0;
1160 1.1 augustss memset(dps, 0, sizeof dps);
1161 1.1 augustss for (;;) {
1162 1.1 augustss ibuf += dp->bLength;
1163 1.1 augustss if (ibuf >= ibufend)
1164 1.1 augustss break;
1165 1.1 augustss dp = (usb_descriptor_t *)ibuf;
1166 1.1 augustss if (ibuf + dp->bLength > ibufend)
1167 1.1 augustss return (USBD_INVAL);
1168 1.1 augustss if (dp->bDescriptorType != UDESC_CS_INTERFACE) {
1169 1.1 augustss printf("uaudio_identify: skip desc type=0x%02x\n",
1170 1.1 augustss dp->bDescriptorType);
1171 1.1 augustss continue;
1172 1.1 augustss }
1173 1.1 augustss i = ((struct usb_audio_input_terminal *)dp)->bTerminalId;
1174 1.1 augustss dps[i] = dp;
1175 1.1 augustss if (i > ndps)
1176 1.1 augustss ndps = i;
1177 1.1 augustss }
1178 1.1 augustss ndps++;
1179 1.1 augustss
1180 1.1 augustss for (i = 0; i < ndps; i++) {
1181 1.1 augustss dp = dps[i];
1182 1.1 augustss if (dp == 0)
1183 1.1 augustss continue;
1184 1.1 augustss DPRINTF(("uaudio_identify: subtype=%d\n",
1185 1.1 augustss dp->bDescriptorSubtype));
1186 1.1 augustss switch (dp->bDescriptorSubtype) {
1187 1.1 augustss case UDESCSUB_AC_HEADER:
1188 1.1 augustss printf("uaudio_identify: unexpected AC header\n");
1189 1.1 augustss break;
1190 1.1 augustss case UDESCSUB_AC_INPUT:
1191 1.1 augustss uaudio_add_input(sc, dp, dps);
1192 1.1 augustss break;
1193 1.1 augustss case UDESCSUB_AC_OUTPUT:
1194 1.1 augustss uaudio_add_output(sc, dp, dps);
1195 1.1 augustss break;
1196 1.1 augustss case UDESCSUB_AC_MIXER:
1197 1.1 augustss uaudio_add_mixer(sc, dp, dps);
1198 1.1 augustss break;
1199 1.1 augustss case UDESCSUB_AC_SELECTOR:
1200 1.1 augustss uaudio_add_selector(sc, dp, dps);
1201 1.1 augustss break;
1202 1.1 augustss case UDESCSUB_AC_FEATURE:
1203 1.1 augustss uaudio_add_feature(sc, dp, dps);
1204 1.1 augustss break;
1205 1.1 augustss case UDESCSUB_AC_PROCESSING:
1206 1.1 augustss uaudio_add_processing(sc, dp, dps);
1207 1.1 augustss break;
1208 1.1 augustss case UDESCSUB_AC_EXTENSION:
1209 1.1 augustss uaudio_add_extension(sc, dp, dps);
1210 1.1 augustss break;
1211 1.1 augustss default:
1212 1.1 augustss printf("uaudio_identify: bad AC desc subtype=0x%02x\n",
1213 1.1 augustss dp->bDescriptorSubtype);
1214 1.1 augustss break;
1215 1.1 augustss }
1216 1.1 augustss }
1217 1.1 augustss return (USBD_NORMAL_COMPLETION);
1218 1.1 augustss }
1219 1.1 augustss
1220 1.1 augustss int
1221 1.1 augustss uaudio_query_devinfo(addr, mi)
1222 1.1 augustss void *addr;
1223 1.1 augustss mixer_devinfo_t *mi;
1224 1.1 augustss {
1225 1.1 augustss struct uaudio_softc *sc = addr;
1226 1.1 augustss struct mixerctl *mc;
1227 1.1 augustss int n, nctls;
1228 1.1 augustss
1229 1.1 augustss DPRINTFN(2,("uaudio_query_devinfo: index=%d\n", mi->index));
1230 1.1 augustss if (sc->sc_dying)
1231 1.1 augustss return (EIO);
1232 1.1 augustss
1233 1.1 augustss n = mi->index;
1234 1.1 augustss nctls = sc->sc_nctls;
1235 1.1 augustss
1236 1.1 augustss if (n < 0 || n >= nctls) {
1237 1.1 augustss switch (n - nctls) {
1238 1.1 augustss case UAC_OUTPUT:
1239 1.1 augustss mi->type = AUDIO_MIXER_CLASS;
1240 1.1 augustss mi->mixer_class = nctls + UAC_OUTPUT;
1241 1.1 augustss mi->next = mi->prev = AUDIO_MIXER_LAST;
1242 1.1 augustss strcpy(mi->label.name, AudioCoutputs);
1243 1.1 augustss return (0);
1244 1.1 augustss case UAC_INPUT:
1245 1.1 augustss mi->type = AUDIO_MIXER_CLASS;
1246 1.1 augustss mi->mixer_class = nctls + UAC_INPUT;
1247 1.1 augustss mi->next = mi->prev = AUDIO_MIXER_LAST;
1248 1.1 augustss strcpy(mi->label.name, AudioCinputs);
1249 1.1 augustss return (0);
1250 1.1 augustss case UAC_EQUAL:
1251 1.1 augustss mi->type = AUDIO_MIXER_CLASS;
1252 1.1 augustss mi->mixer_class = nctls + UAC_EQUAL;
1253 1.1 augustss mi->next = mi->prev = AUDIO_MIXER_LAST;
1254 1.1 augustss strcpy(mi->label.name, AudioCequalization);
1255 1.1 augustss return (0);
1256 1.1 augustss default:
1257 1.1 augustss return (ENXIO);
1258 1.1 augustss }
1259 1.1 augustss }
1260 1.1 augustss mc = &sc->sc_ctls[n];
1261 1.1 augustss strncpy(mi->label.name, mc->ctlname, MAX_AUDIO_DEV_LEN);
1262 1.1 augustss mi->mixer_class = mc->class;
1263 1.1 augustss mi->next = mi->prev = AUDIO_MIXER_LAST; /* XXX */
1264 1.1 augustss switch (mc->type) {
1265 1.1 augustss case MIX_ON_OFF:
1266 1.1 augustss mi->type = AUDIO_MIXER_ENUM;
1267 1.1 augustss mi->un.e.num_mem = 2;
1268 1.1 augustss strcpy(mi->un.e.member[0].label.name, AudioNoff);
1269 1.1 augustss mi->un.e.member[0].ord = 0;
1270 1.1 augustss strcpy(mi->un.e.member[1].label.name, AudioNon);
1271 1.1 augustss mi->un.e.member[1].ord = 1;
1272 1.1 augustss break;
1273 1.1 augustss default:
1274 1.1 augustss mi->type = AUDIO_MIXER_VALUE;
1275 1.1 augustss strncpy(mi->un.v.units.name, mc->ctlunit, MAX_AUDIO_DEV_LEN);
1276 1.1 augustss mi->un.v.num_channels = mc->nchan;
1277 1.1 augustss break;
1278 1.1 augustss }
1279 1.1 augustss return (0);
1280 1.1 augustss }
1281 1.1 augustss
1282 1.1 augustss int
1283 1.1 augustss uaudio_open(addr, flags)
1284 1.1 augustss void *addr;
1285 1.1 augustss int flags;
1286 1.1 augustss {
1287 1.1 augustss struct uaudio_softc *sc = addr;
1288 1.1 augustss
1289 1.1 augustss DPRINTF(("uaudio_open: sc=%p\n", sc));
1290 1.1 augustss if (sc->sc_dying)
1291 1.1 augustss return (EIO);
1292 1.1 augustss
1293 1.5 augustss if (sc->sc_chan.terminal < 0)
1294 1.5 augustss return (ENXIO);
1295 1.5 augustss
1296 1.5 augustss if ((flags & FREAD) && sc->sc_chan.dir != UE_DIR_IN)
1297 1.1 augustss return (EACCES);
1298 1.5 augustss if ((flags & FWRITE) && sc->sc_chan.dir != UE_DIR_OUT)
1299 1.1 augustss return (EACCES);
1300 1.1 augustss
1301 1.5 augustss sc->sc_chan.intr = 0;
1302 1.1 augustss
1303 1.1 augustss return (0);
1304 1.1 augustss }
1305 1.1 augustss
1306 1.1 augustss /*
1307 1.1 augustss * Close function is called at splaudio().
1308 1.1 augustss */
1309 1.1 augustss void
1310 1.1 augustss uaudio_close(addr)
1311 1.1 augustss void *addr;
1312 1.1 augustss {
1313 1.1 augustss struct uaudio_softc *sc = addr;
1314 1.1 augustss
1315 1.1 augustss DPRINTF(("uaudio_close: sc=%p\n", sc));
1316 1.1 augustss uaudio_halt_in_dma(sc);
1317 1.1 augustss uaudio_halt_out_dma(sc);
1318 1.1 augustss
1319 1.5 augustss sc->sc_chan.intr = 0;
1320 1.1 augustss }
1321 1.1 augustss
1322 1.1 augustss int
1323 1.1 augustss uaudio_drain(addr)
1324 1.1 augustss void *addr;
1325 1.1 augustss {
1326 1.1 augustss struct uaudio_softc *sc = addr;
1327 1.1 augustss
1328 1.1 augustss usbd_delay_ms(sc->sc_udev, UAUDIO_NCHANBUFS * UAUDIO_NFRAMES);
1329 1.1 augustss
1330 1.1 augustss return (0);
1331 1.1 augustss }
1332 1.1 augustss
1333 1.1 augustss int
1334 1.1 augustss uaudio_halt_out_dma(addr)
1335 1.1 augustss void *addr;
1336 1.1 augustss {
1337 1.1 augustss struct uaudio_softc *sc = addr;
1338 1.1 augustss
1339 1.1 augustss DPRINTF(("uaudio_halt_out_dma: enter\n"));
1340 1.5 augustss if (sc->sc_chan.pipe) {
1341 1.5 augustss uaudio_chan_close(sc, &sc->sc_chan);
1342 1.5 augustss sc->sc_chan.pipe = 0;
1343 1.5 augustss uaudio_chan_free_buffers(sc, &sc->sc_chan);
1344 1.1 augustss }
1345 1.1 augustss return (0);
1346 1.1 augustss }
1347 1.1 augustss
1348 1.1 augustss int
1349 1.1 augustss uaudio_halt_in_dma(addr)
1350 1.1 augustss void *addr;
1351 1.1 augustss {
1352 1.1 augustss struct uaudio_softc *sc = addr;
1353 1.1 augustss
1354 1.1 augustss DPRINTF(("uaudio_halt_in_dma: enter\n"));
1355 1.5 augustss if (sc->sc_chan.pipe) {
1356 1.5 augustss uaudio_chan_close(sc, &sc->sc_chan);
1357 1.5 augustss sc->sc_chan.pipe = 0;
1358 1.5 augustss uaudio_chan_free_buffers(sc, &sc->sc_chan);
1359 1.5 augustss }
1360 1.1 augustss return (0);
1361 1.1 augustss }
1362 1.1 augustss
1363 1.1 augustss int
1364 1.1 augustss uaudio_getdev(addr, retp)
1365 1.1 augustss void *addr;
1366 1.1 augustss struct audio_device *retp;
1367 1.1 augustss {
1368 1.1 augustss struct uaudio_softc *sc = addr;
1369 1.1 augustss
1370 1.1 augustss DPRINTF(("uaudio_mixer_getdev:\n"));
1371 1.1 augustss if (sc->sc_dying)
1372 1.1 augustss return (EIO);
1373 1.1 augustss
1374 1.1 augustss *retp = uaudio_device;
1375 1.1 augustss return (0);
1376 1.1 augustss }
1377 1.1 augustss
1378 1.1 augustss /*
1379 1.1 augustss * Make sure the block size is large enough to hold all outstanding transfers.
1380 1.1 augustss */
1381 1.1 augustss int
1382 1.1 augustss uaudio_round_blocksize(addr, blk)
1383 1.1 augustss void *addr;
1384 1.1 augustss int blk;
1385 1.1 augustss {
1386 1.1 augustss struct uaudio_softc *sc = addr;
1387 1.1 augustss int bpf;
1388 1.1 augustss
1389 1.5 augustss bpf = sc->sc_chan.bytes_per_frame + sc->sc_chan.sample_size;
1390 1.1 augustss /* XXX */
1391 1.1 augustss bpf *= UAUDIO_NFRAMES * UAUDIO_NCHANBUFS;
1392 1.1 augustss
1393 1.1 augustss bpf = (bpf + 15) &~ 15;
1394 1.1 augustss
1395 1.1 augustss if (blk < bpf)
1396 1.1 augustss blk = bpf;
1397 1.1 augustss
1398 1.5 augustss #ifdef DIAGNOSTIC
1399 1.5 augustss if (blk <= 0) {
1400 1.5 augustss printf("uaudio_round_blocksize: blk=%d\n", blk);
1401 1.5 augustss blk = 512;
1402 1.5 augustss }
1403 1.5 augustss #endif
1404 1.5 augustss
1405 1.1 augustss DPRINTFN(1,("uaudio_round_blocksize: blk=%d\n", blk));
1406 1.1 augustss return (blk);
1407 1.1 augustss }
1408 1.1 augustss
1409 1.1 augustss int
1410 1.1 augustss uaudio_get_props(addr)
1411 1.1 augustss void *addr;
1412 1.1 augustss {
1413 1.1 augustss struct uaudio_softc *sc = addr;
1414 1.1 augustss
1415 1.1 augustss if (sc->sc_dying)
1416 1.1 augustss return (EIO);
1417 1.1 augustss
1418 1.1 augustss return (sc->sc_props);
1419 1.1 augustss }
1420 1.1 augustss
1421 1.1 augustss int
1422 1.1 augustss uaudio_get(sc, which, type, wValue, wIndex, len)
1423 1.1 augustss struct uaudio_softc *sc;
1424 1.1 augustss int type, which, wValue, wIndex, len;
1425 1.1 augustss {
1426 1.1 augustss usb_device_request_t req;
1427 1.1 augustss u_int8_t data[4];
1428 1.1 augustss usbd_status r;
1429 1.1 augustss int val;
1430 1.1 augustss
1431 1.1 augustss if (wValue == -1)
1432 1.1 augustss return (0);
1433 1.1 augustss
1434 1.1 augustss req.bmRequestType = type;
1435 1.1 augustss req.bRequest = which;
1436 1.1 augustss USETW(req.wValue, wValue);
1437 1.1 augustss USETW(req.wIndex, wIndex);
1438 1.1 augustss USETW(req.wLength, len);
1439 1.1 augustss DPRINTFN(2,("uaudio_get: type=0x%02x req=0x%02x wValue=0x%04x "
1440 1.1 augustss "wIndex=0x%04x len=%d\n",
1441 1.1 augustss type, which, wValue, wIndex, len));
1442 1.1 augustss r = usbd_do_request(sc->sc_udev, &req, &data);
1443 1.1 augustss if (r != USBD_NORMAL_COMPLETION) {
1444 1.1 augustss DPRINTF(("uaudio_get: r=%d\n", r));
1445 1.1 augustss return (-1);
1446 1.1 augustss }
1447 1.1 augustss switch (len) {
1448 1.1 augustss case 1:
1449 1.1 augustss val = data[0];
1450 1.1 augustss break;
1451 1.1 augustss case 2:
1452 1.1 augustss val = data[0] | (data[1] << 8);
1453 1.1 augustss break;
1454 1.1 augustss default:
1455 1.1 augustss DPRINTF(("uaudio_get: bad length=%d\n", len));
1456 1.1 augustss return (-1);
1457 1.1 augustss }
1458 1.1 augustss DPRINTFN(2,("uaudio_get: val=%d\n", val));
1459 1.1 augustss return (val);
1460 1.1 augustss }
1461 1.1 augustss
1462 1.1 augustss void
1463 1.1 augustss uaudio_set(sc, which, type, wValue, wIndex, len, val)
1464 1.1 augustss struct uaudio_softc *sc;
1465 1.1 augustss int type, which, wValue, wIndex, len, val;
1466 1.1 augustss {
1467 1.1 augustss usb_device_request_t req;
1468 1.1 augustss u_int8_t data[4];
1469 1.1 augustss usbd_status r;
1470 1.1 augustss
1471 1.1 augustss if (wValue == -1)
1472 1.1 augustss return;
1473 1.1 augustss
1474 1.1 augustss req.bmRequestType = type;
1475 1.1 augustss req.bRequest = which;
1476 1.1 augustss USETW(req.wValue, wValue);
1477 1.1 augustss USETW(req.wIndex, wIndex);
1478 1.1 augustss USETW(req.wLength, len);
1479 1.1 augustss switch (len) {
1480 1.1 augustss case 1:
1481 1.1 augustss data[0] = val;
1482 1.1 augustss break;
1483 1.1 augustss case 2:
1484 1.1 augustss data[0] = val;
1485 1.1 augustss data[1] = val >> 8;
1486 1.1 augustss break;
1487 1.1 augustss default:
1488 1.1 augustss return;
1489 1.1 augustss }
1490 1.1 augustss DPRINTFN(2,("uaudio_set: type=0x%02x req=0x%02x wValue=0x%04x "
1491 1.1 augustss "wIndex=0x%04x len=%d, val=%d\n",
1492 1.1 augustss type, which, wValue, wIndex, len, val & 0xffff));
1493 1.1 augustss r = usbd_do_request(sc->sc_udev, &req, &data);
1494 1.4 augustss #ifdef UAUDIO_DEBUG
1495 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
1496 1.1 augustss DPRINTF(("uaudio_set: r=%d\n", r));
1497 1.1 augustss #endif
1498 1.1 augustss }
1499 1.1 augustss
1500 1.1 augustss int
1501 1.1 augustss uaudio_signext(type, val)
1502 1.1 augustss int type, val;
1503 1.1 augustss {
1504 1.1 augustss if (!MIX_UNSIGNED(type)) {
1505 1.1 augustss if (MIX_SIZE(type) == 2)
1506 1.1 augustss val = (int16_t)val;
1507 1.1 augustss else
1508 1.1 augustss val = (int8_t)val;
1509 1.1 augustss }
1510 1.1 augustss return (val);
1511 1.1 augustss }
1512 1.1 augustss
1513 1.1 augustss int
1514 1.1 augustss uaudio_value2bsd(mc, val)
1515 1.1 augustss struct mixerctl *mc;
1516 1.1 augustss int val;
1517 1.1 augustss {
1518 1.1 augustss DPRINTFN(5, ("uaudio_value2bsd: type=%03x val=%d min=%d max=%d ",
1519 1.1 augustss mc->type, val, mc->minval, mc->maxval));
1520 1.1 augustss if (mc->type == MIX_ON_OFF)
1521 1.1 augustss val = val != 0;
1522 1.1 augustss else
1523 1.1 augustss val = (uaudio_signext(mc->type, val) - mc->minval) * 256
1524 1.1 augustss / (mc->maxval - mc->minval);
1525 1.1 augustss DPRINTFN(5, ("val'=%d\n", val));
1526 1.1 augustss return (val);
1527 1.1 augustss }
1528 1.1 augustss
1529 1.1 augustss int
1530 1.1 augustss uaudio_bsd2value(mc, val)
1531 1.1 augustss struct mixerctl *mc;
1532 1.1 augustss int val;
1533 1.1 augustss {
1534 1.1 augustss DPRINTFN(5,("uaudio_bsd2value: type=%03x val=%d min=%d max=%d ",
1535 1.1 augustss mc->type, val, mc->minval, mc->maxval));
1536 1.1 augustss if (mc->type == MIX_ON_OFF)
1537 1.1 augustss val = val != 0;
1538 1.1 augustss else
1539 1.1 augustss val = val * (mc->maxval - mc->minval) / 256 + mc->minval;
1540 1.1 augustss DPRINTFN(5, ("val'=%d\n", val));
1541 1.1 augustss return (val);
1542 1.1 augustss }
1543 1.1 augustss
1544 1.1 augustss int
1545 1.1 augustss uaudio_ctl_get(sc, which, mc, chan)
1546 1.1 augustss struct uaudio_softc *sc;
1547 1.1 augustss int which;
1548 1.1 augustss struct mixerctl *mc;
1549 1.1 augustss int chan;
1550 1.1 augustss {
1551 1.1 augustss int val;
1552 1.1 augustss
1553 1.1 augustss DPRINTFN(5,("uaudio_ctl_get: which=%d chan=%d\n", which, chan));
1554 1.1 augustss val = uaudio_get(sc, which, UT_READ_CLASS_INTERFACE, mc->wValue[chan],
1555 1.1 augustss mc->wIndex, MIX_SIZE(mc->type));
1556 1.1 augustss return (uaudio_value2bsd(mc, val));
1557 1.1 augustss }
1558 1.1 augustss
1559 1.1 augustss void
1560 1.1 augustss uaudio_ctl_set(sc, which, mc, chan, val)
1561 1.1 augustss struct uaudio_softc *sc;
1562 1.1 augustss int which;
1563 1.1 augustss struct mixerctl *mc;
1564 1.1 augustss int chan;
1565 1.1 augustss int val;
1566 1.1 augustss {
1567 1.1 augustss val = uaudio_bsd2value(mc, val);
1568 1.1 augustss uaudio_set(sc, which, UT_WRITE_CLASS_INTERFACE, mc->wValue[chan],
1569 1.1 augustss mc->wIndex, MIX_SIZE(mc->type), val);
1570 1.1 augustss }
1571 1.1 augustss
1572 1.1 augustss int
1573 1.1 augustss uaudio_mixer_get_port(addr, cp)
1574 1.1 augustss void *addr;
1575 1.1 augustss mixer_ctrl_t *cp;
1576 1.1 augustss {
1577 1.1 augustss struct uaudio_softc *sc = addr;
1578 1.1 augustss struct mixerctl *mc;
1579 1.1 augustss int i, n, vals[MIX_MAX_CHAN], val;
1580 1.1 augustss
1581 1.1 augustss DPRINTFN(2,("uaudio_mixer_get_port: index=%d\n", cp->dev));
1582 1.1 augustss
1583 1.1 augustss if (sc->sc_dying)
1584 1.1 augustss return (EIO);
1585 1.1 augustss
1586 1.1 augustss n = cp->dev;
1587 1.1 augustss if (n < 0 || n >= sc->sc_nctls)
1588 1.1 augustss return (ENXIO);
1589 1.1 augustss mc = &sc->sc_ctls[n];
1590 1.1 augustss
1591 1.1 augustss if (mc->type == MIX_ON_OFF) {
1592 1.1 augustss if (cp->type != AUDIO_MIXER_ENUM)
1593 1.1 augustss return (EINVAL);
1594 1.1 augustss cp->un.ord = uaudio_ctl_get(sc, GET_CUR, mc, 0);
1595 1.1 augustss } else {
1596 1.1 augustss if (cp->type != AUDIO_MIXER_VALUE)
1597 1.1 augustss return (EINVAL);
1598 1.1 augustss if (cp->un.value.num_channels != 1 &&
1599 1.1 augustss cp->un.value.num_channels != mc->nchan)
1600 1.1 augustss return (EINVAL);
1601 1.1 augustss for (i = 0; i < mc->nchan; i++)
1602 1.1 augustss vals[i] = uaudio_ctl_get(sc, GET_CUR, mc, i);
1603 1.1 augustss if (cp->un.value.num_channels == 1 && mc->nchan != 1) {
1604 1.1 augustss for (val = 0, i = 0; i < mc->nchan; i++)
1605 1.1 augustss val += vals[i];
1606 1.1 augustss vals[0] = val / mc->nchan;
1607 1.1 augustss }
1608 1.1 augustss for (i = 0; i < cp->un.value.num_channels; i++)
1609 1.1 augustss cp->un.value.level[i] = vals[i];
1610 1.1 augustss }
1611 1.1 augustss
1612 1.1 augustss return (0);
1613 1.1 augustss }
1614 1.1 augustss
1615 1.1 augustss int
1616 1.1 augustss uaudio_mixer_set_port(addr, cp)
1617 1.1 augustss void *addr;
1618 1.1 augustss mixer_ctrl_t *cp;
1619 1.1 augustss {
1620 1.1 augustss struct uaudio_softc *sc = addr;
1621 1.1 augustss struct mixerctl *mc;
1622 1.1 augustss int i, n, vals[MIX_MAX_CHAN];
1623 1.1 augustss
1624 1.1 augustss DPRINTFN(2,("uaudio_mixer_set_port: index = %d\n", cp->dev));
1625 1.1 augustss if (sc->sc_dying)
1626 1.1 augustss return (EIO);
1627 1.1 augustss
1628 1.1 augustss n = cp->dev;
1629 1.1 augustss if (n < 0 || n >= sc->sc_nctls)
1630 1.1 augustss return (ENXIO);
1631 1.1 augustss mc = &sc->sc_ctls[n];
1632 1.1 augustss
1633 1.1 augustss if (mc->type == MIX_ON_OFF) {
1634 1.1 augustss if (cp->type != AUDIO_MIXER_ENUM)
1635 1.1 augustss return (EINVAL);
1636 1.1 augustss uaudio_ctl_set(sc, SET_CUR, mc, 0, cp->un.ord);
1637 1.1 augustss } else {
1638 1.1 augustss if (cp->type != AUDIO_MIXER_VALUE)
1639 1.1 augustss return (EINVAL);
1640 1.1 augustss if (cp->un.value.num_channels == 1)
1641 1.1 augustss for (i = 0; i < mc->nchan; i++)
1642 1.1 augustss vals[i] = cp->un.value.level[0];
1643 1.1 augustss else if (cp->un.value.num_channels == mc->nchan)
1644 1.1 augustss for (i = 0; i < mc->nchan; i++)
1645 1.1 augustss vals[i] = cp->un.value.level[i];
1646 1.1 augustss else
1647 1.1 augustss return (EINVAL);
1648 1.1 augustss for (i = 0; i < mc->nchan; i++)
1649 1.1 augustss uaudio_ctl_set(sc, SET_CUR, mc, i, vals[i]);
1650 1.1 augustss }
1651 1.1 augustss return (0);
1652 1.1 augustss }
1653 1.1 augustss
1654 1.1 augustss int
1655 1.1 augustss uaudio_trigger_input(addr, start, end, blksize, intr, arg, param)
1656 1.1 augustss void *addr;
1657 1.1 augustss void *start, *end;
1658 1.1 augustss int blksize;
1659 1.1 augustss void (*intr) __P((void *));
1660 1.1 augustss void *arg;
1661 1.1 augustss struct audio_params *param;
1662 1.1 augustss {
1663 1.1 augustss struct uaudio_softc *sc = addr;
1664 1.5 augustss struct chan *ch = &sc->sc_chan;
1665 1.5 augustss usbd_status r;
1666 1.5 augustss int i, s;
1667 1.1 augustss
1668 1.1 augustss if (sc->sc_dying)
1669 1.1 augustss return (EIO);
1670 1.1 augustss
1671 1.5 augustss DPRINTFN(3,("uaudio_trigger_input: sc=%p start=%p end=%p "
1672 1.1 augustss "blksize=%d\n", sc, start, end, blksize));
1673 1.1 augustss
1674 1.5 augustss uaudio_chan_set_param(ch, param, start, end, blksize);
1675 1.5 augustss DPRINTFN(3,("uaudio_trigger_input: sample_size=%d bytes/frame=%d "
1676 1.5 augustss "fraction=0.%03d\n", ch->sample_size, ch->bytes_per_frame,
1677 1.5 augustss ch->fraction));
1678 1.5 augustss
1679 1.5 augustss r = uaudio_chan_alloc_buffers(sc, ch);
1680 1.5 augustss if (r != USBD_NORMAL_COMPLETION)
1681 1.5 augustss return (EIO);
1682 1.5 augustss
1683 1.5 augustss r = uaudio_chan_open(sc, ch);
1684 1.5 augustss if (r != USBD_NORMAL_COMPLETION) {
1685 1.5 augustss uaudio_chan_free_buffers(sc, ch);
1686 1.5 augustss return (EIO);
1687 1.5 augustss }
1688 1.5 augustss
1689 1.5 augustss sc->sc_chan.intr = intr;
1690 1.5 augustss sc->sc_chan.arg = arg;
1691 1.5 augustss
1692 1.5 augustss s = splusb();
1693 1.5 augustss for (i = 0; i < UAUDIO_NCHANBUFS; i++)
1694 1.5 augustss uaudio_chan_rtransfer(ch);
1695 1.5 augustss splx(s);
1696 1.5 augustss
1697 1.5 augustss return (0);
1698 1.1 augustss }
1699 1.1 augustss
1700 1.1 augustss int
1701 1.1 augustss uaudio_trigger_output(addr, start, end, blksize, intr, arg, param)
1702 1.1 augustss void *addr;
1703 1.1 augustss void *start, *end;
1704 1.1 augustss int blksize;
1705 1.1 augustss void (*intr) __P((void *));
1706 1.1 augustss void *arg;
1707 1.1 augustss struct audio_params *param;
1708 1.1 augustss {
1709 1.1 augustss struct uaudio_softc *sc = addr;
1710 1.5 augustss struct chan *ch = &sc->sc_chan;
1711 1.1 augustss usbd_status r;
1712 1.1 augustss int i, s;
1713 1.1 augustss
1714 1.1 augustss if (sc->sc_dying)
1715 1.1 augustss return (EIO);
1716 1.1 augustss
1717 1.1 augustss DPRINTFN(3,("uaudio_trigger_output: sc=%p start=%p end=%p "
1718 1.1 augustss "blksize=%d\n", sc, start, end, blksize));
1719 1.1 augustss
1720 1.1 augustss uaudio_chan_set_param(ch, param, start, end, blksize);
1721 1.1 augustss DPRINTFN(3,("uaudio_trigger_output: sample_size=%d bytes/frame=%d "
1722 1.1 augustss "fraction=0.%03d\n", ch->sample_size, ch->bytes_per_frame,
1723 1.1 augustss ch->fraction));
1724 1.1 augustss
1725 1.1 augustss r = uaudio_chan_alloc_buffers(sc, ch);
1726 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
1727 1.1 augustss return (EIO);
1728 1.1 augustss
1729 1.1 augustss r = uaudio_chan_open(sc, ch);
1730 1.1 augustss if (r != USBD_NORMAL_COMPLETION) {
1731 1.1 augustss uaudio_chan_free_buffers(sc, ch);
1732 1.1 augustss return (EIO);
1733 1.1 augustss }
1734 1.1 augustss
1735 1.5 augustss sc->sc_chan.intr = intr;
1736 1.5 augustss sc->sc_chan.arg = arg;
1737 1.1 augustss
1738 1.1 augustss s = splusb();
1739 1.1 augustss for (i = 0; i < UAUDIO_NCHANBUFS; i++)
1740 1.5 augustss uaudio_chan_ptransfer(ch);
1741 1.1 augustss splx(s);
1742 1.1 augustss
1743 1.1 augustss return (0);
1744 1.1 augustss }
1745 1.1 augustss
1746 1.1 augustss /* Set up a pipe for a channel. */
1747 1.1 augustss usbd_status
1748 1.1 augustss uaudio_chan_open(sc, ch)
1749 1.1 augustss struct uaudio_softc *sc;
1750 1.1 augustss struct chan *ch;
1751 1.1 augustss {
1752 1.1 augustss struct as_info *as = &sc->sc_alts[sc->sc_curaltidx];
1753 1.1 augustss int endpt = as->edesc->bEndpointAddress;
1754 1.1 augustss usbd_status r;
1755 1.1 augustss
1756 1.1 augustss DPRINTF(("uaudio_open_chan: endpt=0x%02x, speed=%d, alt=%d\n",
1757 1.1 augustss endpt, ch->sample_rate, as->alt));
1758 1.1 augustss
1759 1.1 augustss /* Set alternate interface corresponding to the mode. */
1760 1.1 augustss r = usbd_set_interface(sc->sc_as_ifaceh, as->alt);
1761 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
1762 1.1 augustss return (r);
1763 1.1 augustss
1764 1.1 augustss /* Some devices do not support this request, so ignore errors. */
1765 1.4 augustss #ifdef UAUDIO_DEBUG
1766 1.1 augustss r = uaudio_set_speed(sc, endpt, ch->sample_rate);
1767 1.5 augustss if (r != USBD_NORMAL_COMPLETION)
1768 1.5 augustss DPRINTF(("uaudio_chan_open: set_speed failed r=%s\n",
1769 1.5 augustss usbd_errstr(r)));
1770 1.1 augustss #else
1771 1.1 augustss (void)uaudio_set_speed(sc, endpt, ch->sample_rate);
1772 1.1 augustss #endif
1773 1.1 augustss
1774 1.1 augustss DPRINTF(("uaudio_open_chan: create pipe to 0x%02x\n", endpt));
1775 1.1 augustss r = usbd_open_pipe(sc->sc_as_ifaceh, endpt, 0, &ch->pipe);
1776 1.1 augustss return (r);
1777 1.1 augustss }
1778 1.1 augustss
1779 1.1 augustss void
1780 1.1 augustss uaudio_chan_close(sc, ch)
1781 1.1 augustss struct uaudio_softc *sc;
1782 1.1 augustss struct chan *ch;
1783 1.1 augustss {
1784 1.1 augustss if (sc->sc_nullalt >= 0) {
1785 1.1 augustss DPRINTF(("uaudio_close_chan: set null alt=%d\n",
1786 1.1 augustss sc->sc_nullalt));
1787 1.1 augustss usbd_set_interface(sc->sc_as_ifaceh, sc->sc_nullalt);
1788 1.1 augustss }
1789 1.1 augustss usbd_abort_pipe(ch->pipe);
1790 1.1 augustss usbd_close_pipe(ch->pipe);
1791 1.1 augustss }
1792 1.1 augustss
1793 1.1 augustss usbd_status
1794 1.1 augustss uaudio_chan_alloc_buffers(sc, ch)
1795 1.1 augustss struct uaudio_softc *sc;
1796 1.1 augustss struct chan *ch;
1797 1.1 augustss {
1798 1.1 augustss usbd_request_handle reqh;
1799 1.1 augustss void *buf;
1800 1.1 augustss int i, size;
1801 1.1 augustss
1802 1.1 augustss size = (ch->bytes_per_frame + ch->sample_size) * UAUDIO_NFRAMES;
1803 1.1 augustss for (i = 0; i < UAUDIO_NCHANBUFS; i++) {
1804 1.1 augustss reqh = usbd_alloc_request(sc->sc_udev);
1805 1.1 augustss if (reqh == 0)
1806 1.1 augustss goto bad;
1807 1.1 augustss ch->chanbufs[i].reqh = reqh;
1808 1.1 augustss buf = usbd_alloc_buffer(reqh, size);
1809 1.1 augustss if (buf == 0) {
1810 1.1 augustss i++;
1811 1.1 augustss goto bad;
1812 1.1 augustss }
1813 1.1 augustss ch->chanbufs[i].buffer = buf;
1814 1.1 augustss ch->chanbufs[i].chan = ch;
1815 1.1 augustss }
1816 1.1 augustss
1817 1.1 augustss return (USBD_NORMAL_COMPLETION);
1818 1.1 augustss
1819 1.1 augustss bad:
1820 1.1 augustss while (--i >= 0)
1821 1.1 augustss /* implicit buffer free */
1822 1.1 augustss usbd_free_request(ch->chanbufs[i].reqh);
1823 1.1 augustss return (USBD_NOMEM);
1824 1.1 augustss }
1825 1.1 augustss
1826 1.1 augustss void
1827 1.1 augustss uaudio_chan_free_buffers(sc, ch)
1828 1.1 augustss struct uaudio_softc *sc;
1829 1.1 augustss struct chan *ch;
1830 1.1 augustss {
1831 1.1 augustss int i;
1832 1.1 augustss
1833 1.1 augustss for (i = 0; i < UAUDIO_NCHANBUFS; i++)
1834 1.1 augustss usbd_free_request(ch->chanbufs[i].reqh);
1835 1.1 augustss }
1836 1.1 augustss
1837 1.1 augustss /* Called at splusb() */
1838 1.1 augustss void
1839 1.5 augustss uaudio_chan_ptransfer(ch)
1840 1.1 augustss struct chan *ch;
1841 1.1 augustss {
1842 1.1 augustss struct chanbuf *cb;
1843 1.1 augustss int i, n, size, residue, total;
1844 1.1 augustss
1845 1.1 augustss /* Pick the next channel buffer. */
1846 1.1 augustss cb = &ch->chanbufs[ch->curchanbuf];
1847 1.1 augustss if (++ch->curchanbuf >= UAUDIO_NCHANBUFS)
1848 1.1 augustss ch->curchanbuf = 0;
1849 1.1 augustss
1850 1.1 augustss /* Compute the size of each frame in the next transfer. */
1851 1.1 augustss residue = ch->residue;
1852 1.1 augustss total = 0;
1853 1.1 augustss for (i = 0; i < UAUDIO_NFRAMES; i++) {
1854 1.1 augustss size = ch->bytes_per_frame;
1855 1.1 augustss residue += ch->fraction;
1856 1.1 augustss if (residue >= USB_FRAMES_PER_SECOND) {
1857 1.1 augustss size += ch->sample_size;
1858 1.1 augustss residue -= USB_FRAMES_PER_SECOND;
1859 1.1 augustss }
1860 1.1 augustss cb->sizes[i] = size;
1861 1.1 augustss total += size;
1862 1.1 augustss }
1863 1.1 augustss ch->residue = residue;
1864 1.1 augustss cb->size = total;
1865 1.1 augustss
1866 1.1 augustss /*
1867 1.1 augustss * Transfer data from upper layer buffer to channel buffer, taking
1868 1.1 augustss * care of wrapping the upper layer buffer.
1869 1.1 augustss */
1870 1.1 augustss n = min(total, ch->end - ch->cur);
1871 1.1 augustss memcpy(cb->buffer, ch->cur, n);
1872 1.1 augustss ch->cur += n;
1873 1.1 augustss if (ch->cur >= ch->end)
1874 1.1 augustss ch->cur = ch->start;
1875 1.1 augustss if (total > n) {
1876 1.1 augustss total -= n;
1877 1.1 augustss memcpy(cb->buffer + n, ch->cur, total);
1878 1.1 augustss ch->cur += total;
1879 1.1 augustss }
1880 1.1 augustss
1881 1.4 augustss #ifdef UAUDIO_DEBUG
1882 1.1 augustss if (uaudiodebug > 8) {
1883 1.5 augustss DPRINTF(("uaudio_chan_ptransfer: buffer=%p, residue=0.%03d\n",
1884 1.1 augustss cb->buffer, ch->residue));
1885 1.1 augustss for (i = 0; i < UAUDIO_NFRAMES; i++) {
1886 1.1 augustss DPRINTF((" [%d] length %d\n", i, cb->sizes[i]));
1887 1.1 augustss }
1888 1.1 augustss }
1889 1.1 augustss #endif
1890 1.1 augustss
1891 1.5 augustss DPRINTFN(5,("uaudio_chan_transfer: ptransfer reqh=%p\n", cb->reqh));
1892 1.1 augustss /* Fill the request */
1893 1.1 augustss usbd_setup_isoc_request(cb->reqh, ch->pipe, cb, cb->sizes,
1894 1.2 augustss UAUDIO_NFRAMES, USBD_NO_COPY,
1895 1.2 augustss uaudio_chan_pintr);
1896 1.1 augustss
1897 1.1 augustss (void)usbd_transfer(cb->reqh);
1898 1.1 augustss }
1899 1.1 augustss
1900 1.1 augustss void
1901 1.1 augustss uaudio_chan_pintr(reqh, priv, status)
1902 1.1 augustss usbd_request_handle reqh;
1903 1.1 augustss usbd_private_handle priv;
1904 1.1 augustss usbd_status status;
1905 1.1 augustss {
1906 1.1 augustss struct chanbuf *cb = priv;
1907 1.1 augustss struct chan *ch = cb->chan;
1908 1.1 augustss u_int32_t count;
1909 1.1 augustss int s;
1910 1.1 augustss
1911 1.1 augustss /* Return if we are aborting. */
1912 1.1 augustss if (status == USBD_CANCELLED)
1913 1.1 augustss return;
1914 1.1 augustss
1915 1.5 augustss usbd_get_request_status(reqh, 0, 0, &count, 0);
1916 1.5 augustss DPRINTFN(5,("uaudio_chan_pintr: count=%d, transferred=%d\n",
1917 1.5 augustss count, ch->transferred));
1918 1.5 augustss #ifdef DIAGNOSTIC
1919 1.5 augustss if (count != cb->size) {
1920 1.5 augustss printf("uaudio_chan_pintr: count(%d) != size(%d)\n",
1921 1.5 augustss count, cb->size);
1922 1.5 augustss }
1923 1.5 augustss #endif
1924 1.5 augustss
1925 1.5 augustss ch->transferred += cb->size;
1926 1.5 augustss s = splaudio();
1927 1.1 augustss /* Call back to upper layer */
1928 1.5 augustss while (ch->transferred >= ch->blksize) {
1929 1.5 augustss ch->transferred -= ch->blksize;
1930 1.5 augustss DPRINTFN(5,("uaudio_chan_pintr: call %p(%p)\n",
1931 1.5 augustss ch->intr, ch->arg));
1932 1.5 augustss ch->intr(ch->arg);
1933 1.5 augustss }
1934 1.5 augustss splx(s);
1935 1.5 augustss
1936 1.5 augustss /* start next transfer */
1937 1.5 augustss uaudio_chan_ptransfer(ch);
1938 1.5 augustss }
1939 1.5 augustss
1940 1.5 augustss /* Called at splusb() */
1941 1.5 augustss void
1942 1.5 augustss uaudio_chan_rtransfer(ch)
1943 1.5 augustss struct chan *ch;
1944 1.5 augustss {
1945 1.5 augustss struct chanbuf *cb;
1946 1.5 augustss int i, size, residue, total;
1947 1.5 augustss
1948 1.5 augustss /* Pick the next channel buffer. */
1949 1.5 augustss cb = &ch->chanbufs[ch->curchanbuf];
1950 1.5 augustss if (++ch->curchanbuf >= UAUDIO_NCHANBUFS)
1951 1.5 augustss ch->curchanbuf = 0;
1952 1.5 augustss
1953 1.5 augustss /* Compute the size of each frame in the next transfer. */
1954 1.5 augustss residue = ch->residue;
1955 1.5 augustss total = 0;
1956 1.5 augustss for (i = 0; i < UAUDIO_NFRAMES; i++) {
1957 1.5 augustss size = ch->bytes_per_frame;
1958 1.5 augustss residue += ch->fraction;
1959 1.5 augustss if (residue >= USB_FRAMES_PER_SECOND) {
1960 1.5 augustss size += ch->sample_size;
1961 1.5 augustss residue -= USB_FRAMES_PER_SECOND;
1962 1.5 augustss }
1963 1.5 augustss cb->sizes[i] = size;
1964 1.5 augustss total += size;
1965 1.5 augustss }
1966 1.5 augustss ch->residue = residue;
1967 1.5 augustss cb->size = total;
1968 1.5 augustss
1969 1.5 augustss #ifdef UAUDIO_DEBUG
1970 1.5 augustss if (uaudiodebug > 8) {
1971 1.5 augustss DPRINTF(("uaudio_chan_rtransfer: buffer=%p, residue=0.%03d\n",
1972 1.5 augustss cb->buffer, ch->residue));
1973 1.5 augustss for (i = 0; i < UAUDIO_NFRAMES; i++) {
1974 1.5 augustss DPRINTF((" [%d] length %d\n", i, cb->sizes[i]));
1975 1.5 augustss }
1976 1.5 augustss }
1977 1.5 augustss #endif
1978 1.5 augustss
1979 1.5 augustss DPRINTFN(5,("uaudio_chan_rtransfer: transfer reqh=%p\n", cb->reqh));
1980 1.5 augustss /* Fill the request */
1981 1.5 augustss usbd_setup_isoc_request(cb->reqh, ch->pipe, cb, cb->sizes,
1982 1.5 augustss UAUDIO_NFRAMES, USBD_NO_COPY,
1983 1.5 augustss uaudio_chan_rintr);
1984 1.5 augustss
1985 1.5 augustss (void)usbd_transfer(cb->reqh);
1986 1.5 augustss }
1987 1.5 augustss
1988 1.5 augustss void
1989 1.5 augustss uaudio_chan_rintr(reqh, priv, status)
1990 1.5 augustss usbd_request_handle reqh;
1991 1.5 augustss usbd_private_handle priv;
1992 1.5 augustss usbd_status status;
1993 1.5 augustss {
1994 1.5 augustss struct chanbuf *cb = priv;
1995 1.5 augustss struct chan *ch = cb->chan;
1996 1.5 augustss u_int32_t count;
1997 1.5 augustss int s, n;
1998 1.5 augustss
1999 1.5 augustss /* Return if we are aborting. */
2000 1.5 augustss if (status == USBD_CANCELLED)
2001 1.5 augustss return;
2002 1.5 augustss
2003 1.1 augustss usbd_get_request_status(reqh, 0, 0, &count, 0);
2004 1.5 augustss DPRINTFN(5,("uaudio_chan_rintr: count=%d, transferred=%d\n",
2005 1.1 augustss count, ch->transferred));
2006 1.1 augustss #ifdef DIAGNOSTIC
2007 1.1 augustss if (count != cb->size) {
2008 1.1 augustss printf("uaudio_chan_pintr: count(%d) != size(%d)\n",
2009 1.1 augustss count, cb->size);
2010 1.1 augustss }
2011 1.1 augustss #endif
2012 1.1 augustss
2013 1.5 augustss /*
2014 1.5 augustss * Transfer data from channel buffer to upper layer buffer, taking
2015 1.5 augustss * care of wrapping the upper layer buffer.
2016 1.5 augustss */
2017 1.5 augustss n = min(count, ch->end - ch->cur);
2018 1.5 augustss memcpy(ch->cur, cb->buffer, n);
2019 1.5 augustss ch->cur += n;
2020 1.5 augustss if (ch->cur >= ch->end)
2021 1.5 augustss ch->cur = ch->start;
2022 1.5 augustss if (count > n) {
2023 1.5 augustss memcpy(ch->cur, cb->buffer + n, count - n);
2024 1.5 augustss ch->cur += count - n;
2025 1.5 augustss }
2026 1.5 augustss
2027 1.5 augustss /* Call back to upper layer */
2028 1.1 augustss ch->transferred += cb->size;
2029 1.1 augustss s = splaudio();
2030 1.1 augustss while (ch->transferred >= ch->blksize) {
2031 1.1 augustss ch->transferred -= ch->blksize;
2032 1.1 augustss DPRINTFN(5,("uaudio_chan_pintr: call %p(%p)\n",
2033 1.1 augustss ch->intr, ch->arg));
2034 1.1 augustss ch->intr(ch->arg);
2035 1.1 augustss }
2036 1.1 augustss splx(s);
2037 1.1 augustss
2038 1.1 augustss /* start next transfer */
2039 1.5 augustss uaudio_chan_rtransfer(ch);
2040 1.1 augustss }
2041 1.1 augustss
2042 1.1 augustss void
2043 1.1 augustss uaudio_chan_set_param(ch, param, start, end, blksize)
2044 1.1 augustss struct chan *ch;
2045 1.1 augustss struct audio_params *param;
2046 1.1 augustss u_char *start, *end;
2047 1.1 augustss int blksize;
2048 1.1 augustss {
2049 1.1 augustss int samples_per_frame, sample_size;
2050 1.1 augustss
2051 1.1 augustss sample_size = param->precision * param->channels / 8;
2052 1.1 augustss samples_per_frame = param->sample_rate / USB_FRAMES_PER_SECOND;
2053 1.1 augustss ch->fraction = param->sample_rate % USB_FRAMES_PER_SECOND;
2054 1.1 augustss ch->sample_size = sample_size;
2055 1.1 augustss ch->sample_rate = param->sample_rate;
2056 1.1 augustss ch->bytes_per_frame = samples_per_frame * sample_size;
2057 1.1 augustss ch->residue = 0;
2058 1.1 augustss
2059 1.1 augustss ch->start = start;
2060 1.1 augustss ch->end = end;
2061 1.1 augustss ch->cur = start;
2062 1.1 augustss ch->blksize = blksize;
2063 1.1 augustss ch->transferred = 0;
2064 1.1 augustss
2065 1.1 augustss ch->curchanbuf = 0;
2066 1.1 augustss }
2067 1.1 augustss
2068 1.1 augustss int
2069 1.1 augustss uaudio_set_params(addr, setmode, usemode, p, r)
2070 1.1 augustss void *addr;
2071 1.1 augustss int setmode, usemode;
2072 1.1 augustss struct audio_params *p, *r;
2073 1.1 augustss {
2074 1.1 augustss struct uaudio_softc *sc = addr;
2075 1.1 augustss int flags = sc->sc_altflags;
2076 1.1 augustss int enc, i, j;
2077 1.1 augustss void (*pswcode) __P((void *, u_char *buf, int cnt));
2078 1.1 augustss void (*rswcode) __P((void *, u_char *buf, int cnt));
2079 1.1 augustss
2080 1.1 augustss if (sc->sc_dying)
2081 1.1 augustss return (EIO);
2082 1.1 augustss
2083 1.5 augustss if (sc->sc_chan.pipe)
2084 1.1 augustss return (EBUSY);
2085 1.1 augustss
2086 1.1 augustss pswcode = rswcode = 0;
2087 1.1 augustss enc = p->encoding;
2088 1.1 augustss switch (p->encoding) {
2089 1.1 augustss case AUDIO_ENCODING_SLINEAR_BE:
2090 1.1 augustss if (p->precision == 16) {
2091 1.1 augustss rswcode = pswcode = swap_bytes;
2092 1.1 augustss enc = AUDIO_ENCODING_SLINEAR_LE;
2093 1.1 augustss } else if (p->precision == 8 && !(flags & HAS_8)) {
2094 1.1 augustss pswcode = rswcode = change_sign8;
2095 1.1 augustss enc = AUDIO_ENCODING_ULINEAR_LE;
2096 1.1 augustss }
2097 1.1 augustss break;
2098 1.1 augustss case AUDIO_ENCODING_SLINEAR_LE:
2099 1.1 augustss if (p->precision == 8 && !(flags & HAS_8)) {
2100 1.1 augustss pswcode = rswcode = change_sign8;
2101 1.1 augustss enc = AUDIO_ENCODING_ULINEAR_LE;
2102 1.1 augustss }
2103 1.1 augustss break;
2104 1.1 augustss case AUDIO_ENCODING_ULINEAR_BE:
2105 1.1 augustss if (p->precision == 16) {
2106 1.6 augustss pswcode = swap_bytes_change_sign16_le;
2107 1.6 augustss rswcode = change_sign16_swap_bytes_le;
2108 1.1 augustss enc = AUDIO_ENCODING_SLINEAR_LE;
2109 1.1 augustss } else if (p->precision == 8 && !(flags & HAS_8U)) {
2110 1.1 augustss pswcode = rswcode = change_sign8;
2111 1.1 augustss enc = AUDIO_ENCODING_SLINEAR_LE;
2112 1.1 augustss }
2113 1.1 augustss break;
2114 1.1 augustss case AUDIO_ENCODING_ULINEAR_LE:
2115 1.1 augustss if (p->precision == 16) {
2116 1.6 augustss pswcode = rswcode = change_sign16_le;
2117 1.1 augustss enc = AUDIO_ENCODING_SLINEAR_LE;
2118 1.1 augustss } else if (p->precision == 8 && !(flags & HAS_8U)) {
2119 1.1 augustss pswcode = rswcode = change_sign8;
2120 1.1 augustss enc = AUDIO_ENCODING_SLINEAR_LE;
2121 1.1 augustss }
2122 1.1 augustss break;
2123 1.1 augustss case AUDIO_ENCODING_ULAW:
2124 1.1 augustss if (!(flags & HAS_MULAW)) {
2125 1.1 augustss if (flags & HAS_8U) {
2126 1.1 augustss pswcode = mulaw_to_ulinear8;
2127 1.1 augustss rswcode = ulinear8_to_mulaw;
2128 1.1 augustss enc = AUDIO_ENCODING_ULINEAR_LE;
2129 1.1 augustss } else if (flags & HAS_8) {
2130 1.1 augustss pswcode = mulaw_to_slinear8;
2131 1.1 augustss rswcode = slinear8_to_mulaw;
2132 1.1 augustss enc = AUDIO_ENCODING_SLINEAR_LE;
2133 1.1 augustss } else
2134 1.1 augustss return (EINVAL);
2135 1.1 augustss }
2136 1.1 augustss break;
2137 1.1 augustss case AUDIO_ENCODING_ALAW:
2138 1.1 augustss if (!(flags & HAS_ALAW)) {
2139 1.1 augustss if (flags & HAS_8U) {
2140 1.1 augustss pswcode = alaw_to_ulinear8;
2141 1.1 augustss rswcode = ulinear8_to_alaw;
2142 1.1 augustss enc = AUDIO_ENCODING_ULINEAR_LE;
2143 1.1 augustss } else if (flags & HAS_8) {
2144 1.1 augustss pswcode = alaw_to_slinear8;
2145 1.1 augustss rswcode = slinear8_to_alaw;
2146 1.1 augustss enc = AUDIO_ENCODING_SLINEAR_LE;
2147 1.1 augustss } else
2148 1.1 augustss return (EINVAL);
2149 1.1 augustss }
2150 1.1 augustss break;
2151 1.1 augustss default:
2152 1.1 augustss return (EINVAL);
2153 1.1 augustss }
2154 1.1 augustss /* XXX do some other conversions... */
2155 1.1 augustss
2156 1.1 augustss DPRINTF(("uaudio_set_params: chan=%d prec=%d enc=%d rate=%ld\n",
2157 1.1 augustss p->channels, p->precision, enc, p->sample_rate));
2158 1.1 augustss
2159 1.1 augustss for (i = 0; i < sc->sc_nalts; i++) {
2160 1.1 augustss struct usb_audio_streaming_type1_descriptor *a1d =
2161 1.1 augustss sc->sc_alts[i].asf1desc;
2162 1.1 augustss if (p->channels == a1d->bNrChannels &&
2163 1.1 augustss p->precision ==a1d->bBitResolution &&
2164 1.1 augustss enc == sc->sc_alts[i].encoding) {
2165 1.1 augustss if (a1d->bSamFreqType == UA_SAMP_CONTNUOUS) {
2166 1.1 augustss if (UA_SAMP_LO(a1d) < p->sample_rate &&
2167 1.1 augustss p->sample_rate < UA_SAMP_HI(a1d))
2168 1.1 augustss goto found;
2169 1.1 augustss } else {
2170 1.1 augustss for (j = 0; j < a1d->bSamFreqType; j++) {
2171 1.1 augustss /* XXX allow for some slack */
2172 1.1 augustss if (UA_GETSAMP(a1d, j) ==
2173 1.1 augustss p->sample_rate)
2174 1.1 augustss goto found;
2175 1.1 augustss }
2176 1.1 augustss }
2177 1.1 augustss }
2178 1.1 augustss }
2179 1.1 augustss return (EINVAL);
2180 1.1 augustss
2181 1.1 augustss found:
2182 1.1 augustss p->sw_code = pswcode;
2183 1.1 augustss r->sw_code = rswcode;
2184 1.1 augustss sc->sc_curaltidx = i;
2185 1.1 augustss
2186 1.1 augustss DPRINTF(("uaudio_set_params: use altidx=%d, altno=%d\n",
2187 1.1 augustss sc->sc_curaltidx,
2188 1.1 augustss sc->sc_alts[sc->sc_curaltidx].idesc->bAlternateSetting));
2189 1.1 augustss
2190 1.1 augustss return (0);
2191 1.1 augustss }
2192 1.1 augustss
2193 1.1 augustss usbd_status
2194 1.1 augustss uaudio_set_speed(sc, endpt, speed)
2195 1.1 augustss struct uaudio_softc *sc;
2196 1.1 augustss int endpt;
2197 1.1 augustss u_int speed;
2198 1.1 augustss {
2199 1.1 augustss usb_device_request_t req;
2200 1.1 augustss u_int8_t data[3];
2201 1.1 augustss
2202 1.1 augustss DPRINTFN(5,("uaudio_set_speed: endpt=%d speed=%u\n", endpt, speed));
2203 1.1 augustss req.bmRequestType = UT_WRITE_CLASS_ENDPOINT;
2204 1.1 augustss req.bRequest = SET_CUR;
2205 1.1 augustss USETW2(req.wValue, SAMPLING_FREQ_CONTROL, 0);
2206 1.1 augustss USETW(req.wIndex, endpt);
2207 1.1 augustss USETW(req.wLength, 3);
2208 1.1 augustss data[0] = speed;
2209 1.1 augustss data[1] = speed >> 8;
2210 1.1 augustss data[2] = speed >> 16;
2211 1.1 augustss
2212 1.1 augustss return (usbd_do_request(sc->sc_udev, &req, &data));
2213 1.1 augustss }
2214 1.1 augustss
2215