Home | History | Annotate | Line # | Download | only in bluetooth
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