btsco.c revision 1.18 1 1.18 plunky /* $NetBSD: btsco.c,v 1.18 2007/11/11 12:59:05 plunky Exp $ */
2 1.1 tron
3 1.1 tron /*-
4 1.1 tron * Copyright (c) 2006 Itronix Inc.
5 1.1 tron * All rights reserved.
6 1.1 tron *
7 1.1 tron * Written by Iain Hibbert for Itronix Inc.
8 1.1 tron *
9 1.1 tron * Redistribution and use in source and binary forms, with or without
10 1.1 tron * modification, are permitted provided that the following conditions
11 1.1 tron * are met:
12 1.1 tron * 1. Redistributions of source code must retain the above copyright
13 1.1 tron * notice, this list of conditions and the following disclaimer.
14 1.1 tron * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 tron * notice, this list of conditions and the following disclaimer in the
16 1.1 tron * documentation and/or other materials provided with the distribution.
17 1.1 tron * 3. The name of Itronix Inc. may not be used to endorse
18 1.1 tron * or promote products derived from this software without specific
19 1.1 tron * prior written permission.
20 1.1 tron *
21 1.1 tron * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
22 1.1 tron * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
23 1.1 tron * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
24 1.1 tron * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
25 1.1 tron * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
26 1.1 tron * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
27 1.1 tron * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
28 1.1 tron * ON ANY THEORY OF LIABILITY, WHETHER IN
29 1.1 tron * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30 1.1 tron * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31 1.1 tron * POSSIBILITY OF SUCH DAMAGE.
32 1.1 tron */
33 1.1 tron
34 1.1 tron #include <sys/cdefs.h>
35 1.18 plunky __KERNEL_RCSID(0, "$NetBSD: btsco.c,v 1.18 2007/11/11 12:59:05 plunky Exp $");
36 1.1 tron
37 1.1 tron #include <sys/param.h>
38 1.1 tron #include <sys/audioio.h>
39 1.1 tron #include <sys/conf.h>
40 1.1 tron #include <sys/device.h>
41 1.1 tron #include <sys/fcntl.h>
42 1.1 tron #include <sys/kernel.h>
43 1.1 tron #include <sys/queue.h>
44 1.1 tron #include <sys/malloc.h>
45 1.1 tron #include <sys/mbuf.h>
46 1.1 tron #include <sys/proc.h>
47 1.1 tron #include <sys/systm.h>
48 1.15 ad #include <sys/intr.h>
49 1.1 tron
50 1.1 tron #include <prop/proplib.h>
51 1.1 tron
52 1.1 tron #include <netbt/bluetooth.h>
53 1.1 tron #include <netbt/rfcomm.h>
54 1.1 tron #include <netbt/sco.h>
55 1.1 tron
56 1.1 tron #include <dev/audio_if.h>
57 1.1 tron #include <dev/auconv.h>
58 1.1 tron #include <dev/mulaw.h>
59 1.1 tron
60 1.1 tron #include <dev/bluetooth/btdev.h>
61 1.1 tron #include <dev/bluetooth/btsco.h>
62 1.1 tron
63 1.1 tron #undef DPRINTF
64 1.1 tron #undef DPRINTFN
65 1.1 tron
66 1.1 tron #ifdef BTSCO_DEBUG
67 1.1 tron int btsco_debug = BTSCO_DEBUG;
68 1.1 tron #define DPRINTF(fmt, args...) do { \
69 1.1 tron if (btsco_debug) \
70 1.1 tron printf("%s: "fmt, __func__ , ##args); \
71 1.1 tron } while (/* CONSTCOND */0)
72 1.1 tron
73 1.1 tron #define DPRINTFN(n, fmt, args...) do { \
74 1.1 tron if (btsco_debug > (n)) \
75 1.1 tron printf("%s: "fmt, __func__ , ##args); \
76 1.1 tron } while (/* CONSTCOND */0)
77 1.1 tron #else
78 1.1 tron #define DPRINTF(...)
79 1.1 tron #define DPRINTFN(...)
80 1.1 tron #endif
81 1.1 tron
82 1.1 tron /*****************************************************************************
83 1.1 tron *
84 1.1 tron * Bluetooth SCO Audio device
85 1.1 tron */
86 1.1 tron
87 1.1 tron /* btsco softc */
88 1.1 tron struct btsco_softc {
89 1.3 plunky struct btdev sc_btdev;
90 1.1 tron uint16_t sc_flags;
91 1.16 plunky const char *sc_name; /* our device_xname */
92 1.1 tron
93 1.16 plunky device_t sc_audio; /* MI audio device */
94 1.1 tron void *sc_intr; /* interrupt cookie */
95 1.1 tron
96 1.1 tron /* Bluetooth */
97 1.1 tron bdaddr_t sc_laddr; /* local address */
98 1.1 tron bdaddr_t sc_raddr; /* remote address */
99 1.1 tron uint16_t sc_state; /* link state */
100 1.1 tron struct sco_pcb *sc_sco; /* SCO handle */
101 1.1 tron struct sco_pcb *sc_sco_l; /* SCO listen handle */
102 1.4 plunky uint16_t sc_mtu; /* SCO mtu */
103 1.1 tron uint8_t sc_channel; /* RFCOMM channel */
104 1.1 tron int sc_err; /* stored error */
105 1.1 tron
106 1.1 tron /* Receive */
107 1.1 tron int sc_rx_want; /* bytes wanted */
108 1.1 tron uint8_t *sc_rx_block; /* receive block */
109 1.1 tron void (*sc_rx_intr)(void *); /* callback */
110 1.1 tron void *sc_rx_intrarg; /* callback arg */
111 1.1 tron struct mbuf *sc_rx_mbuf; /* leftover mbuf */
112 1.1 tron
113 1.1 tron /* Transmit */
114 1.1 tron int sc_tx_size; /* bytes to send */
115 1.1 tron int sc_tx_pending; /* packets pending */
116 1.1 tron uint8_t *sc_tx_block; /* transmit block */
117 1.1 tron void (*sc_tx_intr)(void *); /* callback */
118 1.1 tron void *sc_tx_intrarg; /* callback arg */
119 1.1 tron void *sc_tx_buf; /* transmit buffer */
120 1.1 tron int sc_tx_refcnt; /* buffer refcnt */
121 1.1 tron
122 1.1 tron /* mixer data */
123 1.1 tron int sc_vgs; /* speaker volume */
124 1.1 tron int sc_vgm; /* mic volume */
125 1.1 tron };
126 1.1 tron
127 1.1 tron /* sc_state */
128 1.1 tron #define BTSCO_CLOSED 0
129 1.1 tron #define BTSCO_WAIT_CONNECT 1
130 1.1 tron #define BTSCO_OPEN 2
131 1.1 tron
132 1.1 tron /* sc_flags */
133 1.1 tron #define BTSCO_LISTEN (1 << 1)
134 1.1 tron
135 1.1 tron /* autoconf(9) glue */
136 1.16 plunky static int btsco_match(device_t, struct cfdata *, void *);
137 1.16 plunky static void btsco_attach(device_t, device_t, void *);
138 1.16 plunky static int btsco_detach(device_t, int);
139 1.1 tron
140 1.16 plunky CFATTACH_DECL_NEW(btsco, sizeof(struct btsco_softc),
141 1.1 tron btsco_match, btsco_attach, btsco_detach, NULL);
142 1.1 tron
143 1.1 tron /* audio(9) glue */
144 1.1 tron static int btsco_open(void *, int);
145 1.1 tron static void btsco_close(void *);
146 1.1 tron static int btsco_query_encoding(void *, struct audio_encoding *);
147 1.1 tron static int btsco_set_params(void *, int, int, audio_params_t *, audio_params_t *,
148 1.1 tron stream_filter_list_t *, stream_filter_list_t *);
149 1.1 tron static int btsco_round_blocksize(void *, int, int, const audio_params_t *);
150 1.1 tron static int btsco_start_output(void *, void *, int, void (*)(void *), void *);
151 1.1 tron static int btsco_start_input(void *, void *, int, void (*)(void *), void *);
152 1.1 tron static int btsco_halt_output(void *);
153 1.1 tron static int btsco_halt_input(void *);
154 1.1 tron static int btsco_getdev(void *, struct audio_device *);
155 1.1 tron static int btsco_setfd(void *, int);
156 1.1 tron static int btsco_set_port(void *, mixer_ctrl_t *);
157 1.1 tron static int btsco_get_port(void *, mixer_ctrl_t *);
158 1.1 tron static int btsco_query_devinfo(void *, mixer_devinfo_t *);
159 1.1 tron static void *btsco_allocm(void *, int, size_t, struct malloc_type *, int);
160 1.1 tron static void btsco_freem(void *, void *, struct malloc_type *);
161 1.1 tron static int btsco_get_props(void *);
162 1.12 christos static int btsco_dev_ioctl(void *, u_long, void *, int, struct lwp *);
163 1.1 tron
164 1.1 tron static const struct audio_hw_if btsco_if = {
165 1.1 tron btsco_open, /* open */
166 1.1 tron btsco_close, /* close */
167 1.1 tron NULL, /* drain */
168 1.1 tron btsco_query_encoding, /* query_encoding */
169 1.1 tron btsco_set_params, /* set_params */
170 1.1 tron btsco_round_blocksize, /* round_blocksize */
171 1.1 tron NULL, /* commit_settings */
172 1.1 tron NULL, /* init_output */
173 1.1 tron NULL, /* init_input */
174 1.1 tron btsco_start_output, /* start_output */
175 1.1 tron btsco_start_input, /* start_input */
176 1.1 tron btsco_halt_output, /* halt_output */
177 1.1 tron btsco_halt_input, /* halt_input */
178 1.1 tron NULL, /* speaker_ctl */
179 1.1 tron btsco_getdev, /* getdev */
180 1.1 tron btsco_setfd, /* setfd */
181 1.7 plunky btsco_set_port, /* set_port */
182 1.7 plunky btsco_get_port, /* get_port */
183 1.1 tron btsco_query_devinfo, /* query_devinfo */
184 1.1 tron btsco_allocm, /* allocm */
185 1.1 tron btsco_freem, /* freem */
186 1.1 tron NULL, /* round_buffersize */
187 1.1 tron NULL, /* mappage */
188 1.1 tron btsco_get_props, /* get_props */
189 1.1 tron NULL, /* trigger_output */
190 1.1 tron NULL, /* trigger_input */
191 1.1 tron btsco_dev_ioctl, /* dev_ioctl */
192 1.1 tron NULL, /* powerstate */
193 1.1 tron };
194 1.1 tron
195 1.1 tron static const struct audio_device btsco_device = {
196 1.1 tron "Bluetooth Audio",
197 1.1 tron "",
198 1.1 tron "btsco"
199 1.1 tron };
200 1.1 tron
201 1.8 plunky /* Voice_Setting == 0x0060: 8000Hz, mono, 16-bit, slinear_le */
202 1.8 plunky static const struct audio_format btsco_format = {
203 1.8 plunky NULL, /* driver_data */
204 1.8 plunky (AUMODE_PLAY | AUMODE_RECORD), /* mode */
205 1.8 plunky AUDIO_ENCODING_SLINEAR_LE, /* encoding */
206 1.8 plunky 16, /* validbits */
207 1.8 plunky 16, /* precision */
208 1.8 plunky 1, /* channels */
209 1.8 plunky AUFMT_MONAURAL, /* channel_mask */
210 1.8 plunky 1, /* frequency_type */
211 1.8 plunky { 8000 } /* frequency */
212 1.8 plunky };
213 1.8 plunky
214 1.1 tron /* bluetooth(9) glue for SCO */
215 1.1 tron static void btsco_sco_connecting(void *);
216 1.1 tron static void btsco_sco_connected(void *);
217 1.1 tron static void btsco_sco_disconnected(void *, int);
218 1.1 tron static void *btsco_sco_newconn(void *, struct sockaddr_bt *, struct sockaddr_bt *);
219 1.1 tron static void btsco_sco_complete(void *, int);
220 1.14 plunky static void btsco_sco_linkmode(void *, int);
221 1.1 tron static void btsco_sco_input(void *, struct mbuf *);
222 1.1 tron
223 1.1 tron static const struct btproto btsco_sco_proto = {
224 1.1 tron btsco_sco_connecting,
225 1.1 tron btsco_sco_connected,
226 1.1 tron btsco_sco_disconnected,
227 1.1 tron btsco_sco_newconn,
228 1.1 tron btsco_sco_complete,
229 1.14 plunky btsco_sco_linkmode,
230 1.1 tron btsco_sco_input,
231 1.1 tron };
232 1.1 tron
233 1.1 tron
234 1.1 tron /*****************************************************************************
235 1.1 tron *
236 1.1 tron * btsco definitions
237 1.1 tron */
238 1.1 tron
239 1.1 tron /*
240 1.1 tron * btsco mixer class
241 1.1 tron */
242 1.1 tron #define BTSCO_VGS 0
243 1.1 tron #define BTSCO_VGM 1
244 1.1 tron #define BTSCO_INPUT_CLASS 2
245 1.1 tron #define BTSCO_OUTPUT_CLASS 3
246 1.1 tron
247 1.1 tron /* connect timeout */
248 1.1 tron #define BTSCO_TIMEOUT (30 * hz)
249 1.1 tron
250 1.1 tron /* misc btsco functions */
251 1.12 christos static void btsco_extfree(struct mbuf *, void *, size_t, void *);
252 1.1 tron static void btsco_intr(void *);
253 1.1 tron
254 1.1 tron
255 1.1 tron /*****************************************************************************
256 1.1 tron *
257 1.1 tron * btsco autoconf(9) routines
258 1.1 tron */
259 1.1 tron
260 1.1 tron static int
261 1.16 plunky btsco_match(device_t self, struct cfdata *cfdata, void *aux)
262 1.1 tron {
263 1.1 tron prop_dictionary_t dict = aux;
264 1.1 tron prop_object_t obj;
265 1.1 tron
266 1.9 plunky obj = prop_dictionary_get(dict, BTDEVservice);
267 1.9 plunky if (prop_string_equals_cstring(obj, "HSET"))
268 1.9 plunky return 1;
269 1.9 plunky
270 1.9 plunky if (prop_string_equals_cstring(obj, "HF"))
271 1.9 plunky return 1;
272 1.9 plunky
273 1.9 plunky return 0;
274 1.1 tron }
275 1.1 tron
276 1.1 tron static void
277 1.16 plunky btsco_attach(device_t parent, device_t self, void *aux)
278 1.1 tron {
279 1.16 plunky struct btsco_softc *sc = device_private(self);
280 1.1 tron prop_dictionary_t dict = aux;
281 1.1 tron prop_object_t obj;
282 1.1 tron
283 1.1 tron /*
284 1.1 tron * Init softc
285 1.1 tron */
286 1.1 tron sc->sc_vgs = 200;
287 1.1 tron sc->sc_vgm = 200;
288 1.1 tron sc->sc_state = BTSCO_CLOSED;
289 1.16 plunky sc->sc_name = device_xname(self);
290 1.1 tron
291 1.1 tron /*
292 1.1 tron * copy in our configuration info
293 1.1 tron */
294 1.3 plunky obj = prop_dictionary_get(dict, BTDEVladdr);
295 1.1 tron bdaddr_copy(&sc->sc_laddr, prop_data_data_nocopy(obj));
296 1.1 tron
297 1.3 plunky obj = prop_dictionary_get(dict, BTDEVraddr);
298 1.1 tron bdaddr_copy(&sc->sc_raddr, prop_data_data_nocopy(obj));
299 1.1 tron
300 1.9 plunky obj = prop_dictionary_get(dict, BTDEVservice);
301 1.9 plunky if (prop_string_equals_cstring(obj, "HF")) {
302 1.1 tron sc->sc_flags |= BTSCO_LISTEN;
303 1.2 plunky aprint_verbose(" listen mode");
304 1.1 tron }
305 1.1 tron
306 1.3 plunky obj = prop_dictionary_get(dict, BTSCOchannel);
307 1.3 plunky if (prop_object_type(obj) != PROP_TYPE_NUMBER
308 1.1 tron || prop_number_integer_value(obj) < RFCOMM_CHANNEL_MIN
309 1.1 tron || prop_number_integer_value(obj) > RFCOMM_CHANNEL_MAX) {
310 1.3 plunky aprint_error(" invalid %s", BTSCOchannel);
311 1.1 tron return;
312 1.1 tron }
313 1.1 tron sc->sc_channel = prop_number_integer_value(obj);
314 1.1 tron
315 1.1 tron aprint_verbose(" channel %d", sc->sc_channel);
316 1.1 tron aprint_normal("\n");
317 1.1 tron
318 1.1 tron DPRINTF("sc=%p\n", sc);
319 1.1 tron
320 1.1 tron /*
321 1.1 tron * set up transmit interrupt
322 1.1 tron */
323 1.15 ad sc->sc_intr = softint_establish(SOFTINT_NET, btsco_intr, sc);
324 1.1 tron if (sc->sc_intr == NULL) {
325 1.16 plunky aprint_error_dev(self, "softint_establish failed\n");
326 1.1 tron return;
327 1.1 tron }
328 1.1 tron
329 1.1 tron /*
330 1.1 tron * attach audio device
331 1.1 tron */
332 1.16 plunky sc->sc_audio = audio_attach_mi(&btsco_if, sc, self);
333 1.1 tron if (sc->sc_audio == NULL) {
334 1.16 plunky aprint_error_dev(self, "audio_attach_mi failed\n");
335 1.1 tron return;
336 1.1 tron }
337 1.1 tron }
338 1.1 tron
339 1.1 tron static int
340 1.16 plunky btsco_detach(device_t self, int flags)
341 1.1 tron {
342 1.16 plunky struct btsco_softc *sc = device_private(self);
343 1.1 tron int s;
344 1.1 tron
345 1.1 tron DPRINTF("sc=%p\n", sc);
346 1.1 tron
347 1.6 plunky s = splsoftnet();
348 1.1 tron if (sc->sc_sco != NULL) {
349 1.1 tron DPRINTF("sc_sco=%p\n", sc->sc_sco);
350 1.1 tron sco_disconnect(sc->sc_sco, 0);
351 1.1 tron sco_detach(&sc->sc_sco);
352 1.1 tron sc->sc_sco = NULL;
353 1.1 tron }
354 1.1 tron
355 1.1 tron if (sc->sc_sco_l != NULL) {
356 1.1 tron DPRINTF("sc_sco_l=%p\n", sc->sc_sco_l);
357 1.1 tron sco_detach(&sc->sc_sco_l);
358 1.1 tron sc->sc_sco_l = NULL;
359 1.1 tron }
360 1.6 plunky splx(s);
361 1.1 tron
362 1.1 tron if (sc->sc_audio != NULL) {
363 1.1 tron DPRINTF("sc_audio=%p\n", sc->sc_audio);
364 1.1 tron config_detach(sc->sc_audio, flags);
365 1.1 tron sc->sc_audio = NULL;
366 1.1 tron }
367 1.1 tron
368 1.1 tron if (sc->sc_intr != NULL) {
369 1.15 ad softint_disestablish(sc->sc_intr);
370 1.1 tron sc->sc_intr = NULL;
371 1.1 tron }
372 1.1 tron
373 1.1 tron if (sc->sc_rx_mbuf != NULL) {
374 1.1 tron m_freem(sc->sc_rx_mbuf);
375 1.1 tron sc->sc_rx_mbuf = NULL;
376 1.1 tron }
377 1.1 tron
378 1.1 tron if (sc->sc_tx_refcnt > 0) {
379 1.16 plunky aprint_error_dev(self, "tx_refcnt=%d!\n", sc->sc_tx_refcnt);
380 1.1 tron
381 1.1 tron if ((flags & DETACH_FORCE) == 0)
382 1.1 tron return EAGAIN;
383 1.1 tron }
384 1.1 tron
385 1.1 tron return 0;
386 1.1 tron }
387 1.1 tron
388 1.1 tron /*****************************************************************************
389 1.1 tron *
390 1.1 tron * bluetooth(9) methods for SCO
391 1.1 tron *
392 1.1 tron * All these are called from Bluetooth Protocol code, in a soft
393 1.1 tron * interrupt context at IPL_SOFTNET.
394 1.1 tron */
395 1.1 tron
396 1.1 tron static void
397 1.11 christos btsco_sco_connecting(void *arg)
398 1.1 tron {
399 1.1 tron /* struct btsco_softc *sc = arg; */
400 1.1 tron
401 1.1 tron /* dont care */
402 1.1 tron }
403 1.1 tron
404 1.1 tron static void
405 1.1 tron btsco_sco_connected(void *arg)
406 1.1 tron {
407 1.1 tron struct btsco_softc *sc = arg;
408 1.1 tron
409 1.16 plunky DPRINTF("%s\n", sc->sc_name);
410 1.1 tron
411 1.1 tron KASSERT(sc->sc_sco != NULL);
412 1.1 tron KASSERT(sc->sc_state == BTSCO_WAIT_CONNECT);
413 1.1 tron
414 1.2 plunky /*
415 1.2 plunky * If we are listening, no more need
416 1.2 plunky */
417 1.2 plunky if (sc->sc_sco_l != NULL)
418 1.2 plunky sco_detach(&sc->sc_sco_l);
419 1.2 plunky
420 1.1 tron sc->sc_state = BTSCO_OPEN;
421 1.1 tron wakeup(sc);
422 1.1 tron }
423 1.1 tron
424 1.1 tron static void
425 1.1 tron btsco_sco_disconnected(void *arg, int err)
426 1.1 tron {
427 1.1 tron struct btsco_softc *sc = arg;
428 1.2 plunky int s;
429 1.1 tron
430 1.16 plunky DPRINTF("%s sc_state %d\n", sc->sc_name, sc->sc_state);
431 1.1 tron
432 1.1 tron KASSERT(sc->sc_sco != NULL);
433 1.1 tron
434 1.1 tron sc->sc_err = err;
435 1.1 tron sco_detach(&sc->sc_sco);
436 1.1 tron
437 1.1 tron switch (sc->sc_state) {
438 1.1 tron case BTSCO_CLOSED: /* dont think this can happen */
439 1.1 tron break;
440 1.1 tron
441 1.1 tron case BTSCO_WAIT_CONNECT: /* connect failed */
442 1.1 tron wakeup(sc);
443 1.1 tron break;
444 1.1 tron
445 1.1 tron case BTSCO_OPEN: /* link lost */
446 1.2 plunky /*
447 1.2 plunky * If IO is in progress, tell the audio driver that it
448 1.2 plunky * has completed so that when it tries to send more, we
449 1.2 plunky * can indicate an error.
450 1.2 plunky */
451 1.2 plunky s = splaudio();
452 1.2 plunky if (sc->sc_tx_pending > 0) {
453 1.2 plunky sc->sc_tx_pending = 0;
454 1.2 plunky (*sc->sc_tx_intr)(sc->sc_tx_intrarg);
455 1.2 plunky }
456 1.2 plunky if (sc->sc_rx_want > 0) {
457 1.2 plunky sc->sc_rx_want = 0;
458 1.2 plunky (*sc->sc_rx_intr)(sc->sc_rx_intrarg);
459 1.2 plunky }
460 1.2 plunky splx(s);
461 1.1 tron break;
462 1.1 tron
463 1.1 tron default:
464 1.1 tron UNKNOWN(sc->sc_state);
465 1.1 tron }
466 1.1 tron
467 1.1 tron sc->sc_state = BTSCO_CLOSED;
468 1.1 tron }
469 1.1 tron
470 1.1 tron static void *
471 1.11 christos btsco_sco_newconn(void *arg, struct sockaddr_bt *laddr,
472 1.10 christos struct sockaddr_bt *raddr)
473 1.1 tron {
474 1.1 tron struct btsco_softc *sc = arg;
475 1.1 tron
476 1.16 plunky DPRINTF("%s\n", sc->sc_name);
477 1.16 plunky
478 1.1 tron if (bdaddr_same(&raddr->bt_bdaddr, &sc->sc_raddr) == 0
479 1.1 tron || sc->sc_state != BTSCO_WAIT_CONNECT
480 1.1 tron || sc->sc_sco != NULL)
481 1.1 tron return NULL;
482 1.1 tron
483 1.1 tron sco_attach(&sc->sc_sco, &btsco_sco_proto, sc);
484 1.1 tron return sc->sc_sco;
485 1.1 tron }
486 1.1 tron
487 1.1 tron static void
488 1.1 tron btsco_sco_complete(void *arg, int count)
489 1.1 tron {
490 1.1 tron struct btsco_softc *sc = arg;
491 1.1 tron int s;
492 1.1 tron
493 1.16 plunky DPRINTFN(10, "%s count %d\n", sc->sc_name, count);
494 1.1 tron
495 1.1 tron s = splaudio();
496 1.1 tron if (sc->sc_tx_pending > 0) {
497 1.1 tron sc->sc_tx_pending -= count;
498 1.1 tron if (sc->sc_tx_pending == 0)
499 1.1 tron (*sc->sc_tx_intr)(sc->sc_tx_intrarg);
500 1.1 tron }
501 1.1 tron splx(s);
502 1.1 tron }
503 1.1 tron
504 1.1 tron static void
505 1.14 plunky btsco_sco_linkmode(void *arg, int new)
506 1.14 plunky {
507 1.14 plunky /* struct btsco_softc *sc = arg; */
508 1.14 plunky
509 1.14 plunky /* dont care */
510 1.14 plunky }
511 1.14 plunky
512 1.14 plunky static void
513 1.1 tron btsco_sco_input(void *arg, struct mbuf *m)
514 1.1 tron {
515 1.1 tron struct btsco_softc *sc = arg;
516 1.1 tron int len, s;
517 1.1 tron
518 1.16 plunky DPRINTFN(10, "%s len=%d\n", sc->sc_name, m->m_pkthdr.len);
519 1.1 tron
520 1.1 tron s = splaudio();
521 1.1 tron if (sc->sc_rx_want == 0) {
522 1.1 tron m_freem(m);
523 1.1 tron } else {
524 1.1 tron KASSERT(sc->sc_rx_intr != NULL);
525 1.1 tron KASSERT(sc->sc_rx_block != NULL);
526 1.1 tron
527 1.1 tron len = MIN(sc->sc_rx_want, m->m_pkthdr.len);
528 1.1 tron m_copydata(m, 0, len, sc->sc_rx_block);
529 1.1 tron
530 1.1 tron sc->sc_rx_want -= len;
531 1.1 tron sc->sc_rx_block += len;
532 1.1 tron
533 1.1 tron if (len > m->m_pkthdr.len) {
534 1.1 tron if (sc->sc_rx_mbuf != NULL)
535 1.1 tron m_freem(sc->sc_rx_mbuf);
536 1.1 tron
537 1.1 tron m_adj(m, len);
538 1.1 tron sc->sc_rx_mbuf = m;
539 1.1 tron } else {
540 1.1 tron m_freem(m);
541 1.1 tron }
542 1.1 tron
543 1.1 tron if (sc->sc_rx_want == 0)
544 1.1 tron (*sc->sc_rx_intr)(sc->sc_rx_intrarg);
545 1.1 tron }
546 1.1 tron splx(s);
547 1.1 tron }
548 1.1 tron
549 1.1 tron
550 1.1 tron /*****************************************************************************
551 1.1 tron *
552 1.1 tron * audio(9) methods
553 1.1 tron *
554 1.1 tron */
555 1.1 tron
556 1.1 tron static int
557 1.11 christos btsco_open(void *hdl, int flags)
558 1.1 tron {
559 1.1 tron struct sockaddr_bt sa;
560 1.1 tron struct btsco_softc *sc = hdl;
561 1.2 plunky int err, s, timo;
562 1.1 tron
563 1.16 plunky DPRINTF("%s flags 0x%x\n", sc->sc_name, flags);
564 1.1 tron /* flags FREAD & FWRITE? */
565 1.1 tron
566 1.1 tron if (sc->sc_sco != NULL || sc->sc_sco_l != NULL)
567 1.1 tron return EIO;
568 1.1 tron
569 1.1 tron s = splsoftnet();
570 1.1 tron
571 1.1 tron memset(&sa, 0, sizeof(sa));
572 1.1 tron sa.bt_len = sizeof(sa);
573 1.1 tron sa.bt_family = AF_BLUETOOTH;
574 1.1 tron bdaddr_copy(&sa.bt_bdaddr, &sc->sc_laddr);
575 1.1 tron
576 1.1 tron if (sc->sc_flags & BTSCO_LISTEN) {
577 1.1 tron err = sco_attach(&sc->sc_sco_l, &btsco_sco_proto, sc);
578 1.1 tron if (err)
579 1.1 tron goto done;
580 1.1 tron
581 1.1 tron err = sco_bind(sc->sc_sco_l, &sa);
582 1.1 tron if (err) {
583 1.1 tron sco_detach(&sc->sc_sco_l);
584 1.1 tron goto done;
585 1.1 tron }
586 1.1 tron
587 1.1 tron err = sco_listen(sc->sc_sco_l);
588 1.1 tron if (err) {
589 1.1 tron sco_detach(&sc->sc_sco_l);
590 1.1 tron goto done;
591 1.1 tron }
592 1.2 plunky
593 1.2 plunky timo = 0; /* no timeout */
594 1.1 tron } else {
595 1.1 tron err = sco_attach(&sc->sc_sco, &btsco_sco_proto, sc);
596 1.1 tron if (err)
597 1.1 tron goto done;
598 1.1 tron
599 1.1 tron err = sco_bind(sc->sc_sco, &sa);
600 1.1 tron if (err) {
601 1.1 tron sco_detach(&sc->sc_sco);
602 1.1 tron goto done;
603 1.1 tron }
604 1.1 tron
605 1.1 tron bdaddr_copy(&sa.bt_bdaddr, &sc->sc_raddr);
606 1.1 tron err = sco_connect(sc->sc_sco, &sa);
607 1.1 tron if (err) {
608 1.1 tron sco_detach(&sc->sc_sco);
609 1.1 tron goto done;
610 1.1 tron }
611 1.2 plunky
612 1.2 plunky timo = BTSCO_TIMEOUT;
613 1.1 tron }
614 1.1 tron
615 1.1 tron sc->sc_state = BTSCO_WAIT_CONNECT;
616 1.1 tron while (err == 0 && sc->sc_state == BTSCO_WAIT_CONNECT)
617 1.2 plunky err = tsleep(sc, PWAIT | PCATCH, "btsco", timo);
618 1.1 tron
619 1.1 tron switch (sc->sc_state) {
620 1.1 tron case BTSCO_CLOSED: /* disconnected */
621 1.1 tron err = sc->sc_err;
622 1.1 tron
623 1.1 tron /* fall through to */
624 1.1 tron case BTSCO_WAIT_CONNECT: /* error */
625 1.1 tron if (sc->sc_sco != NULL)
626 1.1 tron sco_detach(&sc->sc_sco);
627 1.1 tron
628 1.1 tron if (sc->sc_sco_l != NULL)
629 1.1 tron sco_detach(&sc->sc_sco_l);
630 1.1 tron
631 1.1 tron break;
632 1.1 tron
633 1.1 tron case BTSCO_OPEN: /* hurrah */
634 1.2 plunky sco_getopt(sc->sc_sco, SO_SCO_MTU, &sc->sc_mtu);
635 1.1 tron break;
636 1.1 tron
637 1.1 tron default:
638 1.1 tron UNKNOWN(sc->sc_state);
639 1.1 tron break;
640 1.1 tron }
641 1.1 tron
642 1.1 tron done:
643 1.1 tron splx(s);
644 1.1 tron
645 1.1 tron DPRINTF("done err=%d, sc_state=%d, sc_mtu=%d\n",
646 1.1 tron err, sc->sc_state, sc->sc_mtu);
647 1.1 tron return err;
648 1.1 tron }
649 1.1 tron
650 1.1 tron static void
651 1.1 tron btsco_close(void *hdl)
652 1.1 tron {
653 1.1 tron struct btsco_softc *sc = hdl;
654 1.1 tron int s;
655 1.1 tron
656 1.16 plunky DPRINTF("%s\n", sc->sc_name);
657 1.1 tron
658 1.6 plunky s = splsoftnet();
659 1.1 tron if (sc->sc_sco != NULL) {
660 1.1 tron sco_disconnect(sc->sc_sco, 0);
661 1.1 tron sco_detach(&sc->sc_sco);
662 1.1 tron }
663 1.1 tron
664 1.1 tron if (sc->sc_sco_l != NULL) {
665 1.1 tron sco_detach(&sc->sc_sco_l);
666 1.1 tron }
667 1.6 plunky splx(s);
668 1.1 tron
669 1.1 tron if (sc->sc_rx_mbuf != NULL) {
670 1.1 tron m_freem(sc->sc_rx_mbuf);
671 1.1 tron sc->sc_rx_mbuf = NULL;
672 1.1 tron }
673 1.1 tron
674 1.1 tron sc->sc_rx_want = 0;
675 1.1 tron sc->sc_rx_block = NULL;
676 1.1 tron sc->sc_rx_intr = NULL;
677 1.1 tron sc->sc_rx_intrarg = NULL;
678 1.1 tron
679 1.1 tron sc->sc_tx_size = 0;
680 1.1 tron sc->sc_tx_block = NULL;
681 1.1 tron sc->sc_tx_pending = 0;
682 1.1 tron sc->sc_tx_intr = NULL;
683 1.1 tron sc->sc_tx_intrarg = NULL;
684 1.1 tron }
685 1.1 tron
686 1.1 tron static int
687 1.11 christos btsco_query_encoding(void *hdl, struct audio_encoding *ae)
688 1.1 tron {
689 1.1 tron /* struct btsco_softc *sc = hdl; */
690 1.1 tron int err = 0;
691 1.1 tron
692 1.1 tron switch (ae->index) {
693 1.1 tron case 0:
694 1.1 tron strcpy(ae->name, AudioEslinear_le);
695 1.1 tron ae->encoding = AUDIO_ENCODING_SLINEAR_LE;
696 1.1 tron ae->precision = 16;
697 1.1 tron ae->flags = 0;
698 1.1 tron break;
699 1.1 tron
700 1.1 tron default:
701 1.1 tron err = EINVAL;
702 1.1 tron }
703 1.1 tron
704 1.1 tron return err;
705 1.1 tron }
706 1.1 tron
707 1.1 tron static int
708 1.11 christos btsco_set_params(void *hdl, int setmode, int usemode,
709 1.1 tron audio_params_t *play, audio_params_t *rec,
710 1.1 tron stream_filter_list_t *pfil, stream_filter_list_t *rfil)
711 1.1 tron {
712 1.1 tron /* struct btsco_softc *sc = hdl; */
713 1.8 plunky const struct audio_format *f;
714 1.8 plunky int rv;
715 1.1 tron
716 1.1 tron DPRINTF("setmode 0x%x usemode 0x%x\n", setmode, usemode);
717 1.1 tron DPRINTF("rate %d, precision %d, channels %d encoding %d\n",
718 1.1 tron play->sample_rate, play->precision, play->channels, play->encoding);
719 1.1 tron
720 1.8 plunky /*
721 1.8 plunky * If we had a list of formats, we could check the HCI_Voice_Setting
722 1.8 plunky * and select the appropriate one to use. Currently only one is
723 1.8 plunky * supported: 0x0060 == 8000Hz, mono, 16-bit, slinear_le
724 1.8 plunky */
725 1.8 plunky f = &btsco_format;
726 1.1 tron
727 1.8 plunky if (setmode & AUMODE_PLAY) {
728 1.8 plunky rv = auconv_set_converter(f, 1, AUMODE_PLAY, play, TRUE, pfil);
729 1.8 plunky if (rv < 0)
730 1.8 plunky return EINVAL;
731 1.8 plunky }
732 1.1 tron
733 1.8 plunky if (setmode & AUMODE_RECORD) {
734 1.8 plunky rv = auconv_set_converter(f, 1, AUMODE_RECORD, rec, TRUE, rfil);
735 1.8 plunky if (rv < 0)
736 1.8 plunky return EINVAL;
737 1.1 tron }
738 1.1 tron
739 1.8 plunky return 0;
740 1.1 tron }
741 1.1 tron
742 1.1 tron /*
743 1.1 tron * If we have an MTU value to use, round the blocksize to that.
744 1.1 tron */
745 1.1 tron static int
746 1.11 christos btsco_round_blocksize(void *hdl, int bs, int mode,
747 1.11 christos const audio_params_t *param)
748 1.1 tron {
749 1.1 tron struct btsco_softc *sc = hdl;
750 1.1 tron
751 1.4 plunky if (sc->sc_mtu > 0) {
752 1.1 tron bs = (bs / sc->sc_mtu) * sc->sc_mtu;
753 1.4 plunky if (bs == 0)
754 1.4 plunky bs = sc->sc_mtu;
755 1.4 plunky }
756 1.13 plunky
757 1.1 tron DPRINTF("%s mode=0x%x, bs=%d, sc_mtu=%d\n",
758 1.16 plunky sc->sc_name, mode, bs, sc->sc_mtu);
759 1.1 tron
760 1.1 tron return bs;
761 1.1 tron }
762 1.1 tron
763 1.1 tron /*
764 1.1 tron * Start Output
765 1.1 tron *
766 1.1 tron * We dont want to be calling the network stack at splaudio() so make
767 1.1 tron * a note of what is to be sent, and schedule an interrupt to bundle
768 1.1 tron * it up and queue it.
769 1.1 tron */
770 1.1 tron static int
771 1.1 tron btsco_start_output(void *hdl, void *block, int blksize,
772 1.1 tron void (*intr)(void *), void *intrarg)
773 1.1 tron {
774 1.1 tron struct btsco_softc *sc = hdl;
775 1.1 tron
776 1.16 plunky DPRINTFN(5, "%s blksize %d\n", sc->sc_name, blksize);
777 1.1 tron
778 1.1 tron if (sc->sc_sco == NULL)
779 1.1 tron return ENOTCONN; /* connection lost */
780 1.1 tron
781 1.1 tron sc->sc_tx_block = block;
782 1.1 tron sc->sc_tx_pending = 0;
783 1.1 tron sc->sc_tx_size = blksize;
784 1.1 tron sc->sc_tx_intr = intr;
785 1.1 tron sc->sc_tx_intrarg = intrarg;
786 1.1 tron
787 1.15 ad softint_schedule(sc->sc_intr);
788 1.1 tron return 0;
789 1.1 tron }
790 1.1 tron
791 1.1 tron /*
792 1.1 tron * Start Input
793 1.1 tron *
794 1.1 tron * When the SCO link is up, we are getting data in any case, so all we do
795 1.1 tron * is note what we want and where to put it and let the sco_input routine
796 1.1 tron * fill in the data.
797 1.1 tron *
798 1.1 tron * If there was any leftover data that didnt fit in the last block, retry
799 1.1 tron * it now.
800 1.1 tron */
801 1.1 tron static int
802 1.1 tron btsco_start_input(void *hdl, void *block, int blksize,
803 1.1 tron void (*intr)(void *), void *intrarg)
804 1.1 tron {
805 1.1 tron struct btsco_softc *sc = hdl;
806 1.1 tron struct mbuf *m;
807 1.1 tron
808 1.16 plunky DPRINTFN(5, "%s blksize %d\n", sc->sc_name, blksize);
809 1.1 tron
810 1.1 tron if (sc->sc_sco == NULL)
811 1.5 plunky return ENOTCONN;
812 1.1 tron
813 1.1 tron sc->sc_rx_want = blksize;
814 1.1 tron sc->sc_rx_block = block;
815 1.1 tron sc->sc_rx_intr = intr;
816 1.1 tron sc->sc_rx_intrarg = intrarg;
817 1.1 tron
818 1.1 tron if (sc->sc_rx_mbuf != NULL) {
819 1.1 tron m = sc->sc_rx_mbuf;
820 1.1 tron sc->sc_rx_mbuf = NULL;
821 1.1 tron btsco_sco_input(sc, m);
822 1.1 tron }
823 1.1 tron
824 1.1 tron return 0;
825 1.1 tron }
826 1.1 tron
827 1.1 tron /*
828 1.1 tron * Halt Output
829 1.1 tron *
830 1.1 tron * This doesnt really halt the output, but it will look
831 1.1 tron * that way to the audio driver. The current block will
832 1.1 tron * still be transmitted.
833 1.1 tron */
834 1.1 tron static int
835 1.1 tron btsco_halt_output(void *hdl)
836 1.1 tron {
837 1.1 tron struct btsco_softc *sc = hdl;
838 1.1 tron
839 1.16 plunky DPRINTFN(5, "%s\n", sc->sc_name);
840 1.1 tron
841 1.1 tron sc->sc_tx_size = 0;
842 1.1 tron sc->sc_tx_block = NULL;
843 1.1 tron sc->sc_tx_pending = 0;
844 1.1 tron sc->sc_tx_intr = NULL;
845 1.1 tron sc->sc_tx_intrarg = NULL;
846 1.1 tron
847 1.1 tron return 0;
848 1.1 tron }
849 1.1 tron
850 1.1 tron /*
851 1.1 tron * Halt Input
852 1.1 tron *
853 1.1 tron * This doesnt really halt the input, but it will look
854 1.1 tron * that way to the audio driver. Incoming data will be
855 1.1 tron * discarded.
856 1.1 tron */
857 1.1 tron static int
858 1.1 tron btsco_halt_input(void *hdl)
859 1.1 tron {
860 1.1 tron struct btsco_softc *sc = hdl;
861 1.1 tron
862 1.16 plunky DPRINTFN(5, "%s\n", sc->sc_name);
863 1.1 tron
864 1.1 tron sc->sc_rx_want = 0;
865 1.1 tron sc->sc_rx_block = NULL;
866 1.1 tron sc->sc_rx_intr = NULL;
867 1.1 tron sc->sc_rx_intrarg = NULL;
868 1.1 tron
869 1.1 tron if (sc->sc_rx_mbuf != NULL) {
870 1.1 tron m_freem(sc->sc_rx_mbuf);
871 1.1 tron sc->sc_rx_mbuf = NULL;
872 1.1 tron }
873 1.1 tron
874 1.1 tron return 0;
875 1.1 tron }
876 1.1 tron
877 1.1 tron static int
878 1.11 christos btsco_getdev(void *hdl, struct audio_device *ret)
879 1.1 tron {
880 1.1 tron
881 1.1 tron *ret = btsco_device;
882 1.1 tron return 0;
883 1.1 tron }
884 1.1 tron
885 1.1 tron static int
886 1.11 christos btsco_setfd(void *hdl, int fd)
887 1.1 tron {
888 1.1 tron DPRINTF("set %s duplex\n", fd ? "full" : "half");
889 1.1 tron
890 1.1 tron return 0;
891 1.1 tron }
892 1.1 tron
893 1.1 tron static int
894 1.1 tron btsco_set_port(void *hdl, mixer_ctrl_t *mc)
895 1.1 tron {
896 1.1 tron struct btsco_softc *sc = hdl;
897 1.1 tron int err = 0;
898 1.1 tron
899 1.16 plunky DPRINTF("%s dev %d type %d\n", sc->sc_name, mc->dev, mc->type);
900 1.1 tron
901 1.1 tron switch (mc->dev) {
902 1.1 tron case BTSCO_VGS:
903 1.1 tron if (mc->type != AUDIO_MIXER_VALUE ||
904 1.1 tron mc->un.value.num_channels != 1) {
905 1.1 tron err = EINVAL;
906 1.1 tron break;
907 1.1 tron }
908 1.1 tron
909 1.1 tron sc->sc_vgs = mc->un.value.level[AUDIO_MIXER_LEVEL_MONO];
910 1.1 tron break;
911 1.1 tron
912 1.1 tron case BTSCO_VGM:
913 1.1 tron if (mc->type != AUDIO_MIXER_VALUE ||
914 1.1 tron mc->un.value.num_channels != 1) {
915 1.1 tron err = EINVAL;
916 1.1 tron break;
917 1.1 tron }
918 1.1 tron
919 1.1 tron sc->sc_vgm = mc->un.value.level[AUDIO_MIXER_LEVEL_MONO];
920 1.1 tron break;
921 1.1 tron
922 1.1 tron default:
923 1.1 tron err = EINVAL;
924 1.1 tron break;
925 1.1 tron }
926 1.1 tron
927 1.1 tron return err;
928 1.1 tron }
929 1.1 tron
930 1.1 tron static int
931 1.1 tron btsco_get_port(void *hdl, mixer_ctrl_t *mc)
932 1.1 tron {
933 1.1 tron struct btsco_softc *sc = hdl;
934 1.1 tron int err = 0;
935 1.1 tron
936 1.16 plunky DPRINTF("%s dev %d\n", sc->sc_name, mc->dev);
937 1.1 tron
938 1.1 tron switch (mc->dev) {
939 1.1 tron case BTSCO_VGS:
940 1.1 tron mc->type = AUDIO_MIXER_VALUE;
941 1.1 tron mc->un.value.num_channels = 1;
942 1.1 tron mc->un.value.level[AUDIO_MIXER_LEVEL_MONO] = sc->sc_vgs;
943 1.1 tron break;
944 1.1 tron
945 1.1 tron case BTSCO_VGM:
946 1.1 tron mc->type = AUDIO_MIXER_VALUE;
947 1.1 tron mc->un.value.num_channels = 1;
948 1.1 tron mc->un.value.level[AUDIO_MIXER_LEVEL_MONO] = sc->sc_vgm;
949 1.1 tron break;
950 1.1 tron
951 1.1 tron default:
952 1.1 tron err = EINVAL;
953 1.1 tron break;
954 1.1 tron }
955 1.1 tron
956 1.1 tron return err;
957 1.1 tron }
958 1.1 tron
959 1.1 tron static int
960 1.11 christos btsco_query_devinfo(void *hdl, mixer_devinfo_t *di)
961 1.1 tron {
962 1.1 tron /* struct btsco_softc *sc = hdl; */
963 1.1 tron int err = 0;
964 1.1 tron
965 1.1 tron switch(di->index) {
966 1.1 tron case BTSCO_VGS:
967 1.1 tron di->mixer_class = BTSCO_INPUT_CLASS;
968 1.1 tron di->next = di->prev = AUDIO_MIXER_LAST;
969 1.1 tron strcpy(di->label.name, AudioNspeaker);
970 1.1 tron di->type = AUDIO_MIXER_VALUE;
971 1.1 tron strcpy(di->un.v.units.name, AudioNvolume);
972 1.1 tron di->un.v.num_channels = 1;
973 1.1 tron di->un.v.delta = BTSCO_DELTA;
974 1.1 tron break;
975 1.1 tron
976 1.1 tron case BTSCO_VGM:
977 1.1 tron di->mixer_class = BTSCO_INPUT_CLASS;
978 1.1 tron di->next = di->prev = AUDIO_MIXER_LAST;
979 1.1 tron strcpy(di->label.name, AudioNmicrophone);
980 1.1 tron di->type = AUDIO_MIXER_VALUE;
981 1.1 tron strcpy(di->un.v.units.name, AudioNvolume);
982 1.1 tron di->un.v.num_channels = 1;
983 1.1 tron di->un.v.delta = BTSCO_DELTA;
984 1.1 tron break;
985 1.1 tron
986 1.1 tron case BTSCO_INPUT_CLASS:
987 1.1 tron di->mixer_class = BTSCO_INPUT_CLASS;
988 1.1 tron di->next = di->prev = AUDIO_MIXER_LAST;
989 1.1 tron strcpy(di->label.name, AudioCinputs);
990 1.1 tron di->type = AUDIO_MIXER_CLASS;
991 1.1 tron break;
992 1.1 tron
993 1.1 tron default:
994 1.1 tron err = ENXIO;
995 1.1 tron break;
996 1.1 tron }
997 1.1 tron
998 1.1 tron return err;
999 1.1 tron }
1000 1.1 tron
1001 1.1 tron /*
1002 1.1 tron * Allocate Ring Buffers.
1003 1.1 tron */
1004 1.1 tron static void *
1005 1.1 tron btsco_allocm(void *hdl, int direction, size_t size,
1006 1.1 tron struct malloc_type *type, int flags)
1007 1.1 tron {
1008 1.1 tron struct btsco_softc *sc = hdl;
1009 1.1 tron void *addr;
1010 1.1 tron
1011 1.16 plunky DPRINTF("%s: size %d direction %d\n", sc->sc_name, size, direction);
1012 1.1 tron
1013 1.1 tron addr = malloc(size, type, flags);
1014 1.1 tron
1015 1.1 tron if (direction == AUMODE_PLAY) {
1016 1.1 tron sc->sc_tx_buf = addr;
1017 1.1 tron sc->sc_tx_refcnt = 0;
1018 1.1 tron }
1019 1.1 tron
1020 1.1 tron return addr;
1021 1.1 tron }
1022 1.1 tron
1023 1.1 tron /*
1024 1.1 tron * Free Ring Buffers.
1025 1.1 tron *
1026 1.1 tron * Because we used external memory for the tx mbufs, we dont
1027 1.1 tron * want to free the memory until all the mbufs are done with
1028 1.1 tron *
1029 1.1 tron * Just to be sure, dont free if something is still pending.
1030 1.1 tron * This would be a memory leak but at least there is a warning..
1031 1.1 tron */
1032 1.1 tron static void
1033 1.1 tron btsco_freem(void *hdl, void *addr, struct malloc_type *type)
1034 1.1 tron {
1035 1.1 tron struct btsco_softc *sc = hdl;
1036 1.1 tron int count = hz / 2;
1037 1.1 tron
1038 1.1 tron if (addr == sc->sc_tx_buf) {
1039 1.16 plunky DPRINTF("%s: tx_refcnt=%d\n", sc->sc_name, sc->sc_tx_refcnt);
1040 1.1 tron
1041 1.1 tron sc->sc_tx_buf = NULL;
1042 1.1 tron
1043 1.1 tron while (sc->sc_tx_refcnt> 0 && count-- > 0)
1044 1.1 tron tsleep(sc, PWAIT, "drain", 1);
1045 1.1 tron
1046 1.1 tron if (sc->sc_tx_refcnt > 0) {
1047 1.18 plunky aprint_error("%s: ring buffer unreleased!\n", sc->sc_name);
1048 1.1 tron return;
1049 1.1 tron }
1050 1.1 tron }
1051 1.1 tron
1052 1.1 tron free(addr, type);
1053 1.1 tron }
1054 1.1 tron
1055 1.1 tron static int
1056 1.11 christos btsco_get_props(void *hdl)
1057 1.1 tron {
1058 1.1 tron
1059 1.1 tron return AUDIO_PROP_FULLDUPLEX;
1060 1.1 tron }
1061 1.1 tron
1062 1.1 tron /*
1063 1.1 tron * Handle private ioctl. We pass information out about how to talk
1064 1.1 tron * to the device and mixer.
1065 1.1 tron */
1066 1.1 tron static int
1067 1.12 christos btsco_dev_ioctl(void *hdl, u_long cmd, void *addr, int flag,
1068 1.11 christos struct lwp *l)
1069 1.1 tron {
1070 1.1 tron struct btsco_softc *sc = hdl;
1071 1.1 tron struct btsco_info *bi = (struct btsco_info *)addr;
1072 1.1 tron int err = 0;
1073 1.1 tron
1074 1.16 plunky DPRINTF("%s cmd 0x%lx flag %d\n", sc->sc_name, cmd, flag);
1075 1.1 tron
1076 1.1 tron switch (cmd) {
1077 1.1 tron case BTSCO_GETINFO:
1078 1.1 tron memset(bi, 0, sizeof(*bi));
1079 1.1 tron bdaddr_copy(&bi->laddr, &sc->sc_laddr);
1080 1.1 tron bdaddr_copy(&bi->raddr, &sc->sc_raddr);
1081 1.1 tron bi->channel = sc->sc_channel;
1082 1.1 tron bi->vgs = BTSCO_VGS;
1083 1.1 tron bi->vgm = BTSCO_VGM;
1084 1.1 tron break;
1085 1.1 tron
1086 1.1 tron default:
1087 1.1 tron err = EPASSTHROUGH;
1088 1.1 tron break;
1089 1.1 tron }
1090 1.1 tron
1091 1.1 tron return err;
1092 1.1 tron }
1093 1.1 tron
1094 1.1 tron
1095 1.1 tron /*****************************************************************************
1096 1.1 tron *
1097 1.1 tron * misc btsco functions
1098 1.1 tron *
1099 1.1 tron */
1100 1.1 tron
1101 1.1 tron /*
1102 1.1 tron * Our transmit interrupt. This is triggered when a new block is to be
1103 1.1 tron * sent. We send mtu sized chunks of the block as mbufs with external
1104 1.1 tron * storage to sco_send()
1105 1.1 tron */
1106 1.1 tron static void
1107 1.1 tron btsco_intr(void *arg)
1108 1.1 tron {
1109 1.1 tron struct btsco_softc *sc = arg;
1110 1.1 tron struct mbuf *m;
1111 1.1 tron uint8_t *block;
1112 1.1 tron int mlen, size;
1113 1.1 tron
1114 1.1 tron DPRINTFN(10, "%s block %p size %d\n",
1115 1.16 plunky sc->sc_name, sc->sc_tx_block, sc->sc_tx_size);
1116 1.1 tron
1117 1.1 tron if (sc->sc_sco == NULL)
1118 1.1 tron return; /* connection is lost */
1119 1.1 tron
1120 1.1 tron block = sc->sc_tx_block;
1121 1.1 tron size = sc->sc_tx_size;
1122 1.1 tron sc->sc_tx_block = NULL;
1123 1.1 tron sc->sc_tx_size = 0;
1124 1.1 tron
1125 1.1 tron while (size > 0) {
1126 1.1 tron MGETHDR(m, M_DONTWAIT, MT_DATA);
1127 1.1 tron if (m == NULL)
1128 1.1 tron break;
1129 1.1 tron
1130 1.1 tron mlen = MIN(sc->sc_mtu, size);
1131 1.1 tron
1132 1.1 tron /* I think M_DEVBUF is true but not relevant */
1133 1.1 tron MEXTADD(m, block, mlen, M_DEVBUF, btsco_extfree, sc);
1134 1.1 tron if ((m->m_flags & M_EXT) == 0) {
1135 1.1 tron m_free(m);
1136 1.1 tron break;
1137 1.1 tron }
1138 1.1 tron sc->sc_tx_refcnt++;
1139 1.1 tron
1140 1.1 tron m->m_pkthdr.len = m->m_len = mlen;
1141 1.1 tron sc->sc_tx_pending++;
1142 1.1 tron
1143 1.1 tron if (sco_send(sc->sc_sco, m) > 0) {
1144 1.1 tron sc->sc_tx_pending--;
1145 1.1 tron break;
1146 1.1 tron }
1147 1.1 tron
1148 1.1 tron block += mlen;
1149 1.1 tron size -= mlen;
1150 1.1 tron }
1151 1.1 tron }
1152 1.1 tron
1153 1.1 tron /*
1154 1.1 tron * Release the mbuf, we keep a reference count on the tx buffer so
1155 1.1 tron * that we dont release it before its free.
1156 1.1 tron */
1157 1.1 tron static void
1158 1.12 christos btsco_extfree(struct mbuf *m, void *addr, size_t size,
1159 1.10 christos void *arg)
1160 1.1 tron {
1161 1.1 tron struct btsco_softc *sc = arg;
1162 1.1 tron
1163 1.1 tron if (m != NULL)
1164 1.17 ad pool_cache_put(mb_cache, m);
1165 1.1 tron
1166 1.1 tron sc->sc_tx_refcnt--;
1167 1.1 tron }
1168