Home | History | Annotate | Line # | Download | only in bluetooth
btuart.c revision 1.14
      1  1.14    plunky /*	$NetBSD: btuart.c,v 1.14 2007/11/28 20:16:11 plunky Exp $	*/
      2   1.1  kiyohara /*
      3   1.1  kiyohara  * Copyright (c) 2006, 2007 KIYOHARA Takashi
      4   1.1  kiyohara  * All rights reserved.
      5   1.1  kiyohara  *
      6   1.1  kiyohara  * Redistribution and use in source and binary forms, with or without
      7   1.1  kiyohara  * modification, are permitted provided that the following conditions
      8   1.1  kiyohara  * are met:
      9   1.1  kiyohara  * 1. Redistributions of source code must retain the above copyright
     10   1.1  kiyohara  *    notice, this list of conditions and the following disclaimer.
     11   1.1  kiyohara  * 2. Redistributions in binary form must reproduce the above copyright
     12   1.1  kiyohara  *    notice, this list of conditions and the following disclaimer in the
     13   1.1  kiyohara  *    documentation and/or other materials provided with the distribution.
     14   1.1  kiyohara  *
     15   1.1  kiyohara  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16   1.1  kiyohara  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     17   1.1  kiyohara  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     18   1.1  kiyohara  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     19   1.1  kiyohara  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     20   1.1  kiyohara  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     21   1.1  kiyohara  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     22   1.1  kiyohara  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     23   1.1  kiyohara  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     24   1.1  kiyohara  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     25   1.1  kiyohara  * POSSIBILITY OF SUCH DAMAGE.
     26   1.1  kiyohara  */
     27   1.1  kiyohara 
     28   1.1  kiyohara #include <sys/cdefs.h>
     29  1.14    plunky __KERNEL_RCSID(0, "$NetBSD: btuart.c,v 1.14 2007/11/28 20:16:11 plunky Exp $");
     30   1.1  kiyohara 
     31   1.1  kiyohara #include <sys/types.h>
     32   1.1  kiyohara #include <sys/param.h>
     33   1.1  kiyohara #include <sys/device.h>
     34   1.1  kiyohara #include <sys/errno.h>
     35   1.1  kiyohara 
     36   1.1  kiyohara #include <sys/conf.h>
     37   1.1  kiyohara #include <sys/fcntl.h>
     38   1.1  kiyohara #include <sys/kauth.h>
     39   1.1  kiyohara #include <sys/kernel.h>
     40   1.1  kiyohara #include <sys/malloc.h>
     41   1.1  kiyohara #include <sys/mbuf.h>
     42   1.1  kiyohara #include <sys/proc.h>
     43   1.1  kiyohara #include <sys/syslimits.h>
     44   1.1  kiyohara #include <sys/systm.h>
     45   1.1  kiyohara #include <sys/tty.h>
     46   1.1  kiyohara 
     47   1.9        ad #include <sys/bus.h>
     48   1.9        ad #include <sys/intr.h>
     49   1.1  kiyohara 
     50   1.1  kiyohara #include <netbt/bluetooth.h>
     51   1.1  kiyohara #include <netbt/hci.h>
     52   1.1  kiyohara 
     53   1.1  kiyohara #include <dev/bluetooth/btuart.h>
     54   1.1  kiyohara #include <dev/firmload.h>
     55   1.1  kiyohara 
     56   1.1  kiyohara #include "ioconf.h"
     57   1.1  kiyohara 
     58   1.1  kiyohara #ifdef BTUART_DEBUG
     59   1.1  kiyohara int btuart_debug = 1;
     60   1.1  kiyohara #endif
     61   1.1  kiyohara 
     62   1.1  kiyohara struct btuart_softc;
     63   1.1  kiyohara struct bth4hci {
     64   1.1  kiyohara 	int type;
     65   1.1  kiyohara 	int init_baud;
     66   1.1  kiyohara #define FLOW_CTL	1
     67   1.1  kiyohara 	int flags;
     68   1.1  kiyohara 	int (*init)(struct btuart_softc *);
     69   1.1  kiyohara };
     70   1.1  kiyohara 
     71   1.1  kiyohara struct btuart_softc {
     72  1.10    plunky 	device_t	sc_dev;
     73  1.14    plunky 	int sc_flags;
     74   1.1  kiyohara 
     75   1.1  kiyohara 	struct tty *sc_tp;
     76  1.14    plunky 	struct hci_unit *sc_unit;		/* Bluetooth HCI Unit */
     77  1.14    plunky 	struct bt_stats sc_stats;
     78   1.1  kiyohara 
     79   1.1  kiyohara 	struct bth4hci sc_bth4hci;
     80   1.1  kiyohara 	int sc_baud;
     81   1.1  kiyohara 
     82   1.1  kiyohara 	int sc_state;				/* receive state */
     83   1.1  kiyohara #define BTUART_RECV_PKT_TYPE	0			/* packet type */
     84   1.1  kiyohara #define BTUART_RECV_ACL_HDR	1			/* acl header */
     85   1.1  kiyohara #define BTUART_RECV_SCO_HDR	2			/* sco header */
     86   1.1  kiyohara #define BTUART_RECV_EVENT_HDR	3			/* event header */
     87   1.1  kiyohara #define BTUART_RECV_ACL_DATA	4			/* acl packet data */
     88   1.1  kiyohara #define BTUART_RECV_SCO_DATA	5			/* sco packet data */
     89   1.1  kiyohara #define BTUART_RECV_EVENT_DATA	6			/* event packet data */
     90   1.1  kiyohara 	int sc_want;				/* how much we want */
     91   1.1  kiyohara 	struct mbuf *sc_rxp;			/* incoming packet */
     92   1.1  kiyohara 	struct mbuf *sc_txp;			/* outgoing packet */
     93   1.1  kiyohara 
     94  1.14    plunky 	MBUFQ_HEAD() sc_cmdq;
     95  1.14    plunky 	MBUFQ_HEAD() sc_aclq;
     96  1.14    plunky 	MBUFQ_HEAD() sc_scoq;
     97  1.14    plunky 
     98  1.14    plunky 	bool (*sc_input_acl)(struct hci_unit *, struct mbuf *);
     99  1.14    plunky 	bool (*sc_input_sco)(struct hci_unit *, struct mbuf *);
    100  1.14    plunky 	bool (*sc_input_event)(struct hci_unit *, struct mbuf *);
    101   1.1  kiyohara };
    102   1.1  kiyohara 
    103  1.14    plunky /* sc_flags */
    104  1.14    plunky #define BTUART_XMIT	(1 << 0)	/* transmit is active */
    105  1.14    plunky #define BTUART_ENABLED	(1 << 1)	/* device is enabled */
    106  1.14    plunky 
    107   1.1  kiyohara void btuartattach(int);
    108  1.10    plunky static int btuart_match(device_t, struct cfdata *, void *);
    109  1.10    plunky static void btuart_attach(device_t, device_t, void *);
    110  1.10    plunky static int btuart_detach(device_t, int);
    111   1.1  kiyohara 
    112   1.1  kiyohara static int bth4_waitresp(struct btuart_softc *, struct mbuf **, uint16_t);
    113   1.1  kiyohara static int bth4_firmload(struct btuart_softc *, char *,
    114   1.1  kiyohara 			 int (*)(struct btuart_softc *, int, char *));
    115   1.1  kiyohara static int init_ericsson(struct btuart_softc *);
    116   1.1  kiyohara static int init_digi(struct btuart_softc *);
    117   1.1  kiyohara static int init_texas(struct btuart_softc *);
    118   1.1  kiyohara static int init_csr(struct btuart_softc *);
    119   1.1  kiyohara static int init_swave(struct btuart_softc *);
    120   1.1  kiyohara static int init_st(struct btuart_softc *);
    121   1.1  kiyohara static int firmload_stlc2500(struct btuart_softc *, int, char *);
    122   1.1  kiyohara static int init_stlc2500(struct btuart_softc *);
    123   1.1  kiyohara static int init_bcm2035(struct btuart_softc *);
    124   1.1  kiyohara static int bth4init(struct btuart_softc *);
    125  1.14    plunky static bool bth4init_input(struct hci_unit *, struct mbuf *);
    126   1.1  kiyohara 
    127   1.1  kiyohara static int bth4open(dev_t, struct tty *);
    128   1.1  kiyohara static int bth4close(struct tty *, int);
    129   1.2  christos static int bth4ioctl(struct tty *, u_long, void *, int, struct lwp *);
    130   1.1  kiyohara static int bth4input(int, struct tty *);
    131   1.1  kiyohara static int bth4start(struct tty *);
    132  1.14    plunky static void bth4_start(struct btuart_softc *);
    133   1.1  kiyohara 
    134  1.12    plunky static int bth4_enable(device_t);
    135  1.12    plunky static void bth4_disable(device_t);
    136  1.14    plunky static void bth4_output_cmd(device_t, struct mbuf *);
    137  1.14    plunky static void bth4_output_acl(device_t, struct mbuf *);
    138  1.14    plunky static void bth4_output_sco(device_t, struct mbuf *);
    139  1.14    plunky static void bth4_stats(device_t, struct bt_stats *, int);
    140   1.1  kiyohara 
    141   1.1  kiyohara /*
    142   1.1  kiyohara  * It doesn't need to be exported, as only btuartattach() uses it,
    143   1.1  kiyohara  * but there's no "official" way to make it static.
    144   1.1  kiyohara  */
    145  1.10    plunky CFATTACH_DECL_NEW(btuart, sizeof(struct btuart_softc),
    146   1.1  kiyohara     btuart_match, btuart_attach, btuart_detach, NULL);
    147   1.1  kiyohara 
    148   1.1  kiyohara static struct linesw bth4_disc = {
    149   1.1  kiyohara 	.l_name = "btuart",
    150   1.1  kiyohara 	.l_open = bth4open,
    151   1.1  kiyohara 	.l_close = bth4close,
    152   1.1  kiyohara 	.l_read = ttyerrio,
    153   1.1  kiyohara 	.l_write = ttyerrio,
    154   1.1  kiyohara 	.l_ioctl = bth4ioctl,
    155   1.1  kiyohara 	.l_rint = bth4input,
    156   1.1  kiyohara 	.l_start = bth4start,
    157   1.1  kiyohara 	.l_modem = ttymodem,
    158   1.1  kiyohara 	.l_poll = ttyerrpoll
    159   1.1  kiyohara };
    160   1.1  kiyohara 
    161  1.14    plunky static const struct hci_if btuart_hci = {
    162  1.14    plunky 	.enable = bth4_enable,
    163  1.14    plunky 	.disable = bth4_disable,
    164  1.14    plunky 	.output_cmd = bth4_output_cmd,
    165  1.14    plunky 	.output_acl = bth4_output_acl,
    166  1.14    plunky 	.output_sco = bth4_output_sco,
    167  1.14    plunky 	.get_stats = bth4_stats,
    168  1.14    plunky 	.ipl = IPL_TTY,
    169  1.14    plunky };
    170  1.14    plunky 
    171   1.1  kiyohara static struct bth4hci bth4hci[] = {
    172   1.1  kiyohara 	{ BTUART_HCITYPE_ANY,		     B0, FLOW_CTL, NULL },
    173   1.1  kiyohara 	{ BTUART_HCITYPE_ERICSSON,	 B57600, FLOW_CTL, init_ericsson },
    174   1.1  kiyohara 	{ BTUART_HCITYPE_DIGI,		  B9600, FLOW_CTL, init_digi },
    175   1.1  kiyohara 	{ BTUART_HCITYPE_TEXAS,		B115200, FLOW_CTL, init_texas },
    176   1.1  kiyohara 	/* CSR Casira serial adapter or BrainBoxes serial dongle (BL642) */
    177   1.1  kiyohara 	{ BTUART_HCITYPE_CSR,		B115200, FLOW_CTL, init_csr },
    178   1.1  kiyohara 	/* Silicon Wave kits */
    179   1.1  kiyohara 	{ BTUART_HCITYPE_SWAVE,		B115200, FLOW_CTL, init_swave },
    180   1.1  kiyohara 	/* ST Microelectronics minikits based on STLC2410/STLC2415 */
    181   1.1  kiyohara 	{ BTUART_HCITYPE_ST,		 B57600, FLOW_CTL, init_st },
    182   1.1  kiyohara 	/* ST Microelectronics minikits based on STLC2500 */
    183   1.1  kiyohara 	{ BTUART_HCITYPE_STLC2500,	B115200, FLOW_CTL, init_stlc2500 },
    184   1.1  kiyohara 	/* AmbiCom BT2000C Bluetooth PC/CF Card */
    185   1.1  kiyohara 	{ BTUART_HCITYPE_BT2000C,	 B57600, FLOW_CTL, init_csr },
    186   1.1  kiyohara 	/* Broadcom BCM2035 */
    187   1.1  kiyohara 	{ BTUART_HCITYPE_BCM2035,	B115200,        0, init_bcm2035 },
    188   1.1  kiyohara 
    189   1.1  kiyohara 	{ -1,				     B0,        0, NULL }
    190   1.1  kiyohara };
    191   1.1  kiyohara 
    192   1.1  kiyohara 
    193   1.1  kiyohara /* ARGSUSED */
    194   1.1  kiyohara void
    195   1.1  kiyohara btuartattach(int num __unused)
    196   1.1  kiyohara {
    197   1.1  kiyohara 	int error;
    198   1.1  kiyohara 
    199   1.1  kiyohara 	error = ttyldisc_attach(&bth4_disc);
    200   1.1  kiyohara 	if (error) {
    201   1.1  kiyohara 		aprint_error("%s: unable to register line discipline, "
    202   1.1  kiyohara 		    "error = %d\n", btuart_cd.cd_name, error);
    203   1.1  kiyohara 		return;
    204   1.1  kiyohara 	}
    205   1.1  kiyohara 
    206   1.1  kiyohara 	error = config_cfattach_attach(btuart_cd.cd_name, &btuart_ca);
    207   1.1  kiyohara 	if (error) {
    208   1.1  kiyohara 		aprint_error("%s: unable to register cfattach, error = %d\n",
    209   1.1  kiyohara 		    btuart_cd.cd_name, error);
    210   1.1  kiyohara 		config_cfdriver_detach(&btuart_cd);
    211   1.1  kiyohara 		(void) ttyldisc_detach(&bth4_disc);
    212   1.1  kiyohara 	}
    213   1.1  kiyohara }
    214   1.1  kiyohara 
    215   1.1  kiyohara /*
    216   1.1  kiyohara  * Autoconf match routine.
    217   1.1  kiyohara  *
    218   1.1  kiyohara  * XXX: unused: config_attach_pseudo(9) does not call ca_match.
    219   1.1  kiyohara  */
    220   1.1  kiyohara /* ARGSUSED */
    221   1.1  kiyohara static int
    222  1.10    plunky btuart_match(device_t self __unused,
    223   1.1  kiyohara     struct cfdata *cfdata __unused, void *arg __unused)
    224   1.1  kiyohara {
    225   1.1  kiyohara 
    226   1.1  kiyohara 	/* pseudo-device; always present */
    227   1.1  kiyohara 	return 1;
    228   1.1  kiyohara }
    229   1.1  kiyohara 
    230   1.1  kiyohara /*
    231   1.1  kiyohara  * Autoconf attach routine.  Called by config_attach_pseudo(9) when we
    232   1.1  kiyohara  * open the line discipline.
    233   1.1  kiyohara  */
    234   1.1  kiyohara /* ARGSUSED */
    235   1.1  kiyohara static void
    236  1.10    plunky btuart_attach(device_t parent __unused,
    237  1.10    plunky     device_t self, void *aux __unused)
    238   1.1  kiyohara {
    239   1.1  kiyohara 	struct btuart_softc *sc = device_private(self);
    240   1.1  kiyohara 	int i;
    241   1.1  kiyohara 
    242  1.10    plunky 	sc->sc_dev = self;
    243  1.10    plunky 
    244  1.14    plunky 	MBUFQ_INIT(&sc->sc_cmdq);
    245  1.14    plunky 	MBUFQ_INIT(&sc->sc_aclq);
    246  1.14    plunky 	MBUFQ_INIT(&sc->sc_scoq);
    247  1.14    plunky 
    248   1.1  kiyohara 	aprint_normal("\n");
    249   1.1  kiyohara 	aprint_naive("\n");
    250   1.1  kiyohara 
    251   1.1  kiyohara 	sc->sc_input_acl = bth4init_input;
    252   1.1  kiyohara 	sc->sc_input_sco = bth4init_input;
    253   1.1  kiyohara 	sc->sc_input_event = bth4init_input;
    254   1.1  kiyohara 
    255   1.1  kiyohara 	/* Copy default type */
    256   1.1  kiyohara 	for (i = 0; bth4hci[i].type != BTUART_HCITYPE_ANY; i++);
    257   1.1  kiyohara 	memcpy(&sc->sc_bth4hci, &bth4hci[i], sizeof(struct bth4hci));
    258   1.1  kiyohara 
    259   1.1  kiyohara 	/* Attach Bluetooth unit */
    260  1.14    plunky 	sc->sc_unit = hci_attach(&btuart_hci, self, 0);
    261   1.1  kiyohara }
    262   1.1  kiyohara 
    263   1.1  kiyohara /*
    264   1.1  kiyohara  * Autoconf detach routine.  Called when we close the line discipline.
    265   1.1  kiyohara  */
    266   1.1  kiyohara static int
    267  1.10    plunky btuart_detach(device_t self, int flags __unused)
    268   1.1  kiyohara {
    269   1.1  kiyohara 	struct btuart_softc *sc = device_private(self);
    270   1.1  kiyohara 
    271  1.14    plunky 	if (sc->sc_unit) {
    272  1.14    plunky 		hci_detach(sc->sc_unit);
    273  1.14    plunky 		sc->sc_unit = NULL;
    274  1.14    plunky 	}
    275   1.1  kiyohara 
    276   1.1  kiyohara 	return 0;
    277   1.1  kiyohara }
    278   1.1  kiyohara 
    279   1.1  kiyohara 
    280   1.1  kiyohara static int
    281   1.1  kiyohara bth4_waitresp(struct btuart_softc *sc, struct mbuf **mp, uint16_t opcode)
    282   1.1  kiyohara {
    283   1.1  kiyohara 	hci_event_hdr_t *e;
    284  1.14    plunky 	struct hci_unit *unit = sc->sc_unit;
    285   1.1  kiyohara 	int status = 0, rv;
    286   1.1  kiyohara 
    287   1.1  kiyohara 	*mp = NULL;
    288   1.1  kiyohara 	while (1 /* CONSTCOND */) {
    289   1.1  kiyohara 		if ((rv =
    290   1.1  kiyohara 		    tsleep(&unit->hci_eventq, PCATCH, "bth4init", 0)) != 0)
    291   1.1  kiyohara 			return rv;
    292   1.1  kiyohara 
    293   1.1  kiyohara 		MBUFQ_DEQUEUE(&unit->hci_eventq, *mp);
    294   1.1  kiyohara 		unit->hci_eventqlen--;
    295   1.1  kiyohara 		KASSERT(*mp != NULL);
    296   1.1  kiyohara 
    297   1.1  kiyohara 		e = mtod(*mp, hci_event_hdr_t *);
    298   1.1  kiyohara 		if (e->event == HCI_EVENT_COMMAND_COMPL) {
    299   1.1  kiyohara 			hci_command_compl_ep *ep;
    300   1.1  kiyohara 
    301   1.1  kiyohara 			ep = (hci_command_compl_ep *)(e + 1);
    302   1.1  kiyohara 			if (ep->opcode == opcode) {
    303   1.1  kiyohara 				status = *(char *)(ep + 1);
    304   1.1  kiyohara 				break;
    305   1.1  kiyohara 			}
    306   1.1  kiyohara 		} else if (e->event == HCI_EVENT_COMMAND_STATUS) {
    307   1.1  kiyohara 			hci_command_status_ep *ep;
    308   1.1  kiyohara 
    309   1.1  kiyohara 			ep = (hci_command_status_ep *)(e + 1);
    310   1.1  kiyohara 			if (ep->opcode == opcode) {
    311   1.1  kiyohara 				status = ep->status;
    312   1.1  kiyohara 				break;
    313   1.1  kiyohara 			}
    314   1.1  kiyohara 		} else if (e->event == HCI_EVENT_VENDOR)
    315   1.1  kiyohara 				break;
    316   1.1  kiyohara 	}
    317   1.1  kiyohara 
    318   1.1  kiyohara 	return status;
    319   1.1  kiyohara }
    320   1.1  kiyohara 
    321   1.1  kiyohara static int
    322   1.1  kiyohara bth4_firmload(struct btuart_softc *sc, char *filename,
    323   1.1  kiyohara 	      int (*func_firmload)(struct btuart_softc *, int, char *))
    324   1.1  kiyohara {
    325  1.10    plunky 	const cfdriver_t cd = device_cfdriver(sc->sc_dev);
    326   1.1  kiyohara 	firmware_handle_t fh = NULL;
    327   1.1  kiyohara 	int error, size;
    328   1.1  kiyohara 	char *buf;
    329   1.1  kiyohara 
    330   1.1  kiyohara 	if ((error = firmware_open(cd->cd_name, filename, &fh)) != 0) {
    331  1.13    plunky 		aprint_error_dev(sc->sc_dev, "firmware_open failed\n");
    332   1.1  kiyohara 		return error;
    333   1.1  kiyohara 	}
    334   1.1  kiyohara 	size = firmware_get_size(fh);
    335   1.1  kiyohara 	if ((buf = firmware_malloc(size)) != NULL) {
    336  1.13    plunky 		aprint_error_dev(sc->sc_dev, "firmware_malloc failed\n");
    337   1.1  kiyohara 		firmware_close(fh);
    338   1.1  kiyohara 		return ENOMEM;
    339   1.1  kiyohara 	}
    340   1.1  kiyohara 
    341   1.1  kiyohara 	if ((error = firmware_read(fh, 0, buf, size)) != 0)
    342  1.13    plunky 		aprint_error_dev(sc->sc_dev, "firmware_read failed\n");
    343   1.1  kiyohara 	if (error == 0)
    344   1.1  kiyohara 		error = (*func_firmload)(sc, size, buf);
    345   1.1  kiyohara 
    346   1.1  kiyohara 	firmware_close(fh);
    347   1.1  kiyohara 	firmware_free(buf, size);
    348   1.1  kiyohara 
    349   1.1  kiyohara 	return error;
    350   1.1  kiyohara }
    351   1.1  kiyohara 
    352   1.1  kiyohara /*
    353   1.1  kiyohara  * LSI initialize functions.
    354   1.1  kiyohara  */
    355   1.1  kiyohara static int
    356   1.1  kiyohara init_ericsson(struct btuart_softc *sc)
    357   1.1  kiyohara {
    358   1.1  kiyohara 	struct mbuf *m;
    359   1.1  kiyohara 	hci_cmd_hdr_t *p;
    360   1.1  kiyohara 	int i, error = 0;
    361   1.1  kiyohara 	const uint16_t opcode = htole16(HCI_CMD_ERICSSON_SET_UART_BAUD_RATE);
    362   1.1  kiyohara 	static struct {
    363   1.1  kiyohara 		int baud;
    364   1.1  kiyohara 		uint8_t param;
    365   1.1  kiyohara 	} ericsson_baudtbl[] = {
    366   1.1  kiyohara 		{ B460800, 0x00 },
    367   1.1  kiyohara 		{ B230400, 0x01 },
    368   1.1  kiyohara 		{ B115200, 0x02 },
    369   1.1  kiyohara 		{  B57600, 0x03 },
    370   1.1  kiyohara 		{  B28800, 0x04 },
    371   1.1  kiyohara 		{  B14400, 0x05 },
    372   1.1  kiyohara 		{   B7200, 0x06 },
    373   1.1  kiyohara #if defined(B3600)
    374   1.1  kiyohara 		{   B3600, 0x07 },
    375   1.1  kiyohara #endif
    376   1.1  kiyohara 		{   B1800, 0x08 },
    377   1.1  kiyohara #if defined(B900)
    378   1.1  kiyohara 		{    B900, 0x09 },
    379   1.1  kiyohara #endif
    380   1.1  kiyohara #if defined(B153600)
    381   1.1  kiyohara 		{ B153600, 0x10 },
    382   1.1  kiyohara #endif
    383   1.1  kiyohara 		{  B76800, 0x11 },
    384   1.1  kiyohara 		{  B38400, 0x12 },
    385   1.1  kiyohara 		{  B19200, 0x13 },
    386   1.1  kiyohara 		{   B9600, 0x14 },
    387   1.1  kiyohara 		{   B4800, 0x15 },
    388   1.1  kiyohara 		{   B2400, 0x16 },
    389   1.1  kiyohara 		{   B1200, 0x17 },
    390   1.1  kiyohara 		{    B600, 0x18 },
    391   1.1  kiyohara 		{    B300, 0x19 },
    392   1.1  kiyohara 		{ B921600, 0x20 },
    393   1.1  kiyohara 		{      B0, 0xff }
    394   1.1  kiyohara 	};
    395   1.1  kiyohara 
    396   1.1  kiyohara 	for (i = 0; ericsson_baudtbl[i].baud != sc->sc_baud; i++)
    397   1.1  kiyohara 		if (ericsson_baudtbl[i].baud == B0)
    398   1.1  kiyohara 			return EINVAL;
    399   1.1  kiyohara 
    400   1.1  kiyohara 	m = m_gethdr(M_WAIT, MT_DATA);
    401   1.1  kiyohara 	p = mtod(m, hci_cmd_hdr_t *);
    402   1.1  kiyohara 	p->type = HCI_CMD_PKT;
    403   1.1  kiyohara 	p->opcode = opcode;
    404   1.1  kiyohara 	p->length = sizeof(ericsson_baudtbl[0].param);
    405   1.1  kiyohara 	m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    406   1.1  kiyohara 	m_copyback(m, sizeof(hci_cmd_hdr_t), p->length,
    407   1.1  kiyohara 	    &ericsson_baudtbl[i].param);
    408   1.1  kiyohara 
    409  1.14    plunky 	bth4_output_cmd(sc->sc_dev, m);
    410   1.1  kiyohara 
    411   1.1  kiyohara #if 0
    412   1.1  kiyohara 	error = bth4_waitresp(sc, &m, opcode);
    413   1.1  kiyohara 	if (m != NULL) {
    414   1.1  kiyohara 		if (error != 0) {
    415  1.13    plunky 			aprint_error_dev(sc->sc_dev,
    416  1.13    plunky 			    "EricssonSetUARTBaudRate failed: Status 0x%02x\n",
    417  1.13    plunky 			    error);
    418   1.1  kiyohara 			error = EFAULT;
    419   1.1  kiyohara 		}
    420   1.1  kiyohara 		m_freem(m);
    421   1.1  kiyohara 	}
    422   1.1  kiyohara #else
    423   1.1  kiyohara 	/*
    424   1.1  kiyohara 	 * XXXX: We cannot correctly receive this response perhaps.  Wait
    425   1.1  kiyohara 	 * until the transmission of the data of 5 bytes * 10 bit is completed.
    426   1.1  kiyohara 	 *   1000000usec * 10bit * 5byte / baud
    427   1.1  kiyohara 	 */
    428   1.1  kiyohara 	delay(50000000 / sc->sc_bth4hci.init_baud);
    429   1.1  kiyohara #endif
    430   1.1  kiyohara 	return error;
    431   1.1  kiyohara }
    432   1.1  kiyohara 
    433   1.1  kiyohara static int
    434   1.1  kiyohara init_digi(struct btuart_softc *sc)
    435   1.1  kiyohara {
    436   1.1  kiyohara 	struct mbuf *m;
    437   1.1  kiyohara 	hci_cmd_hdr_t *p;
    438   1.1  kiyohara 	uint8_t param;
    439   1.1  kiyohara 
    440   1.1  kiyohara 	/* XXXX */
    441   1.1  kiyohara 	switch (sc->sc_baud) {
    442   1.1  kiyohara 	case B57600:
    443   1.1  kiyohara 		param = 0x08;
    444   1.1  kiyohara 		break;
    445   1.1  kiyohara 
    446   1.1  kiyohara 	case B115200:
    447   1.1  kiyohara 		param = 0x09;
    448   1.1  kiyohara 		break;
    449   1.1  kiyohara 
    450   1.1  kiyohara 	default:
    451   1.1  kiyohara 		return EINVAL;
    452   1.1  kiyohara 	}
    453   1.1  kiyohara 
    454   1.1  kiyohara 	m = m_gethdr(M_WAIT, MT_DATA);
    455   1.1  kiyohara 	p = mtod(m, hci_cmd_hdr_t *);
    456   1.1  kiyohara 	p->type = HCI_CMD_PKT;
    457   1.1  kiyohara #define HCI_CMD_DIGIANSWER_SET_UART_BAUD_RATE	0xfc07		/* XXXX */
    458   1.1  kiyohara 	p->opcode = htole16(HCI_CMD_DIGIANSWER_SET_UART_BAUD_RATE);
    459   1.1  kiyohara 	p->length = sizeof(param);
    460   1.1  kiyohara 	m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    461   1.1  kiyohara 	m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, &param);
    462   1.1  kiyohara 
    463  1.14    plunky 	bth4_output_cmd(sc->sc_dev, m);
    464   1.1  kiyohara 
    465   1.1  kiyohara 	/*
    466   1.1  kiyohara 	 * XXXX
    467   1.1  kiyohara 	 * Wait until the transmission of the data of 5 bytes * 10 bit is
    468   1.1  kiyohara 	 * completed.
    469   1.1  kiyohara 	 *     1000000usec * 10bit * 5byte / baud
    470   1.1  kiyohara 	 */
    471   1.1  kiyohara 	delay(50000000 / sc->sc_bth4hci.init_baud);
    472   1.1  kiyohara 	return 0;
    473   1.1  kiyohara }
    474   1.1  kiyohara 
    475   1.1  kiyohara static int
    476   1.1  kiyohara init_texas(struct btuart_softc *sc)
    477   1.1  kiyohara {
    478   1.1  kiyohara 
    479   1.1  kiyohara 	/* XXXX: Should we obtain the version of LMP? */
    480   1.1  kiyohara 	return 0;
    481   1.1  kiyohara }
    482   1.1  kiyohara 
    483   1.1  kiyohara static int
    484   1.1  kiyohara init_csr(struct btuart_softc *sc)
    485   1.1  kiyohara {
    486   1.1  kiyohara 	struct mbuf *m;
    487   1.1  kiyohara 	hci_cmd_hdr_t *p;
    488   1.1  kiyohara 	int error;
    489   1.1  kiyohara 	const uint16_t opcode = htole16(HCI_CMD_CSR_EXTN);
    490   1.1  kiyohara 	struct {
    491   1.1  kiyohara 		uint8_t last :1;
    492   1.1  kiyohara 		uint8_t first :1;
    493   1.1  kiyohara #define CSR_BCCMD_CHANID_BCCMD		2
    494   1.1  kiyohara #define CSR_BCCMD_CHANID_HQ		3
    495   1.1  kiyohara #define CSR_BCCMD_CHANID_DEVMGRLIB	4
    496   1.1  kiyohara #define CSR_BCCMD_CHANID_L2CAPLIB	8
    497   1.1  kiyohara #define CSR_BCCMD_CHANID_RFCOMMLIB	9
    498   1.1  kiyohara #define CSR_BCCMD_CHANID_SDPLIB		10
    499   1.1  kiyohara #define CSR_BCCMD_CHANID_DFU		12
    500   1.1  kiyohara #define CSR_BCCMD_CHANID_VM		13
    501   1.1  kiyohara #define CSR_BCCMD_CHANID_LMDEBUG	20
    502   1.1  kiyohara 		uint8_t chanid :6;
    503   1.1  kiyohara 
    504   1.1  kiyohara 		struct {
    505   1.1  kiyohara #define CSR_BCCMD_MESSAGE_TYPE_GETREQ	0x0000
    506   1.1  kiyohara #define CSR_BCCMD_MESSAGE_TYPE_GETRESP	0x0001
    507   1.1  kiyohara #define CSR_BCCMD_MESSAGE_TYPE_SETREQ	0x0002
    508   1.1  kiyohara 			uint16_t type;
    509   1.1  kiyohara 			uint16_t length;
    510   1.1  kiyohara 			uint16_t seqno;
    511   1.1  kiyohara #define CSR_BCCMD_MESSAGE_VARID_CONFIG_UART		0x6802
    512   1.1  kiyohara #define CSR_BCCMD_MESSAGE_VARID_CONFIG_UART_STOPB		0x2000
    513   1.1  kiyohara #define CSR_BCCMD_MESSAGE_VARID_CONFIG_UART_PARENB		0x4000
    514   1.1  kiyohara #define CSR_BCCMD_MESSAGE_VARID_CONFIG_UART_PARODD		0x8000
    515   1.1  kiyohara 			uint16_t varid;
    516   1.1  kiyohara #define CSR_BCCMD_MESSAGE_STATUS_OK			0x0000
    517   1.1  kiyohara #define CSR_BCCMD_MESSAGE_STATUS_NO_SUCH_VARID		0x0001
    518   1.1  kiyohara #define CSR_BCCMD_MESSAGE_STATUS_TOO_BIG		0x0002
    519   1.1  kiyohara #define CSR_BCCMD_MESSAGE_STATUS_NO_VALUE		0x0003
    520   1.1  kiyohara #define CSR_BCCMD_MESSAGE_STATUS_BAD_REQ		0x0004
    521   1.1  kiyohara #define CSR_BCCMD_MESSAGE_STATUS_NO_ACCESS		0x0005
    522   1.1  kiyohara #define CSR_BCCMD_MESSAGE_STATUS_READ_ONLY		0x0006
    523   1.1  kiyohara #define CSR_BCCMD_MESSAGE_STATUS_WRITE_ONLY		0x0007
    524   1.1  kiyohara #define CSR_BCCMD_MESSAGE_STATUS_ERROR			0x0008
    525   1.1  kiyohara #define CSR_BCCMD_MESSAGE_STATUS_PERMISION_DENIED	0x0009
    526   1.1  kiyohara 			uint16_t status;
    527   1.1  kiyohara 			uint16_t payload[4];
    528   1.1  kiyohara 		} message;
    529   1.1  kiyohara 	} bccmd;
    530   1.1  kiyohara 
    531   1.1  kiyohara 	m = m_gethdr(M_WAIT, MT_DATA);
    532   1.1  kiyohara 	p = mtod(m, hci_cmd_hdr_t *);
    533   1.1  kiyohara 	p->type = HCI_CMD_PKT;
    534   1.1  kiyohara 	p->opcode = opcode;
    535   1.1  kiyohara 	p->length = sizeof(bccmd);
    536   1.1  kiyohara 	m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    537   1.1  kiyohara 
    538   1.1  kiyohara 	/* setup BCSP command packet */
    539   1.1  kiyohara 	bccmd.last = 1;
    540   1.1  kiyohara 	bccmd.first = 1;
    541   1.1  kiyohara 	bccmd.chanid = CSR_BCCMD_CHANID_BCCMD;
    542   1.1  kiyohara 	bccmd.message.type = htole16(CSR_BCCMD_MESSAGE_TYPE_SETREQ);
    543   1.1  kiyohara 	bccmd.message.length = htole16(sizeof(bccmd.message) >> 1);
    544   1.1  kiyohara 	bccmd.message.seqno = htole16(0);
    545   1.1  kiyohara 	bccmd.message.varid = htole16(CSR_BCCMD_MESSAGE_VARID_CONFIG_UART);
    546   1.1  kiyohara 	bccmd.message.status = htole16(CSR_BCCMD_MESSAGE_STATUS_OK);
    547   1.1  kiyohara 	memset(bccmd.message.payload, 0, sizeof(bccmd.message.payload));
    548   1.1  kiyohara 
    549   1.1  kiyohara 	/* Value = (baud rate / 244.140625) | no parity | 1 stop bit. */
    550   1.1  kiyohara 	bccmd.message.payload[0] = htole16((sc->sc_baud * 64 + 7812) / 15625);
    551   1.1  kiyohara 
    552   1.1  kiyohara 	m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, &bccmd);
    553  1.14    plunky 	bth4_output_cmd(sc->sc_dev, m);
    554   1.1  kiyohara 
    555   1.1  kiyohara 	error = bth4_waitresp(sc, &m, opcode);
    556   1.1  kiyohara 	if (m != NULL) {
    557   1.1  kiyohara 		/*
    558   1.1  kiyohara 		 * XXXX:
    559   1.1  kiyohara 		 * We will have to check the HCI_EVENT_VENDOR packet. For
    560   1.5    plunky 		 * instance, it might be a different HCI_EVENT_VENDOR packet.
    561   1.1  kiyohara 		 */
    562   1.1  kiyohara 		if (error != 0) {
    563  1.13    plunky 			aprint_error_dev(sc->sc_dev,
    564  1.13    plunky 			    "CSR set UART speed failed: Status 0x%02x\n",
    565  1.13    plunky 			    error);
    566   1.1  kiyohara 			error = EFAULT;
    567   1.1  kiyohara 		}
    568   1.1  kiyohara 		m_freem(m);
    569   1.1  kiyohara 	}
    570   1.1  kiyohara 
    571   1.1  kiyohara 	return error;
    572   1.1  kiyohara }
    573   1.1  kiyohara 
    574   1.1  kiyohara static int
    575   1.1  kiyohara init_swave(struct btuart_softc *sc)
    576   1.1  kiyohara {
    577   1.1  kiyohara 	struct mbuf *m;
    578   1.1  kiyohara 	hci_cmd_hdr_t *p;
    579   1.1  kiyohara 	hci_event_hdr_t *e;
    580   1.1  kiyohara 	int i, error;
    581   1.1  kiyohara #define HCI_CMD_SWAVE_SET_UART_BAUD_RATE	0xfc0b		/* XXXX */
    582   1.1  kiyohara 	const uint16_t opcode = htole16(HCI_CMD_SWAVE_SET_UART_BAUD_RATE);
    583   1.1  kiyohara 	char param[6], *resp;
    584   1.1  kiyohara 	static struct {			/* XXXX */
    585   1.1  kiyohara 		int baud;
    586   1.1  kiyohara 		uint8_t param;
    587   1.1  kiyohara 	} swave_baudtbl[] = {
    588   1.1  kiyohara 		{  B19200, 0x03 },
    589   1.1  kiyohara 		{  B38400, 0x02 },
    590   1.1  kiyohara 		{  B57600, 0x01 },
    591   1.1  kiyohara 		{ B115200, 0x00 },
    592   1.1  kiyohara 		{      B0, 0xff }
    593   1.1  kiyohara 	};
    594   1.1  kiyohara 
    595   1.1  kiyohara 	for (i = 0; swave_baudtbl[i].baud != sc->sc_baud; i++)
    596   1.1  kiyohara 		if (swave_baudtbl[i].baud == B0)
    597   1.1  kiyohara 			return EINVAL;
    598   1.1  kiyohara 
    599   1.1  kiyohara 	m = m_gethdr(M_WAIT, MT_DATA);
    600   1.1  kiyohara 	/* first send 'param access set' command. */
    601   1.1  kiyohara 	p = mtod(m, hci_cmd_hdr_t *);
    602   1.1  kiyohara 	p->type = HCI_CMD_PKT;
    603   1.1  kiyohara 	p->opcode = opcode;
    604   1.1  kiyohara 	p->length = sizeof(param);
    605   1.1  kiyohara 	m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    606   1.1  kiyohara 
    607   1.1  kiyohara 	/* XXXX */
    608   1.1  kiyohara 	param[0] = 0x01;		/* param sub command */
    609   1.1  kiyohara 	param[1] = 0x11;		/* HCI Tranport Params */
    610   1.1  kiyohara 	param[2] = 0x03;		/* length of the parameter following */
    611   1.1  kiyohara 	param[3] = 0x01;		/* HCI Transport flow control enable */
    612   1.1  kiyohara 	param[4] = 0x01;		/* HCI Transport Type = UART */
    613   1.1  kiyohara 	param[5] = swave_baudtbl[i].param;
    614   1.1  kiyohara 	m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, &param);
    615   1.1  kiyohara 
    616  1.14    plunky 	bth4_output_cmd(sc->sc_dev, m);
    617   1.1  kiyohara 
    618   1.1  kiyohara 	while(1 /* CONSTCOND */) {
    619   1.1  kiyohara 		error = bth4_waitresp(sc, &m, opcode);
    620   1.1  kiyohara 		if (error != 0) {
    621   1.1  kiyohara 			if (m != NULL)
    622   1.1  kiyohara 				m_freem(m);
    623  1.13    plunky 			aprint_error_dev(sc->sc_dev,
    624  1.13    plunky 			    "swave set baud rate command failed: error 0x%02x\n",
    625  1.13    plunky 			    error);
    626   1.1  kiyohara 			return error;
    627   1.1  kiyohara 		}
    628   1.1  kiyohara 		if (m != NULL) {
    629   1.1  kiyohara 			e = mtod(m, hci_event_hdr_t *);
    630   1.1  kiyohara 			resp = (char *)(e + 1);
    631   1.1  kiyohara 			if (e->length == 7 && *resp == 0xb &&
    632   1.1  kiyohara 			    memcmp(resp + 1, param, sizeof(param)) == 0)
    633   1.1  kiyohara 				break;
    634   1.1  kiyohara 			m_freem(m);
    635   1.1  kiyohara 		}
    636   1.1  kiyohara 	}
    637   1.1  kiyohara 
    638   1.1  kiyohara 	/* send 'reset' command consecutively. */
    639   1.1  kiyohara 	p = mtod(m, hci_cmd_hdr_t *);
    640   1.1  kiyohara 	p->type = HCI_CMD_PKT;
    641   1.1  kiyohara 	p->opcode = htole16(HCI_CMD_RESET);
    642   1.1  kiyohara 	p->length = 0;
    643   1.1  kiyohara 	m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    644   1.1  kiyohara 
    645   1.1  kiyohara 	/*
    646   1.1  kiyohara 	 * XXXX
    647   1.1  kiyohara 	 * Wait until the transmission of the data of 4 bytes * 10 bit is
    648   1.1  kiyohara 	 * completed.
    649   1.1  kiyohara 	 *     1000000usec * 10bit * 4byte / baud
    650   1.1  kiyohara 	 */
    651   1.1  kiyohara 	delay(40000000 / sc->sc_bth4hci.init_baud);
    652   1.1  kiyohara 	return 0;
    653   1.1  kiyohara }
    654   1.1  kiyohara 
    655   1.1  kiyohara static int
    656   1.1  kiyohara init_st(struct btuart_softc *sc)
    657   1.1  kiyohara {
    658   1.1  kiyohara 	struct mbuf *m;
    659   1.1  kiyohara 	hci_cmd_hdr_t *p;
    660   1.1  kiyohara 	int i;
    661   1.1  kiyohara 	static struct {			/* XXXX */
    662   1.1  kiyohara 		int baud;
    663   1.1  kiyohara 		uint8_t param;
    664   1.1  kiyohara 	} st_baudtbl[] = {
    665   1.1  kiyohara 		{   B9600, 0x09 },
    666   1.1  kiyohara 		{  B19200, 0x0b },
    667   1.1  kiyohara 		{  B38400, 0x0d },
    668   1.1  kiyohara 		{  B57600, 0x0e },
    669   1.1  kiyohara 		{ B115200, 0x10 },
    670   1.1  kiyohara 		{ B230400, 0x12 },
    671   1.1  kiyohara 		{ B460800, 0x13 },
    672   1.1  kiyohara 		{ B921600, 0x14 },
    673   1.1  kiyohara 		{      B0, 0xff }
    674   1.1  kiyohara 	};
    675   1.1  kiyohara 
    676   1.1  kiyohara 	for (i = 0; st_baudtbl[i].baud != sc->sc_baud; i++)
    677   1.1  kiyohara 		if (st_baudtbl[i].baud == B0)
    678   1.1  kiyohara 			return EINVAL;
    679   1.1  kiyohara 
    680   1.1  kiyohara 	m = m_gethdr(M_WAIT, MT_DATA);
    681   1.1  kiyohara 	p = mtod(m, hci_cmd_hdr_t *);
    682   1.1  kiyohara 	p->type = HCI_CMD_PKT;
    683   1.1  kiyohara #define HCI_CMD_ST_SET_UART_BAUD_RATE	0xfc46	/* XXXX */
    684   1.1  kiyohara 	p->opcode = htole16(HCI_CMD_ST_SET_UART_BAUD_RATE);
    685   1.1  kiyohara 	p->length = sizeof(st_baudtbl[0].param);
    686   1.1  kiyohara 	m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    687   1.1  kiyohara 	m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, &st_baudtbl[i].param);
    688   1.1  kiyohara 
    689  1.14    plunky 	bth4_output_cmd(sc->sc_dev, m);
    690   1.1  kiyohara 
    691   1.1  kiyohara 	/*
    692   1.1  kiyohara 	 * XXXX
    693   1.1  kiyohara 	 * Wait until the transmission of the data of 5 bytes * 10 bit is
    694   1.1  kiyohara 	 * completed.
    695   1.1  kiyohara 	 *     1000000usec * 10bit * 5byte / baud
    696   1.1  kiyohara 	 */
    697   1.1  kiyohara 	delay(50000000 / sc->sc_bth4hci.init_baud);
    698   1.1  kiyohara 	return 0;
    699   1.1  kiyohara }
    700   1.1  kiyohara 
    701   1.1  kiyohara static int
    702   1.1  kiyohara firmload_stlc2500(struct btuart_softc *sc, int size, char *buf)
    703   1.1  kiyohara {
    704   1.1  kiyohara 	struct mbuf *m;
    705   1.1  kiyohara 	hci_cmd_hdr_t *p;
    706   1.1  kiyohara 	int error, offset, n;
    707   1.1  kiyohara 	uint16_t opcode = htole16(0xfc2e);	/* XXXX */
    708   1.1  kiyohara 	uint8_t seq;
    709   1.1  kiyohara 
    710   1.1  kiyohara 	m = m_gethdr(M_WAIT, MT_DATA);
    711   1.1  kiyohara 	seq = 0;
    712   1.1  kiyohara 	offset = 0;
    713   1.1  kiyohara 	error = 0;
    714   1.1  kiyohara 	while (offset < size) {
    715   1.1  kiyohara 		n = size - offset < 254 ? size - offset : 254;
    716   1.1  kiyohara 
    717   1.1  kiyohara 		p = mtod(m, hci_cmd_hdr_t *);
    718   1.1  kiyohara 		p->type = HCI_CMD_PKT;
    719   1.1  kiyohara 		p->opcode = opcode;
    720   1.1  kiyohara 		p->length = n;
    721   1.1  kiyohara 		m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    722   1.1  kiyohara 		*(char *)(p + 1) = seq;
    723   1.1  kiyohara 		m_copyback(m,
    724   1.1  kiyohara 		    sizeof(hci_cmd_hdr_t) + 1, p->length, buf + offset);
    725   1.1  kiyohara 
    726  1.14    plunky 		bth4_output_cmd(sc->sc_dev, m);
    727   1.1  kiyohara 
    728   1.1  kiyohara 		error = bth4_waitresp(sc, &m, opcode);
    729   1.1  kiyohara 		if (m != NULL) {
    730   1.1  kiyohara 			if (error != 0) {
    731  1.13    plunky 				aprint_error_dev(sc->sc_dev,
    732  1.13    plunky 				    "stlc2500 firmware load failed: Status 0x%02x\n",
    733  1.13    plunky 				    error);
    734   1.1  kiyohara 				error = EFAULT;
    735   1.1  kiyohara 				break;
    736   1.1  kiyohara 			}
    737   1.1  kiyohara 		}
    738   1.1  kiyohara 
    739   1.1  kiyohara 		seq++;
    740   1.1  kiyohara 		offset += n;
    741   1.1  kiyohara 	}
    742   1.1  kiyohara 	m_freem(m);
    743   1.1  kiyohara 
    744   1.1  kiyohara 	return error;
    745   1.1  kiyohara }
    746   1.1  kiyohara 
    747   1.1  kiyohara static int
    748   1.1  kiyohara init_stlc2500(struct btuart_softc *sc)
    749   1.1  kiyohara {
    750   1.1  kiyohara 	struct mbuf *m;
    751   1.1  kiyohara 	hci_cmd_hdr_t *p;
    752   1.1  kiyohara 	hci_event_hdr_t *e;
    753   1.1  kiyohara 	hci_read_local_ver_rp *lv;
    754   1.1  kiyohara 	int error, revision, i;
    755   1.1  kiyohara 	uint16_t opcode;
    756   1.1  kiyohara 	char filename[NAME_MAX], param[8];
    757   1.1  kiyohara 	static const char filenametmpl[] = "STLC2500_R%d_%02d%s";
    758   1.1  kiyohara 	const char *suffix[] = { ".ptc", ".ssf", NULL };
    759   1.1  kiyohara 
    760   1.1  kiyohara 	m = m_gethdr(M_WAIT, MT_DATA);
    761   1.1  kiyohara 	p = mtod(m, hci_cmd_hdr_t *);
    762   1.1  kiyohara 	opcode = htole16(HCI_CMD_READ_LOCAL_VER);
    763   1.1  kiyohara 	p->type = HCI_CMD_PKT;
    764   1.1  kiyohara 	p->opcode = opcode;
    765   1.1  kiyohara 	p->length = 0;
    766   1.1  kiyohara 	m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    767   1.1  kiyohara 
    768  1.14    plunky 	bth4_output_cmd(sc->sc_dev, m);
    769   1.1  kiyohara 
    770   1.1  kiyohara 	error = bth4_waitresp(sc, &m, opcode);
    771   1.1  kiyohara 	if (m != NULL) {
    772   1.1  kiyohara 		if (error != 0) {
    773  1.13    plunky 			aprint_error_dev(sc->sc_dev,
    774  1.13    plunky 			    "HCI_Read_Local_Version_Information failed:"
    775  1.13    plunky 			    " Status 0x%02x\n", error);
    776   1.1  kiyohara 			error = EFAULT;
    777   1.1  kiyohara 			m_freem(m);
    778   1.1  kiyohara 		}
    779   1.1  kiyohara 	}
    780   1.1  kiyohara 	if (error != 0)
    781   1.1  kiyohara 		return error;
    782   1.1  kiyohara 
    783   1.1  kiyohara 	e = mtod(m, hci_event_hdr_t *);
    784   1.1  kiyohara 	lv = (hci_read_local_ver_rp *)(e + 1);
    785   1.1  kiyohara 	revision = le16toh(lv->hci_revision);
    786   1.1  kiyohara 	opcode = htole16(HCI_CMD_RESET);
    787   1.1  kiyohara 	for (i = 0; suffix[i] != NULL; i++) {
    788   1.1  kiyohara 		/* send firmware */
    789   1.1  kiyohara 		snprintf(filename, sizeof(filename), filenametmpl,
    790   1.1  kiyohara 		    (uint8_t)(revision >> 8), (uint8_t)revision, suffix[i]);
    791   1.1  kiyohara 		bth4_firmload(sc, filename, firmload_stlc2500);
    792   1.1  kiyohara 
    793   1.1  kiyohara 		p = mtod(m, hci_cmd_hdr_t *);
    794   1.1  kiyohara 		p->type = HCI_CMD_PKT;
    795   1.1  kiyohara 		p->opcode = opcode;
    796   1.1  kiyohara 		p->length = 0;
    797   1.1  kiyohara 		m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    798   1.1  kiyohara 
    799  1.14    plunky 		bth4_output_cmd(sc->sc_dev, m);
    800   1.1  kiyohara 
    801   1.1  kiyohara 		error = bth4_waitresp(sc, &m, opcode);
    802   1.1  kiyohara 		if (m != NULL) {
    803   1.1  kiyohara 			if (error != 0) {
    804  1.13    plunky 				aprint_error_dev(sc->sc_dev,
    805  1.13    plunky 				    "HCI_Reset (%d) failed: Status 0x%02x\n",
    806  1.13    plunky 				    i, error);
    807   1.1  kiyohara 				error = EFAULT;
    808   1.1  kiyohara 				m_freem(m);
    809   1.1  kiyohara 			}
    810   1.1  kiyohara 		}
    811   1.1  kiyohara 		if (error != 0)
    812   1.1  kiyohara 			return error;
    813   1.1  kiyohara 	}
    814   1.1  kiyohara 
    815   1.1  kiyohara 	/* XXXX: We will obtain the character string.  But I don't know... */
    816   1.1  kiyohara 	p = mtod(m, hci_cmd_hdr_t *);
    817   1.1  kiyohara 	opcode = htole16(0xfc0f);		/* XXXXX ?? */
    818   1.1  kiyohara 	p->type = HCI_CMD_PKT;
    819   1.1  kiyohara 	p->opcode = opcode;
    820   1.1  kiyohara 	p->length = 0;
    821   1.1  kiyohara 	m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    822   1.1  kiyohara 
    823  1.14    plunky 	bth4_output_cmd(sc->sc_dev, m);
    824   1.1  kiyohara 
    825   1.1  kiyohara 	error = bth4_waitresp(sc, &m, opcode);
    826   1.1  kiyohara 	if (m != NULL) {
    827   1.1  kiyohara 		if (error != 0) {
    828  1.13    plunky 			aprint_error_dev(sc->sc_dev,
    829  1.13    plunky 			    "failed: opcode 0xfc0f Status 0x%02x\n", error);
    830   1.1  kiyohara 			error = EFAULT;
    831   1.1  kiyohara 			m_freem(m);
    832   1.1  kiyohara 		}
    833   1.1  kiyohara 	}
    834   1.1  kiyohara 	if (error != 0)
    835   1.1  kiyohara 		return error;
    836   1.1  kiyohara 	/*
    837   1.1  kiyohara 	 * XXXX:
    838   1.1  kiyohara 	 * We do not know the beginning point of this character string.
    839   1.5    plunky 	 * Because it doesn't know the event of this packet.
    840   1.1  kiyohara 	 *
    841  1.13    plunky 	 * aprint_error_dev(sc->sc_dev, "%s\n", ???);
    842   1.1  kiyohara 	 */
    843   1.1  kiyohara 
    844   1.1  kiyohara 	p = mtod(m, hci_cmd_hdr_t *);
    845   1.1  kiyohara 	opcode = htole16(0xfc22);		/* XXXXX ?? */
    846   1.1  kiyohara 	p->type = HCI_CMD_PKT;
    847   1.1  kiyohara 	p->opcode = opcode;
    848   1.1  kiyohara 	p->length = sizeof(param);
    849   1.1  kiyohara 	m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    850   1.1  kiyohara 
    851   1.1  kiyohara 	/* XXXX */
    852   1.1  kiyohara 	param[0] = 0xfe;
    853   1.1  kiyohara 	param[1] = 0x06;
    854   1.1  kiyohara 	param[2] = 0xba;
    855   1.1  kiyohara 	param[3] = 0xab;
    856   1.1  kiyohara 	param[4] = 0x00;
    857   1.1  kiyohara 	param[5] = 0xe1;
    858   1.1  kiyohara 	param[6] = 0x80;
    859   1.1  kiyohara 	param[7] = 0x00;
    860   1.1  kiyohara 	m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, param);
    861   1.1  kiyohara 
    862  1.14    plunky 	bth4_output_cmd(sc->sc_dev, m);
    863   1.1  kiyohara 
    864   1.1  kiyohara 	error = bth4_waitresp(sc, &m, opcode);
    865   1.1  kiyohara 	if (m != NULL) {
    866   1.1  kiyohara 		if (error != 0) {
    867  1.13    plunky 			aprint_error_dev(sc->sc_dev,
    868  1.13    plunky 			    "failed: opcode 0xfc0f Status 0x%02x\n", error);
    869   1.1  kiyohara 			error = EFAULT;
    870   1.1  kiyohara 			m_freem(m);
    871   1.1  kiyohara 		}
    872   1.1  kiyohara 	}
    873   1.1  kiyohara 	if (error != 0)
    874   1.1  kiyohara 		return error;
    875   1.1  kiyohara 
    876   1.1  kiyohara 	opcode = htole16(HCI_CMD_RESET);
    877   1.1  kiyohara 	p = mtod(m, hci_cmd_hdr_t *);
    878   1.1  kiyohara 	p->type = HCI_CMD_PKT;
    879   1.1  kiyohara 	p->opcode = opcode;
    880   1.1  kiyohara 	p->length = 0;
    881   1.1  kiyohara 	m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    882   1.1  kiyohara 
    883  1.14    plunky 	bth4_output_cmd(sc->sc_dev, m);
    884   1.1  kiyohara 
    885   1.1  kiyohara 	error = bth4_waitresp(sc, &m, opcode);
    886   1.1  kiyohara 	if (m != NULL) {
    887   1.1  kiyohara 		if (error != 0) {
    888  1.13    plunky 			aprint_error_dev(sc->sc_dev,
    889  1.13    plunky 			    "HCI_Reset failed: Status 0x%02x\n", error);
    890   1.1  kiyohara 			error = EFAULT;
    891   1.1  kiyohara 			m_freem(m);
    892   1.1  kiyohara 		}
    893   1.1  kiyohara 	}
    894   1.1  kiyohara 
    895   1.1  kiyohara 	return error;
    896   1.1  kiyohara }
    897   1.1  kiyohara 
    898   1.1  kiyohara static int
    899   1.1  kiyohara init_bcm2035(struct btuart_softc *sc)
    900   1.1  kiyohara {
    901   1.1  kiyohara 	struct mbuf *m;
    902   1.1  kiyohara 	hci_cmd_hdr_t *p;
    903   1.1  kiyohara 	int i, error;
    904   1.1  kiyohara #define HCI_CMD_BCM2035_SET_UART_BAUD_RATE	0xfc18	/* XXXX */
    905   1.1  kiyohara 	const uint16_t opcode = htole16(HCI_CMD_BCM2035_SET_UART_BAUD_RATE);
    906   1.1  kiyohara 	static struct {			/* XXXX */
    907   1.1  kiyohara 		int baud;
    908   1.1  kiyohara 		uint16_t param;
    909   1.1  kiyohara 	} bcm2035_baudtbl[] = {
    910   1.1  kiyohara 		{  B57600, 0xe600 },
    911   1.1  kiyohara 		{ B230400, 0xfa22 },
    912   1.1  kiyohara 		{ B460800, 0xfd11 },
    913   1.1  kiyohara 		{ B921600, 0xff65 },
    914   1.1  kiyohara 		{      B0, 0xffff }
    915   1.1  kiyohara 	};
    916   1.1  kiyohara 
    917   1.1  kiyohara 	for (i = 0; bcm2035_baudtbl[i].baud != sc->sc_baud; i++)
    918   1.1  kiyohara 		if (bcm2035_baudtbl[i].baud == -1)
    919   1.1  kiyohara 			return EINVAL;
    920   1.1  kiyohara 
    921   1.1  kiyohara 	m = m_gethdr(M_WAIT, MT_DATA);
    922   1.1  kiyohara 
    923   1.1  kiyohara 	/*
    924   1.1  kiyohara 	 * XXXX: Should we send some commands?
    925   1.1  kiyohara 	 *         HCI_CMD_RESET and HCI_CMD_READ_LOCAL_VER and
    926   1.1  kiyohara 	 *         HCI_CMD_READ_LOCAL_COMMANDS
    927   1.1  kiyohara 	 */
    928   1.1  kiyohara 
    929   1.1  kiyohara 	p = mtod(m, hci_cmd_hdr_t *);
    930   1.1  kiyohara 	p->type = HCI_CMD_PKT;
    931   1.1  kiyohara 	p->opcode = opcode;
    932   1.1  kiyohara 	p->length = sizeof(bcm2035_baudtbl[0].param);
    933   1.1  kiyohara 	m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t);
    934   1.1  kiyohara 	m_copyback(m, sizeof(hci_cmd_hdr_t), p->length,
    935   1.1  kiyohara 	    &bcm2035_baudtbl[i].param);
    936   1.1  kiyohara 
    937  1.14    plunky 	bth4_output_cmd(sc->sc_dev, m);
    938   1.1  kiyohara 
    939   1.1  kiyohara 	error = bth4_waitresp(sc, &m, opcode);
    940   1.1  kiyohara 	if (m != NULL) {
    941   1.1  kiyohara 		if (error != 0) {
    942  1.13    plunky 			aprint_error_dev(sc->sc_dev,
    943  1.13    plunky 			    "bcm2035 set baud rate failed: Status 0x%02x\n",
    944  1.13    plunky 			    error);
    945   1.1  kiyohara 			error = EFAULT;
    946   1.1  kiyohara 		}
    947   1.1  kiyohara 		m_freem(m);
    948   1.1  kiyohara 	}
    949   1.1  kiyohara 
    950   1.1  kiyohara 	return error;
    951   1.1  kiyohara }
    952   1.1  kiyohara 
    953   1.1  kiyohara static int
    954   1.1  kiyohara bth4init(struct btuart_softc *sc)
    955   1.1  kiyohara {
    956   1.1  kiyohara 	struct tty *tp = sc->sc_tp;
    957   1.1  kiyohara 	struct termios t;
    958   1.1  kiyohara 	int error = 0, s;
    959   1.1  kiyohara 
    960   1.1  kiyohara 	sc->sc_baud = tp->t_ospeed;
    961   1.1  kiyohara 	t.c_cflag = tp->t_cflag;
    962   1.1  kiyohara 	t.c_ispeed = 0;
    963   1.1  kiyohara 	t.c_ospeed = tp->t_ospeed;
    964   1.1  kiyohara 	if ((tp->t_cflag & CRTSCTS) && !(sc->sc_bth4hci.flags & FLOW_CTL))
    965   1.1  kiyohara 		t.c_cflag &= ~CRTSCTS;
    966   1.1  kiyohara 	if (sc->sc_bth4hci.init_baud != 0 &&
    967   1.1  kiyohara 	    tp->t_ospeed != sc->sc_bth4hci.init_baud)
    968   1.1  kiyohara 		t.c_ospeed = sc->sc_bth4hci.init_baud;
    969   1.1  kiyohara 	if (t.c_ospeed != tp->t_ospeed || t.c_cflag != tp->t_cflag)
    970   1.1  kiyohara 		error = (*tp->t_param)(tp, &t);
    971   1.1  kiyohara 
    972   1.1  kiyohara 	if (error == 0 && sc->sc_bth4hci.init != NULL)
    973   1.1  kiyohara 		error = (*sc->sc_bth4hci.init)(sc);
    974   1.1  kiyohara 
    975   1.1  kiyohara 	s = splserial();
    976   1.1  kiyohara 	sc->sc_input_acl = hci_input_acl;
    977   1.1  kiyohara 	sc->sc_input_sco = hci_input_sco;
    978   1.1  kiyohara 	sc->sc_input_event = hci_input_event;
    979   1.1  kiyohara 	splx(s);
    980   1.1  kiyohara 
    981   1.1  kiyohara 	if (sc->sc_bth4hci.init_baud != 0 &&
    982   1.1  kiyohara 	    sc->sc_bth4hci.init_baud != sc->sc_baud) {
    983   1.1  kiyohara 		t.c_ospeed = sc->sc_baud;
    984   1.1  kiyohara 		t.c_cflag = tp->t_cflag;
    985   1.1  kiyohara 		error = (*tp->t_param)(tp, &t);
    986   1.1  kiyohara 	}
    987   1.1  kiyohara 
    988   1.1  kiyohara 	return error;
    989   1.1  kiyohara }
    990   1.1  kiyohara 
    991  1.14    plunky static bool
    992   1.1  kiyohara bth4init_input(struct hci_unit *unit, struct mbuf *m)
    993   1.1  kiyohara {
    994   1.1  kiyohara 	int i;
    995   1.1  kiyohara 	uint8_t *rptr =  mtod(m, uint8_t *);
    996   1.1  kiyohara 	const char *pktstr = NULL;
    997   1.1  kiyohara 
    998   1.1  kiyohara 	switch (*rptr) {
    999   1.1  kiyohara 	case HCI_ACL_DATA_PKT:
   1000   1.1  kiyohara 		pktstr = "acl data";
   1001   1.1  kiyohara 		break;
   1002   1.1  kiyohara 
   1003   1.1  kiyohara 	case HCI_SCO_DATA_PKT:
   1004   1.1  kiyohara 		pktstr = "sco data";
   1005   1.1  kiyohara 		break;
   1006   1.1  kiyohara 
   1007   1.1  kiyohara 	case HCI_EVENT_PKT:
   1008   1.1  kiyohara 		break;
   1009   1.1  kiyohara 
   1010   1.1  kiyohara 	default:
   1011   1.1  kiyohara 		pktstr = "unknown";
   1012   1.1  kiyohara 		break;
   1013   1.1  kiyohara 	}
   1014   1.1  kiyohara 	if (pktstr != NULL)
   1015  1.12    plunky 		aprint_error_dev(unit->hci_dev,
   1016  1.12    plunky 		    "%s packet was received in initialization phase\n", pktstr);
   1017   1.1  kiyohara 	if (
   1018   1.1  kiyohara #ifdef BTUART_DEBUG
   1019   1.1  kiyohara 	    btuart_debug ||
   1020   1.1  kiyohara #endif
   1021   1.1  kiyohara 	    pktstr != NULL) {
   1022  1.12    plunky 		aprint_error_dev(unit->hci_dev, "%s:", __FUNCTION__);
   1023   1.1  kiyohara 		for (i = 0; i < m->m_len; i++)
   1024  1.13    plunky 			aprint_error(" %02x", *(rptr + i));
   1025  1.13    plunky 		aprint_error("\n");
   1026   1.1  kiyohara 	}
   1027   1.1  kiyohara 
   1028   1.1  kiyohara 	if (*rptr == HCI_EVENT_PKT)
   1029   1.1  kiyohara 		if (unit->hci_eventqlen <= hci_eventq_max) {
   1030   1.1  kiyohara 			unit->hci_eventqlen++;
   1031   1.1  kiyohara 			MBUFQ_ENQUEUE(&unit->hci_eventq, m);
   1032   1.1  kiyohara 			m = NULL;
   1033   1.1  kiyohara 			wakeup(&unit->hci_eventq);
   1034   1.1  kiyohara 		}
   1035   1.1  kiyohara 
   1036   1.1  kiyohara 	if (m != NULL)
   1037   1.1  kiyohara 		m_freem(m);
   1038  1.14    plunky 
   1039  1.14    plunky 	return true;
   1040   1.1  kiyohara }
   1041   1.1  kiyohara 
   1042   1.1  kiyohara 
   1043   1.1  kiyohara /*
   1044   1.1  kiyohara  * Line discipline functions.
   1045   1.1  kiyohara  */
   1046   1.1  kiyohara /* ARGSUSED */
   1047   1.1  kiyohara static int
   1048   1.1  kiyohara bth4open(dev_t device __unused, struct tty *tp)
   1049   1.1  kiyohara {
   1050   1.1  kiyohara 	struct btuart_softc *sc;
   1051   1.1  kiyohara 	struct cfdata *cfdata;
   1052   1.1  kiyohara 	struct lwp *l = curlwp;		/* XXX */
   1053   1.1  kiyohara 	int error, unit, s;
   1054   1.1  kiyohara 	static char name[] = "btuart";
   1055   1.1  kiyohara 
   1056   1.1  kiyohara 	if ((error = kauth_authorize_device_tty(l->l_cred,
   1057   1.4  kiyohara 	    KAUTH_GENERIC_ISSUSER, tp)) != 0)
   1058   1.1  kiyohara 		return error;
   1059   1.1  kiyohara 
   1060   1.1  kiyohara 	s = spltty();
   1061   1.1  kiyohara 
   1062   1.1  kiyohara 	if (tp->t_linesw == &bth4_disc) {
   1063   1.1  kiyohara 		sc = (struct btuart_softc *)tp->t_sc;
   1064   1.1  kiyohara 		if (sc != NULL) {
   1065   1.1  kiyohara 			splx(s);
   1066   1.1  kiyohara 			return EBUSY;
   1067   1.1  kiyohara 		}
   1068   1.1  kiyohara 	}
   1069   1.1  kiyohara 
   1070   1.1  kiyohara 	KASSERT(tp->t_oproc != NULL);
   1071   1.1  kiyohara 
   1072   1.1  kiyohara 	cfdata = malloc(sizeof(struct cfdata), M_DEVBUF, M_WAITOK);
   1073   1.1  kiyohara 	for (unit = 0; unit < btuart_cd.cd_ndevs; unit++)
   1074   1.1  kiyohara 		if (btuart_cd.cd_devs[unit] == NULL)
   1075   1.1  kiyohara 			break;
   1076   1.1  kiyohara 	cfdata->cf_name = name;
   1077   1.1  kiyohara 	cfdata->cf_atname = name;
   1078   1.1  kiyohara 	cfdata->cf_unit = unit;
   1079   1.3    plunky 	cfdata->cf_fstate = FSTATE_STAR;
   1080   1.1  kiyohara 
   1081  1.13    plunky 	aprint_normal("%s%d at tty major %d minor %d",
   1082   1.1  kiyohara 	    name, unit, major(tp->t_dev), minor(tp->t_dev));
   1083   1.1  kiyohara 	sc = (struct btuart_softc *)config_attach_pseudo(cfdata);
   1084   1.1  kiyohara 	if (sc == NULL) {
   1085   1.1  kiyohara 		splx(s);
   1086   1.1  kiyohara 		return EIO;
   1087   1.1  kiyohara 	}
   1088  1.11        ad 	mutex_spin_enter(&tty_lock);
   1089   1.1  kiyohara 	tp->t_sc = sc;
   1090   1.1  kiyohara 	sc->sc_tp = tp;
   1091   1.1  kiyohara 	ttyflush(tp, FREAD | FWRITE);
   1092  1.11        ad 	mutex_spin_exit(&tty_lock);
   1093   1.1  kiyohara 
   1094   1.1  kiyohara 	splx(s);
   1095   1.1  kiyohara 
   1096   1.1  kiyohara 	return 0;
   1097   1.1  kiyohara }
   1098   1.1  kiyohara 
   1099   1.1  kiyohara /* ARGSUSED */
   1100   1.1  kiyohara static int
   1101   1.1  kiyohara bth4close(struct tty *tp, int flag __unused)
   1102   1.1  kiyohara {
   1103   1.1  kiyohara 	struct btuart_softc *sc;
   1104   1.1  kiyohara 	struct cfdata *cfdata;
   1105   1.1  kiyohara 	int s, baud;
   1106   1.1  kiyohara 
   1107   1.1  kiyohara 	sc = tp->t_sc;
   1108   1.1  kiyohara 
   1109   1.1  kiyohara 	/* reset to initial speed */
   1110   1.1  kiyohara 	if (sc->sc_bth4hci.init != NULL) {
   1111   1.1  kiyohara 		baud = sc->sc_baud;
   1112   1.1  kiyohara 		sc->sc_baud = sc->sc_bth4hci.init_baud;
   1113   1.1  kiyohara 		sc->sc_bth4hci.init_baud = baud;
   1114   1.1  kiyohara 		s = splserial();
   1115   1.1  kiyohara 		sc->sc_input_acl = bth4init_input;
   1116   1.1  kiyohara 		sc->sc_input_sco = bth4init_input;
   1117   1.1  kiyohara 		sc->sc_input_event = bth4init_input;
   1118   1.1  kiyohara 		splx(s);
   1119   1.1  kiyohara 		if ((*sc->sc_bth4hci.init)(sc) != 0)
   1120  1.13    plunky 			aprint_error_dev(sc->sc_dev, "reset speed fail\n");
   1121   1.1  kiyohara 	}
   1122   1.1  kiyohara 
   1123   1.1  kiyohara 	s = spltty();
   1124  1.11        ad 	mutex_spin_enter(&tty_lock);
   1125   1.1  kiyohara 	ttyflush(tp, FREAD | FWRITE);
   1126  1.11        ad 	mutex_spin_exit(&tty_lock);	/* XXX */
   1127   1.1  kiyohara 	ttyldisc_release(tp->t_linesw);
   1128   1.1  kiyohara 	tp->t_linesw = ttyldisc_default();
   1129   1.1  kiyohara 	if (sc != NULL) {
   1130   1.1  kiyohara 		tp->t_sc = NULL;
   1131   1.1  kiyohara 		if (sc->sc_tp == tp) {
   1132  1.10    plunky 			cfdata = device_cfdata(sc->sc_dev);
   1133  1.10    plunky 			config_detach(sc->sc_dev, 0);
   1134   1.1  kiyohara 			free(cfdata, M_DEVBUF);
   1135   1.1  kiyohara 		}
   1136   1.1  kiyohara 
   1137   1.1  kiyohara 	}
   1138   1.1  kiyohara 	splx(s);
   1139   1.1  kiyohara 	return 0;
   1140   1.1  kiyohara }
   1141   1.1  kiyohara 
   1142   1.1  kiyohara /* ARGSUSED */
   1143   1.1  kiyohara static int
   1144   1.2  christos bth4ioctl(struct tty *tp, u_long cmd, void *data,
   1145   1.1  kiyohara     int flag __unused, struct lwp *l __unused)
   1146   1.1  kiyohara {
   1147   1.1  kiyohara 	struct btuart_softc *sc = (struct btuart_softc *)tp->t_sc;
   1148   1.1  kiyohara 	int error, i;
   1149   1.1  kiyohara 
   1150   1.1  kiyohara 	if (sc == NULL || tp != sc->sc_tp)
   1151   1.1  kiyohara 		return EPASSTHROUGH;
   1152   1.1  kiyohara 
   1153   1.1  kiyohara 	error = 0;
   1154   1.1  kiyohara 	switch (cmd) {
   1155   1.1  kiyohara 	case BTUART_HCITYPE:
   1156   1.1  kiyohara 		for (i = 0; bth4hci[i].type != -1; i++)
   1157   1.1  kiyohara 			if (bth4hci[i].type == *(uint32_t *)data)
   1158   1.1  kiyohara 				break;
   1159   1.1  kiyohara 		if (bth4hci[i].type != -1)
   1160   1.1  kiyohara 			memcpy(&sc->sc_bth4hci, &bth4hci[i],
   1161   1.1  kiyohara 			    sizeof(struct bth4hci));
   1162   1.1  kiyohara 		else
   1163   1.1  kiyohara 			error = EINVAL;
   1164   1.1  kiyohara 		break;
   1165   1.1  kiyohara 
   1166   1.1  kiyohara 	case BTUART_INITSPEED:
   1167   1.1  kiyohara 		sc->sc_bth4hci.init_baud = *(uint32_t *)data;
   1168   1.1  kiyohara 		break;
   1169   1.1  kiyohara 
   1170   1.1  kiyohara 	case BTUART_START:
   1171   1.1  kiyohara 		error = bth4init(sc);
   1172   1.1  kiyohara 		break;
   1173   1.1  kiyohara 
   1174   1.1  kiyohara 	default:
   1175   1.1  kiyohara 		error = EPASSTHROUGH;
   1176   1.1  kiyohara 		break;
   1177   1.1  kiyohara 	}
   1178   1.1  kiyohara 
   1179   1.1  kiyohara 	return error;
   1180   1.1  kiyohara }
   1181   1.1  kiyohara 
   1182   1.1  kiyohara static int
   1183   1.1  kiyohara bth4input(int c, struct tty *tp)
   1184   1.1  kiyohara {
   1185   1.1  kiyohara 	struct btuart_softc *sc = (struct btuart_softc *)tp->t_sc;
   1186   1.1  kiyohara 	struct mbuf *m = sc->sc_rxp;
   1187   1.1  kiyohara 	int space = 0;
   1188   1.1  kiyohara 
   1189   1.1  kiyohara 	c &= TTY_CHARMASK;
   1190   1.1  kiyohara 
   1191   1.1  kiyohara 	/* If we already started a packet, find the trailing end of it. */
   1192   1.1  kiyohara 	if (m) {
   1193   1.1  kiyohara 		while (m->m_next)
   1194   1.1  kiyohara 			m = m->m_next;
   1195   1.1  kiyohara 
   1196   1.1  kiyohara 		space = M_TRAILINGSPACE(m);
   1197   1.1  kiyohara 	}
   1198   1.1  kiyohara 
   1199   1.1  kiyohara 	if (space == 0) {
   1200   1.1  kiyohara 		if (m == NULL) {
   1201   1.1  kiyohara 			/* new packet */
   1202   1.1  kiyohara 			MGETHDR(m, M_DONTWAIT, MT_DATA);
   1203   1.1  kiyohara 			if (m == NULL) {
   1204  1.13    plunky 				aprint_error_dev(sc->sc_dev,
   1205  1.13    plunky 				    "out of memory\n");
   1206  1.14    plunky 				sc->sc_stats.err_rx++;
   1207   1.1  kiyohara 				return 0;	/* (lost sync) */
   1208   1.1  kiyohara 			}
   1209   1.1  kiyohara 
   1210   1.1  kiyohara 			sc->sc_rxp = m;
   1211   1.1  kiyohara 			m->m_pkthdr.len = m->m_len = 0;
   1212   1.1  kiyohara 			space = MHLEN;
   1213   1.1  kiyohara 
   1214   1.1  kiyohara 			sc->sc_state = BTUART_RECV_PKT_TYPE;
   1215   1.1  kiyohara 			sc->sc_want = 1;
   1216   1.1  kiyohara 		} else {
   1217   1.1  kiyohara 			/* extend mbuf */
   1218   1.1  kiyohara 			MGET(m->m_next, M_DONTWAIT, MT_DATA);
   1219   1.1  kiyohara 			if (m->m_next == NULL) {
   1220  1.13    plunky 				aprint_error_dev(sc->sc_dev,
   1221  1.13    plunky 				    "out of memory\n");
   1222  1.14    plunky 				sc->sc_stats.err_rx++;
   1223   1.1  kiyohara 				return 0;	/* (lost sync) */
   1224   1.1  kiyohara 			}
   1225   1.1  kiyohara 
   1226   1.1  kiyohara 			m = m->m_next;
   1227   1.1  kiyohara 			m->m_len = 0;
   1228   1.1  kiyohara 			space = MLEN;
   1229   1.1  kiyohara 
   1230   1.1  kiyohara 			if (sc->sc_want > MINCLSIZE) {
   1231   1.1  kiyohara 				MCLGET(m, M_DONTWAIT);
   1232   1.1  kiyohara 				if (m->m_flags & M_EXT)
   1233   1.1  kiyohara 					space = MCLBYTES;
   1234   1.1  kiyohara 			}
   1235   1.1  kiyohara 		}
   1236   1.1  kiyohara 	}
   1237   1.1  kiyohara 
   1238   1.1  kiyohara 	mtod(m, uint8_t *)[m->m_len++] = c;
   1239   1.1  kiyohara 	sc->sc_rxp->m_pkthdr.len++;
   1240  1.14    plunky 	sc->sc_stats.byte_rx++;
   1241   1.1  kiyohara 
   1242   1.1  kiyohara 	sc->sc_want--;
   1243   1.1  kiyohara 	if (sc->sc_want > 0)
   1244   1.1  kiyohara 		return 0;	/* want more */
   1245   1.1  kiyohara 
   1246   1.1  kiyohara 	switch (sc->sc_state) {
   1247   1.1  kiyohara 	case BTUART_RECV_PKT_TYPE:	/* Got packet type */
   1248   1.1  kiyohara 
   1249   1.1  kiyohara 		switch (c) {
   1250   1.1  kiyohara 		case HCI_ACL_DATA_PKT:
   1251   1.1  kiyohara 			sc->sc_state = BTUART_RECV_ACL_HDR;
   1252   1.1  kiyohara 			sc->sc_want = sizeof(hci_acldata_hdr_t) - 1;
   1253   1.1  kiyohara 			break;
   1254   1.1  kiyohara 
   1255   1.1  kiyohara 		case HCI_SCO_DATA_PKT:
   1256   1.1  kiyohara 			sc->sc_state = BTUART_RECV_SCO_HDR;
   1257   1.1  kiyohara 			sc->sc_want = sizeof(hci_scodata_hdr_t) - 1;
   1258   1.1  kiyohara 			break;
   1259   1.1  kiyohara 
   1260   1.1  kiyohara 		case HCI_EVENT_PKT:
   1261   1.1  kiyohara 			sc->sc_state = BTUART_RECV_EVENT_HDR;
   1262   1.1  kiyohara 			sc->sc_want = sizeof(hci_event_hdr_t) - 1;
   1263   1.1  kiyohara 			break;
   1264   1.1  kiyohara 
   1265   1.1  kiyohara 		default:
   1266  1.13    plunky 			aprint_error_dev(sc->sc_dev,
   1267  1.13    plunky 			    "Unknown packet type=%#x!\n", c);
   1268  1.14    plunky 			sc->sc_stats.err_rx++;
   1269   1.1  kiyohara 			m_freem(sc->sc_rxp);
   1270   1.1  kiyohara 			sc->sc_rxp = NULL;
   1271   1.1  kiyohara 			return 0;	/* (lost sync) */
   1272   1.1  kiyohara 		}
   1273   1.1  kiyohara 
   1274   1.1  kiyohara 		break;
   1275   1.1  kiyohara 
   1276   1.1  kiyohara 	/*
   1277   1.1  kiyohara 	 * we assume (correctly of course :) that the packet headers all fit
   1278   1.1  kiyohara 	 * into a single pkthdr mbuf
   1279   1.1  kiyohara 	 */
   1280   1.1  kiyohara 	case BTUART_RECV_ACL_HDR:	/* Got ACL Header */
   1281   1.1  kiyohara 		sc->sc_state = BTUART_RECV_ACL_DATA;
   1282   1.1  kiyohara 		sc->sc_want = mtod(m, hci_acldata_hdr_t *)->length;
   1283   1.1  kiyohara 		sc->sc_want = le16toh(sc->sc_want);
   1284   1.1  kiyohara 		break;
   1285   1.1  kiyohara 
   1286   1.1  kiyohara 	case BTUART_RECV_SCO_HDR:	/* Got SCO Header */
   1287   1.1  kiyohara 		sc->sc_state = BTUART_RECV_SCO_DATA;
   1288   1.1  kiyohara 		sc->sc_want =  mtod(m, hci_scodata_hdr_t *)->length;
   1289   1.1  kiyohara 		break;
   1290   1.1  kiyohara 
   1291   1.1  kiyohara 	case BTUART_RECV_EVENT_HDR:	/* Got Event Header */
   1292   1.1  kiyohara 		sc->sc_state = BTUART_RECV_EVENT_DATA;
   1293   1.1  kiyohara 		sc->sc_want =  mtod(m, hci_event_hdr_t *)->length;
   1294   1.1  kiyohara 		break;
   1295   1.1  kiyohara 
   1296   1.1  kiyohara 	case BTUART_RECV_ACL_DATA:	/* ACL Packet Complete */
   1297  1.14    plunky 		if (!(*sc->sc_input_acl)(sc->sc_unit, sc->sc_rxp))
   1298  1.14    plunky 			sc->sc_stats.err_rx++;
   1299  1.14    plunky 
   1300  1.14    plunky 		sc->sc_stats.acl_rx++;
   1301   1.1  kiyohara 		sc->sc_rxp = m = NULL;
   1302   1.1  kiyohara 		break;
   1303   1.1  kiyohara 
   1304   1.1  kiyohara 	case BTUART_RECV_SCO_DATA:	/* SCO Packet Complete */
   1305  1.14    plunky 		if (!(*sc->sc_input_sco)(sc->sc_unit, sc->sc_rxp))
   1306  1.14    plunky 			sc->sc_stats.err_rx++;
   1307  1.14    plunky 
   1308  1.14    plunky 		sc->sc_stats.sco_rx++;
   1309   1.1  kiyohara 		sc->sc_rxp = m = NULL;
   1310   1.1  kiyohara 		break;
   1311   1.1  kiyohara 
   1312   1.1  kiyohara 	case BTUART_RECV_EVENT_DATA:	/* Event Packet Complete */
   1313  1.14    plunky 		if (!(*sc->sc_input_event)(sc->sc_unit, sc->sc_rxp))
   1314  1.14    plunky 			sc->sc_stats.err_rx++;
   1315  1.14    plunky 
   1316  1.14    plunky 		sc->sc_stats.evt_rx++;
   1317   1.1  kiyohara 		sc->sc_rxp = m = NULL;
   1318   1.1  kiyohara 		break;
   1319   1.1  kiyohara 
   1320   1.1  kiyohara 	default:
   1321   1.1  kiyohara 		panic("%s: invalid state %d!\n",
   1322  1.10    plunky 		    device_xname(sc->sc_dev), sc->sc_state);
   1323   1.1  kiyohara 	}
   1324   1.1  kiyohara 
   1325   1.1  kiyohara 	return 0;
   1326   1.1  kiyohara }
   1327   1.1  kiyohara 
   1328   1.1  kiyohara static int
   1329   1.1  kiyohara bth4start(struct tty *tp)
   1330   1.1  kiyohara {
   1331   1.1  kiyohara 	struct btuart_softc *sc = (struct btuart_softc *)tp->t_sc;
   1332   1.1  kiyohara 	struct mbuf *m;
   1333   1.1  kiyohara 	int count, rlen;
   1334   1.1  kiyohara 	uint8_t *rptr;
   1335   1.1  kiyohara 
   1336   1.1  kiyohara 	m = sc->sc_txp;
   1337   1.1  kiyohara 	if (m == NULL) {
   1338  1.14    plunky 		sc->sc_flags &= ~BTUART_XMIT;
   1339  1.14    plunky 		bth4_start(sc);
   1340   1.1  kiyohara 		return 0;
   1341   1.1  kiyohara 	}
   1342   1.1  kiyohara 
   1343   1.1  kiyohara 	count = 0;
   1344   1.1  kiyohara 	rlen = 0;
   1345   1.1  kiyohara 	rptr = mtod(m, uint8_t *);
   1346   1.1  kiyohara 
   1347   1.1  kiyohara 	for(;;) {
   1348   1.1  kiyohara 		if (rlen >= m->m_len) {
   1349   1.1  kiyohara 			m = m->m_next;
   1350   1.1  kiyohara 			if (m == NULL) {
   1351   1.1  kiyohara 				m = sc->sc_txp;
   1352   1.1  kiyohara 				sc->sc_txp = NULL;
   1353   1.1  kiyohara 
   1354   1.1  kiyohara 				if (M_GETCTX(m, void *) == NULL)
   1355   1.1  kiyohara 					m_freem(m);
   1356  1.14    plunky 				else if (!hci_complete_sco(sc->sc_unit, m))
   1357  1.14    plunky 					sc->sc_stats.err_tx++;
   1358   1.1  kiyohara 
   1359   1.1  kiyohara 				break;
   1360   1.1  kiyohara 			}
   1361   1.1  kiyohara 
   1362   1.1  kiyohara 			rlen = 0;
   1363   1.1  kiyohara 			rptr = mtod(m, uint8_t *);
   1364   1.1  kiyohara 			continue;
   1365   1.1  kiyohara 		}
   1366   1.1  kiyohara 
   1367   1.1  kiyohara 		if (putc(*rptr++, &tp->t_outq) < 0) {
   1368   1.1  kiyohara 			m_adj(m, rlen);
   1369   1.1  kiyohara 			break;
   1370   1.1  kiyohara 		}
   1371   1.1  kiyohara 		rlen++;
   1372   1.1  kiyohara 		count++;
   1373   1.1  kiyohara 	}
   1374   1.1  kiyohara 
   1375  1.14    plunky 	sc->sc_stats.byte_tx += count;
   1376   1.1  kiyohara 
   1377   1.1  kiyohara 	if (tp->t_outq.c_cc != 0)
   1378   1.1  kiyohara 		(*tp->t_oproc)(tp);
   1379   1.1  kiyohara 
   1380   1.1  kiyohara 	return 0;
   1381   1.1  kiyohara }
   1382   1.1  kiyohara 
   1383   1.1  kiyohara 
   1384   1.1  kiyohara /*
   1385   1.1  kiyohara  * HCI UART (H4) functions.
   1386   1.1  kiyohara  */
   1387   1.1  kiyohara static int
   1388  1.12    plunky bth4_enable(device_t self)
   1389   1.1  kiyohara {
   1390  1.12    plunky 	struct btuart_softc *sc = device_private(self);
   1391  1.14    plunky 	int s;
   1392   1.1  kiyohara 
   1393  1.14    plunky 	if (sc->sc_flags & BTUART_ENABLED)
   1394   1.1  kiyohara 		return 0;
   1395   1.1  kiyohara 
   1396  1.14    plunky 	s = spltty();
   1397  1.14    plunky 
   1398  1.14    plunky 	sc->sc_flags |= BTUART_ENABLED;
   1399  1.14    plunky 	sc->sc_flags &= ~BTUART_XMIT;
   1400  1.14    plunky 
   1401  1.14    plunky 	splx(s);
   1402   1.1  kiyohara 
   1403   1.1  kiyohara 	return 0;
   1404   1.1  kiyohara }
   1405   1.1  kiyohara 
   1406   1.1  kiyohara static void
   1407  1.12    plunky bth4_disable(device_t self)
   1408   1.1  kiyohara {
   1409  1.12    plunky 	struct btuart_softc *sc = device_private(self);
   1410  1.14    plunky 	int s;
   1411   1.1  kiyohara 
   1412  1.14    plunky 	if ((sc->sc_flags & BTUART_ENABLED) == 0)
   1413   1.1  kiyohara 		return;
   1414   1.1  kiyohara 
   1415  1.14    plunky 	s = spltty();
   1416  1.14    plunky 
   1417   1.1  kiyohara 	if (sc->sc_rxp) {
   1418   1.1  kiyohara 		m_freem(sc->sc_rxp);
   1419   1.1  kiyohara 		sc->sc_rxp = NULL;
   1420   1.1  kiyohara 	}
   1421   1.1  kiyohara 
   1422   1.1  kiyohara 	if (sc->sc_txp) {
   1423   1.1  kiyohara 		m_freem(sc->sc_txp);
   1424   1.1  kiyohara 		sc->sc_txp = NULL;
   1425   1.1  kiyohara 	}
   1426   1.1  kiyohara 
   1427  1.14    plunky 	MBUFQ_DRAIN(&sc->sc_cmdq);
   1428  1.14    plunky 	MBUFQ_DRAIN(&sc->sc_aclq);
   1429  1.14    plunky 	MBUFQ_DRAIN(&sc->sc_scoq);
   1430  1.14    plunky 
   1431  1.14    plunky 	sc->sc_flags &= ~BTUART_ENABLED;
   1432  1.14    plunky 
   1433  1.14    plunky 	splx(s);
   1434   1.1  kiyohara }
   1435   1.1  kiyohara 
   1436   1.1  kiyohara static void
   1437  1.14    plunky bth4_start(struct btuart_softc *sc)
   1438   1.1  kiyohara {
   1439   1.1  kiyohara 	struct mbuf *m;
   1440   1.1  kiyohara 
   1441  1.14    plunky 	KASSERT((sc->sc_flags & BTUART_XMIT) == 0);
   1442   1.1  kiyohara 	KASSERT(sc->sc_txp == NULL);
   1443   1.1  kiyohara 
   1444  1.14    plunky 	if (MBUFQ_FIRST(&sc->sc_cmdq)) {
   1445  1.14    plunky 		MBUFQ_DEQUEUE(&sc->sc_cmdq, m);
   1446  1.14    plunky 		sc->sc_stats.cmd_tx++;
   1447   1.1  kiyohara 		goto start;
   1448   1.1  kiyohara 	}
   1449   1.1  kiyohara 
   1450  1.14    plunky 	if (MBUFQ_FIRST(&sc->sc_scoq)) {
   1451  1.14    plunky 		MBUFQ_DEQUEUE(&sc->sc_scoq, m);
   1452  1.14    plunky 		sc->sc_stats.sco_tx++;
   1453   1.1  kiyohara 		goto start;
   1454   1.1  kiyohara 	}
   1455   1.1  kiyohara 
   1456  1.14    plunky 	if (MBUFQ_FIRST(&sc->sc_aclq)) {
   1457  1.14    plunky 		MBUFQ_DEQUEUE(&sc->sc_aclq, m);
   1458  1.14    plunky 		sc->sc_stats.acl_tx++;
   1459   1.1  kiyohara 		goto start;
   1460   1.1  kiyohara 	}
   1461   1.1  kiyohara 
   1462   1.1  kiyohara 	/* Nothing to send */
   1463   1.1  kiyohara 	return;
   1464   1.1  kiyohara 
   1465   1.1  kiyohara start:
   1466   1.1  kiyohara 	sc->sc_txp = m;
   1467  1.14    plunky 	sc->sc_flags |= BTUART_XMIT;
   1468   1.1  kiyohara 	bth4start(sc->sc_tp);
   1469   1.1  kiyohara }
   1470  1.14    plunky 
   1471  1.14    plunky static void
   1472  1.14    plunky bth4_output_cmd(device_t self, struct mbuf *m)
   1473  1.14    plunky {
   1474  1.14    plunky 	struct btuart_softc *sc = device_private(self);
   1475  1.14    plunky 	int s;
   1476  1.14    plunky 
   1477  1.14    plunky 	KASSERT(sc->sc_flags & BTUART_ENABLED);
   1478  1.14    plunky 
   1479  1.14    plunky 	M_SETCTX(m, NULL);
   1480  1.14    plunky 
   1481  1.14    plunky 	s = spltty();
   1482  1.14    plunky 	MBUFQ_ENQUEUE(&sc->sc_cmdq, m);
   1483  1.14    plunky 	if ((sc->sc_flags & BTUART_XMIT) == 0)
   1484  1.14    plunky 		bth4_start(sc);
   1485  1.14    plunky 
   1486  1.14    plunky 	splx(s);
   1487  1.14    plunky }
   1488  1.14    plunky 
   1489  1.14    plunky static void
   1490  1.14    plunky bth4_output_acl(device_t self, struct mbuf *m)
   1491  1.14    plunky {
   1492  1.14    plunky 	struct btuart_softc *sc = device_private(self);
   1493  1.14    plunky 	int s;
   1494  1.14    plunky 
   1495  1.14    plunky 	KASSERT(sc->sc_flags & BTUART_ENABLED);
   1496  1.14    plunky 
   1497  1.14    plunky 	M_SETCTX(m, NULL);
   1498  1.14    plunky 
   1499  1.14    plunky 	s = spltty();
   1500  1.14    plunky 	MBUFQ_ENQUEUE(&sc->sc_aclq, m);
   1501  1.14    plunky 	if ((sc->sc_flags & BTUART_XMIT) == 0)
   1502  1.14    plunky 		bth4_start(sc);
   1503  1.14    plunky 
   1504  1.14    plunky 	splx(s);
   1505  1.14    plunky }
   1506  1.14    plunky 
   1507  1.14    plunky static void
   1508  1.14    plunky bth4_output_sco(device_t self, struct mbuf *m)
   1509  1.14    plunky {
   1510  1.14    plunky 	struct btuart_softc *sc = device_private(self);
   1511  1.14    plunky 	int s;
   1512  1.14    plunky 
   1513  1.14    plunky 	KASSERT(sc->sc_flags & BTUART_ENABLED);
   1514  1.14    plunky 
   1515  1.14    plunky 	s = spltty();
   1516  1.14    plunky 	MBUFQ_ENQUEUE(&sc->sc_scoq, m);
   1517  1.14    plunky 	if ((sc->sc_flags & BTUART_XMIT) == 0)
   1518  1.14    plunky 		bth4_start(sc);
   1519  1.14    plunky 
   1520  1.14    plunky 	splx(s);
   1521  1.14    plunky }
   1522  1.14    plunky 
   1523  1.14    plunky static void
   1524  1.14    plunky bth4_stats(device_t self, struct bt_stats *dest, int flush)
   1525  1.14    plunky {
   1526  1.14    plunky 	struct btuart_softc *sc = device_private(self);
   1527  1.14    plunky 	int s;
   1528  1.14    plunky 
   1529  1.14    plunky 	s = spltty();
   1530  1.14    plunky 
   1531  1.14    plunky 	memcpy(dest, &sc->sc_stats, sizeof(struct bt_stats));
   1532  1.14    plunky 
   1533  1.14    plunky 	if (flush)
   1534  1.14    plunky 		memset(&sc->sc_stats, 0, sizeof(struct bt_stats));
   1535  1.14    plunky 
   1536  1.14    plunky 	splx(s);
   1537  1.14    plunky }
   1538