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