bt3c.c revision 1.1.2.3
1 1.1.2.3 yamt /* $NetBSD: bt3c.c,v 1.1.2.3 2006/12/30 20:49:17 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.3 yamt __KERNEL_RCSID(0, "$NetBSD: bt3c.c,v 1.1.2.3 2006/12/30 20:49:17 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.2 yamt #include <machine/cpu.h> 80 1.1.2.2 yamt #include <machine/bus.h> 81 1.1.2.2 yamt #include <machine/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.2 yamt struct device sc_dev; /* required */ 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.2 yamt static int bt3c_match(struct device *, struct cfdata *, void *); 130 1.1.2.2 yamt static void bt3c_attach(struct device *, struct device *, void *); 131 1.1.2.2 yamt static int bt3c_detach(struct device *, int); 132 1.1.2.2 yamt static int bt3c_activate(struct device *, enum devact); 133 1.1.2.2 yamt static void bt3c_power(int, void *); 134 1.1.2.2 yamt 135 1.1.2.2 yamt CFATTACH_DECL(bt3c, sizeof(struct bt3c_softc), 136 1.1.2.2 yamt bt3c_match, bt3c_attach, bt3c_detach, bt3c_activate); 137 1.1.2.2 yamt 138 1.1.2.2 yamt static void bt3c_start(struct hci_unit *); 139 1.1.2.2 yamt static int bt3c_enable(struct hci_unit *); 140 1.1.2.2 yamt static void bt3c_disable(struct hci_unit *); 141 1.1.2.2 yamt 142 1.1.2.2 yamt /************************************************************************** 143 1.1.2.2 yamt * 144 1.1.2.2 yamt * Hardware Definitions & IO routines 145 1.1.2.2 yamt * 146 1.1.2.2 yamt * I made up the names for most of these defs since we dont have 147 1.1.2.2 yamt * manufacturers recommendations, but I dont like raw numbers.. 148 1.1.2.2 yamt * 149 1.1.2.2 yamt * all hardware routines are running at IPL_TTY 150 1.1.2.2 yamt * 151 1.1.2.2 yamt */ 152 1.1.2.2 yamt #define BT3C_ISR 0x7001 /* Interrupt Status Register */ 153 1.1.2.2 yamt #define BT3C_ISR_RXRDY (1<<0) /* Device has data */ 154 1.1.2.2 yamt #define BT3C_ISR_TXRDY (1<<1) /* Finished sending data */ 155 1.1.2.2 yamt #define BT3C_ISR_ANTENNA (1<<5) /* Antenna position changed */ 156 1.1.2.2 yamt 157 1.1.2.2 yamt #define BT3C_CSR 0x7002 /* Card Status Register */ 158 1.1.2.2 yamt #define BT3C_CSR_ANTENNA (1<<4) /* Antenna position */ 159 1.1.2.2 yamt 160 1.1.2.2 yamt #define BT3C_TX_COUNT 0x7005 /* Tx fifo contents */ 161 1.1.2.2 yamt #define BT3C_TX_FIFO 0x7080 /* Transmit Fifo */ 162 1.1.2.2 yamt #define BT3C_RX_COUNT 0x7006 /* Rx fifo contents */ 163 1.1.2.2 yamt #define BT3C_RX_FIFO 0x7480 /* Receive Fifo */ 164 1.1.2.2 yamt #define BT3C_FIFO_SIZE 256 165 1.1.2.2 yamt 166 1.1.2.2 yamt /* IO Registers */ 167 1.1.2.2 yamt #define BT3C_IOR_DATA_L 0x00 /* data low byte */ 168 1.1.2.2 yamt #define BT3C_IOR_DATA_H 0x01 /* data high byte */ 169 1.1.2.2 yamt #define BT3C_IOR_ADDR_L 0x02 /* address low byte */ 170 1.1.2.2 yamt #define BT3C_IOR_ADDR_H 0x03 /* address high byte */ 171 1.1.2.2 yamt #define BT3C_IOR_CNTL 0x04 /* control byte */ 172 1.1.2.2 yamt #define BT3C_IOR_CNTL_BOOT (1<<6) /* Boot Card */ 173 1.1.2.2 yamt #define BT3C_IOR_CNTL_INTR (1<<7) /* Interrupt Requested */ 174 1.1.2.2 yamt #define BT3C_IOR_LEN 0x05 175 1.1.2.2 yamt 176 1.1.2.2 yamt static inline uint16_t 177 1.1.2.2 yamt bt3c_get(struct bt3c_softc *sc) 178 1.1.2.2 yamt { 179 1.1.2.2 yamt uint16_t data; 180 1.1.2.2 yamt 181 1.1.2.2 yamt bus_space_barrier(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 182 1.1.2.2 yamt 0, BT3C_IOR_LEN, BUS_SPACE_BARRIER_READ); 183 1.1.2.2 yamt data = bus_space_read_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 184 1.1.2.2 yamt BT3C_IOR_DATA_L); 185 1.1.2.2 yamt data |= bus_space_read_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 186 1.1.2.2 yamt BT3C_IOR_DATA_H) << 8; 187 1.1.2.2 yamt 188 1.1.2.2 yamt return data; 189 1.1.2.2 yamt } 190 1.1.2.2 yamt 191 1.1.2.2 yamt static inline void 192 1.1.2.2 yamt bt3c_put(struct bt3c_softc *sc, uint16_t data) 193 1.1.2.2 yamt { 194 1.1.2.2 yamt 195 1.1.2.2 yamt bus_space_barrier(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 196 1.1.2.2 yamt 0, BT3C_IOR_LEN, BUS_SPACE_BARRIER_WRITE); 197 1.1.2.2 yamt bus_space_write_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 198 1.1.2.2 yamt BT3C_IOR_DATA_L, data & 0xff); 199 1.1.2.2 yamt bus_space_write_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 200 1.1.2.2 yamt BT3C_IOR_DATA_H, (data >> 8) & 0xff); 201 1.1.2.2 yamt } 202 1.1.2.2 yamt 203 1.1.2.2 yamt static inline uint8_t 204 1.1.2.2 yamt bt3c_read_control(struct bt3c_softc *sc) 205 1.1.2.2 yamt { 206 1.1.2.2 yamt 207 1.1.2.2 yamt bus_space_barrier(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 208 1.1.2.2 yamt 0, BT3C_IOR_LEN, BUS_SPACE_BARRIER_READ); 209 1.1.2.2 yamt return bus_space_read_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 210 1.1.2.2 yamt BT3C_IOR_CNTL); 211 1.1.2.2 yamt } 212 1.1.2.2 yamt 213 1.1.2.2 yamt static inline void 214 1.1.2.2 yamt bt3c_write_control(struct bt3c_softc *sc, uint8_t data) 215 1.1.2.2 yamt { 216 1.1.2.2 yamt 217 1.1.2.2 yamt bus_space_barrier(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 218 1.1.2.2 yamt 0, BT3C_IOR_LEN, BUS_SPACE_BARRIER_WRITE); 219 1.1.2.2 yamt bus_space_write_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 220 1.1.2.2 yamt BT3C_IOR_CNTL, data); 221 1.1.2.2 yamt } 222 1.1.2.2 yamt 223 1.1.2.2 yamt static inline void 224 1.1.2.2 yamt bt3c_set_address(struct bt3c_softc *sc, uint16_t addr) 225 1.1.2.2 yamt { 226 1.1.2.2 yamt 227 1.1.2.2 yamt bus_space_barrier(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 228 1.1.2.2 yamt 0, BT3C_IOR_LEN, BUS_SPACE_BARRIER_WRITE); 229 1.1.2.2 yamt bus_space_write_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 230 1.1.2.2 yamt BT3C_IOR_ADDR_L, addr & 0xff); 231 1.1.2.2 yamt bus_space_write_1(sc->sc_pcioh.iot, sc->sc_pcioh.ioh, 232 1.1.2.2 yamt BT3C_IOR_ADDR_H, (addr >> 8) & 0xff); 233 1.1.2.2 yamt } 234 1.1.2.2 yamt 235 1.1.2.2 yamt static inline uint16_t 236 1.1.2.2 yamt bt3c_read(struct bt3c_softc *sc, uint16_t addr) 237 1.1.2.2 yamt { 238 1.1.2.2 yamt 239 1.1.2.2 yamt bt3c_set_address(sc, addr); 240 1.1.2.2 yamt return bt3c_get(sc); 241 1.1.2.2 yamt } 242 1.1.2.2 yamt 243 1.1.2.2 yamt static inline void 244 1.1.2.2 yamt bt3c_write(struct bt3c_softc *sc, uint16_t addr, uint16_t data) 245 1.1.2.2 yamt { 246 1.1.2.2 yamt 247 1.1.2.2 yamt bt3c_set_address(sc, addr); 248 1.1.2.2 yamt bt3c_put(sc, data); 249 1.1.2.2 yamt } 250 1.1.2.2 yamt 251 1.1.2.2 yamt /* 252 1.1.2.2 yamt * receive incoming data from device, store in mbuf chain and 253 1.1.2.2 yamt * pass on complete packets to bt device 254 1.1.2.2 yamt */ 255 1.1.2.2 yamt static void 256 1.1.2.2 yamt bt3c_receive(struct bt3c_softc *sc) 257 1.1.2.2 yamt { 258 1.1.2.2 yamt struct mbuf *m = sc->sc_rxp; 259 1.1.2.2 yamt int space = 0; 260 1.1.2.2 yamt uint16_t count; 261 1.1.2.2 yamt uint8_t b; 262 1.1.2.2 yamt 263 1.1.2.2 yamt /* 264 1.1.2.2 yamt * If we already started a packet, find the 265 1.1.2.2 yamt * trailing end of it. 266 1.1.2.2 yamt */ 267 1.1.2.2 yamt if (m) { 268 1.1.2.2 yamt while (m->m_next) 269 1.1.2.2 yamt m = m->m_next; 270 1.1.2.2 yamt 271 1.1.2.2 yamt space = M_TRAILINGSPACE(m); 272 1.1.2.2 yamt } 273 1.1.2.2 yamt 274 1.1.2.2 yamt count = bt3c_read(sc, BT3C_RX_COUNT); 275 1.1.2.2 yamt bt3c_set_address(sc, BT3C_RX_FIFO); 276 1.1.2.2 yamt 277 1.1.2.2 yamt while (count > 0) { 278 1.1.2.2 yamt if (space == 0) { 279 1.1.2.2 yamt if (m == NULL) { 280 1.1.2.2 yamt /* new packet */ 281 1.1.2.2 yamt MGETHDR(m, M_DONTWAIT, MT_DATA); 282 1.1.2.2 yamt if (m == NULL) { 283 1.1.2.2 yamt printf("%s: out of memory\n", 284 1.1.2.2 yamt sc->sc_dev.dv_xname); 285 1.1.2.2 yamt ++sc->sc_unit.hci_stats.err_rx; 286 1.1.2.2 yamt goto out; /* (lost sync) */ 287 1.1.2.2 yamt } 288 1.1.2.2 yamt 289 1.1.2.2 yamt sc->sc_rxp = m; 290 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = 0; 291 1.1.2.2 yamt space = MHLEN; 292 1.1.2.2 yamt 293 1.1.2.2 yamt sc->sc_state = BT3C_RECV_PKT_TYPE; 294 1.1.2.2 yamt sc->sc_want = 1; 295 1.1.2.2 yamt } else { 296 1.1.2.2 yamt /* extend mbuf */ 297 1.1.2.2 yamt MGET(m->m_next, M_DONTWAIT, MT_DATA); 298 1.1.2.2 yamt if (m->m_next == NULL) { 299 1.1.2.2 yamt printf("%s: out of memory\n", 300 1.1.2.2 yamt sc->sc_dev.dv_xname); 301 1.1.2.2 yamt ++sc->sc_unit.hci_stats.err_rx; 302 1.1.2.2 yamt goto out; /* (lost sync) */ 303 1.1.2.2 yamt } 304 1.1.2.2 yamt 305 1.1.2.2 yamt m = m->m_next; 306 1.1.2.2 yamt m->m_len = 0; 307 1.1.2.2 yamt space = MLEN; 308 1.1.2.2 yamt 309 1.1.2.2 yamt if (sc->sc_want > MINCLSIZE) { 310 1.1.2.2 yamt MCLGET(m, M_DONTWAIT); 311 1.1.2.2 yamt if (m->m_flags & M_EXT) 312 1.1.2.2 yamt space = MCLBYTES; 313 1.1.2.2 yamt } 314 1.1.2.2 yamt } 315 1.1.2.2 yamt } 316 1.1.2.2 yamt 317 1.1.2.2 yamt b = bt3c_get(sc); 318 1.1.2.2 yamt mtod(m, uint8_t *)[m->m_len++] = b; 319 1.1.2.2 yamt count--; 320 1.1.2.2 yamt space--; 321 1.1.2.2 yamt sc->sc_rxp->m_pkthdr.len++; 322 1.1.2.2 yamt sc->sc_unit.hci_stats.byte_rx++; 323 1.1.2.2 yamt 324 1.1.2.2 yamt sc->sc_want--; 325 1.1.2.2 yamt if (sc->sc_want > 0) 326 1.1.2.2 yamt continue; /* want more */ 327 1.1.2.2 yamt 328 1.1.2.2 yamt switch (sc->sc_state) { 329 1.1.2.2 yamt case BT3C_RECV_PKT_TYPE: /* Got packet type */ 330 1.1.2.2 yamt 331 1.1.2.2 yamt switch (b) { 332 1.1.2.2 yamt case HCI_ACL_DATA_PKT: 333 1.1.2.2 yamt sc->sc_state = BT3C_RECV_ACL_HDR; 334 1.1.2.2 yamt sc->sc_want = sizeof(hci_acldata_hdr_t) - 1; 335 1.1.2.2 yamt break; 336 1.1.2.2 yamt 337 1.1.2.2 yamt case HCI_SCO_DATA_PKT: 338 1.1.2.2 yamt sc->sc_state = BT3C_RECV_SCO_HDR; 339 1.1.2.2 yamt sc->sc_want = sizeof(hci_scodata_hdr_t) - 1; 340 1.1.2.2 yamt break; 341 1.1.2.2 yamt 342 1.1.2.2 yamt case HCI_EVENT_PKT: 343 1.1.2.2 yamt sc->sc_state = BT3C_RECV_EVENT_HDR; 344 1.1.2.2 yamt sc->sc_want = sizeof(hci_event_hdr_t) - 1; 345 1.1.2.2 yamt break; 346 1.1.2.2 yamt 347 1.1.2.2 yamt default: 348 1.1.2.2 yamt printf("%s: Unknown packet type=%#x!\n", 349 1.1.2.2 yamt sc->sc_dev.dv_xname, b); 350 1.1.2.2 yamt ++sc->sc_unit.hci_stats.err_rx; 351 1.1.2.2 yamt m_freem(sc->sc_rxp); 352 1.1.2.2 yamt sc->sc_rxp = NULL; 353 1.1.2.2 yamt goto out; /* (lost sync) */ 354 1.1.2.2 yamt } 355 1.1.2.2 yamt 356 1.1.2.2 yamt break; 357 1.1.2.2 yamt 358 1.1.2.2 yamt /* 359 1.1.2.2 yamt * we assume (correctly of course :) that the packet headers 360 1.1.2.2 yamt * all fit into a single pkthdr mbuf 361 1.1.2.2 yamt */ 362 1.1.2.2 yamt case BT3C_RECV_ACL_HDR: /* Got ACL Header */ 363 1.1.2.2 yamt sc->sc_state = BT3C_RECV_ACL_DATA; 364 1.1.2.2 yamt sc->sc_want = mtod(m, hci_acldata_hdr_t *)->length; 365 1.1.2.2 yamt sc->sc_want = le16toh(sc->sc_want); 366 1.1.2.2 yamt break; 367 1.1.2.2 yamt 368 1.1.2.2 yamt case BT3C_RECV_SCO_HDR: /* Got SCO Header */ 369 1.1.2.2 yamt sc->sc_state = BT3C_RECV_SCO_DATA; 370 1.1.2.2 yamt sc->sc_want = mtod(m, hci_scodata_hdr_t *)->length; 371 1.1.2.2 yamt break; 372 1.1.2.2 yamt 373 1.1.2.2 yamt case BT3C_RECV_EVENT_HDR: /* Got Event Header */ 374 1.1.2.2 yamt sc->sc_state = BT3C_RECV_EVENT_DATA; 375 1.1.2.2 yamt sc->sc_want = mtod(m, hci_event_hdr_t *)->length; 376 1.1.2.2 yamt break; 377 1.1.2.2 yamt 378 1.1.2.2 yamt case BT3C_RECV_ACL_DATA: /* ACL Packet Complete */ 379 1.1.2.2 yamt hci_input_acl(&sc->sc_unit, sc->sc_rxp); 380 1.1.2.2 yamt sc->sc_unit.hci_stats.acl_rx++; 381 1.1.2.2 yamt sc->sc_rxp = m = NULL; 382 1.1.2.2 yamt space = 0; 383 1.1.2.2 yamt break; 384 1.1.2.2 yamt 385 1.1.2.2 yamt case BT3C_RECV_SCO_DATA: /* SCO Packet Complete */ 386 1.1.2.2 yamt hci_input_sco(&sc->sc_unit, sc->sc_rxp); 387 1.1.2.2 yamt sc->sc_unit.hci_stats.sco_rx++; 388 1.1.2.2 yamt sc->sc_rxp = m = NULL; 389 1.1.2.2 yamt space = 0; 390 1.1.2.2 yamt break; 391 1.1.2.2 yamt 392 1.1.2.2 yamt case BT3C_RECV_EVENT_DATA: /* Event Packet Complete */ 393 1.1.2.2 yamt sc->sc_unit.hci_stats.evt_rx++; 394 1.1.2.2 yamt hci_input_event(&sc->sc_unit, sc->sc_rxp); 395 1.1.2.2 yamt sc->sc_rxp = m = NULL; 396 1.1.2.2 yamt space = 0; 397 1.1.2.2 yamt break; 398 1.1.2.2 yamt 399 1.1.2.2 yamt default: 400 1.1.2.2 yamt panic("%s: invalid state %d!\n", 401 1.1.2.2 yamt sc->sc_dev.dv_xname, sc->sc_state); 402 1.1.2.2 yamt } 403 1.1.2.2 yamt } 404 1.1.2.2 yamt 405 1.1.2.2 yamt out: 406 1.1.2.2 yamt bt3c_write(sc, BT3C_RX_COUNT, 0x0000); 407 1.1.2.2 yamt } 408 1.1.2.2 yamt 409 1.1.2.2 yamt /* 410 1.1.2.2 yamt * write data from current packet to Transmit FIFO. 411 1.1.2.2 yamt * restart when done. 412 1.1.2.2 yamt */ 413 1.1.2.2 yamt static void 414 1.1.2.2 yamt bt3c_transmit(struct bt3c_softc *sc) 415 1.1.2.2 yamt { 416 1.1.2.2 yamt struct mbuf *m; 417 1.1.2.2 yamt int count, rlen; 418 1.1.2.2 yamt uint8_t *rptr; 419 1.1.2.2 yamt 420 1.1.2.2 yamt m = sc->sc_txp; 421 1.1.2.2 yamt if (m == NULL) { 422 1.1.2.2 yamt sc->sc_unit.hci_flags &= ~BTF_XMIT; 423 1.1.2.2 yamt bt3c_start(&sc->sc_unit); 424 1.1.2.2 yamt return; 425 1.1.2.2 yamt } 426 1.1.2.2 yamt 427 1.1.2.2 yamt count = 0; 428 1.1.2.2 yamt rlen = 0; 429 1.1.2.2 yamt rptr = mtod(m, uint8_t *); 430 1.1.2.2 yamt 431 1.1.2.2 yamt bt3c_set_address(sc, BT3C_TX_FIFO); 432 1.1.2.2 yamt 433 1.1.2.2 yamt for(;;) { 434 1.1.2.2 yamt if (rlen >= m->m_len) { 435 1.1.2.2 yamt m = m->m_next; 436 1.1.2.2 yamt if (m == NULL) { 437 1.1.2.2 yamt m = sc->sc_txp; 438 1.1.2.2 yamt sc->sc_txp = NULL; 439 1.1.2.2 yamt 440 1.1.2.2 yamt if (M_GETCTX(m, void *) == NULL) 441 1.1.2.2 yamt m_freem(m); 442 1.1.2.2 yamt else 443 1.1.2.2 yamt hci_complete_sco(&sc->sc_unit, m); 444 1.1.2.2 yamt 445 1.1.2.2 yamt break; 446 1.1.2.2 yamt } 447 1.1.2.2 yamt 448 1.1.2.2 yamt rlen = 0; 449 1.1.2.2 yamt rptr = mtod(m, uint8_t *); 450 1.1.2.2 yamt continue; 451 1.1.2.2 yamt } 452 1.1.2.2 yamt 453 1.1.2.2 yamt if (count >= BT3C_FIFO_SIZE) { 454 1.1.2.2 yamt m_adj(m, rlen); 455 1.1.2.2 yamt break; 456 1.1.2.2 yamt } 457 1.1.2.2 yamt 458 1.1.2.2 yamt bt3c_put(sc, *rptr++); 459 1.1.2.2 yamt rlen++; 460 1.1.2.2 yamt count++; 461 1.1.2.2 yamt } 462 1.1.2.2 yamt 463 1.1.2.2 yamt bt3c_write(sc, BT3C_TX_COUNT, count); 464 1.1.2.2 yamt sc->sc_unit.hci_stats.byte_tx += count; 465 1.1.2.2 yamt } 466 1.1.2.2 yamt 467 1.1.2.2 yamt /* 468 1.1.2.2 yamt * interrupt routine 469 1.1.2.2 yamt */ 470 1.1.2.2 yamt static int 471 1.1.2.2 yamt bt3c_intr(void *arg) 472 1.1.2.2 yamt { 473 1.1.2.2 yamt struct bt3c_softc *sc = arg; 474 1.1.2.2 yamt uint16_t control, isr; 475 1.1.2.2 yamt 476 1.1.2.2 yamt control = bt3c_read_control(sc); 477 1.1.2.2 yamt if (control & BT3C_IOR_CNTL_INTR) { 478 1.1.2.2 yamt isr = bt3c_read(sc, BT3C_ISR); 479 1.1.2.2 yamt if ((isr & 0xff) == 0x7f) { 480 1.1.2.2 yamt printf("%s: bt3c_intr got strange ISR=%04x\n", 481 1.1.2.2 yamt sc->sc_dev.dv_xname, isr); 482 1.1.2.2 yamt } else if ((isr & 0xff) != 0xff) { 483 1.1.2.2 yamt 484 1.1.2.2 yamt if (isr & BT3C_ISR_RXRDY) 485 1.1.2.2 yamt bt3c_receive(sc); 486 1.1.2.2 yamt 487 1.1.2.2 yamt if (isr & BT3C_ISR_TXRDY) 488 1.1.2.2 yamt bt3c_transmit(sc); 489 1.1.2.2 yamt 490 1.1.2.2 yamt #ifdef DIAGNOSTIC 491 1.1.2.2 yamt if (isr & BT3C_ISR_ANTENNA) { 492 1.1.2.2 yamt if (bt3c_read(sc, BT3C_CSR) & BT3C_CSR_ANTENNA) 493 1.1.2.2 yamt printf("%s: Antenna Out\n", 494 1.1.2.2 yamt sc->sc_dev.dv_xname); 495 1.1.2.2 yamt else 496 1.1.2.2 yamt printf("%s: Antenna In\n", 497 1.1.2.2 yamt sc->sc_dev.dv_xname); 498 1.1.2.2 yamt } 499 1.1.2.2 yamt #endif 500 1.1.2.2 yamt 501 1.1.2.2 yamt bt3c_write(sc, BT3C_ISR, 0x0000); 502 1.1.2.2 yamt bt3c_write_control(sc, control); 503 1.1.2.2 yamt 504 1.1.2.2 yamt return 1; /* handled */ 505 1.1.2.2 yamt } 506 1.1.2.2 yamt } 507 1.1.2.2 yamt 508 1.1.2.2 yamt return 0; /* not handled */ 509 1.1.2.2 yamt } 510 1.1.2.2 yamt 511 1.1.2.2 yamt /* 512 1.1.2.2 yamt * load firmware for the device 513 1.1.2.2 yamt * 514 1.1.2.2 yamt * The firmware file is a plain ASCII file containing lines in the format: 515 1.1.2.2 yamt * 516 1.1.2.2 yamt * S<Digit><Len><Address><Data1><Data2>...<DataN><Checksum> 517 1.1.2.2 yamt * 518 1.1.2.2 yamt * <Digit>: 0 start ? 519 1.1.2.2 yamt * 3 data line 520 1.1.2.2 yamt * 7 finish ? 521 1.1.2.2 yamt * 522 1.1.2.2 yamt * <Len>: 1 byte, and is the number of bytes in the rest of the line 523 1.1.2.2 yamt * <Address>: 4 byte address (only 2 bytes are valid for bt3c I think) 524 1.1.2.2 yamt * <Data>: 2 byte data word to be written to the address 525 1.1.2.2 yamt * <Checksum>: checksum of all bytes in the line including <Len> 526 1.1.2.2 yamt * 527 1.1.2.2 yamt * all bytes are in hexadecimal 528 1.1.2.2 yamt */ 529 1.1.2.2 yamt static inline int32_t 530 1.1.2.2 yamt hex(const uint8_t *p, int n) 531 1.1.2.2 yamt { 532 1.1.2.2 yamt uint32_t val = 0; 533 1.1.2.2 yamt 534 1.1.2.2 yamt while (n > 0) { 535 1.1.2.2 yamt val <<= 4; 536 1.1.2.2 yamt 537 1.1.2.2 yamt if ('0' <= *p && *p <= '9') 538 1.1.2.2 yamt val += (*p - '0'); 539 1.1.2.2 yamt else if ('a' <= *p && *p <= 'f') 540 1.1.2.2 yamt val += (*p - 'a' + 0xa); 541 1.1.2.2 yamt else if ('A' <= *p && *p <= 'F') 542 1.1.2.2 yamt val += (*p - 'A' + 0xa); 543 1.1.2.2 yamt else 544 1.1.2.2 yamt return -1; 545 1.1.2.2 yamt 546 1.1.2.2 yamt p++; 547 1.1.2.2 yamt n--; 548 1.1.2.2 yamt } 549 1.1.2.2 yamt 550 1.1.2.2 yamt return val; 551 1.1.2.2 yamt } 552 1.1.2.2 yamt 553 1.1.2.2 yamt static int 554 1.1.2.2 yamt bt3c_load_firmware(struct bt3c_softc *sc) 555 1.1.2.2 yamt { 556 1.1.2.2 yamt uint8_t *buf, *line, *next, *p; 557 1.1.2.2 yamt int32_t addr, data; 558 1.1.2.2 yamt int err, sum, len; 559 1.1.2.2 yamt firmware_handle_t fh; 560 1.1.2.2 yamt size_t size; 561 1.1.2.2 yamt 562 1.1.2.2 yamt err = firmware_open(sc->sc_dev.dv_cfdata->cf_name, 563 1.1.2.2 yamt BT3C_FIRMWARE_FILE, &fh); 564 1.1.2.2 yamt if (err) { 565 1.1.2.2 yamt printf("%s: Cannot open firmware %s/%s\n", sc->sc_dev.dv_xname, 566 1.1.2.2 yamt sc->sc_dev.dv_cfdata->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.2 yamt printf("%s: firmware file seems WAY too big!\n", 574 1.1.2.2 yamt sc->sc_dev.dv_xname); 575 1.1.2.3 yamt firmware_close(fh); 576 1.1.2.2 yamt return EFBIG; 577 1.1.2.2 yamt } 578 1.1.2.2 yamt #endif 579 1.1.2.2 yamt 580 1.1.2.2 yamt buf = firmware_malloc(size); 581 1.1.2.2 yamt KASSERT(buf != NULL); 582 1.1.2.2 yamt 583 1.1.2.2 yamt err = firmware_read(fh, 0, buf, size); 584 1.1.2.2 yamt if (err) { 585 1.1.2.2 yamt printf("%s: Firmware read failed (%d)\n", 586 1.1.2.2 yamt sc->sc_dev.dv_xname, err); 587 1.1.2.2 yamt goto out; 588 1.1.2.2 yamt } 589 1.1.2.2 yamt 590 1.1.2.2 yamt /* Reset */ 591 1.1.2.2 yamt bt3c_write(sc, 0x8040, 0x0404); 592 1.1.2.2 yamt bt3c_write(sc, 0x8040, 0x0400); 593 1.1.2.2 yamt DELAY(1); 594 1.1.2.2 yamt bt3c_write(sc, 0x8040, 0x0404); 595 1.1.2.2 yamt DELAY(17); 596 1.1.2.2 yamt 597 1.1.2.2 yamt next = buf; 598 1.1.2.2 yamt err = EFTYPE; 599 1.1.2.2 yamt 600 1.1.2.2 yamt while (next < buf + size) { 601 1.1.2.2 yamt line = next; 602 1.1.2.2 yamt 603 1.1.2.2 yamt while (*next != '\r' && *next != '\n') { 604 1.1.2.2 yamt if (next >= buf + size) 605 1.1.2.2 yamt goto out; 606 1.1.2.2 yamt 607 1.1.2.2 yamt next++; 608 1.1.2.2 yamt } 609 1.1.2.2 yamt 610 1.1.2.2 yamt /* 14 covers address and checksum minimum */ 611 1.1.2.2 yamt if (next - line < 14) 612 1.1.2.2 yamt goto out; 613 1.1.2.2 yamt 614 1.1.2.2 yamt if (line[0] != 'S') 615 1.1.2.2 yamt goto out; 616 1.1.2.2 yamt 617 1.1.2.2 yamt /* verify line length */ 618 1.1.2.2 yamt len = hex(line + 2, 2); 619 1.1.2.2 yamt if (len < 0 || next - line != len * 2 + 4) 620 1.1.2.2 yamt goto out; 621 1.1.2.2 yamt 622 1.1.2.2 yamt /* checksum the line */ 623 1.1.2.2 yamt sum = 0; 624 1.1.2.2 yamt for (p = line + 2 ; p < next ; p += 2) 625 1.1.2.2 yamt sum += hex(p, 2); 626 1.1.2.2 yamt 627 1.1.2.2 yamt if ((sum & 0xff) != 0xff) 628 1.1.2.2 yamt goto out; 629 1.1.2.2 yamt 630 1.1.2.2 yamt /* extract relevant data */ 631 1.1.2.2 yamt switch (line[1]) { 632 1.1.2.2 yamt case '0': 633 1.1.2.2 yamt /* I dont know what this is */ 634 1.1.2.2 yamt break; 635 1.1.2.2 yamt 636 1.1.2.2 yamt case '3': 637 1.1.2.2 yamt /* find number of data words */ 638 1.1.2.2 yamt len = (len - 5) / 2; 639 1.1.2.2 yamt if (len > 15) 640 1.1.2.2 yamt goto out; 641 1.1.2.2 yamt 642 1.1.2.2 yamt addr = hex(line + 8, 4); 643 1.1.2.2 yamt if (addr < 0) 644 1.1.2.2 yamt goto out; 645 1.1.2.2 yamt 646 1.1.2.2 yamt bt3c_set_address(sc, addr); 647 1.1.2.2 yamt 648 1.1.2.2 yamt for (p = line + 12 ; p + 4 < next ; p += 4) { 649 1.1.2.2 yamt data = hex(p, 4); 650 1.1.2.2 yamt if (data < 0) 651 1.1.2.2 yamt goto out; 652 1.1.2.2 yamt 653 1.1.2.2 yamt bt3c_put(sc, data); 654 1.1.2.2 yamt } 655 1.1.2.2 yamt break; 656 1.1.2.2 yamt 657 1.1.2.2 yamt case '7': 658 1.1.2.2 yamt /* I dont know what this is */ 659 1.1.2.2 yamt break; 660 1.1.2.2 yamt 661 1.1.2.2 yamt default: 662 1.1.2.2 yamt goto out; 663 1.1.2.2 yamt } 664 1.1.2.2 yamt 665 1.1.2.2 yamt /* skip to start of next line */ 666 1.1.2.2 yamt while (next < buf + size && (*next == '\r' || *next == '\n')) 667 1.1.2.2 yamt next++; 668 1.1.2.2 yamt } 669 1.1.2.2 yamt 670 1.1.2.2 yamt err = 0; 671 1.1.2.2 yamt DELAY(17); 672 1.1.2.2 yamt 673 1.1.2.2 yamt /* Boot */ 674 1.1.2.2 yamt bt3c_set_address(sc, 0x3000); 675 1.1.2.2 yamt bt3c_write_control(sc, (bt3c_read_control(sc) | BT3C_IOR_CNTL_BOOT)); 676 1.1.2.2 yamt DELAY(17); 677 1.1.2.2 yamt 678 1.1.2.2 yamt /* Clear Registers */ 679 1.1.2.2 yamt bt3c_write(sc, BT3C_RX_COUNT, 0x0000); 680 1.1.2.2 yamt bt3c_write(sc, BT3C_TX_COUNT, 0x0000); 681 1.1.2.2 yamt bt3c_write(sc, BT3C_ISR, 0x0000); 682 1.1.2.2 yamt DELAY(1000); 683 1.1.2.2 yamt 684 1.1.2.2 yamt out: 685 1.1.2.2 yamt firmware_free(buf, size); 686 1.1.2.2 yamt firmware_close(fh); 687 1.1.2.2 yamt return err; 688 1.1.2.2 yamt } 689 1.1.2.2 yamt 690 1.1.2.2 yamt /************************************************************************** 691 1.1.2.2 yamt * 692 1.1.2.2 yamt * bt device callbacks (all called at IPL_TTY) 693 1.1.2.2 yamt */ 694 1.1.2.2 yamt 695 1.1.2.2 yamt /* 696 1.1.2.2 yamt * start sending on bt3c 697 1.1.2.2 yamt * this should be called only when BTF_XMIT is not set, and 698 1.1.2.2 yamt * we only send cmd packets that are clear to send 699 1.1.2.2 yamt */ 700 1.1.2.2 yamt static void 701 1.1.2.2 yamt bt3c_start(struct hci_unit *unit) 702 1.1.2.2 yamt { 703 1.1.2.2 yamt struct bt3c_softc *sc = unit->hci_softc; 704 1.1.2.2 yamt struct mbuf *m; 705 1.1.2.2 yamt 706 1.1.2.2 yamt KASSERT((unit->hci_flags & BTF_XMIT) == 0); 707 1.1.2.2 yamt KASSERT(sc->sc_txp == NULL); 708 1.1.2.2 yamt 709 1.1.2.2 yamt if (MBUFQ_FIRST(&unit->hci_cmdq)) { 710 1.1.2.2 yamt MBUFQ_DEQUEUE(&unit->hci_cmdq, m); 711 1.1.2.2 yamt unit->hci_stats.cmd_tx++; 712 1.1.2.2 yamt M_SETCTX(m, NULL); 713 1.1.2.2 yamt goto start; 714 1.1.2.2 yamt } 715 1.1.2.2 yamt 716 1.1.2.2 yamt if (MBUFQ_FIRST(&unit->hci_scotxq)) { 717 1.1.2.2 yamt MBUFQ_DEQUEUE(&unit->hci_scotxq, m); 718 1.1.2.2 yamt unit->hci_stats.sco_tx++; 719 1.1.2.2 yamt goto start; 720 1.1.2.2 yamt } 721 1.1.2.2 yamt 722 1.1.2.2 yamt if (MBUFQ_FIRST(&unit->hci_acltxq)) { 723 1.1.2.2 yamt MBUFQ_DEQUEUE(&unit->hci_acltxq, m); 724 1.1.2.2 yamt unit->hci_stats.acl_tx++; 725 1.1.2.2 yamt M_SETCTX(m, NULL); 726 1.1.2.2 yamt goto start; 727 1.1.2.2 yamt } 728 1.1.2.2 yamt 729 1.1.2.2 yamt /* Nothing to send */ 730 1.1.2.2 yamt return; 731 1.1.2.2 yamt 732 1.1.2.2 yamt start: 733 1.1.2.2 yamt sc->sc_txp = m; 734 1.1.2.2 yamt unit->hci_flags |= BTF_XMIT; 735 1.1.2.2 yamt bt3c_transmit(sc); 736 1.1.2.2 yamt } 737 1.1.2.2 yamt 738 1.1.2.2 yamt /* 739 1.1.2.2 yamt * enable device 740 1.1.2.2 yamt * turn on card 741 1.1.2.2 yamt * load firmware 742 1.1.2.2 yamt * establish interrupts 743 1.1.2.2 yamt */ 744 1.1.2.2 yamt static int 745 1.1.2.2 yamt bt3c_enable(struct hci_unit *unit) 746 1.1.2.2 yamt { 747 1.1.2.2 yamt struct bt3c_softc *sc = unit->hci_softc; 748 1.1.2.2 yamt int err; 749 1.1.2.2 yamt 750 1.1.2.2 yamt if (unit->hci_flags & BTF_RUNNING) 751 1.1.2.2 yamt return 0; 752 1.1.2.2 yamt 753 1.1.2.2 yamt sc->sc_intr = pcmcia_intr_establish(sc->sc_pf, IPL_TTY, bt3c_intr, sc); 754 1.1.2.2 yamt if (sc->sc_intr == NULL) { 755 1.1.2.2 yamt err = EIO; 756 1.1.2.2 yamt goto bad; 757 1.1.2.2 yamt } 758 1.1.2.2 yamt 759 1.1.2.2 yamt err = pcmcia_function_enable(sc->sc_pf); 760 1.1.2.2 yamt if (err) 761 1.1.2.2 yamt goto bad1; 762 1.1.2.2 yamt 763 1.1.2.2 yamt err = bt3c_load_firmware(sc); 764 1.1.2.2 yamt if (err) 765 1.1.2.2 yamt goto bad2; 766 1.1.2.2 yamt 767 1.1.2.2 yamt unit->hci_flags |= BTF_RUNNING; 768 1.1.2.2 yamt unit->hci_flags &= ~BTF_XMIT; 769 1.1.2.2 yamt 770 1.1.2.2 yamt /* 771 1.1.2.2 yamt * 3Com card will send a Command_Status packet when its 772 1.1.2.2 yamt * ready to receive commands 773 1.1.2.2 yamt */ 774 1.1.2.2 yamt unit->hci_num_cmd_pkts = 0; 775 1.1.2.2 yamt 776 1.1.2.2 yamt return 0; 777 1.1.2.2 yamt 778 1.1.2.2 yamt bad2: 779 1.1.2.2 yamt pcmcia_function_disable(sc->sc_pf); 780 1.1.2.2 yamt bad1: 781 1.1.2.2 yamt pcmcia_intr_disestablish(sc->sc_pf, sc->sc_intr); 782 1.1.2.2 yamt sc->sc_intr = NULL; 783 1.1.2.2 yamt bad: 784 1.1.2.2 yamt return err; 785 1.1.2.2 yamt } 786 1.1.2.2 yamt 787 1.1.2.2 yamt /* 788 1.1.2.2 yamt * disable device 789 1.1.2.2 yamt * shut down card 790 1.1.2.2 yamt * disestablish interrupts 791 1.1.2.2 yamt * free held packets 792 1.1.2.2 yamt */ 793 1.1.2.2 yamt static void 794 1.1.2.2 yamt bt3c_disable(struct hci_unit *unit) 795 1.1.2.2 yamt { 796 1.1.2.2 yamt struct bt3c_softc *sc = unit->hci_softc; 797 1.1.2.2 yamt 798 1.1.2.2 yamt if ((unit->hci_flags & BTF_RUNNING) == 0) 799 1.1.2.2 yamt return; 800 1.1.2.2 yamt 801 1.1.2.2 yamt pcmcia_function_disable(sc->sc_pf); 802 1.1.2.2 yamt 803 1.1.2.2 yamt if (sc->sc_intr) { 804 1.1.2.2 yamt pcmcia_intr_disestablish(sc->sc_pf, sc->sc_intr); 805 1.1.2.2 yamt sc->sc_intr = NULL; 806 1.1.2.2 yamt } 807 1.1.2.2 yamt 808 1.1.2.2 yamt if (sc->sc_rxp) { 809 1.1.2.2 yamt m_freem(sc->sc_rxp); 810 1.1.2.2 yamt sc->sc_rxp = NULL; 811 1.1.2.2 yamt } 812 1.1.2.2 yamt 813 1.1.2.2 yamt if (sc->sc_txp) { 814 1.1.2.2 yamt m_freem(sc->sc_txp); 815 1.1.2.2 yamt sc->sc_txp = NULL; 816 1.1.2.2 yamt } 817 1.1.2.2 yamt 818 1.1.2.2 yamt unit->hci_flags &= ~BTF_RUNNING; 819 1.1.2.2 yamt } 820 1.1.2.2 yamt 821 1.1.2.2 yamt /************************************************************************** 822 1.1.2.2 yamt * 823 1.1.2.2 yamt * bt3c PCMCIA autoconfig glue 824 1.1.2.2 yamt */ 825 1.1.2.2 yamt 826 1.1.2.2 yamt static int 827 1.1.2.3 yamt bt3c_match(struct device *parent, struct cfdata *match, 828 1.1.2.3 yamt void *aux) 829 1.1.2.2 yamt { 830 1.1.2.2 yamt struct pcmcia_attach_args *pa = aux; 831 1.1.2.2 yamt 832 1.1.2.2 yamt if (pa->manufacturer == PCMCIA_VENDOR_3COM && 833 1.1.2.2 yamt pa->product == PCMCIA_PRODUCT_3COM_3CRWB6096) 834 1.1.2.2 yamt return 10; /* 'com' also claims this, so trump them */ 835 1.1.2.2 yamt 836 1.1.2.2 yamt return 0; 837 1.1.2.2 yamt } 838 1.1.2.2 yamt 839 1.1.2.2 yamt static void 840 1.1.2.2 yamt bt3c_attach(struct device *parent, struct device *self, void *aux) 841 1.1.2.2 yamt { 842 1.1.2.2 yamt struct bt3c_softc *sc = (struct bt3c_softc *)self; 843 1.1.2.2 yamt struct pcmcia_attach_args *pa = aux; 844 1.1.2.2 yamt struct pcmcia_config_entry *cfe; 845 1.1.2.2 yamt 846 1.1.2.2 yamt sc->sc_pf = pa->pf; 847 1.1.2.2 yamt 848 1.1.2.2 yamt /* Find a PCMCIA config entry we can use */ 849 1.1.2.2 yamt SIMPLEQ_FOREACH(cfe, &pa->pf->cfe_head, cfe_list) { 850 1.1.2.2 yamt if (cfe->num_memspace != 0) 851 1.1.2.2 yamt continue; 852 1.1.2.2 yamt 853 1.1.2.2 yamt if (cfe->num_iospace != 1) 854 1.1.2.2 yamt continue; 855 1.1.2.2 yamt 856 1.1.2.2 yamt if (pcmcia_io_alloc(pa->pf, cfe->iospace[0].start, 857 1.1.2.2 yamt cfe->iospace[0].length, 0, &sc->sc_pcioh) == 0) 858 1.1.2.2 yamt break; 859 1.1.2.2 yamt } 860 1.1.2.2 yamt 861 1.1.2.2 yamt if (cfe == 0) { 862 1.1.2.2 yamt aprint_error("bt3c_attach: cannot allocate io space\n"); 863 1.1.2.2 yamt goto no_config_entry; 864 1.1.2.2 yamt } 865 1.1.2.2 yamt 866 1.1.2.2 yamt /* Initialise it */ 867 1.1.2.2 yamt pcmcia_function_init(pa->pf, cfe); 868 1.1.2.2 yamt 869 1.1.2.2 yamt /* Map in the io space */ 870 1.1.2.2 yamt if (pcmcia_io_map(pa->pf, PCMCIA_WIDTH_AUTO, 871 1.1.2.2 yamt &sc->sc_pcioh, &sc->sc_iow)) { 872 1.1.2.2 yamt aprint_error("bt3c_attach: cannot map io space\n"); 873 1.1.2.2 yamt goto iomap_failed; 874 1.1.2.2 yamt } 875 1.1.2.2 yamt 876 1.1.2.2 yamt /* Attach Bluetooth unit */ 877 1.1.2.2 yamt sc->sc_unit.hci_softc = sc; 878 1.1.2.2 yamt sc->sc_unit.hci_devname = sc->sc_dev.dv_xname; 879 1.1.2.2 yamt sc->sc_unit.hci_enable = bt3c_enable; 880 1.1.2.2 yamt sc->sc_unit.hci_disable = bt3c_disable; 881 1.1.2.2 yamt sc->sc_unit.hci_start_cmd = bt3c_start; 882 1.1.2.2 yamt sc->sc_unit.hci_start_acl = bt3c_start; 883 1.1.2.2 yamt sc->sc_unit.hci_start_sco = bt3c_start; 884 1.1.2.3 yamt sc->sc_unit.hci_ipl = makeiplcookie(IPL_TTY); 885 1.1.2.2 yamt hci_attach(&sc->sc_unit); 886 1.1.2.2 yamt 887 1.1.2.2 yamt /* establish a power change hook */ 888 1.1.2.3 yamt sc->sc_powerhook = powerhook_establish(sc->sc_dev.dv_xname, 889 1.1.2.3 yamt bt3c_power, sc); 890 1.1.2.2 yamt return; 891 1.1.2.2 yamt 892 1.1.2.2 yamt iomap_failed: 893 1.1.2.2 yamt /* unmap io space */ 894 1.1.2.2 yamt pcmcia_io_free(pa->pf, &sc->sc_pcioh); 895 1.1.2.2 yamt 896 1.1.2.2 yamt no_config_entry: 897 1.1.2.2 yamt sc->sc_iow = -1; 898 1.1.2.2 yamt } 899 1.1.2.2 yamt 900 1.1.2.2 yamt static int 901 1.1.2.2 yamt bt3c_detach(struct device *self, int flags) 902 1.1.2.2 yamt { 903 1.1.2.2 yamt struct bt3c_softc *sc = (struct bt3c_softc *)self; 904 1.1.2.2 yamt int err = 0; 905 1.1.2.2 yamt 906 1.1.2.2 yamt bt3c_disable(&sc->sc_unit); 907 1.1.2.2 yamt 908 1.1.2.2 yamt if (sc->sc_powerhook) { 909 1.1.2.2 yamt powerhook_disestablish(sc->sc_powerhook); 910 1.1.2.2 yamt sc->sc_powerhook = NULL; 911 1.1.2.2 yamt } 912 1.1.2.2 yamt 913 1.1.2.2 yamt hci_detach(&sc->sc_unit); 914 1.1.2.2 yamt 915 1.1.2.2 yamt if (sc->sc_iow != -1) { 916 1.1.2.2 yamt pcmcia_io_unmap(sc->sc_pf, sc->sc_iow); 917 1.1.2.2 yamt pcmcia_io_free(sc->sc_pf, &sc->sc_pcioh); 918 1.1.2.2 yamt sc->sc_iow = -1; 919 1.1.2.2 yamt } 920 1.1.2.2 yamt 921 1.1.2.2 yamt return err; 922 1.1.2.2 yamt } 923 1.1.2.2 yamt 924 1.1.2.2 yamt static int 925 1.1.2.2 yamt bt3c_activate(struct device *self, enum devact act) 926 1.1.2.2 yamt { 927 1.1.2.2 yamt // struct bt3c_softc *sc = (struct bt3c_softc *)self; 928 1.1.2.2 yamt int err = 0; 929 1.1.2.2 yamt 930 1.1.2.2 yamt switch(act) { 931 1.1.2.2 yamt case DVACT_ACTIVATE: 932 1.1.2.2 yamt err = EOPNOTSUPP; 933 1.1.2.2 yamt break; 934 1.1.2.2 yamt 935 1.1.2.2 yamt case DVACT_DEACTIVATE: 936 1.1.2.2 yamt // could notify unit somehow? 937 1.1.2.2 yamt break; 938 1.1.2.2 yamt } 939 1.1.2.2 yamt 940 1.1.2.2 yamt return err; 941 1.1.2.2 yamt } 942 1.1.2.2 yamt 943 1.1.2.2 yamt static void 944 1.1.2.2 yamt bt3c_power(int why, void *arg) 945 1.1.2.2 yamt { 946 1.1.2.2 yamt struct bt3c_softc *sc = arg; 947 1.1.2.2 yamt 948 1.1.2.2 yamt switch(why) { 949 1.1.2.2 yamt case PWR_SUSPEND: 950 1.1.2.2 yamt case PWR_STANDBY: 951 1.1.2.2 yamt if (sc->sc_unit.hci_flags & BTF_RUNNING) { 952 1.1.2.3 yamt hci_detach(&sc->sc_unit); 953 1.1.2.3 yamt 954 1.1.2.2 yamt sc->sc_flags |= BT3C_SLEEPING; 955 1.1.2.3 yamt printf_nolog("%s: sleeping\n", sc->sc_dev.dv_xname); 956 1.1.2.2 yamt } 957 1.1.2.2 yamt break; 958 1.1.2.2 yamt 959 1.1.2.2 yamt case PWR_RESUME: 960 1.1.2.2 yamt if (sc->sc_flags & BT3C_SLEEPING) { 961 1.1.2.2 yamt printf_nolog("%s: waking up\n", sc->sc_dev.dv_xname); 962 1.1.2.2 yamt sc->sc_flags &= ~BT3C_SLEEPING; 963 1.1.2.3 yamt 964 1.1.2.3 yamt memset(&sc->sc_unit, 0, sizeof(sc->sc_unit)); 965 1.1.2.3 yamt sc->sc_unit.hci_softc = sc; 966 1.1.2.3 yamt sc->sc_unit.hci_devname = sc->sc_dev.dv_xname; 967 1.1.2.3 yamt sc->sc_unit.hci_enable = bt3c_enable; 968 1.1.2.3 yamt sc->sc_unit.hci_disable = bt3c_disable; 969 1.1.2.3 yamt sc->sc_unit.hci_start_cmd = bt3c_start; 970 1.1.2.3 yamt sc->sc_unit.hci_start_acl = bt3c_start; 971 1.1.2.3 yamt sc->sc_unit.hci_start_sco = bt3c_start; 972 1.1.2.3 yamt sc->sc_unit.hci_ipl = makeiplcookie(IPL_TTY); 973 1.1.2.3 yamt hci_attach(&sc->sc_unit); 974 1.1.2.2 yamt } 975 1.1.2.2 yamt break; 976 1.1.2.2 yamt 977 1.1.2.2 yamt case PWR_SOFTSUSPEND: 978 1.1.2.2 yamt case PWR_SOFTSTANDBY: 979 1.1.2.2 yamt case PWR_SOFTRESUME: 980 1.1.2.2 yamt break; 981 1.1.2.2 yamt } 982 1.1.2.2 yamt } 983
Indexes created Mon Oct 27 04:09:48 GMT 2025