Home | History | Annotate | Line # | Download | only in pcmcia
bt3c.c revision 1.1.2.6
      1  1.1.2.6  yamt /* $NetBSD: bt3c.c,v 1.1.2.6 2007/11/15 11:44:28 yamt Exp $ */
      2  1.1.2.2  yamt 
      3  1.1.2.2  yamt /*-
      4  1.1.2.2  yamt  * Copyright (c) 2005 Iain D. Hibbert,
      5  1.1.2.2  yamt  * All rights reserved.
      6  1.1.2.2  yamt  *
      7  1.1.2.2  yamt  * Redistribution and use in source and binary forms, with or without
      8  1.1.2.2  yamt  * modification, are permitted provided that the following conditions
      9  1.1.2.2  yamt  * are met:
     10  1.1.2.2  yamt  * 1. Redistributions of source code must retain the above copyright
     11  1.1.2.2  yamt  *    notice, this list of conditions and the following disclaimer.
     12  1.1.2.2  yamt  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1.2.2  yamt  *    notice, this list of conditions and the following disclaimer in the
     14  1.1.2.2  yamt  *    documentation and/or other materials provided with the distribution.
     15  1.1.2.2  yamt  * 3. The name of the author may not be used to endorse or promote products
     16  1.1.2.2  yamt  *    derived from this software without specific prior written permission.
     17  1.1.2.2  yamt  *
     18  1.1.2.2  yamt  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     19  1.1.2.2  yamt  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     20  1.1.2.2  yamt  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     21  1.1.2.2  yamt  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     22  1.1.2.2  yamt  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     23  1.1.2.2  yamt  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     24  1.1.2.2  yamt  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     25  1.1.2.2  yamt  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     26  1.1.2.2  yamt  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     27  1.1.2.2  yamt  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     28  1.1.2.2  yamt  */
     29  1.1.2.2  yamt 
     30  1.1.2.2  yamt /*
     31  1.1.2.2  yamt  * Driver for the 3Com Bluetooth PC Card 3CRWB6096, written with reference to
     32  1.1.2.2  yamt  *  FreeBSD and BlueZ drivers for same, with credit for those going to:
     33  1.1.2.2  yamt  *
     34  1.1.2.2  yamt  *		Maksim Yevmenkin <m_evmenkin (at) yahoo.com>		(FreeBSD)
     35  1.1.2.2  yamt  *		Marcel Holtmann <marcel (at) holtmann.org>		(BlueZ)
     36  1.1.2.2  yamt  *		Jose Orlando Pereira <jop (at) di.uminho.pt>		(BlueZ)
     37  1.1.2.2  yamt  *		David Hinds <dahinds (at) users.sourceforge.net>	(Original Code)
     38  1.1.2.2  yamt  */
     39  1.1.2.2  yamt 
     40  1.1.2.2  yamt /*
     41  1.1.2.2  yamt  * The CIS info from my card:
     42  1.1.2.2  yamt  *
     43  1.1.2.2  yamt  *	pcmcia1: CIS tuple chain:
     44  1.1.2.2  yamt  *	CISTPL_DEVICE type=null speed=null
     45  1.1.2.2  yamt  *	 01 03 00 00 ff
     46  1.1.2.2  yamt  *	CISTPL_VERS_1
     47  1.1.2.2  yamt  *	 15 24 05 00 33 43 4f 4d 00 33 43 52 57 42 36 30
     48  1.1.2.2  yamt  *	 2d 41 00 42 6c 75 65 74 6f 6f 74 68 20 50 43 20
     49  1.1.2.2  yamt  *	 43 61 72 64 00 ff
     50  1.1.2.2  yamt  *	CISTPL_MANFID
     51  1.1.2.2  yamt  *	 20 04 01 01 40 00
     52  1.1.2.2  yamt  *	CISTPL_FUNCID
     53  1.1.2.2  yamt  *	 21 02 02 01
     54  1.1.2.2  yamt  *	CISTPL_CONFIG
     55  1.1.2.2  yamt  *	 1a 06 05 30 20 03 17 00
     56  1.1.2.2  yamt  *	CISTPL_CFTABLE_ENTRY
     57  1.1.2.2  yamt  *	 1b 09 f0 41 18 a0 40 07 30 ff ff
     58  1.1.2.2  yamt  *	unhandled CISTPL 80
     59  1.1.2.2  yamt  *	 80 0a 02 01 40 00 2d 00 00 00 00 ff
     60  1.1.2.2  yamt  *	CISTPL_NO_LINK
     61  1.1.2.2  yamt  *	 14 00
     62  1.1.2.2  yamt  *	CISTPL_END
     63  1.1.2.2  yamt  *	 ff
     64  1.1.2.2  yamt  *	pcmcia1: CIS version PC Card Standard 5.0
     65  1.1.2.2  yamt  *	pcmcia1: CIS info: 3COM, 3CRWB60-A, Bluetooth PC Card
     66  1.1.2.2  yamt  *	pcmcia1: Manufacturer code 0x101, product 0x40
     67  1.1.2.2  yamt  *	pcmcia1: function 0: serial port, ccr addr 320 mask 17
     68  1.1.2.2  yamt  *	pcmcia1: function 0, config table entry 48: I/O card; irq mask ffff; iomask 0, iospace 0-7; rdybsy_active io8 irqlevel
     69  1.1.2.2  yamt  */
     70  1.1.2.2  yamt 
     71  1.1.2.2  yamt #include <sys/cdefs.h>
     72  1.1.2.6  yamt __KERNEL_RCSID(0, "$NetBSD: bt3c.c,v 1.1.2.6 2007/11/15 11:44:28 yamt Exp $");
     73  1.1.2.2  yamt 
     74  1.1.2.2  yamt #include <sys/param.h>
     75  1.1.2.2  yamt #include <sys/device.h>
     76  1.1.2.2  yamt #include <sys/mbuf.h>
     77  1.1.2.2  yamt #include <sys/systm.h>
     78  1.1.2.2  yamt 
     79  1.1.2.5  yamt #include <sys/cpu.h>
     80  1.1.2.5  yamt #include <sys/bus.h>
     81  1.1.2.5  yamt #include <sys/intr.h>
     82  1.1.2.2  yamt 
     83  1.1.2.2  yamt #include <dev/pcmcia/pcmciareg.h>
     84  1.1.2.2  yamt #include <dev/pcmcia/pcmciavar.h>
     85  1.1.2.2  yamt #include <dev/pcmcia/pcmciadevs.h>
     86  1.1.2.2  yamt 
     87  1.1.2.2  yamt #include <netbt/bluetooth.h>
     88  1.1.2.2  yamt #include <netbt/hci.h>
     89  1.1.2.2  yamt 
     90  1.1.2.2  yamt #include <dev/firmload.h>
     91  1.1.2.2  yamt #define BT3C_FIRMWARE_FILE	"BT3CPCC.bin"
     92  1.1.2.2  yamt 
     93  1.1.2.2  yamt /**************************************************************************
     94  1.1.2.2  yamt  *
     95  1.1.2.2  yamt  *	bt3c autoconfig glue
     96  1.1.2.2  yamt  */
     97  1.1.2.2  yamt 
     98  1.1.2.2  yamt struct bt3c_softc {
     99  1.1.2.6  yamt 	device_t	sc_dev;
    100  1.1.2.2  yamt 
    101  1.1.2.2  yamt 	struct pcmcia_function *sc_pf;		/* our PCMCIA function */
    102  1.1.2.2  yamt 	struct pcmcia_io_handle sc_pcioh;	/* PCMCIA i/o space info */
    103  1.1.2.2  yamt 	int		sc_iow;			/* our i/o window */
    104  1.1.2.2  yamt 	void		*sc_powerhook;		/* power hook descriptor */
    105  1.1.2.2  yamt 	int		sc_flags;		/* flags */
    106  1.1.2.2  yamt 
    107  1.1.2.2  yamt 	struct hci_unit sc_unit;		/* Bluetooth HCI Unit */
    108  1.1.2.2  yamt 
    109  1.1.2.2  yamt 	/* hardware interrupt */
    110  1.1.2.2  yamt 	void		*sc_intr;		/* cookie */
    111  1.1.2.2  yamt 	int		sc_state;		/* receive state */
    112  1.1.2.2  yamt 	int		sc_want;		/* how much we want */
    113  1.1.2.2  yamt 	struct mbuf	*sc_rxp;		/* incoming packet */
    114  1.1.2.2  yamt 	struct mbuf	*sc_txp;		/* outgoing packet */
    115  1.1.2.2  yamt };
    116  1.1.2.2  yamt 
    117  1.1.2.2  yamt /* sc_state */				/* receiving */
    118  1.1.2.2  yamt #define BT3C_RECV_PKT_TYPE	0		/* packet type */
    119  1.1.2.2  yamt #define BT3C_RECV_ACL_HDR	1		/* acl header */
    120  1.1.2.2  yamt #define BT3C_RECV_SCO_HDR	2		/* sco header */
    121  1.1.2.2  yamt #define BT3C_RECV_EVENT_HDR	3		/* event header */
    122  1.1.2.2  yamt #define BT3C_RECV_ACL_DATA	4		/* acl packet data */
    123  1.1.2.2  yamt #define BT3C_RECV_SCO_DATA	5		/* sco packet data */
    124  1.1.2.2  yamt #define BT3C_RECV_EVENT_DATA	6		/* event packet data */
    125  1.1.2.2  yamt 
    126  1.1.2.2  yamt /* sc_flags */
    127  1.1.2.2  yamt #define BT3C_SLEEPING		(1 << 0)	/* but not with the fishes */
    128  1.1.2.2  yamt 
    129  1.1.2.6  yamt static int bt3c_match(device_t, struct cfdata *, void *);
    130  1.1.2.6  yamt static void bt3c_attach(device_t, device_t, void *);
    131  1.1.2.6  yamt static int bt3c_detach(device_t, int);
    132  1.1.2.2  yamt static void bt3c_power(int, void *);
    133  1.1.2.2  yamt 
    134  1.1.2.6  yamt CFATTACH_DECL_NEW(bt3c, sizeof(struct bt3c_softc),
    135  1.1.2.5  yamt     bt3c_match, bt3c_attach, bt3c_detach, NULL);
    136  1.1.2.2  yamt 
    137  1.1.2.6  yamt static void bt3c_start(device_t);
    138  1.1.2.6  yamt static int bt3c_enable(device_t);
    139  1.1.2.6  yamt static void bt3c_disable(device_t);
    140  1.1.2.2  yamt 
    141  1.1.2.2  yamt /**************************************************************************
    142  1.1.2.2  yamt  *
    143  1.1.2.2  yamt  *	Hardware Definitions & IO routines
    144  1.1.2.2  yamt  *
    145  1.1.2.2  yamt  *	I made up the names for most of these defs since we dont have
    146  1.1.2.2  yamt  *	manufacturers recommendations, but I dont like raw numbers..
    147  1.1.2.2  yamt  *
    148  1.1.2.2  yamt  *	all hardware routines are running at IPL_TTY
    149  1.1.2.2  yamt  *
    150  1.1.2.2  yamt  */
    151  1.1.2.2  yamt #define BT3C_ISR		0x7001		/* Interrupt Status Register */
    152  1.1.2.2  yamt #define BT3C_ISR_RXRDY			(1<<0)	/* Device has data */
    153  1.1.2.2  yamt #define BT3C_ISR_TXRDY			(1<<1)	/* Finished sending data */
    154  1.1.2.2  yamt #define BT3C_ISR_ANTENNA		(1<<5)	/* Antenna position changed */
    155  1.1.2.2  yamt 
    156  1.1.2.2  yamt #define BT3C_CSR		0x7002		/* Card Status Register */
    157  1.1.2.2  yamt #define BT3C_CSR_ANTENNA		(1<<4)	/* Antenna position */
    158  1.1.2.2  yamt 
    159  1.1.2.2  yamt #define BT3C_TX_COUNT		0x7005		/* Tx fifo contents */
    160  1.1.2.2  yamt #define BT3C_TX_FIFO		0x7080		/* Transmit Fifo */
    161  1.1.2.2  yamt #define BT3C_RX_COUNT		0x7006		/* Rx fifo contents */
    162  1.1.2.2  yamt #define BT3C_RX_FIFO		0x7480		/* Receive Fifo */
    163  1.1.2.2  yamt #define BT3C_FIFO_SIZE			256
    164  1.1.2.2  yamt 
    165  1.1.2.2  yamt /* IO Registers */
    166  1.1.2.2  yamt #define BT3C_IOR_DATA_L		0x00		/* data low byte */
    167  1.1.2.2  yamt #define BT3C_IOR_DATA_H		0x01		/* data high byte */
    168  1.1.2.2  yamt #define BT3C_IOR_ADDR_L		0x02		/* address low byte */
    169  1.1.2.2  yamt #define BT3C_IOR_ADDR_H		0x03		/* address high byte */
    170  1.1.2.2  yamt #define BT3C_IOR_CNTL		0x04		/* control byte */
    171  1.1.2.2  yamt #define BT3C_IOR_CNTL_BOOT		(1<<6)	/* Boot Card */
    172  1.1.2.2  yamt #define BT3C_IOR_CNTL_INTR		(1<<7)	/* Interrupt Requested */
    173  1.1.2.2  yamt #define BT3C_IOR_LEN		0x05
    174  1.1.2.2  yamt 
    175  1.1.2.2  yamt static inline uint16_t
    176  1.1.2.2  yamt bt3c_get(struct bt3c_softc *sc)
    177  1.1.2.2  yamt {
    178  1.1.2.2  yamt 	uint16_t data;
    179  1.1.2.2  yamt 
    180  1.1.2.2  yamt 	bus_space_barrier(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    181  1.1.2.2  yamt 				0, BT3C_IOR_LEN, BUS_SPACE_BARRIER_READ);
    182  1.1.2.2  yamt 	data = bus_space_read_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    183  1.1.2.2  yamt 				BT3C_IOR_DATA_L);
    184  1.1.2.2  yamt 	data |= bus_space_read_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    185  1.1.2.2  yamt 				BT3C_IOR_DATA_H) << 8;
    186  1.1.2.2  yamt 
    187  1.1.2.2  yamt 	return data;
    188  1.1.2.2  yamt }
    189  1.1.2.2  yamt 
    190  1.1.2.2  yamt static inline void
    191  1.1.2.2  yamt bt3c_put(struct bt3c_softc *sc, uint16_t data)
    192  1.1.2.2  yamt {
    193  1.1.2.2  yamt 
    194  1.1.2.2  yamt 	bus_space_barrier(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    195  1.1.2.2  yamt 			0, BT3C_IOR_LEN, BUS_SPACE_BARRIER_WRITE);
    196  1.1.2.2  yamt 	bus_space_write_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    197  1.1.2.2  yamt 			BT3C_IOR_DATA_L, data & 0xff);
    198  1.1.2.2  yamt 	bus_space_write_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    199  1.1.2.2  yamt 			BT3C_IOR_DATA_H, (data >> 8) & 0xff);
    200  1.1.2.2  yamt }
    201  1.1.2.2  yamt 
    202  1.1.2.2  yamt static inline uint8_t
    203  1.1.2.2  yamt bt3c_read_control(struct bt3c_softc *sc)
    204  1.1.2.2  yamt {
    205  1.1.2.2  yamt 
    206  1.1.2.2  yamt 	bus_space_barrier(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    207  1.1.2.2  yamt 			0, BT3C_IOR_LEN, BUS_SPACE_BARRIER_READ);
    208  1.1.2.2  yamt 	return bus_space_read_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    209  1.1.2.2  yamt 			BT3C_IOR_CNTL);
    210  1.1.2.2  yamt }
    211  1.1.2.2  yamt 
    212  1.1.2.2  yamt static inline void
    213  1.1.2.2  yamt bt3c_write_control(struct bt3c_softc *sc, uint8_t data)
    214  1.1.2.2  yamt {
    215  1.1.2.2  yamt 
    216  1.1.2.2  yamt 	bus_space_barrier(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    217  1.1.2.2  yamt 			0, BT3C_IOR_LEN, BUS_SPACE_BARRIER_WRITE);
    218  1.1.2.2  yamt 	bus_space_write_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    219  1.1.2.2  yamt 			BT3C_IOR_CNTL, data);
    220  1.1.2.2  yamt }
    221  1.1.2.2  yamt 
    222  1.1.2.2  yamt static inline void
    223  1.1.2.2  yamt bt3c_set_address(struct bt3c_softc *sc, uint16_t addr)
    224  1.1.2.2  yamt {
    225  1.1.2.2  yamt 
    226  1.1.2.2  yamt 	bus_space_barrier(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    227  1.1.2.2  yamt 			0, BT3C_IOR_LEN, BUS_SPACE_BARRIER_WRITE);
    228  1.1.2.2  yamt 	bus_space_write_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    229  1.1.2.2  yamt 			BT3C_IOR_ADDR_L, addr & 0xff);
    230  1.1.2.2  yamt 	bus_space_write_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh,
    231  1.1.2.2  yamt 			BT3C_IOR_ADDR_H, (addr >> 8) & 0xff);
    232  1.1.2.2  yamt }
    233  1.1.2.2  yamt 
    234  1.1.2.2  yamt static inline uint16_t
    235  1.1.2.2  yamt bt3c_read(struct bt3c_softc *sc, uint16_t addr)
    236  1.1.2.2  yamt {
    237  1.1.2.2  yamt 
    238  1.1.2.2  yamt 	bt3c_set_address(sc, addr);
    239  1.1.2.2  yamt 	return bt3c_get(sc);
    240  1.1.2.2  yamt }
    241  1.1.2.2  yamt 
    242  1.1.2.2  yamt static inline void
    243  1.1.2.2  yamt bt3c_write(struct bt3c_softc *sc, uint16_t addr, uint16_t data)
    244  1.1.2.2  yamt {
    245  1.1.2.2  yamt 
    246  1.1.2.2  yamt 	bt3c_set_address(sc, addr);
    247  1.1.2.2  yamt 	bt3c_put(sc, data);
    248  1.1.2.2  yamt }
    249  1.1.2.2  yamt 
    250  1.1.2.2  yamt /*
    251  1.1.2.2  yamt  * receive incoming data from device, store in mbuf chain and
    252  1.1.2.2  yamt  * pass on complete packets to bt device
    253  1.1.2.2  yamt  */
    254  1.1.2.2  yamt static void
    255  1.1.2.2  yamt bt3c_receive(struct bt3c_softc *sc)
    256  1.1.2.2  yamt {
    257  1.1.2.2  yamt 	struct mbuf *m = sc->sc_rxp;
    258  1.1.2.2  yamt 	int space = 0;
    259  1.1.2.2  yamt 	uint16_t count;
    260  1.1.2.2  yamt 	uint8_t b;
    261  1.1.2.2  yamt 
    262  1.1.2.2  yamt 	/*
    263  1.1.2.2  yamt 	 * If we already started a packet, find the
    264  1.1.2.2  yamt 	 * trailing end of it.
    265  1.1.2.2  yamt 	 */
    266  1.1.2.2  yamt 	if (m) {
    267  1.1.2.2  yamt 		while (m->m_next)
    268  1.1.2.2  yamt 			m = m->m_next;
    269  1.1.2.2  yamt 
    270  1.1.2.2  yamt 		space = M_TRAILINGSPACE(m);
    271  1.1.2.2  yamt 	}
    272  1.1.2.2  yamt 
    273  1.1.2.2  yamt 	count = bt3c_read(sc, BT3C_RX_COUNT);
    274  1.1.2.2  yamt 	bt3c_set_address(sc, BT3C_RX_FIFO);
    275  1.1.2.2  yamt 
    276  1.1.2.2  yamt 	while (count > 0) {
    277  1.1.2.2  yamt 		if (space == 0) {
    278  1.1.2.2  yamt 			if (m == NULL) {
    279  1.1.2.2  yamt 				/* new packet */
    280  1.1.2.2  yamt 				MGETHDR(m, M_DONTWAIT, MT_DATA);
    281  1.1.2.2  yamt 				if (m == NULL) {
    282  1.1.2.6  yamt 					aprint_error_dev(sc->sc_dev,
    283  1.1.2.6  yamt 					    "out of memory\n");
    284  1.1.2.2  yamt 					++sc->sc_unit.hci_stats.err_rx;
    285  1.1.2.2  yamt 					goto out;	/* (lost sync) */
    286  1.1.2.2  yamt 				}
    287  1.1.2.2  yamt 
    288  1.1.2.2  yamt 				sc->sc_rxp = m;
    289  1.1.2.2  yamt 				m->m_pkthdr.len = m->m_len = 0;
    290  1.1.2.2  yamt 				space = MHLEN;
    291  1.1.2.2  yamt 
    292  1.1.2.2  yamt 				sc->sc_state = BT3C_RECV_PKT_TYPE;
    293  1.1.2.2  yamt 				sc->sc_want = 1;
    294  1.1.2.2  yamt 			} else {
    295  1.1.2.2  yamt 				/* extend mbuf */
    296  1.1.2.2  yamt 				MGET(m->m_next, M_DONTWAIT, MT_DATA);
    297  1.1.2.2  yamt 				if (m->m_next == NULL) {
    298  1.1.2.6  yamt 					aprint_error_dev(sc->sc_dev,
    299  1.1.2.6  yamt 					    "out of memory\n");
    300  1.1.2.2  yamt 					++sc->sc_unit.hci_stats.err_rx;
    301  1.1.2.2  yamt 					goto out;	/* (lost sync) */
    302  1.1.2.2  yamt 				}
    303  1.1.2.2  yamt 
    304  1.1.2.2  yamt 				m = m->m_next;
    305  1.1.2.2  yamt 				m->m_len = 0;
    306  1.1.2.2  yamt 				space = MLEN;
    307  1.1.2.2  yamt 
    308  1.1.2.2  yamt 				if (sc->sc_want > MINCLSIZE) {
    309  1.1.2.2  yamt 					MCLGET(m, M_DONTWAIT);
    310  1.1.2.2  yamt 					if (m->m_flags & M_EXT)
    311  1.1.2.2  yamt 						space = MCLBYTES;
    312  1.1.2.2  yamt 				}
    313  1.1.2.2  yamt 			}
    314  1.1.2.2  yamt 		}
    315  1.1.2.2  yamt 
    316  1.1.2.2  yamt 		b = bt3c_get(sc);
    317  1.1.2.2  yamt 		mtod(m, uint8_t *)[m->m_len++] = b;
    318  1.1.2.2  yamt 		count--;
    319  1.1.2.2  yamt 		space--;
    320  1.1.2.2  yamt 		sc->sc_rxp->m_pkthdr.len++;
    321  1.1.2.2  yamt 		sc->sc_unit.hci_stats.byte_rx++;
    322  1.1.2.2  yamt 
    323  1.1.2.2  yamt 		sc->sc_want--;
    324  1.1.2.2  yamt 		if (sc->sc_want > 0)
    325  1.1.2.2  yamt 			continue; /* want more */
    326  1.1.2.2  yamt 
    327  1.1.2.2  yamt 		switch (sc->sc_state) {
    328  1.1.2.2  yamt 		case BT3C_RECV_PKT_TYPE:		/* Got packet type */
    329  1.1.2.2  yamt 
    330  1.1.2.2  yamt 			switch (b) {
    331  1.1.2.2  yamt 			case HCI_ACL_DATA_PKT:
    332  1.1.2.2  yamt 				sc->sc_state = BT3C_RECV_ACL_HDR;
    333  1.1.2.2  yamt 				sc->sc_want = sizeof(hci_acldata_hdr_t) - 1;
    334  1.1.2.2  yamt 				break;
    335  1.1.2.2  yamt 
    336  1.1.2.2  yamt 			case HCI_SCO_DATA_PKT:
    337  1.1.2.2  yamt 				sc->sc_state = BT3C_RECV_SCO_HDR;
    338  1.1.2.2  yamt 				sc->sc_want = sizeof(hci_scodata_hdr_t) - 1;
    339  1.1.2.2  yamt 				break;
    340  1.1.2.2  yamt 
    341  1.1.2.2  yamt 			case HCI_EVENT_PKT:
    342  1.1.2.2  yamt 				sc->sc_state = BT3C_RECV_EVENT_HDR;
    343  1.1.2.2  yamt 				sc->sc_want = sizeof(hci_event_hdr_t) - 1;
    344  1.1.2.2  yamt 				break;
    345  1.1.2.2  yamt 
    346  1.1.2.2  yamt 			default:
    347  1.1.2.6  yamt 				aprint_error_dev(sc->sc_dev,
    348  1.1.2.6  yamt 				    "Unknown packet type=%#x!\n", b);
    349  1.1.2.2  yamt 				++sc->sc_unit.hci_stats.err_rx;
    350  1.1.2.2  yamt 				m_freem(sc->sc_rxp);
    351  1.1.2.2  yamt 				sc->sc_rxp = NULL;
    352  1.1.2.2  yamt 				goto out;	/* (lost sync) */
    353  1.1.2.2  yamt 			}
    354  1.1.2.2  yamt 
    355  1.1.2.2  yamt 			break;
    356  1.1.2.2  yamt 
    357  1.1.2.2  yamt 		/*
    358  1.1.2.2  yamt 		 * we assume (correctly of course :) that the packet headers
    359  1.1.2.2  yamt 		 * all fit into a single pkthdr mbuf
    360  1.1.2.2  yamt 		 */
    361  1.1.2.2  yamt 		case BT3C_RECV_ACL_HDR:		/* Got ACL Header */
    362  1.1.2.2  yamt 			sc->sc_state = BT3C_RECV_ACL_DATA;
    363  1.1.2.2  yamt 			sc->sc_want = mtod(m, hci_acldata_hdr_t *)->length;
    364  1.1.2.2  yamt 			sc->sc_want = le16toh(sc->sc_want);
    365  1.1.2.2  yamt 			break;
    366  1.1.2.2  yamt 
    367  1.1.2.2  yamt 		case BT3C_RECV_SCO_HDR:		/* Got SCO Header */
    368  1.1.2.2  yamt 			sc->sc_state = BT3C_RECV_SCO_DATA;
    369  1.1.2.2  yamt 			sc->sc_want =  mtod(m, hci_scodata_hdr_t *)->length;
    370  1.1.2.2  yamt 			break;
    371  1.1.2.2  yamt 
    372  1.1.2.2  yamt 		case BT3C_RECV_EVENT_HDR:	/* Got Event Header */
    373  1.1.2.2  yamt 			sc->sc_state = BT3C_RECV_EVENT_DATA;
    374  1.1.2.2  yamt 			sc->sc_want =  mtod(m, hci_event_hdr_t *)->length;
    375  1.1.2.2  yamt 			break;
    376  1.1.2.2  yamt 
    377  1.1.2.2  yamt 		case BT3C_RECV_ACL_DATA:	/* ACL Packet Complete */
    378  1.1.2.2  yamt 			hci_input_acl(&sc->sc_unit, sc->sc_rxp);
    379  1.1.2.2  yamt 			sc->sc_unit.hci_stats.acl_rx++;
    380  1.1.2.2  yamt 			sc->sc_rxp = m = NULL;
    381  1.1.2.2  yamt 			space = 0;
    382  1.1.2.2  yamt 			break;
    383  1.1.2.2  yamt 
    384  1.1.2.2  yamt 		case BT3C_RECV_SCO_DATA:	/* SCO Packet Complete */
    385  1.1.2.2  yamt 			hci_input_sco(&sc->sc_unit, sc->sc_rxp);
    386  1.1.2.2  yamt 			sc->sc_unit.hci_stats.sco_rx++;
    387  1.1.2.2  yamt 			sc->sc_rxp = m = NULL;
    388  1.1.2.2  yamt 			space = 0;
    389  1.1.2.2  yamt 			break;
    390  1.1.2.2  yamt 
    391  1.1.2.2  yamt 		case BT3C_RECV_EVENT_DATA:	/* Event Packet Complete */
    392  1.1.2.2  yamt 			sc->sc_unit.hci_stats.evt_rx++;
    393  1.1.2.2  yamt 			hci_input_event(&sc->sc_unit, sc->sc_rxp);
    394  1.1.2.2  yamt 			sc->sc_rxp = m = NULL;
    395  1.1.2.2  yamt 			space = 0;
    396  1.1.2.2  yamt 			break;
    397  1.1.2.2  yamt 
    398  1.1.2.2  yamt 		default:
    399  1.1.2.2  yamt 			panic("%s: invalid state %d!\n",
    400  1.1.2.6  yamt 				device_xname(sc->sc_dev), sc->sc_state);
    401  1.1.2.2  yamt 		}
    402  1.1.2.2  yamt 	}
    403  1.1.2.2  yamt 
    404  1.1.2.2  yamt out:
    405  1.1.2.2  yamt 	bt3c_write(sc, BT3C_RX_COUNT, 0x0000);
    406  1.1.2.2  yamt }
    407  1.1.2.2  yamt 
    408  1.1.2.2  yamt /*
    409  1.1.2.2  yamt  * write data from current packet to Transmit FIFO.
    410  1.1.2.2  yamt  * restart when done.
    411  1.1.2.2  yamt  */
    412  1.1.2.2  yamt static void
    413  1.1.2.2  yamt bt3c_transmit(struct bt3c_softc *sc)
    414  1.1.2.2  yamt {
    415  1.1.2.2  yamt 	struct mbuf *m;
    416  1.1.2.2  yamt 	int count, rlen;
    417  1.1.2.2  yamt 	uint8_t *rptr;
    418  1.1.2.2  yamt 
    419  1.1.2.2  yamt 	m = sc->sc_txp;
    420  1.1.2.2  yamt 	if (m == NULL) {
    421  1.1.2.2  yamt 		sc->sc_unit.hci_flags &= ~BTF_XMIT;
    422  1.1.2.6  yamt 		bt3c_start(sc->sc_dev);
    423  1.1.2.2  yamt 		return;
    424  1.1.2.2  yamt 	}
    425  1.1.2.2  yamt 
    426  1.1.2.2  yamt 	count = 0;
    427  1.1.2.2  yamt 	rlen = 0;
    428  1.1.2.2  yamt 	rptr = mtod(m, uint8_t *);
    429  1.1.2.2  yamt 
    430  1.1.2.2  yamt 	bt3c_set_address(sc, BT3C_TX_FIFO);
    431  1.1.2.2  yamt 
    432  1.1.2.2  yamt 	for(;;) {
    433  1.1.2.2  yamt 		if (rlen >= m->m_len) {
    434  1.1.2.2  yamt 			m = m->m_next;
    435  1.1.2.2  yamt 			if (m == NULL) {
    436  1.1.2.2  yamt 				m = sc->sc_txp;
    437  1.1.2.2  yamt 				sc->sc_txp = NULL;
    438  1.1.2.2  yamt 
    439  1.1.2.2  yamt 				if (M_GETCTX(m, void *) == NULL)
    440  1.1.2.2  yamt 					m_freem(m);
    441  1.1.2.2  yamt 				else
    442  1.1.2.2  yamt 					hci_complete_sco(&sc->sc_unit, m);
    443  1.1.2.2  yamt 
    444  1.1.2.2  yamt 				break;
    445  1.1.2.2  yamt 			}
    446  1.1.2.2  yamt 
    447  1.1.2.2  yamt 			rlen = 0;
    448  1.1.2.2  yamt 			rptr = mtod(m, uint8_t *);
    449  1.1.2.2  yamt 			continue;
    450  1.1.2.2  yamt 		}
    451  1.1.2.2  yamt 
    452  1.1.2.2  yamt 		if (count >= BT3C_FIFO_SIZE) {
    453  1.1.2.2  yamt 			m_adj(m, rlen);
    454  1.1.2.2  yamt 			break;
    455  1.1.2.2  yamt 		}
    456  1.1.2.2  yamt 
    457  1.1.2.2  yamt 		bt3c_put(sc, *rptr++);
    458  1.1.2.2  yamt 		rlen++;
    459  1.1.2.2  yamt 		count++;
    460  1.1.2.2  yamt 	}
    461  1.1.2.2  yamt 
    462  1.1.2.2  yamt 	bt3c_write(sc, BT3C_TX_COUNT, count);
    463  1.1.2.2  yamt 	sc->sc_unit.hci_stats.byte_tx += count;
    464  1.1.2.2  yamt }
    465  1.1.2.2  yamt 
    466  1.1.2.2  yamt /*
    467  1.1.2.2  yamt  * interrupt routine
    468  1.1.2.2  yamt  */
    469  1.1.2.2  yamt static int
    470  1.1.2.2  yamt bt3c_intr(void *arg)
    471  1.1.2.2  yamt {
    472  1.1.2.2  yamt 	struct bt3c_softc *sc = arg;
    473  1.1.2.2  yamt 	uint16_t control, isr;
    474  1.1.2.2  yamt 
    475  1.1.2.2  yamt 	control = bt3c_read_control(sc);
    476  1.1.2.2  yamt 	if (control & BT3C_IOR_CNTL_INTR) {
    477  1.1.2.2  yamt 		isr = bt3c_read(sc, BT3C_ISR);
    478  1.1.2.2  yamt 		if ((isr & 0xff) == 0x7f) {
    479  1.1.2.6  yamt 			aprint_error_dev(sc->sc_dev, "strange ISR=%04x\n", isr);
    480  1.1.2.2  yamt 		} else if ((isr & 0xff) != 0xff) {
    481  1.1.2.2  yamt 
    482  1.1.2.2  yamt 			if (isr & BT3C_ISR_RXRDY)
    483  1.1.2.2  yamt 				bt3c_receive(sc);
    484  1.1.2.2  yamt 
    485  1.1.2.2  yamt 			if (isr & BT3C_ISR_TXRDY)
    486  1.1.2.2  yamt 				bt3c_transmit(sc);
    487  1.1.2.2  yamt 
    488  1.1.2.2  yamt #ifdef DIAGNOSTIC
    489  1.1.2.2  yamt 			if (isr & BT3C_ISR_ANTENNA) {
    490  1.1.2.2  yamt 				if (bt3c_read(sc, BT3C_CSR) & BT3C_CSR_ANTENNA)
    491  1.1.2.6  yamt 					aprint_verbose_dev(sc->sc_dev,
    492  1.1.2.6  yamt 					    "Antenna Out\n");
    493  1.1.2.2  yamt 				else
    494  1.1.2.6  yamt 					aprint_verbose_dev(sc->sc_dev,
    495  1.1.2.6  yamt 					    "Antenna In\n");
    496  1.1.2.2  yamt 			}
    497  1.1.2.2  yamt #endif
    498  1.1.2.2  yamt 
    499  1.1.2.2  yamt 			bt3c_write(sc, BT3C_ISR, 0x0000);
    500  1.1.2.2  yamt 			bt3c_write_control(sc, control);
    501  1.1.2.2  yamt 
    502  1.1.2.2  yamt 			return 1; /* handled */
    503  1.1.2.2  yamt 		}
    504  1.1.2.2  yamt 	}
    505  1.1.2.2  yamt 
    506  1.1.2.2  yamt 	return 0; /* not handled */
    507  1.1.2.2  yamt }
    508  1.1.2.2  yamt 
    509  1.1.2.2  yamt /*
    510  1.1.2.2  yamt  * load firmware for the device
    511  1.1.2.2  yamt  *
    512  1.1.2.4  yamt  * The firmware file is a plain ASCII file in the Motorola S-Record format,
    513  1.1.2.4  yamt  * with lines in the format:
    514  1.1.2.2  yamt  *
    515  1.1.2.2  yamt  *	S<Digit><Len><Address><Data1><Data2>...<DataN><Checksum>
    516  1.1.2.2  yamt  *
    517  1.1.2.4  yamt  * <Digit>:	0	header
    518  1.1.2.4  yamt  *		3	data record (4 byte address)
    519  1.1.2.4  yamt  *		7	boot record (4 byte address)
    520  1.1.2.2  yamt  *
    521  1.1.2.2  yamt  * <Len>:	1 byte, and is the number of bytes in the rest of the line
    522  1.1.2.2  yamt  * <Address>:	4 byte address (only 2 bytes are valid for bt3c I think)
    523  1.1.2.2  yamt  * <Data>:	2 byte data word to be written to the address
    524  1.1.2.2  yamt  * <Checksum>:	checksum of all bytes in the line including <Len>
    525  1.1.2.2  yamt  *
    526  1.1.2.2  yamt  * all bytes are in hexadecimal
    527  1.1.2.2  yamt  */
    528  1.1.2.2  yamt static inline int32_t
    529  1.1.2.2  yamt hex(const uint8_t *p, int n)
    530  1.1.2.2  yamt {
    531  1.1.2.2  yamt 	uint32_t val = 0;
    532  1.1.2.2  yamt 
    533  1.1.2.2  yamt 	while (n > 0) {
    534  1.1.2.2  yamt 		val <<= 4;
    535  1.1.2.2  yamt 
    536  1.1.2.2  yamt 		if ('0' <= *p && *p <= '9')
    537  1.1.2.2  yamt 			val += (*p - '0');
    538  1.1.2.2  yamt 		else if ('a' <= *p && *p <= 'f')
    539  1.1.2.2  yamt 			val += (*p - 'a' + 0xa);
    540  1.1.2.2  yamt 		else if ('A' <= *p && *p <= 'F')
    541  1.1.2.2  yamt 			val += (*p - 'A' + 0xa);
    542  1.1.2.2  yamt 		else
    543  1.1.2.2  yamt 			return -1;
    544  1.1.2.2  yamt 
    545  1.1.2.2  yamt 		p++;
    546  1.1.2.2  yamt 		n--;
    547  1.1.2.2  yamt 	}
    548  1.1.2.2  yamt 
    549  1.1.2.2  yamt 	return val;
    550  1.1.2.2  yamt }
    551  1.1.2.2  yamt 
    552  1.1.2.2  yamt static int
    553  1.1.2.2  yamt bt3c_load_firmware(struct bt3c_softc *sc)
    554  1.1.2.2  yamt {
    555  1.1.2.2  yamt 	uint8_t *buf, *line, *next, *p;
    556  1.1.2.2  yamt 	int32_t addr, data;
    557  1.1.2.2  yamt 	int err, sum, len;
    558  1.1.2.2  yamt 	firmware_handle_t fh;
    559  1.1.2.6  yamt 	struct cfdata *cf = device_cfdata(sc->sc_dev);
    560  1.1.2.2  yamt 	size_t size;
    561  1.1.2.2  yamt 
    562  1.1.2.6  yamt 	err = firmware_open(cf->cf_name,
    563  1.1.2.2  yamt 			    BT3C_FIRMWARE_FILE, &fh);
    564  1.1.2.2  yamt 	if (err) {
    565  1.1.2.6  yamt 		aprint_error_dev(sc->sc_dev, "Cannot open firmware %s/%s\n",
    566  1.1.2.6  yamt 		    cf->cf_name, BT3C_FIRMWARE_FILE);
    567  1.1.2.2  yamt 		return err;
    568  1.1.2.2  yamt 	}
    569  1.1.2.2  yamt 
    570  1.1.2.2  yamt 	size = (size_t)firmware_get_size(fh);
    571  1.1.2.2  yamt #ifdef DIAGNOSTIC
    572  1.1.2.3  yamt 	if (size > 10 * 1024) {	/* sanity check */
    573  1.1.2.6  yamt 		aprint_error_dev(sc->sc_dev, "insane firmware file size!\n");
    574  1.1.2.3  yamt 		firmware_close(fh);
    575  1.1.2.2  yamt 		return EFBIG;
    576  1.1.2.2  yamt 	}
    577  1.1.2.2  yamt #endif
    578  1.1.2.2  yamt 
    579  1.1.2.2  yamt 	buf = firmware_malloc(size);
    580  1.1.2.2  yamt 	KASSERT(buf != NULL);
    581  1.1.2.2  yamt 
    582  1.1.2.2  yamt 	err = firmware_read(fh, 0, buf, size);
    583  1.1.2.2  yamt 	if (err) {
    584  1.1.2.6  yamt 		aprint_error_dev(sc->sc_dev, "Firmware read failed (%d)\n", err);
    585  1.1.2.2  yamt 		goto out;
    586  1.1.2.2  yamt 	}
    587  1.1.2.2  yamt 
    588  1.1.2.2  yamt 	/* Reset */
    589  1.1.2.2  yamt 	bt3c_write(sc, 0x8040, 0x0404);
    590  1.1.2.2  yamt 	bt3c_write(sc, 0x8040, 0x0400);
    591  1.1.2.2  yamt 	DELAY(1);
    592  1.1.2.2  yamt 	bt3c_write(sc, 0x8040, 0x0404);
    593  1.1.2.2  yamt 	DELAY(17);
    594  1.1.2.2  yamt 
    595  1.1.2.2  yamt 	next = buf;
    596  1.1.2.2  yamt 	err = EFTYPE;
    597  1.1.2.2  yamt 
    598  1.1.2.2  yamt 	while (next < buf + size) {
    599  1.1.2.2  yamt 		line = next;
    600  1.1.2.2  yamt 
    601  1.1.2.2  yamt 		while (*next != '\r' && *next != '\n') {
    602  1.1.2.2  yamt 			if (next >= buf + size)
    603  1.1.2.2  yamt 				goto out;
    604  1.1.2.2  yamt 
    605  1.1.2.2  yamt 			next++;
    606  1.1.2.2  yamt 		}
    607  1.1.2.2  yamt 
    608  1.1.2.2  yamt 		/* 14 covers address and checksum minimum */
    609  1.1.2.2  yamt 		if (next - line < 14)
    610  1.1.2.2  yamt 			goto out;
    611  1.1.2.2  yamt 
    612  1.1.2.2  yamt 		if (line[0] != 'S')
    613  1.1.2.2  yamt 			goto out;
    614  1.1.2.2  yamt 
    615  1.1.2.2  yamt 		/* verify line length */
    616  1.1.2.2  yamt 		len = hex(line + 2, 2);
    617  1.1.2.2  yamt 		if (len < 0 || next - line != len * 2 + 4)
    618  1.1.2.2  yamt 			goto out;
    619  1.1.2.2  yamt 
    620  1.1.2.2  yamt 		/* checksum the line */
    621  1.1.2.2  yamt 		sum = 0;
    622  1.1.2.2  yamt 		for (p = line + 2 ; p < next ; p += 2)
    623  1.1.2.2  yamt 			sum += hex(p, 2);
    624  1.1.2.2  yamt 
    625  1.1.2.2  yamt 		if ((sum & 0xff) != 0xff)
    626  1.1.2.2  yamt 			goto out;
    627  1.1.2.2  yamt 
    628  1.1.2.2  yamt 		/* extract relevant data */
    629  1.1.2.2  yamt 		switch (line[1]) {
    630  1.1.2.2  yamt 		case '0':
    631  1.1.2.4  yamt 			/* we ignore the header */
    632  1.1.2.2  yamt 			break;
    633  1.1.2.2  yamt 
    634  1.1.2.2  yamt 		case '3':
    635  1.1.2.2  yamt 			/* find number of data words */
    636  1.1.2.2  yamt 			len = (len - 5) / 2;
    637  1.1.2.2  yamt 			if (len > 15)
    638  1.1.2.2  yamt 				goto out;
    639  1.1.2.2  yamt 
    640  1.1.2.2  yamt 			addr = hex(line + 8, 4);
    641  1.1.2.2  yamt 			if (addr < 0)
    642  1.1.2.2  yamt 				goto out;
    643  1.1.2.2  yamt 
    644  1.1.2.2  yamt 			bt3c_set_address(sc, addr);
    645  1.1.2.2  yamt 
    646  1.1.2.2  yamt 			for (p = line + 12 ; p + 4 < next ; p += 4) {
    647  1.1.2.2  yamt 				data = hex(p, 4);
    648  1.1.2.2  yamt 				if (data < 0)
    649  1.1.2.2  yamt 					goto out;
    650  1.1.2.2  yamt 
    651  1.1.2.2  yamt 				bt3c_put(sc, data);
    652  1.1.2.2  yamt 			}
    653  1.1.2.2  yamt 			break;
    654  1.1.2.2  yamt 
    655  1.1.2.2  yamt 		case '7':
    656  1.1.2.4  yamt 			/*
    657  1.1.2.4  yamt 			 * for some reason we ignore this record
    658  1.1.2.4  yamt 			 * and boot from 0x3000 which happens to
    659  1.1.2.4  yamt 			 * be the first record in the file.
    660  1.1.2.4  yamt 			 */
    661  1.1.2.2  yamt 			break;
    662  1.1.2.2  yamt 
    663  1.1.2.2  yamt 		default:
    664  1.1.2.2  yamt 			goto out;
    665  1.1.2.2  yamt 		}
    666  1.1.2.2  yamt 
    667  1.1.2.2  yamt 		/* skip to start of next line */
    668  1.1.2.2  yamt 		while (next < buf + size && (*next == '\r' || *next == '\n'))
    669  1.1.2.2  yamt 			next++;
    670  1.1.2.2  yamt 	}
    671  1.1.2.2  yamt 
    672  1.1.2.2  yamt 	err = 0;
    673  1.1.2.2  yamt 	DELAY(17);
    674  1.1.2.2  yamt 
    675  1.1.2.2  yamt 	/* Boot */
    676  1.1.2.2  yamt 	bt3c_set_address(sc, 0x3000);
    677  1.1.2.2  yamt 	bt3c_write_control(sc, (bt3c_read_control(sc) | BT3C_IOR_CNTL_BOOT));
    678  1.1.2.2  yamt 	DELAY(17);
    679  1.1.2.2  yamt 
    680  1.1.2.2  yamt 	/* Clear Registers */
    681  1.1.2.2  yamt 	bt3c_write(sc, BT3C_RX_COUNT, 0x0000);
    682  1.1.2.2  yamt 	bt3c_write(sc, BT3C_TX_COUNT, 0x0000);
    683  1.1.2.2  yamt 	bt3c_write(sc, BT3C_ISR, 0x0000);
    684  1.1.2.2  yamt 	DELAY(1000);
    685  1.1.2.2  yamt 
    686  1.1.2.2  yamt out:
    687  1.1.2.2  yamt 	firmware_free(buf, size);
    688  1.1.2.2  yamt 	firmware_close(fh);
    689  1.1.2.2  yamt 	return err;
    690  1.1.2.2  yamt }
    691  1.1.2.2  yamt 
    692  1.1.2.2  yamt /**************************************************************************
    693  1.1.2.2  yamt  *
    694  1.1.2.2  yamt  *  bt device callbacks (all called at IPL_TTY)
    695  1.1.2.2  yamt  */
    696  1.1.2.2  yamt 
    697  1.1.2.2  yamt /*
    698  1.1.2.2  yamt  * start sending on bt3c
    699  1.1.2.2  yamt  * this should be called only when BTF_XMIT is not set, and
    700  1.1.2.2  yamt  * we only send cmd packets that are clear to send
    701  1.1.2.2  yamt  */
    702  1.1.2.2  yamt static void
    703  1.1.2.6  yamt bt3c_start(device_t self)
    704  1.1.2.2  yamt {
    705  1.1.2.6  yamt 	struct bt3c_softc *sc = device_private(self);
    706  1.1.2.6  yamt 	struct hci_unit *unit = &sc->sc_unit;
    707  1.1.2.2  yamt 	struct mbuf *m;
    708  1.1.2.2  yamt 
    709  1.1.2.2  yamt 	KASSERT((unit->hci_flags & BTF_XMIT) == 0);
    710  1.1.2.2  yamt 	KASSERT(sc->sc_txp == NULL);
    711  1.1.2.2  yamt 
    712  1.1.2.2  yamt 	if (MBUFQ_FIRST(&unit->hci_cmdq)) {
    713  1.1.2.2  yamt 		MBUFQ_DEQUEUE(&unit->hci_cmdq, m);
    714  1.1.2.2  yamt 		unit->hci_stats.cmd_tx++;
    715  1.1.2.2  yamt 		M_SETCTX(m, NULL);
    716  1.1.2.2  yamt 		goto start;
    717  1.1.2.2  yamt 	}
    718  1.1.2.2  yamt 
    719  1.1.2.2  yamt 	if (MBUFQ_FIRST(&unit->hci_scotxq)) {
    720  1.1.2.2  yamt 		MBUFQ_DEQUEUE(&unit->hci_scotxq, m);
    721  1.1.2.2  yamt 		unit->hci_stats.sco_tx++;
    722  1.1.2.2  yamt 		goto start;
    723  1.1.2.2  yamt 	}
    724  1.1.2.2  yamt 
    725  1.1.2.2  yamt 	if (MBUFQ_FIRST(&unit->hci_acltxq)) {
    726  1.1.2.2  yamt 		MBUFQ_DEQUEUE(&unit->hci_acltxq, m);
    727  1.1.2.2  yamt 		unit->hci_stats.acl_tx++;
    728  1.1.2.2  yamt 		M_SETCTX(m, NULL);
    729  1.1.2.2  yamt 		goto start;
    730  1.1.2.2  yamt 	}
    731  1.1.2.2  yamt 
    732  1.1.2.2  yamt 	/* Nothing to send */
    733  1.1.2.2  yamt 	return;
    734  1.1.2.2  yamt 
    735  1.1.2.2  yamt start:
    736  1.1.2.2  yamt 	sc->sc_txp = m;
    737  1.1.2.2  yamt 	unit->hci_flags |= BTF_XMIT;
    738  1.1.2.2  yamt 	bt3c_transmit(sc);
    739  1.1.2.2  yamt }
    740  1.1.2.2  yamt 
    741  1.1.2.2  yamt /*
    742  1.1.2.2  yamt  * enable device
    743  1.1.2.2  yamt  *	turn on card
    744  1.1.2.2  yamt  *	load firmware
    745  1.1.2.2  yamt  *	establish interrupts
    746  1.1.2.2  yamt  */
    747  1.1.2.2  yamt static int
    748  1.1.2.6  yamt bt3c_enable(device_t self)
    749  1.1.2.2  yamt {
    750  1.1.2.6  yamt 	struct bt3c_softc *sc = device_private(self);
    751  1.1.2.6  yamt 	struct hci_unit *unit = &sc->sc_unit;
    752  1.1.2.2  yamt 	int err;
    753  1.1.2.2  yamt 
    754  1.1.2.2  yamt 	if (unit->hci_flags & BTF_RUNNING)
    755  1.1.2.2  yamt 		return 0;
    756  1.1.2.2  yamt 
    757  1.1.2.2  yamt 	sc->sc_intr = pcmcia_intr_establish(sc->sc_pf, IPL_TTY, bt3c_intr, sc);
    758  1.1.2.2  yamt 	if (sc->sc_intr == NULL) {
    759  1.1.2.2  yamt 		err = EIO;
    760  1.1.2.2  yamt 		goto bad;
    761  1.1.2.2  yamt 	}
    762  1.1.2.2  yamt 
    763  1.1.2.2  yamt 	err = pcmcia_function_enable(sc->sc_pf);
    764  1.1.2.2  yamt 	if (err)
    765  1.1.2.2  yamt 		goto bad1;
    766  1.1.2.2  yamt 
    767  1.1.2.2  yamt 	err = bt3c_load_firmware(sc);
    768  1.1.2.2  yamt 	if (err)
    769  1.1.2.2  yamt 		goto bad2;
    770  1.1.2.2  yamt 
    771  1.1.2.2  yamt 	unit->hci_flags |= BTF_RUNNING;
    772  1.1.2.2  yamt 	unit->hci_flags &= ~BTF_XMIT;
    773  1.1.2.2  yamt 
    774  1.1.2.2  yamt 	/*
    775  1.1.2.2  yamt 	 * 3Com card will send a Command_Status packet when its
    776  1.1.2.2  yamt 	 * ready to receive commands
    777  1.1.2.2  yamt 	 */
    778  1.1.2.2  yamt 	unit->hci_num_cmd_pkts = 0;
    779  1.1.2.2  yamt 
    780  1.1.2.2  yamt 	return 0;
    781  1.1.2.2  yamt 
    782  1.1.2.2  yamt bad2:
    783  1.1.2.2  yamt 	pcmcia_function_disable(sc->sc_pf);
    784  1.1.2.2  yamt bad1:
    785  1.1.2.2  yamt 	pcmcia_intr_disestablish(sc->sc_pf, sc->sc_intr);
    786  1.1.2.2  yamt 	sc->sc_intr = NULL;
    787  1.1.2.2  yamt bad:
    788  1.1.2.2  yamt 	return err;
    789  1.1.2.2  yamt }
    790  1.1.2.2  yamt 
    791  1.1.2.2  yamt /*
    792  1.1.2.2  yamt  * disable device
    793  1.1.2.2  yamt  *	shut down card
    794  1.1.2.2  yamt  *	disestablish interrupts
    795  1.1.2.2  yamt  *	free held packets
    796  1.1.2.2  yamt  */
    797  1.1.2.2  yamt static void
    798  1.1.2.6  yamt bt3c_disable(device_t self)
    799  1.1.2.2  yamt {
    800  1.1.2.6  yamt 	struct bt3c_softc *sc = device_private(self);
    801  1.1.2.6  yamt 	struct hci_unit *unit = &sc->sc_unit;
    802  1.1.2.2  yamt 
    803  1.1.2.2  yamt 	if ((unit->hci_flags & BTF_RUNNING) == 0)
    804  1.1.2.2  yamt 		return;
    805  1.1.2.2  yamt 
    806  1.1.2.2  yamt 	pcmcia_function_disable(sc->sc_pf);
    807  1.1.2.2  yamt 
    808  1.1.2.2  yamt 	if (sc->sc_intr) {
    809  1.1.2.2  yamt 		pcmcia_intr_disestablish(sc->sc_pf, sc->sc_intr);
    810  1.1.2.2  yamt 		sc->sc_intr = NULL;
    811  1.1.2.2  yamt 	}
    812  1.1.2.2  yamt 
    813  1.1.2.2  yamt 	if (sc->sc_rxp) {
    814  1.1.2.2  yamt 		m_freem(sc->sc_rxp);
    815  1.1.2.2  yamt 		sc->sc_rxp = NULL;
    816  1.1.2.2  yamt 	}
    817  1.1.2.2  yamt 
    818  1.1.2.2  yamt 	if (sc->sc_txp) {
    819  1.1.2.2  yamt 		m_freem(sc->sc_txp);
    820  1.1.2.2  yamt 		sc->sc_txp = NULL;
    821  1.1.2.2  yamt 	}
    822  1.1.2.2  yamt 
    823  1.1.2.2  yamt 	unit->hci_flags &= ~BTF_RUNNING;
    824  1.1.2.2  yamt }
    825  1.1.2.2  yamt 
    826  1.1.2.2  yamt /**************************************************************************
    827  1.1.2.2  yamt  *
    828  1.1.2.2  yamt  *	bt3c PCMCIA autoconfig glue
    829  1.1.2.2  yamt  */
    830  1.1.2.2  yamt 
    831  1.1.2.2  yamt static int
    832  1.1.2.6  yamt bt3c_match(device_t parent, struct cfdata *match, void *aux)
    833  1.1.2.2  yamt {
    834  1.1.2.2  yamt 	struct pcmcia_attach_args *pa = aux;
    835  1.1.2.2  yamt 
    836  1.1.2.2  yamt 	if (pa->manufacturer == PCMCIA_VENDOR_3COM &&
    837  1.1.2.2  yamt 	    pa->product == PCMCIA_PRODUCT_3COM_3CRWB6096)
    838  1.1.2.2  yamt 	    return 10;		/* 'com' also claims this, so trump them */
    839  1.1.2.2  yamt 
    840  1.1.2.2  yamt 	return 0;
    841  1.1.2.2  yamt }
    842  1.1.2.2  yamt 
    843  1.1.2.2  yamt static void
    844  1.1.2.6  yamt bt3c_attach(device_t parent, device_t self, void *aux)
    845  1.1.2.2  yamt {
    846  1.1.2.6  yamt 	struct bt3c_softc *sc = device_private(self);
    847  1.1.2.2  yamt 	struct pcmcia_attach_args *pa = aux;
    848  1.1.2.2  yamt 	struct pcmcia_config_entry *cfe;
    849  1.1.2.2  yamt 
    850  1.1.2.6  yamt 	sc->sc_dev = self;
    851  1.1.2.2  yamt 	sc->sc_pf = pa->pf;
    852  1.1.2.2  yamt 
    853  1.1.2.2  yamt 	/* Find a PCMCIA config entry we can use */
    854  1.1.2.2  yamt 	SIMPLEQ_FOREACH(cfe, &pa->pf->cfe_head, cfe_list) {
    855  1.1.2.2  yamt 		if (cfe->num_memspace != 0)
    856  1.1.2.2  yamt 			continue;
    857  1.1.2.2  yamt 
    858  1.1.2.2  yamt 		if (cfe->num_iospace != 1)
    859  1.1.2.2  yamt 			continue;
    860  1.1.2.2  yamt 
    861  1.1.2.2  yamt 		if (pcmcia_io_alloc(pa->pf, cfe->iospace[0].start,
    862  1.1.2.2  yamt 				cfe->iospace[0].length, 0, &sc->sc_pcioh) == 0)
    863  1.1.2.2  yamt 			break;
    864  1.1.2.2  yamt 	}
    865  1.1.2.2  yamt 
    866  1.1.2.2  yamt 	if (cfe == 0) {
    867  1.1.2.2  yamt 		aprint_error("bt3c_attach: cannot allocate io space\n");
    868  1.1.2.2  yamt 		goto no_config_entry;
    869  1.1.2.2  yamt 	}
    870  1.1.2.2  yamt 
    871  1.1.2.2  yamt 	/* Initialise it */
    872  1.1.2.2  yamt 	pcmcia_function_init(pa->pf, cfe);
    873  1.1.2.2  yamt 
    874  1.1.2.2  yamt 	/* Map in the io space */
    875  1.1.2.2  yamt 	if (pcmcia_io_map(pa->pf, PCMCIA_WIDTH_AUTO,
    876  1.1.2.2  yamt 			&sc->sc_pcioh, &sc->sc_iow)) {
    877  1.1.2.2  yamt 		aprint_error("bt3c_attach: cannot map io space\n");
    878  1.1.2.2  yamt 		goto iomap_failed;
    879  1.1.2.2  yamt 	}
    880  1.1.2.2  yamt 
    881  1.1.2.2  yamt 	/* Attach Bluetooth unit */
    882  1.1.2.6  yamt 	sc->sc_unit.hci_dev = self;
    883  1.1.2.2  yamt 	sc->sc_unit.hci_enable = bt3c_enable;
    884  1.1.2.2  yamt 	sc->sc_unit.hci_disable = bt3c_disable;
    885  1.1.2.2  yamt 	sc->sc_unit.hci_start_cmd = bt3c_start;
    886  1.1.2.2  yamt 	sc->sc_unit.hci_start_acl = bt3c_start;
    887  1.1.2.2  yamt 	sc->sc_unit.hci_start_sco = bt3c_start;
    888  1.1.2.3  yamt 	sc->sc_unit.hci_ipl = makeiplcookie(IPL_TTY);
    889  1.1.2.2  yamt 	hci_attach(&sc->sc_unit);
    890  1.1.2.2  yamt 
    891  1.1.2.2  yamt 	/* establish a power change hook */
    892  1.1.2.6  yamt 	sc->sc_powerhook = powerhook_establish(device_xname(sc->sc_dev),
    893  1.1.2.3  yamt 	    bt3c_power, sc);
    894  1.1.2.2  yamt 	return;
    895  1.1.2.2  yamt 
    896  1.1.2.2  yamt iomap_failed:
    897  1.1.2.2  yamt 	/* unmap io space */
    898  1.1.2.2  yamt 	pcmcia_io_free(pa->pf, &sc->sc_pcioh);
    899  1.1.2.2  yamt 
    900  1.1.2.2  yamt no_config_entry:
    901  1.1.2.2  yamt 	sc->sc_iow = -1;
    902  1.1.2.2  yamt }
    903  1.1.2.2  yamt 
    904  1.1.2.2  yamt static int
    905  1.1.2.6  yamt bt3c_detach(device_t self, int flags)
    906  1.1.2.2  yamt {
    907  1.1.2.6  yamt 	struct bt3c_softc *sc = device_private(self);
    908  1.1.2.2  yamt 	int err = 0;
    909  1.1.2.2  yamt 
    910  1.1.2.6  yamt 	bt3c_disable(self);
    911  1.1.2.2  yamt 
    912  1.1.2.2  yamt 	if (sc->sc_powerhook) {
    913  1.1.2.2  yamt 		powerhook_disestablish(sc->sc_powerhook);
    914  1.1.2.2  yamt 		sc->sc_powerhook = NULL;
    915  1.1.2.2  yamt 	}
    916  1.1.2.2  yamt 
    917  1.1.2.2  yamt 	hci_detach(&sc->sc_unit);
    918  1.1.2.2  yamt 
    919  1.1.2.2  yamt 	if (sc->sc_iow != -1) {
    920  1.1.2.2  yamt 		pcmcia_io_unmap(sc->sc_pf, sc->sc_iow);
    921  1.1.2.2  yamt 		pcmcia_io_free(sc->sc_pf, &sc->sc_pcioh);
    922  1.1.2.2  yamt 		sc->sc_iow = -1;
    923  1.1.2.2  yamt 	}
    924  1.1.2.2  yamt 
    925  1.1.2.2  yamt 	return err;
    926  1.1.2.2  yamt }
    927  1.1.2.2  yamt 
    928  1.1.2.2  yamt static void
    929  1.1.2.2  yamt bt3c_power(int why, void *arg)
    930  1.1.2.2  yamt {
    931  1.1.2.2  yamt 	struct bt3c_softc *sc = arg;
    932  1.1.2.2  yamt 
    933  1.1.2.2  yamt 	switch(why) {
    934  1.1.2.2  yamt 	case PWR_SUSPEND:
    935  1.1.2.2  yamt 	case PWR_STANDBY:
    936  1.1.2.2  yamt 		if (sc->sc_unit.hci_flags & BTF_RUNNING) {
    937  1.1.2.3  yamt 			hci_detach(&sc->sc_unit);
    938  1.1.2.3  yamt 
    939  1.1.2.2  yamt 			sc->sc_flags |= BT3C_SLEEPING;
    940  1.1.2.6  yamt 			aprint_verbose_dev(sc->sc_dev, "sleeping\n");
    941  1.1.2.2  yamt 		}
    942  1.1.2.2  yamt 		break;
    943  1.1.2.2  yamt 
    944  1.1.2.2  yamt 	case PWR_RESUME:
    945  1.1.2.2  yamt 		if (sc->sc_flags & BT3C_SLEEPING) {
    946  1.1.2.6  yamt 			aprint_verbose_dev(sc->sc_dev, "waking up\n");
    947  1.1.2.2  yamt 			sc->sc_flags &= ~BT3C_SLEEPING;
    948  1.1.2.3  yamt 
    949  1.1.2.3  yamt 			memset(&sc->sc_unit, 0, sizeof(sc->sc_unit));
    950  1.1.2.6  yamt 			sc->sc_unit.hci_dev = sc->sc_dev;
    951  1.1.2.3  yamt 			sc->sc_unit.hci_enable = bt3c_enable;
    952  1.1.2.3  yamt 			sc->sc_unit.hci_disable = bt3c_disable;
    953  1.1.2.3  yamt 			sc->sc_unit.hci_start_cmd = bt3c_start;
    954  1.1.2.3  yamt 			sc->sc_unit.hci_start_acl = bt3c_start;
    955  1.1.2.3  yamt 			sc->sc_unit.hci_start_sco = bt3c_start;
    956  1.1.2.3  yamt 			sc->sc_unit.hci_ipl = makeiplcookie(IPL_TTY);
    957  1.1.2.3  yamt 			hci_attach(&sc->sc_unit);
    958  1.1.2.2  yamt 		}
    959  1.1.2.2  yamt 		break;
    960  1.1.2.2  yamt 
    961  1.1.2.2  yamt 	case PWR_SOFTSUSPEND:
    962  1.1.2.2  yamt 	case PWR_SOFTSTANDBY:
    963  1.1.2.2  yamt 	case PWR_SOFTRESUME:
    964  1.1.2.2  yamt 		break;
    965  1.1.2.2  yamt 	}
    966  1.1.2.2  yamt }
    967