1ceaec73dSDamien Bergamini /* $FreeBSD$ */ 2ceaec73dSDamien Bergamini 3ceaec73dSDamien Bergamini /*- 4ceaec73dSDamien Bergamini * Copyright (c) 2004, 2005 5ceaec73dSDamien Bergamini * Damien Bergamini <damien.bergamini@free.fr>. All rights reserved. 6ceaec73dSDamien Bergamini * 7ceaec73dSDamien Bergamini * Redistribution and use in source and binary forms, with or without 8ceaec73dSDamien Bergamini * modification, are permitted provided that the following conditions 9ceaec73dSDamien Bergamini * are met: 10ceaec73dSDamien Bergamini * 1. Redistributions of source code must retain the above copyright 11ceaec73dSDamien Bergamini * notice unmodified, this list of conditions, and the following 12ceaec73dSDamien Bergamini * disclaimer. 13ceaec73dSDamien Bergamini * 2. Redistributions in binary form must reproduce the above copyright 14ceaec73dSDamien Bergamini * notice, this list of conditions and the following disclaimer in the 15ceaec73dSDamien Bergamini * documentation and/or other materials provided with the distribution. 16ceaec73dSDamien Bergamini * 17ceaec73dSDamien Bergamini * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 18ceaec73dSDamien Bergamini * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19ceaec73dSDamien Bergamini * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20ceaec73dSDamien Bergamini * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 21ceaec73dSDamien Bergamini * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22ceaec73dSDamien Bergamini * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23ceaec73dSDamien Bergamini * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24ceaec73dSDamien Bergamini * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25ceaec73dSDamien Bergamini * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26ceaec73dSDamien Bergamini * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27ceaec73dSDamien Bergamini * SUCH DAMAGE. 28ceaec73dSDamien Bergamini */ 29ceaec73dSDamien Bergamini 30ceaec73dSDamien Bergamini #include <sys/cdefs.h> 31ceaec73dSDamien Bergamini __FBSDID("$FreeBSD$"); 32ceaec73dSDamien Bergamini 33ceaec73dSDamien Bergamini /*- 34ceaec73dSDamien Bergamini * Intel(R) PRO/Wireless 2200BG/2225BG/2915ABG driver 35ceaec73dSDamien Bergamini * http://www.intel.com/network/connectivity/products/wireless/prowireless_mobile.htm 36ceaec73dSDamien Bergamini */ 37ceaec73dSDamien Bergamini 38ceaec73dSDamien Bergamini #include <sys/param.h> 39ceaec73dSDamien Bergamini #include <sys/sysctl.h> 40ceaec73dSDamien Bergamini #include <sys/sockio.h> 41ceaec73dSDamien Bergamini #include <sys/mbuf.h> 42ceaec73dSDamien Bergamini #include <sys/kernel.h> 43ceaec73dSDamien Bergamini #include <sys/socket.h> 44ceaec73dSDamien Bergamini #include <sys/systm.h> 45ceaec73dSDamien Bergamini #include <sys/malloc.h> 46ceaec73dSDamien Bergamini #include <sys/module.h> 47ceaec73dSDamien Bergamini #include <sys/bus.h> 48ceaec73dSDamien Bergamini #include <sys/endian.h> 49408146edSDamien Bergamini #include <sys/proc.h> 50408146edSDamien Bergamini #include <sys/mount.h> 51408146edSDamien Bergamini #include <sys/namei.h> 52408146edSDamien Bergamini #include <sys/vnode.h> 53ceaec73dSDamien Bergamini 54ceaec73dSDamien Bergamini #include <machine/bus.h> 55ceaec73dSDamien Bergamini #include <machine/resource.h> 56ceaec73dSDamien Bergamini #include <machine/clock.h> 57ceaec73dSDamien Bergamini #include <sys/rman.h> 58ceaec73dSDamien Bergamini 59ceaec73dSDamien Bergamini #include <dev/pci/pcireg.h> 60ceaec73dSDamien Bergamini #include <dev/pci/pcivar.h> 61ceaec73dSDamien Bergamini 62ceaec73dSDamien Bergamini #include <net/bpf.h> 63ceaec73dSDamien Bergamini #include <net/if.h> 64ceaec73dSDamien Bergamini #include <net/if_arp.h> 65ceaec73dSDamien Bergamini #include <net/ethernet.h> 66ceaec73dSDamien Bergamini #include <net/if_dl.h> 67ceaec73dSDamien Bergamini #include <net/if_media.h> 68ceaec73dSDamien Bergamini #include <net/if_types.h> 69ceaec73dSDamien Bergamini 70ceaec73dSDamien Bergamini #include <net80211/ieee80211_var.h> 71ceaec73dSDamien Bergamini #include <net80211/ieee80211_radiotap.h> 72ceaec73dSDamien Bergamini 73ceaec73dSDamien Bergamini #include <netinet/in.h> 74ceaec73dSDamien Bergamini #include <netinet/in_systm.h> 75ceaec73dSDamien Bergamini #include <netinet/in_var.h> 76ceaec73dSDamien Bergamini #include <netinet/ip.h> 77ceaec73dSDamien Bergamini #include <netinet/if_ether.h> 78ceaec73dSDamien Bergamini 79ceaec73dSDamien Bergamini #include <dev/iwi/if_iwireg.h> 80ceaec73dSDamien Bergamini #include <dev/iwi/if_iwivar.h> 81ceaec73dSDamien Bergamini 82ceaec73dSDamien Bergamini #ifdef IWI_DEBUG 83ceaec73dSDamien Bergamini #define DPRINTF(x) do { if (iwi_debug > 0) printf x; } while (0) 84ceaec73dSDamien Bergamini #define DPRINTFN(n, x) do { if (iwi_debug >= (n)) printf x; } while (0) 85ceaec73dSDamien Bergamini int iwi_debug = 0; 86ceaec73dSDamien Bergamini SYSCTL_INT(_debug, OID_AUTO, iwi, CTLFLAG_RW, &iwi_debug, 0, "iwi debug level"); 87ceaec73dSDamien Bergamini #else 88ceaec73dSDamien Bergamini #define DPRINTF(x) 89ceaec73dSDamien Bergamini #define DPRINTFN(n, x) 90ceaec73dSDamien Bergamini #endif 91ceaec73dSDamien Bergamini 92ceaec73dSDamien Bergamini MODULE_DEPEND(iwi, pci, 1, 1, 1); 93ceaec73dSDamien Bergamini MODULE_DEPEND(iwi, wlan, 1, 1, 1); 94ceaec73dSDamien Bergamini 95ceaec73dSDamien Bergamini struct iwi_ident { 96ceaec73dSDamien Bergamini uint16_t vendor; 97ceaec73dSDamien Bergamini uint16_t device; 98ceaec73dSDamien Bergamini const char *name; 99ceaec73dSDamien Bergamini }; 100ceaec73dSDamien Bergamini 101ceaec73dSDamien Bergamini static const struct iwi_ident iwi_ident_table[] = { 102ceaec73dSDamien Bergamini { 0x8086, 0x4220, "Intel(R) PRO/Wireless 2200BG" }, 103ceaec73dSDamien Bergamini { 0x8086, 0x4221, "Intel(R) PRO/Wireless 2225BG" }, 104ceaec73dSDamien Bergamini { 0x8086, 0x4223, "Intel(R) PRO/Wireless 2915ABG" }, 105ceaec73dSDamien Bergamini { 0x8086, 0x4224, "Intel(R) PRO/Wireless 2915ABG" }, 106ceaec73dSDamien Bergamini 107ceaec73dSDamien Bergamini { 0, 0, NULL } 108ceaec73dSDamien Bergamini }; 109ceaec73dSDamien Bergamini 110ceaec73dSDamien Bergamini static void iwi_dma_map_addr(void *, bus_dma_segment_t *, int, int); 111ceaec73dSDamien Bergamini static int iwi_alloc_cmd_ring(struct iwi_softc *, struct iwi_cmd_ring *, 112ceaec73dSDamien Bergamini int); 113ceaec73dSDamien Bergamini static void iwi_reset_cmd_ring(struct iwi_softc *, struct iwi_cmd_ring *); 114ceaec73dSDamien Bergamini static void iwi_free_cmd_ring(struct iwi_softc *, struct iwi_cmd_ring *); 115ceaec73dSDamien Bergamini static int iwi_alloc_tx_ring(struct iwi_softc *, struct iwi_tx_ring *, 116ec01dc2bSDamien Bergamini int, bus_addr_t, bus_addr_t); 117ceaec73dSDamien Bergamini static void iwi_reset_tx_ring(struct iwi_softc *, struct iwi_tx_ring *); 118ceaec73dSDamien Bergamini static void iwi_free_tx_ring(struct iwi_softc *, struct iwi_tx_ring *); 119ceaec73dSDamien Bergamini static int iwi_alloc_rx_ring(struct iwi_softc *, struct iwi_rx_ring *, 120ceaec73dSDamien Bergamini int); 121ceaec73dSDamien Bergamini static void iwi_reset_rx_ring(struct iwi_softc *, struct iwi_rx_ring *); 122ceaec73dSDamien Bergamini static void iwi_free_rx_ring(struct iwi_softc *, struct iwi_rx_ring *); 12328a38073SDamien Bergamini static struct ieee80211_node *iwi_node_alloc(struct ieee80211_node_table *); 12428a38073SDamien Bergamini static void iwi_node_free(struct ieee80211_node *); 125ceaec73dSDamien Bergamini static int iwi_media_change(struct ifnet *); 126ceaec73dSDamien Bergamini static void iwi_media_status(struct ifnet *, struct ifmediareq *); 127ceaec73dSDamien Bergamini static int iwi_newstate(struct ieee80211com *, enum ieee80211_state, int); 128ec01dc2bSDamien Bergamini static int iwi_wme_update(struct ieee80211com *); 129ceaec73dSDamien Bergamini static uint16_t iwi_read_prom_word(struct iwi_softc *, uint8_t); 130ceaec73dSDamien Bergamini static void iwi_fix_channel(struct ieee80211com *, struct mbuf *); 131ceaec73dSDamien Bergamini static void iwi_frame_intr(struct iwi_softc *, struct iwi_rx_data *, int, 132ceaec73dSDamien Bergamini struct iwi_frame *); 133ceaec73dSDamien Bergamini static void iwi_notification_intr(struct iwi_softc *, struct iwi_notif *); 134ceaec73dSDamien Bergamini static void iwi_rx_intr(struct iwi_softc *); 135ec01dc2bSDamien Bergamini static void iwi_tx_intr(struct iwi_softc *, struct iwi_tx_ring *); 136ceaec73dSDamien Bergamini static void iwi_intr(void *); 137ceaec73dSDamien Bergamini static int iwi_cmd(struct iwi_softc *, uint8_t, void *, uint8_t, int); 13828a38073SDamien Bergamini static void iwi_write_ibssnode(struct iwi_softc *, const struct iwi_node *); 139ceaec73dSDamien Bergamini static int iwi_tx_start(struct ifnet *, struct mbuf *, 1400b74a285SDamien Bergamini struct ieee80211_node *, int); 141ceaec73dSDamien Bergamini static void iwi_start(struct ifnet *); 142ceaec73dSDamien Bergamini static void iwi_watchdog(struct ifnet *); 143ceaec73dSDamien Bergamini static int iwi_ioctl(struct ifnet *, u_long, caddr_t); 144ceaec73dSDamien Bergamini static void iwi_stop_master(struct iwi_softc *); 145ceaec73dSDamien Bergamini static int iwi_reset(struct iwi_softc *); 146408146edSDamien Bergamini static int iwi_load_ucode(struct iwi_softc *, const char *); 147408146edSDamien Bergamini static int iwi_load_firmware(struct iwi_softc *, const char *); 148ceaec73dSDamien Bergamini static int iwi_config(struct iwi_softc *); 149acea4241SDamien Bergamini static int iwi_set_chan(struct iwi_softc *, struct ieee80211_channel *); 150ceaec73dSDamien Bergamini static int iwi_scan(struct iwi_softc *); 151ceaec73dSDamien Bergamini static int iwi_auth_and_assoc(struct iwi_softc *); 152ceaec73dSDamien Bergamini static void iwi_init(void *); 153ceaec73dSDamien Bergamini static void iwi_stop(void *); 154408146edSDamien Bergamini static int iwi_read_firmware(const char *, caddr_t *, size_t *); 155ceaec73dSDamien Bergamini static int iwi_sysctl_stats(SYSCTL_HANDLER_ARGS); 156ceaec73dSDamien Bergamini static int iwi_sysctl_radio(SYSCTL_HANDLER_ARGS); 157ceaec73dSDamien Bergamini 158ceaec73dSDamien Bergamini static int iwi_probe(device_t); 159ceaec73dSDamien Bergamini static int iwi_attach(device_t); 160ceaec73dSDamien Bergamini static int iwi_detach(device_t); 161ceaec73dSDamien Bergamini static int iwi_shutdown(device_t); 162ceaec73dSDamien Bergamini static int iwi_suspend(device_t); 163ceaec73dSDamien Bergamini static int iwi_resume(device_t); 164ceaec73dSDamien Bergamini 165ceaec73dSDamien Bergamini static device_method_t iwi_methods[] = { 166ceaec73dSDamien Bergamini /* Device interface */ 167ceaec73dSDamien Bergamini DEVMETHOD(device_probe, iwi_probe), 168ceaec73dSDamien Bergamini DEVMETHOD(device_attach, iwi_attach), 169ceaec73dSDamien Bergamini DEVMETHOD(device_detach, iwi_detach), 170ceaec73dSDamien Bergamini DEVMETHOD(device_shutdown, iwi_shutdown), 171ceaec73dSDamien Bergamini DEVMETHOD(device_suspend, iwi_suspend), 172ceaec73dSDamien Bergamini DEVMETHOD(device_resume, iwi_resume), 173ceaec73dSDamien Bergamini 174ceaec73dSDamien Bergamini { 0, 0 } 175ceaec73dSDamien Bergamini }; 176ceaec73dSDamien Bergamini 177ceaec73dSDamien Bergamini static driver_t iwi_driver = { 178ceaec73dSDamien Bergamini "iwi", 179ceaec73dSDamien Bergamini iwi_methods, 180ceaec73dSDamien Bergamini sizeof (struct iwi_softc) 181ceaec73dSDamien Bergamini }; 182ceaec73dSDamien Bergamini 183ceaec73dSDamien Bergamini static devclass_t iwi_devclass; 184ceaec73dSDamien Bergamini 185ceaec73dSDamien Bergamini DRIVER_MODULE(iwi, pci, iwi_driver, iwi_devclass, 0, 0); 186ceaec73dSDamien Bergamini 187ceaec73dSDamien Bergamini /* 188ceaec73dSDamien Bergamini * Supported rates for 802.11a/b/g modes (in 500Kbps unit). 189ceaec73dSDamien Bergamini */ 190ceaec73dSDamien Bergamini static const struct ieee80211_rateset iwi_rateset_11a = 191ceaec73dSDamien Bergamini { 8, { 12, 18, 24, 36, 48, 72, 96, 108 } }; 192ceaec73dSDamien Bergamini 193ceaec73dSDamien Bergamini static const struct ieee80211_rateset iwi_rateset_11b = 194ceaec73dSDamien Bergamini { 4, { 2, 4, 11, 22 } }; 195ceaec73dSDamien Bergamini 196ceaec73dSDamien Bergamini static const struct ieee80211_rateset iwi_rateset_11g = 197ceaec73dSDamien Bergamini { 12, { 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108 } }; 198ceaec73dSDamien Bergamini 199ceaec73dSDamien Bergamini static __inline uint8_t 200ceaec73dSDamien Bergamini MEM_READ_1(struct iwi_softc *sc, uint32_t addr) 201ceaec73dSDamien Bergamini { 202ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_INDIRECT_ADDR, addr); 203ceaec73dSDamien Bergamini return CSR_READ_1(sc, IWI_CSR_INDIRECT_DATA); 204ceaec73dSDamien Bergamini } 205ceaec73dSDamien Bergamini 206ceaec73dSDamien Bergamini static __inline uint32_t 207ceaec73dSDamien Bergamini MEM_READ_4(struct iwi_softc *sc, uint32_t addr) 208ceaec73dSDamien Bergamini { 209ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_INDIRECT_ADDR, addr); 210ceaec73dSDamien Bergamini return CSR_READ_4(sc, IWI_CSR_INDIRECT_DATA); 211ceaec73dSDamien Bergamini } 212ceaec73dSDamien Bergamini 213ceaec73dSDamien Bergamini static int 214ceaec73dSDamien Bergamini iwi_probe(device_t dev) 215ceaec73dSDamien Bergamini { 216ceaec73dSDamien Bergamini const struct iwi_ident *ident; 217ceaec73dSDamien Bergamini 218ceaec73dSDamien Bergamini for (ident = iwi_ident_table; ident->name != NULL; ident++) { 219ceaec73dSDamien Bergamini if (pci_get_vendor(dev) == ident->vendor && 220ceaec73dSDamien Bergamini pci_get_device(dev) == ident->device) { 221ceaec73dSDamien Bergamini device_set_desc(dev, ident->name); 222ceaec73dSDamien Bergamini return 0; 223ceaec73dSDamien Bergamini } 224ceaec73dSDamien Bergamini } 225ceaec73dSDamien Bergamini return ENXIO; 226ceaec73dSDamien Bergamini } 227ceaec73dSDamien Bergamini 228ceaec73dSDamien Bergamini /* Base Address Register */ 229ceaec73dSDamien Bergamini #define IWI_PCI_BAR0 0x10 230ceaec73dSDamien Bergamini 231ceaec73dSDamien Bergamini static int 232ceaec73dSDamien Bergamini iwi_attach(device_t dev) 233ceaec73dSDamien Bergamini { 234ceaec73dSDamien Bergamini struct iwi_softc *sc = device_get_softc(dev); 235fc74a9f9SBrooks Davis struct ifnet *ifp; 236ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 237ceaec73dSDamien Bergamini uint16_t val; 238ceaec73dSDamien Bergamini int error, i; 239ceaec73dSDamien Bergamini 240ceaec73dSDamien Bergamini sc->sc_dev = dev; 241ceaec73dSDamien Bergamini 242ceaec73dSDamien Bergamini mtx_init(&sc->sc_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, 243ceaec73dSDamien Bergamini MTX_DEF | MTX_RECURSE); 244ceaec73dSDamien Bergamini 24528a38073SDamien Bergamini sc->sc_unr = new_unrhdr(0, IWI_MAX_IBSSNODE, &sc->sc_mtx); 24628a38073SDamien Bergamini 247ceaec73dSDamien Bergamini if (pci_get_powerstate(dev) != PCI_POWERSTATE_D0) { 248ceaec73dSDamien Bergamini device_printf(dev, "chip is in D%d power mode " 249ceaec73dSDamien Bergamini "-- setting to D0\n", pci_get_powerstate(dev)); 250ceaec73dSDamien Bergamini pci_set_powerstate(dev, PCI_POWERSTATE_D0); 251ceaec73dSDamien Bergamini } 252ceaec73dSDamien Bergamini 253acea4241SDamien Bergamini pci_write_config(dev, 0x41, 0, 1); 254acea4241SDamien Bergamini 255ceaec73dSDamien Bergamini /* enable bus-mastering */ 256ceaec73dSDamien Bergamini pci_enable_busmaster(dev); 257ceaec73dSDamien Bergamini 258ceaec73dSDamien Bergamini sc->mem_rid = IWI_PCI_BAR0; 259ceaec73dSDamien Bergamini sc->mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->mem_rid, 260ceaec73dSDamien Bergamini RF_ACTIVE); 261ceaec73dSDamien Bergamini if (sc->mem == NULL) { 262ceaec73dSDamien Bergamini device_printf(dev, "could not allocate memory resource\n"); 263ceaec73dSDamien Bergamini goto fail; 264ceaec73dSDamien Bergamini } 265ceaec73dSDamien Bergamini 266ceaec73dSDamien Bergamini sc->sc_st = rman_get_bustag(sc->mem); 267ceaec73dSDamien Bergamini sc->sc_sh = rman_get_bushandle(sc->mem); 268ceaec73dSDamien Bergamini 269ceaec73dSDamien Bergamini sc->irq_rid = 0; 270ceaec73dSDamien Bergamini sc->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->irq_rid, 271ceaec73dSDamien Bergamini RF_ACTIVE | RF_SHAREABLE); 272ceaec73dSDamien Bergamini if (sc->irq == NULL) { 273ceaec73dSDamien Bergamini device_printf(dev, "could not allocate interrupt resource\n"); 274ceaec73dSDamien Bergamini goto fail; 275ceaec73dSDamien Bergamini } 276ceaec73dSDamien Bergamini 277ceaec73dSDamien Bergamini if (iwi_reset(sc) != 0) { 278ceaec73dSDamien Bergamini device_printf(dev, "could not reset adapter\n"); 279ceaec73dSDamien Bergamini goto fail; 280ceaec73dSDamien Bergamini } 281ceaec73dSDamien Bergamini 282ceaec73dSDamien Bergamini /* 283ceaec73dSDamien Bergamini * Allocate rings. 284ceaec73dSDamien Bergamini */ 285ceaec73dSDamien Bergamini if (iwi_alloc_cmd_ring(sc, &sc->cmdq, IWI_CMD_RING_COUNT) != 0) { 286ceaec73dSDamien Bergamini device_printf(dev, "could not allocate Cmd ring\n"); 287ceaec73dSDamien Bergamini goto fail; 288ceaec73dSDamien Bergamini } 289ceaec73dSDamien Bergamini 290ec01dc2bSDamien Bergamini error = iwi_alloc_tx_ring(sc, &sc->txq[0], IWI_TX_RING_COUNT, 291ec01dc2bSDamien Bergamini IWI_CSR_TX1_RIDX, IWI_CSR_TX1_WIDX); 292ec01dc2bSDamien Bergamini if (error != 0) { 293ec01dc2bSDamien Bergamini device_printf(dev, "could not allocate Tx ring 1\n"); 294ec01dc2bSDamien Bergamini goto fail; 295ec01dc2bSDamien Bergamini } 296ec01dc2bSDamien Bergamini 297ec01dc2bSDamien Bergamini error = iwi_alloc_tx_ring(sc, &sc->txq[1], IWI_TX_RING_COUNT, 298ec01dc2bSDamien Bergamini IWI_CSR_TX2_RIDX, IWI_CSR_TX2_WIDX); 299ec01dc2bSDamien Bergamini if (error != 0) { 300ec01dc2bSDamien Bergamini device_printf(dev, "could not allocate Tx ring 2\n"); 301ec01dc2bSDamien Bergamini goto fail; 302ec01dc2bSDamien Bergamini } 303ec01dc2bSDamien Bergamini 304ec01dc2bSDamien Bergamini error = iwi_alloc_tx_ring(sc, &sc->txq[2], IWI_TX_RING_COUNT, 305ec01dc2bSDamien Bergamini IWI_CSR_TX3_RIDX, IWI_CSR_TX3_WIDX); 306ec01dc2bSDamien Bergamini if (error != 0) { 307ec01dc2bSDamien Bergamini device_printf(dev, "could not allocate Tx ring 3\n"); 308ec01dc2bSDamien Bergamini goto fail; 309ec01dc2bSDamien Bergamini } 310ec01dc2bSDamien Bergamini 311ec01dc2bSDamien Bergamini error = iwi_alloc_tx_ring(sc, &sc->txq[3], IWI_TX_RING_COUNT, 312ec01dc2bSDamien Bergamini IWI_CSR_TX4_RIDX, IWI_CSR_TX4_WIDX); 313ec01dc2bSDamien Bergamini if (error != 0) { 314ec01dc2bSDamien Bergamini device_printf(dev, "could not allocate Tx ring 4\n"); 315ceaec73dSDamien Bergamini goto fail; 316ceaec73dSDamien Bergamini } 317ceaec73dSDamien Bergamini 318ceaec73dSDamien Bergamini if (iwi_alloc_rx_ring(sc, &sc->rxq, IWI_RX_RING_COUNT) != 0) { 319ceaec73dSDamien Bergamini device_printf(dev, "could not allocate Rx ring\n"); 320ceaec73dSDamien Bergamini goto fail; 321ceaec73dSDamien Bergamini } 322ceaec73dSDamien Bergamini 323fc74a9f9SBrooks Davis ifp = sc->sc_ifp = if_alloc(IFT_ETHER); 324fc74a9f9SBrooks Davis if (ifp == NULL) { 325fc74a9f9SBrooks Davis device_printf(dev, "can not if_alloc()\n"); 326fc74a9f9SBrooks Davis goto fail; 327fc74a9f9SBrooks Davis } 328ceaec73dSDamien Bergamini ifp->if_softc = sc; 329ceaec73dSDamien Bergamini if_initname(ifp, device_get_name(dev), device_get_unit(dev)); 330ceaec73dSDamien Bergamini ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 331ceaec73dSDamien Bergamini ifp->if_init = iwi_init; 332ceaec73dSDamien Bergamini ifp->if_ioctl = iwi_ioctl; 333ceaec73dSDamien Bergamini ifp->if_start = iwi_start; 334ceaec73dSDamien Bergamini ifp->if_watchdog = iwi_watchdog; 335ceaec73dSDamien Bergamini IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN); 336ceaec73dSDamien Bergamini ifp->if_snd.ifq_drv_maxlen = IFQ_MAXLEN; 337ceaec73dSDamien Bergamini IFQ_SET_READY(&ifp->if_snd); 338ceaec73dSDamien Bergamini 339ceaec73dSDamien Bergamini ic->ic_ifp = ifp; 340ec01dc2bSDamien Bergamini ic->ic_wme.wme_update = iwi_wme_update; 341ceaec73dSDamien Bergamini ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */ 342ceaec73dSDamien Bergamini ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */ 343ceaec73dSDamien Bergamini ic->ic_state = IEEE80211_S_INIT; 344ceaec73dSDamien Bergamini 345ceaec73dSDamien Bergamini /* set device capabilities */ 346ec01dc2bSDamien Bergamini ic->ic_caps = 3470b74a285SDamien Bergamini IEEE80211_C_IBSS | /* IBSS mode supported */ 348ec01dc2bSDamien Bergamini IEEE80211_C_MONITOR | /* monitor mode supported */ 349ec01dc2bSDamien Bergamini IEEE80211_C_TXPMGT | /* tx power management */ 350ec01dc2bSDamien Bergamini IEEE80211_C_SHPREAMBLE | /* short preamble supported */ 351ec01dc2bSDamien Bergamini IEEE80211_C_WPA | /* 802.11i */ 352ec01dc2bSDamien Bergamini IEEE80211_C_WME; /* 802.11e */ 353ceaec73dSDamien Bergamini 354ceaec73dSDamien Bergamini /* read MAC address from EEPROM */ 355ceaec73dSDamien Bergamini val = iwi_read_prom_word(sc, IWI_EEPROM_MAC + 0); 35681e6343cSDamien Bergamini ic->ic_myaddr[0] = val & 0xff; 35781e6343cSDamien Bergamini ic->ic_myaddr[1] = val >> 8; 358ceaec73dSDamien Bergamini val = iwi_read_prom_word(sc, IWI_EEPROM_MAC + 1); 35981e6343cSDamien Bergamini ic->ic_myaddr[2] = val & 0xff; 36081e6343cSDamien Bergamini ic->ic_myaddr[3] = val >> 8; 361ceaec73dSDamien Bergamini val = iwi_read_prom_word(sc, IWI_EEPROM_MAC + 2); 36281e6343cSDamien Bergamini ic->ic_myaddr[4] = val & 0xff; 36381e6343cSDamien Bergamini ic->ic_myaddr[5] = val >> 8; 364ceaec73dSDamien Bergamini 365ceaec73dSDamien Bergamini if (pci_get_device(dev) >= 0x4223) { 366ceaec73dSDamien Bergamini /* set supported .11a rates (2915ABG only) */ 367ceaec73dSDamien Bergamini ic->ic_sup_rates[IEEE80211_MODE_11A] = iwi_rateset_11a; 368ceaec73dSDamien Bergamini 369ceaec73dSDamien Bergamini /* set supported .11a channels */ 370ceaec73dSDamien Bergamini for (i = 36; i <= 64; i += 4) { 371ceaec73dSDamien Bergamini ic->ic_channels[i].ic_freq = 372ceaec73dSDamien Bergamini ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ); 373ceaec73dSDamien Bergamini ic->ic_channels[i].ic_flags = IEEE80211_CHAN_A; 374ceaec73dSDamien Bergamini } 375ceaec73dSDamien Bergamini for (i = 149; i <= 165; i += 4) { 376ceaec73dSDamien Bergamini ic->ic_channels[i].ic_freq = 377ceaec73dSDamien Bergamini ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ); 378ceaec73dSDamien Bergamini ic->ic_channels[i].ic_flags = IEEE80211_CHAN_A; 379ceaec73dSDamien Bergamini } 380ceaec73dSDamien Bergamini } 381ceaec73dSDamien Bergamini 382ceaec73dSDamien Bergamini /* set supported .11b and .11g rates */ 383ceaec73dSDamien Bergamini ic->ic_sup_rates[IEEE80211_MODE_11B] = iwi_rateset_11b; 384ceaec73dSDamien Bergamini ic->ic_sup_rates[IEEE80211_MODE_11G] = iwi_rateset_11g; 385ceaec73dSDamien Bergamini 386ceaec73dSDamien Bergamini /* set supported .11b and .11g channels (1 through 14) */ 387ceaec73dSDamien Bergamini for (i = 1; i <= 14; i++) { 388ceaec73dSDamien Bergamini ic->ic_channels[i].ic_freq = 389ceaec73dSDamien Bergamini ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ); 390ceaec73dSDamien Bergamini ic->ic_channels[i].ic_flags = 391ceaec73dSDamien Bergamini IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM | 392ceaec73dSDamien Bergamini IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ; 393ceaec73dSDamien Bergamini } 394ceaec73dSDamien Bergamini 395ceaec73dSDamien Bergamini ieee80211_ifattach(ic); 39628a38073SDamien Bergamini /* override default methods */ 39728a38073SDamien Bergamini ic->ic_node_alloc = iwi_node_alloc; 39828a38073SDamien Bergamini sc->sc_node_free = ic->ic_node_free; 39928a38073SDamien Bergamini ic->ic_node_free = iwi_node_free; 400ceaec73dSDamien Bergamini /* override state transition machine */ 401ceaec73dSDamien Bergamini sc->sc_newstate = ic->ic_newstate; 402ceaec73dSDamien Bergamini ic->ic_newstate = iwi_newstate; 403ceaec73dSDamien Bergamini ieee80211_media_init(ic, iwi_media_change, iwi_media_status); 404ceaec73dSDamien Bergamini 405ceaec73dSDamien Bergamini bpfattach2(ifp, DLT_IEEE802_11_RADIO, 406ceaec73dSDamien Bergamini sizeof (struct ieee80211_frame) + 64, &sc->sc_drvbpf); 407ceaec73dSDamien Bergamini 408ceaec73dSDamien Bergamini sc->sc_rxtap_len = sizeof sc->sc_rxtapu; 409ceaec73dSDamien Bergamini sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len); 410ceaec73dSDamien Bergamini sc->sc_rxtap.wr_ihdr.it_present = htole32(IWI_RX_RADIOTAP_PRESENT); 411ceaec73dSDamien Bergamini 412ceaec73dSDamien Bergamini sc->sc_txtap_len = sizeof sc->sc_txtapu; 413ceaec73dSDamien Bergamini sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len); 414ceaec73dSDamien Bergamini sc->sc_txtap.wt_ihdr.it_present = htole32(IWI_TX_RADIOTAP_PRESENT); 415ceaec73dSDamien Bergamini 416ceaec73dSDamien Bergamini /* 417ceaec73dSDamien Bergamini * Add a few sysctl knobs. 418ceaec73dSDamien Bergamini */ 419ceaec73dSDamien Bergamini sc->dwelltime = 100; 420ceaec73dSDamien Bergamini sc->bluetooth = 1; 421acea4241SDamien Bergamini sc->antenna = 0; 422ceaec73dSDamien Bergamini 423ceaec73dSDamien Bergamini SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev), 424ceaec73dSDamien Bergamini SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "radio", 425ceaec73dSDamien Bergamini CTLTYPE_INT | CTLFLAG_RD, sc, 0, iwi_sysctl_radio, "I", 426ceaec73dSDamien Bergamini "radio transmitter switch state (0=off, 1=on)"); 427ceaec73dSDamien Bergamini 428ceaec73dSDamien Bergamini SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev), 429ceaec73dSDamien Bergamini SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "stats", 430ceaec73dSDamien Bergamini CTLTYPE_OPAQUE | CTLFLAG_RD, sc, 0, iwi_sysctl_stats, "S", 431ceaec73dSDamien Bergamini "statistics"); 432ceaec73dSDamien Bergamini 433ceaec73dSDamien Bergamini SYSCTL_ADD_INT(device_get_sysctl_ctx(dev), 434ceaec73dSDamien Bergamini SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "dwell", 435ceaec73dSDamien Bergamini CTLFLAG_RW, &sc->dwelltime, 0, 436ceaec73dSDamien Bergamini "channel dwell time (ms) for AP/station scanning"); 437ceaec73dSDamien Bergamini 438ceaec73dSDamien Bergamini SYSCTL_ADD_INT(device_get_sysctl_ctx(dev), 439ceaec73dSDamien Bergamini SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "bluetooth", 440ceaec73dSDamien Bergamini CTLFLAG_RW, &sc->bluetooth, 0, "bluetooth coexistence"); 441ceaec73dSDamien Bergamini 442acea4241SDamien Bergamini SYSCTL_ADD_INT(device_get_sysctl_ctx(dev), 443acea4241SDamien Bergamini SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "antenna", 444acea4241SDamien Bergamini CTLFLAG_RW, &sc->antenna, 0, "antenna (0=auto)"); 445acea4241SDamien Bergamini 446ceaec73dSDamien Bergamini /* 447ceaec73dSDamien Bergamini * Hook our interrupt after all initialization is complete. 448ceaec73dSDamien Bergamini */ 449ceaec73dSDamien Bergamini error = bus_setup_intr(dev, sc->irq, INTR_TYPE_NET | INTR_MPSAFE, 450ceaec73dSDamien Bergamini iwi_intr, sc, &sc->sc_ih); 451ceaec73dSDamien Bergamini if (error != 0) { 452ceaec73dSDamien Bergamini device_printf(dev, "could not set up interrupt\n"); 453ceaec73dSDamien Bergamini goto fail; 454ceaec73dSDamien Bergamini } 455ceaec73dSDamien Bergamini 456ceaec73dSDamien Bergamini if (bootverbose) 457ceaec73dSDamien Bergamini ieee80211_announce(ic); 458ceaec73dSDamien Bergamini 459ceaec73dSDamien Bergamini return 0; 460ceaec73dSDamien Bergamini 461ceaec73dSDamien Bergamini fail: iwi_detach(dev); 462ceaec73dSDamien Bergamini return ENXIO; 463ceaec73dSDamien Bergamini } 464ceaec73dSDamien Bergamini 465ceaec73dSDamien Bergamini static int 466ceaec73dSDamien Bergamini iwi_detach(device_t dev) 467ceaec73dSDamien Bergamini { 468ceaec73dSDamien Bergamini struct iwi_softc *sc = device_get_softc(dev); 469ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 470ceaec73dSDamien Bergamini struct ifnet *ifp = ic->ic_ifp; 471ceaec73dSDamien Bergamini 472ceaec73dSDamien Bergamini iwi_stop(sc); 473ceaec73dSDamien Bergamini 4740b74a285SDamien Bergamini if (ifp != NULL) { 475ceaec73dSDamien Bergamini bpfdetach(ifp); 476ceaec73dSDamien Bergamini ieee80211_ifdetach(ic); 4770b74a285SDamien Bergamini } 478ceaec73dSDamien Bergamini 479ceaec73dSDamien Bergamini iwi_free_cmd_ring(sc, &sc->cmdq); 480ec01dc2bSDamien Bergamini iwi_free_tx_ring(sc, &sc->txq[0]); 481ec01dc2bSDamien Bergamini iwi_free_tx_ring(sc, &sc->txq[1]); 482ec01dc2bSDamien Bergamini iwi_free_tx_ring(sc, &sc->txq[2]); 483ec01dc2bSDamien Bergamini iwi_free_tx_ring(sc, &sc->txq[3]); 484ceaec73dSDamien Bergamini iwi_free_rx_ring(sc, &sc->rxq); 485ceaec73dSDamien Bergamini 486ceaec73dSDamien Bergamini if (sc->irq != NULL) { 487ceaec73dSDamien Bergamini bus_teardown_intr(dev, sc->irq, sc->sc_ih); 488ceaec73dSDamien Bergamini bus_release_resource(dev, SYS_RES_IRQ, sc->irq_rid, sc->irq); 489ceaec73dSDamien Bergamini } 490ceaec73dSDamien Bergamini 491ceaec73dSDamien Bergamini if (sc->mem != NULL) 492ceaec73dSDamien Bergamini bus_release_resource(dev, SYS_RES_MEMORY, sc->mem_rid, sc->mem); 493ceaec73dSDamien Bergamini 494ad4f426eSWarner Losh if (ifp != NULL) 495ad4f426eSWarner Losh if_free(ifp); 4967e47fb02SDamien Bergamini 49728a38073SDamien Bergamini if (sc->sc_unr != NULL) 49828a38073SDamien Bergamini delete_unrhdr(sc->sc_unr); 49928a38073SDamien Bergamini 500ceaec73dSDamien Bergamini mtx_destroy(&sc->sc_mtx); 501ceaec73dSDamien Bergamini 502ceaec73dSDamien Bergamini return 0; 503ceaec73dSDamien Bergamini } 504ceaec73dSDamien Bergamini 505ceaec73dSDamien Bergamini static void 506ceaec73dSDamien Bergamini iwi_dma_map_addr(void *arg, bus_dma_segment_t *segs, int nseg, int error) 507ceaec73dSDamien Bergamini { 508ceaec73dSDamien Bergamini if (error != 0) 509ceaec73dSDamien Bergamini return; 510ceaec73dSDamien Bergamini 511ceaec73dSDamien Bergamini KASSERT(nseg == 1, ("too many DMA segments, %d should be 1", nseg)); 512ceaec73dSDamien Bergamini 513ceaec73dSDamien Bergamini *(bus_addr_t *)arg = segs[0].ds_addr; 514ceaec73dSDamien Bergamini } 515ceaec73dSDamien Bergamini 516ceaec73dSDamien Bergamini static int 517ceaec73dSDamien Bergamini iwi_alloc_cmd_ring(struct iwi_softc *sc, struct iwi_cmd_ring *ring, int count) 518ceaec73dSDamien Bergamini { 519ceaec73dSDamien Bergamini int error; 520ceaec73dSDamien Bergamini 521ceaec73dSDamien Bergamini ring->count = count; 522ceaec73dSDamien Bergamini ring->queued = 0; 523ceaec73dSDamien Bergamini ring->cur = ring->next = 0; 524ceaec73dSDamien Bergamini 525ceaec73dSDamien Bergamini error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT, 526ceaec73dSDamien Bergamini BUS_SPACE_MAXADDR, NULL, NULL, count * IWI_CMD_DESC_SIZE, 1, 527ceaec73dSDamien Bergamini count * IWI_CMD_DESC_SIZE, 0, NULL, NULL, &ring->desc_dmat); 528ceaec73dSDamien Bergamini if (error != 0) { 529ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not create desc DMA tag\n"); 530ceaec73dSDamien Bergamini goto fail; 531ceaec73dSDamien Bergamini } 532ceaec73dSDamien Bergamini 533ceaec73dSDamien Bergamini error = bus_dmamem_alloc(ring->desc_dmat, (void **)&ring->desc, 534ceaec73dSDamien Bergamini BUS_DMA_NOWAIT | BUS_DMA_ZERO, &ring->desc_map); 535ceaec73dSDamien Bergamini if (error != 0) { 536ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not allocate DMA memory\n"); 537ceaec73dSDamien Bergamini goto fail; 538ceaec73dSDamien Bergamini } 539ceaec73dSDamien Bergamini 540ceaec73dSDamien Bergamini error = bus_dmamap_load(ring->desc_dmat, ring->desc_map, ring->desc, 541ceaec73dSDamien Bergamini count * IWI_CMD_DESC_SIZE, iwi_dma_map_addr, &ring->physaddr, 0); 542ceaec73dSDamien Bergamini if (error != 0) { 543ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not load desc DMA map\n"); 544ceaec73dSDamien Bergamini goto fail; 545ceaec73dSDamien Bergamini } 546ceaec73dSDamien Bergamini 547ceaec73dSDamien Bergamini return 0; 548ceaec73dSDamien Bergamini 549ceaec73dSDamien Bergamini fail: iwi_free_cmd_ring(sc, ring); 550ceaec73dSDamien Bergamini return error; 551ceaec73dSDamien Bergamini } 552ceaec73dSDamien Bergamini 553ceaec73dSDamien Bergamini static void 554ceaec73dSDamien Bergamini iwi_reset_cmd_ring(struct iwi_softc *sc, struct iwi_cmd_ring *ring) 555ceaec73dSDamien Bergamini { 556ceaec73dSDamien Bergamini ring->queued = 0; 557ceaec73dSDamien Bergamini ring->cur = ring->next = 0; 558ceaec73dSDamien Bergamini } 559ceaec73dSDamien Bergamini 560ceaec73dSDamien Bergamini static void 561ceaec73dSDamien Bergamini iwi_free_cmd_ring(struct iwi_softc *sc, struct iwi_cmd_ring *ring) 562ceaec73dSDamien Bergamini { 563ceaec73dSDamien Bergamini if (ring->desc != NULL) { 564ceaec73dSDamien Bergamini bus_dmamap_sync(ring->desc_dmat, ring->desc_map, 565ceaec73dSDamien Bergamini BUS_DMASYNC_POSTWRITE); 566ceaec73dSDamien Bergamini bus_dmamap_unload(ring->desc_dmat, ring->desc_map); 567ceaec73dSDamien Bergamini bus_dmamem_free(ring->desc_dmat, ring->desc, ring->desc_map); 568ceaec73dSDamien Bergamini } 569ceaec73dSDamien Bergamini 570ceaec73dSDamien Bergamini if (ring->desc_dmat != NULL) 571ceaec73dSDamien Bergamini bus_dma_tag_destroy(ring->desc_dmat); 572ceaec73dSDamien Bergamini } 573ceaec73dSDamien Bergamini 574ceaec73dSDamien Bergamini static int 575ec01dc2bSDamien Bergamini iwi_alloc_tx_ring(struct iwi_softc *sc, struct iwi_tx_ring *ring, int count, 576ec01dc2bSDamien Bergamini bus_addr_t csr_ridx, bus_addr_t csr_widx) 577ceaec73dSDamien Bergamini { 578ceaec73dSDamien Bergamini int i, error; 579ceaec73dSDamien Bergamini 580ceaec73dSDamien Bergamini ring->count = count; 581ceaec73dSDamien Bergamini ring->queued = 0; 582ceaec73dSDamien Bergamini ring->cur = ring->next = 0; 583ec01dc2bSDamien Bergamini ring->csr_ridx = csr_ridx; 584ec01dc2bSDamien Bergamini ring->csr_widx = csr_widx; 585ceaec73dSDamien Bergamini 586ceaec73dSDamien Bergamini error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT, 587ceaec73dSDamien Bergamini BUS_SPACE_MAXADDR, NULL, NULL, count * IWI_TX_DESC_SIZE, 1, 588ceaec73dSDamien Bergamini count * IWI_TX_DESC_SIZE, 0, NULL, NULL, &ring->desc_dmat); 589ceaec73dSDamien Bergamini if (error != 0) { 590ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not create desc DMA tag\n"); 591ceaec73dSDamien Bergamini goto fail; 592ceaec73dSDamien Bergamini } 593ceaec73dSDamien Bergamini 594ceaec73dSDamien Bergamini error = bus_dmamem_alloc(ring->desc_dmat, (void **)&ring->desc, 595ceaec73dSDamien Bergamini BUS_DMA_NOWAIT | BUS_DMA_ZERO, &ring->desc_map); 596ceaec73dSDamien Bergamini if (error != 0) { 597ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not allocate DMA memory\n"); 598ceaec73dSDamien Bergamini goto fail; 599ceaec73dSDamien Bergamini } 600ceaec73dSDamien Bergamini 601ceaec73dSDamien Bergamini error = bus_dmamap_load(ring->desc_dmat, ring->desc_map, ring->desc, 602ceaec73dSDamien Bergamini count * IWI_TX_DESC_SIZE, iwi_dma_map_addr, &ring->physaddr, 0); 603ceaec73dSDamien Bergamini if (error != 0) { 604ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not load desc DMA map\n"); 605ceaec73dSDamien Bergamini goto fail; 606ceaec73dSDamien Bergamini } 607ceaec73dSDamien Bergamini 608ceaec73dSDamien Bergamini ring->data = malloc(count * sizeof (struct iwi_tx_data), M_DEVBUF, 609ceaec73dSDamien Bergamini M_NOWAIT | M_ZERO); 610ceaec73dSDamien Bergamini if (ring->data == NULL) { 611ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not allocate soft data\n"); 612ceaec73dSDamien Bergamini error = ENOMEM; 613ceaec73dSDamien Bergamini goto fail; 614ceaec73dSDamien Bergamini } 615ceaec73dSDamien Bergamini 616ceaec73dSDamien Bergamini error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT, 617ceaec73dSDamien Bergamini BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, 1, MCLBYTES, 0, NULL, 618ceaec73dSDamien Bergamini NULL, &ring->data_dmat); 619ceaec73dSDamien Bergamini if (error != 0) { 620ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not create data DMA tag\n"); 621ceaec73dSDamien Bergamini goto fail; 622ceaec73dSDamien Bergamini } 623ceaec73dSDamien Bergamini 624ceaec73dSDamien Bergamini for (i = 0; i < count; i++) { 625ceaec73dSDamien Bergamini error = bus_dmamap_create(ring->data_dmat, 0, 626ceaec73dSDamien Bergamini &ring->data[i].map); 627ceaec73dSDamien Bergamini if (error != 0) { 628ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not create DMA map\n"); 629ceaec73dSDamien Bergamini goto fail; 630ceaec73dSDamien Bergamini } 631ceaec73dSDamien Bergamini } 632ceaec73dSDamien Bergamini 633ceaec73dSDamien Bergamini return 0; 634ceaec73dSDamien Bergamini 635ceaec73dSDamien Bergamini fail: iwi_free_tx_ring(sc, ring); 636ceaec73dSDamien Bergamini return error; 637ceaec73dSDamien Bergamini } 638ceaec73dSDamien Bergamini 639ceaec73dSDamien Bergamini static void 640ceaec73dSDamien Bergamini iwi_reset_tx_ring(struct iwi_softc *sc, struct iwi_tx_ring *ring) 641ceaec73dSDamien Bergamini { 642ceaec73dSDamien Bergamini struct iwi_tx_data *data; 643ceaec73dSDamien Bergamini int i; 644ceaec73dSDamien Bergamini 645ceaec73dSDamien Bergamini for (i = 0; i < ring->count; i++) { 646ceaec73dSDamien Bergamini data = &ring->data[i]; 647ceaec73dSDamien Bergamini 648ceaec73dSDamien Bergamini if (data->m != NULL) { 649ceaec73dSDamien Bergamini bus_dmamap_sync(ring->data_dmat, data->map, 650ceaec73dSDamien Bergamini BUS_DMASYNC_POSTWRITE); 651ceaec73dSDamien Bergamini bus_dmamap_unload(ring->data_dmat, data->map); 652ceaec73dSDamien Bergamini m_freem(data->m); 653ceaec73dSDamien Bergamini data->m = NULL; 654ceaec73dSDamien Bergamini } 655ceaec73dSDamien Bergamini 656ceaec73dSDamien Bergamini if (data->ni != NULL) { 657ceaec73dSDamien Bergamini ieee80211_free_node(data->ni); 658ceaec73dSDamien Bergamini data->ni = NULL; 659ceaec73dSDamien Bergamini } 660ceaec73dSDamien Bergamini } 661ceaec73dSDamien Bergamini 662ceaec73dSDamien Bergamini ring->queued = 0; 663ceaec73dSDamien Bergamini ring->cur = ring->next = 0; 664ceaec73dSDamien Bergamini } 665ceaec73dSDamien Bergamini 666ceaec73dSDamien Bergamini static void 667ceaec73dSDamien Bergamini iwi_free_tx_ring(struct iwi_softc *sc, struct iwi_tx_ring *ring) 668ceaec73dSDamien Bergamini { 669ceaec73dSDamien Bergamini struct iwi_tx_data *data; 670ceaec73dSDamien Bergamini int i; 671ceaec73dSDamien Bergamini 672ceaec73dSDamien Bergamini if (ring->desc != NULL) { 673ceaec73dSDamien Bergamini bus_dmamap_sync(ring->desc_dmat, ring->desc_map, 674ceaec73dSDamien Bergamini BUS_DMASYNC_POSTWRITE); 675ceaec73dSDamien Bergamini bus_dmamap_unload(ring->desc_dmat, ring->desc_map); 676ceaec73dSDamien Bergamini bus_dmamem_free(ring->desc_dmat, ring->desc, ring->desc_map); 677ceaec73dSDamien Bergamini } 678ceaec73dSDamien Bergamini 679ceaec73dSDamien Bergamini if (ring->desc_dmat != NULL) 680ceaec73dSDamien Bergamini bus_dma_tag_destroy(ring->desc_dmat); 681ceaec73dSDamien Bergamini 682ceaec73dSDamien Bergamini if (ring->data != NULL) { 683ceaec73dSDamien Bergamini for (i = 0; i < ring->count; i++) { 684ceaec73dSDamien Bergamini data = &ring->data[i]; 685ceaec73dSDamien Bergamini 686ceaec73dSDamien Bergamini if (data->m != NULL) { 687ceaec73dSDamien Bergamini bus_dmamap_sync(ring->data_dmat, data->map, 688ceaec73dSDamien Bergamini BUS_DMASYNC_POSTWRITE); 689ceaec73dSDamien Bergamini bus_dmamap_unload(ring->data_dmat, data->map); 690ceaec73dSDamien Bergamini m_freem(data->m); 691ceaec73dSDamien Bergamini } 692ceaec73dSDamien Bergamini 693ceaec73dSDamien Bergamini if (data->ni != NULL) 694ceaec73dSDamien Bergamini ieee80211_free_node(data->ni); 695ceaec73dSDamien Bergamini 696ceaec73dSDamien Bergamini if (data->map != NULL) 697ceaec73dSDamien Bergamini bus_dmamap_destroy(ring->data_dmat, data->map); 698ceaec73dSDamien Bergamini } 699ceaec73dSDamien Bergamini 700ceaec73dSDamien Bergamini free(ring->data, M_DEVBUF); 701ceaec73dSDamien Bergamini } 702ceaec73dSDamien Bergamini 703ceaec73dSDamien Bergamini if (ring->data_dmat != NULL) 704ceaec73dSDamien Bergamini bus_dma_tag_destroy(ring->data_dmat); 705ceaec73dSDamien Bergamini } 706ceaec73dSDamien Bergamini 707ceaec73dSDamien Bergamini static int 708ceaec73dSDamien Bergamini iwi_alloc_rx_ring(struct iwi_softc *sc, struct iwi_rx_ring *ring, int count) 709ceaec73dSDamien Bergamini { 710ceaec73dSDamien Bergamini struct iwi_rx_data *data; 711ceaec73dSDamien Bergamini int i, error; 712ceaec73dSDamien Bergamini 713ceaec73dSDamien Bergamini ring->count = count; 714ceaec73dSDamien Bergamini ring->cur = 0; 715ceaec73dSDamien Bergamini 716ceaec73dSDamien Bergamini ring->data = malloc(count * sizeof (struct iwi_rx_data), M_DEVBUF, 717ceaec73dSDamien Bergamini M_NOWAIT | M_ZERO); 718ceaec73dSDamien Bergamini if (ring->data == NULL) { 719ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not allocate soft data\n"); 720ceaec73dSDamien Bergamini error = ENOMEM; 721ceaec73dSDamien Bergamini goto fail; 722ceaec73dSDamien Bergamini } 723ceaec73dSDamien Bergamini 724ceaec73dSDamien Bergamini error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT, 725ceaec73dSDamien Bergamini BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, 1, MCLBYTES, 0, NULL, 726ceaec73dSDamien Bergamini NULL, &ring->data_dmat); 727ceaec73dSDamien Bergamini if (error != 0) { 728ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not create data DMA tag\n"); 729ceaec73dSDamien Bergamini goto fail; 730ceaec73dSDamien Bergamini } 731ceaec73dSDamien Bergamini 732ceaec73dSDamien Bergamini for (i = 0; i < count; i++) { 733ceaec73dSDamien Bergamini data = &ring->data[i]; 734ceaec73dSDamien Bergamini 735ceaec73dSDamien Bergamini error = bus_dmamap_create(ring->data_dmat, 0, &data->map); 736ceaec73dSDamien Bergamini if (error != 0) { 737ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not create DMA map\n"); 738ceaec73dSDamien Bergamini goto fail; 739ceaec73dSDamien Bergamini } 740ceaec73dSDamien Bergamini 741ceaec73dSDamien Bergamini data->m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR); 742ceaec73dSDamien Bergamini if (data->m == NULL) { 743ceaec73dSDamien Bergamini device_printf(sc->sc_dev, 744ceaec73dSDamien Bergamini "could not allocate rx mbuf\n"); 745ceaec73dSDamien Bergamini error = ENOMEM; 746ceaec73dSDamien Bergamini goto fail; 747ceaec73dSDamien Bergamini } 748ceaec73dSDamien Bergamini 749ceaec73dSDamien Bergamini error = bus_dmamap_load(ring->data_dmat, data->map, 750ceaec73dSDamien Bergamini mtod(data->m, void *), MCLBYTES, iwi_dma_map_addr, 751ceaec73dSDamien Bergamini &data->physaddr, 0); 752ceaec73dSDamien Bergamini if (error != 0) { 753ceaec73dSDamien Bergamini device_printf(sc->sc_dev, 754ceaec73dSDamien Bergamini "could not load rx buf DMA map"); 755ceaec73dSDamien Bergamini goto fail; 756ceaec73dSDamien Bergamini } 757ceaec73dSDamien Bergamini 758ceaec73dSDamien Bergamini data->reg = IWI_CSR_RX_BASE + i * 4; 759ceaec73dSDamien Bergamini } 760ceaec73dSDamien Bergamini 761ceaec73dSDamien Bergamini return 0; 762ceaec73dSDamien Bergamini 763ceaec73dSDamien Bergamini fail: iwi_free_rx_ring(sc, ring); 764ceaec73dSDamien Bergamini return error; 765ceaec73dSDamien Bergamini } 766ceaec73dSDamien Bergamini 767ceaec73dSDamien Bergamini static void 768ceaec73dSDamien Bergamini iwi_reset_rx_ring(struct iwi_softc *sc, struct iwi_rx_ring *ring) 769ceaec73dSDamien Bergamini { 770ceaec73dSDamien Bergamini ring->cur = 0; 771ceaec73dSDamien Bergamini } 772ceaec73dSDamien Bergamini 773ceaec73dSDamien Bergamini static void 774ceaec73dSDamien Bergamini iwi_free_rx_ring(struct iwi_softc *sc, struct iwi_rx_ring *ring) 775ceaec73dSDamien Bergamini { 776ceaec73dSDamien Bergamini struct iwi_rx_data *data; 777ceaec73dSDamien Bergamini int i; 778ceaec73dSDamien Bergamini 779ceaec73dSDamien Bergamini if (ring->data != NULL) { 780ceaec73dSDamien Bergamini for (i = 0; i < ring->count; i++) { 781ceaec73dSDamien Bergamini data = &ring->data[i]; 782ceaec73dSDamien Bergamini 783ceaec73dSDamien Bergamini if (data->m != NULL) { 784ceaec73dSDamien Bergamini bus_dmamap_sync(ring->data_dmat, data->map, 785ceaec73dSDamien Bergamini BUS_DMASYNC_POSTREAD); 786ceaec73dSDamien Bergamini bus_dmamap_unload(ring->data_dmat, data->map); 787ceaec73dSDamien Bergamini m_freem(data->m); 788ceaec73dSDamien Bergamini } 789ceaec73dSDamien Bergamini 790ceaec73dSDamien Bergamini if (data->map != NULL) 791ceaec73dSDamien Bergamini bus_dmamap_destroy(ring->data_dmat, data->map); 792ceaec73dSDamien Bergamini } 793ceaec73dSDamien Bergamini 794ceaec73dSDamien Bergamini free(ring->data, M_DEVBUF); 795ceaec73dSDamien Bergamini } 796ceaec73dSDamien Bergamini 797ceaec73dSDamien Bergamini if (ring->data_dmat != NULL) 798ceaec73dSDamien Bergamini bus_dma_tag_destroy(ring->data_dmat); 799ceaec73dSDamien Bergamini } 800ceaec73dSDamien Bergamini 801ceaec73dSDamien Bergamini static int 802ceaec73dSDamien Bergamini iwi_shutdown(device_t dev) 803ceaec73dSDamien Bergamini { 804ceaec73dSDamien Bergamini struct iwi_softc *sc = device_get_softc(dev); 805ceaec73dSDamien Bergamini 806ceaec73dSDamien Bergamini iwi_stop(sc); 807ceaec73dSDamien Bergamini 808ceaec73dSDamien Bergamini return 0; 809ceaec73dSDamien Bergamini } 810ceaec73dSDamien Bergamini 811ceaec73dSDamien Bergamini static int 812ceaec73dSDamien Bergamini iwi_suspend(device_t dev) 813ceaec73dSDamien Bergamini { 814ceaec73dSDamien Bergamini struct iwi_softc *sc = device_get_softc(dev); 815ceaec73dSDamien Bergamini 816ceaec73dSDamien Bergamini iwi_stop(sc); 817ceaec73dSDamien Bergamini 818ceaec73dSDamien Bergamini return 0; 819ceaec73dSDamien Bergamini } 820ceaec73dSDamien Bergamini 821ceaec73dSDamien Bergamini static int 822ceaec73dSDamien Bergamini iwi_resume(device_t dev) 823ceaec73dSDamien Bergamini { 824ceaec73dSDamien Bergamini struct iwi_softc *sc = device_get_softc(dev); 825ceaec73dSDamien Bergamini struct ifnet *ifp = sc->sc_ic.ic_ifp; 826ceaec73dSDamien Bergamini 827ceaec73dSDamien Bergamini IWI_LOCK(sc); 828ceaec73dSDamien Bergamini 829acea4241SDamien Bergamini pci_write_config(dev, 0x41, 0, 1); 830acea4241SDamien Bergamini 831ceaec73dSDamien Bergamini if (ifp->if_flags & IFF_UP) { 832ceaec73dSDamien Bergamini ifp->if_init(ifp->if_softc); 83313f4c340SRobert Watson if (ifp->if_drv_flags & IFF_DRV_RUNNING) 834ceaec73dSDamien Bergamini ifp->if_start(ifp); 835ceaec73dSDamien Bergamini } 836ceaec73dSDamien Bergamini 837ceaec73dSDamien Bergamini IWI_UNLOCK(sc); 838ceaec73dSDamien Bergamini 839ceaec73dSDamien Bergamini return 0; 840ceaec73dSDamien Bergamini } 841ceaec73dSDamien Bergamini 84228a38073SDamien Bergamini static struct ieee80211_node * 84328a38073SDamien Bergamini iwi_node_alloc(struct ieee80211_node_table *nt) 84428a38073SDamien Bergamini { 84528a38073SDamien Bergamini struct iwi_node *in; 84628a38073SDamien Bergamini 84728a38073SDamien Bergamini in = malloc(sizeof (struct iwi_node), M_80211_NODE, M_NOWAIT | M_ZERO); 84828a38073SDamien Bergamini if (in == NULL) 84928a38073SDamien Bergamini return NULL; 85028a38073SDamien Bergamini 85128a38073SDamien Bergamini in->in_station = -1; 85228a38073SDamien Bergamini 85328a38073SDamien Bergamini return &in->in_node; 85428a38073SDamien Bergamini } 85528a38073SDamien Bergamini 85628a38073SDamien Bergamini static void 85728a38073SDamien Bergamini iwi_node_free(struct ieee80211_node *ni) 85828a38073SDamien Bergamini { 85928a38073SDamien Bergamini struct ieee80211com *ic = ni->ni_ic; 86028a38073SDamien Bergamini struct iwi_softc *sc = ic->ic_ifp->if_softc; 86128a38073SDamien Bergamini struct iwi_node *in = (struct iwi_node *)ni; 86228a38073SDamien Bergamini 86328a38073SDamien Bergamini if (in->in_station != -1) 86428a38073SDamien Bergamini free_unr(sc->sc_unr, in->in_station); 86528a38073SDamien Bergamini 86628a38073SDamien Bergamini sc->sc_node_free(ni); 86728a38073SDamien Bergamini } 86828a38073SDamien Bergamini 869ceaec73dSDamien Bergamini static int 870ceaec73dSDamien Bergamini iwi_media_change(struct ifnet *ifp) 871ceaec73dSDamien Bergamini { 872ceaec73dSDamien Bergamini struct iwi_softc *sc = ifp->if_softc; 873ceaec73dSDamien Bergamini int error; 874ceaec73dSDamien Bergamini 875ceaec73dSDamien Bergamini IWI_LOCK(sc); 876ceaec73dSDamien Bergamini 877ceaec73dSDamien Bergamini error = ieee80211_media_change(ifp); 878ceaec73dSDamien Bergamini if (error != ENETRESET) { 879ceaec73dSDamien Bergamini IWI_UNLOCK(sc); 880ceaec73dSDamien Bergamini return error; 881ceaec73dSDamien Bergamini } 882ceaec73dSDamien Bergamini 88313f4c340SRobert Watson if ((ifp->if_flags & IFF_UP) && (ifp->if_drv_flags & IFF_DRV_RUNNING)) 884ceaec73dSDamien Bergamini iwi_init(sc); 885ceaec73dSDamien Bergamini 886ceaec73dSDamien Bergamini IWI_UNLOCK(sc); 887ceaec73dSDamien Bergamini 888ceaec73dSDamien Bergamini return 0; 889ceaec73dSDamien Bergamini } 890ceaec73dSDamien Bergamini 891ceaec73dSDamien Bergamini /* 89228a38073SDamien Bergamini * The firmware automatically adapts the transmit speed. We report its current 89328a38073SDamien Bergamini * value here. 894ceaec73dSDamien Bergamini */ 895ceaec73dSDamien Bergamini static void 896ceaec73dSDamien Bergamini iwi_media_status(struct ifnet *ifp, struct ifmediareq *imr) 897ceaec73dSDamien Bergamini { 898ceaec73dSDamien Bergamini struct iwi_softc *sc = ifp->if_softc; 899ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 900ceaec73dSDamien Bergamini #define N(a) (sizeof (a) / sizeof (a[0])) 901ceaec73dSDamien Bergamini static const struct { 902ceaec73dSDamien Bergamini uint32_t val; 903ceaec73dSDamien Bergamini int rate; 904ceaec73dSDamien Bergamini } rates[] = { 905ceaec73dSDamien Bergamini { IWI_RATE_DS1, 2 }, 906ceaec73dSDamien Bergamini { IWI_RATE_DS2, 4 }, 907ceaec73dSDamien Bergamini { IWI_RATE_DS5, 11 }, 908ceaec73dSDamien Bergamini { IWI_RATE_DS11, 22 }, 909ceaec73dSDamien Bergamini { IWI_RATE_OFDM6, 12 }, 910ceaec73dSDamien Bergamini { IWI_RATE_OFDM9, 18 }, 911ceaec73dSDamien Bergamini { IWI_RATE_OFDM12, 24 }, 912ceaec73dSDamien Bergamini { IWI_RATE_OFDM18, 36 }, 913ceaec73dSDamien Bergamini { IWI_RATE_OFDM24, 48 }, 914ceaec73dSDamien Bergamini { IWI_RATE_OFDM36, 72 }, 915ceaec73dSDamien Bergamini { IWI_RATE_OFDM48, 96 }, 916ceaec73dSDamien Bergamini { IWI_RATE_OFDM54, 108 }, 917ceaec73dSDamien Bergamini }; 918ceaec73dSDamien Bergamini uint32_t val; 919ceaec73dSDamien Bergamini int rate, i; 920ceaec73dSDamien Bergamini 921ceaec73dSDamien Bergamini imr->ifm_status = IFM_AVALID; 922ceaec73dSDamien Bergamini imr->ifm_active = IFM_IEEE80211; 923ceaec73dSDamien Bergamini if (ic->ic_state == IEEE80211_S_RUN) 924ceaec73dSDamien Bergamini imr->ifm_status |= IFM_ACTIVE; 925ceaec73dSDamien Bergamini 926ceaec73dSDamien Bergamini /* read current transmission rate from adapter */ 927ceaec73dSDamien Bergamini val = CSR_READ_4(sc, IWI_CSR_CURRENT_TX_RATE); 928ceaec73dSDamien Bergamini 929ceaec73dSDamien Bergamini /* convert rate to 802.11 rate */ 930ceaec73dSDamien Bergamini for (i = 0; i < N(rates) && rates[i].val != val; i++); 931ceaec73dSDamien Bergamini rate = (i < N(rates)) ? rates[i].rate : 0; 932ceaec73dSDamien Bergamini 933ceaec73dSDamien Bergamini imr->ifm_active |= ieee80211_rate2media(ic, rate, ic->ic_curmode); 934ceaec73dSDamien Bergamini switch (ic->ic_opmode) { 935ceaec73dSDamien Bergamini case IEEE80211_M_STA: 936ceaec73dSDamien Bergamini break; 937ceaec73dSDamien Bergamini 938ceaec73dSDamien Bergamini case IEEE80211_M_IBSS: 939ceaec73dSDamien Bergamini imr->ifm_active |= IFM_IEEE80211_ADHOC; 940ceaec73dSDamien Bergamini break; 941ceaec73dSDamien Bergamini 942ceaec73dSDamien Bergamini case IEEE80211_M_MONITOR: 943ceaec73dSDamien Bergamini imr->ifm_active |= IFM_IEEE80211_MONITOR; 944ceaec73dSDamien Bergamini break; 945ceaec73dSDamien Bergamini 946ceaec73dSDamien Bergamini case IEEE80211_M_AHDEMO: 947ceaec73dSDamien Bergamini case IEEE80211_M_HOSTAP: 948ceaec73dSDamien Bergamini /* should not get there */ 949ceaec73dSDamien Bergamini break; 950ceaec73dSDamien Bergamini } 951ceaec73dSDamien Bergamini #undef N 952ceaec73dSDamien Bergamini } 953ceaec73dSDamien Bergamini 954ceaec73dSDamien Bergamini static int 955ceaec73dSDamien Bergamini iwi_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg) 956ceaec73dSDamien Bergamini { 957ceaec73dSDamien Bergamini struct ifnet *ifp = ic->ic_ifp; 958ceaec73dSDamien Bergamini struct iwi_softc *sc = ifp->if_softc; 959ceaec73dSDamien Bergamini 960ceaec73dSDamien Bergamini switch (nstate) { 961ceaec73dSDamien Bergamini case IEEE80211_S_SCAN: 962acea4241SDamien Bergamini if (sc->flags & IWI_FLAG_SCANNING) 963acea4241SDamien Bergamini break; 964acea4241SDamien Bergamini 965acea4241SDamien Bergamini ieee80211_node_table_reset(&ic->ic_scan); 966acea4241SDamien Bergamini ic->ic_flags |= IEEE80211_F_SCAN | IEEE80211_F_ASCAN; 967acea4241SDamien Bergamini sc->flags |= IWI_FLAG_SCANNING; 968ceaec73dSDamien Bergamini iwi_scan(sc); 969ceaec73dSDamien Bergamini break; 970ceaec73dSDamien Bergamini 971ceaec73dSDamien Bergamini case IEEE80211_S_AUTH: 972ceaec73dSDamien Bergamini iwi_auth_and_assoc(sc); 973ceaec73dSDamien Bergamini break; 974ceaec73dSDamien Bergamini 975ceaec73dSDamien Bergamini case IEEE80211_S_RUN: 976ceaec73dSDamien Bergamini if (ic->ic_opmode == IEEE80211_M_IBSS) 977ceaec73dSDamien Bergamini ieee80211_new_state(ic, IEEE80211_S_AUTH, -1); 978acea4241SDamien Bergamini else if (ic->ic_opmode == IEEE80211_M_MONITOR) 979acea4241SDamien Bergamini iwi_set_chan(sc, ic->ic_ibss_chan); 980acea4241SDamien Bergamini 981acea4241SDamien Bergamini return sc->sc_newstate(ic, nstate, 982acea4241SDamien Bergamini IEEE80211_FC0_SUBTYPE_ASSOC_RESP); 983ceaec73dSDamien Bergamini 984ceaec73dSDamien Bergamini case IEEE80211_S_ASSOC: 985acea4241SDamien Bergamini break; 986acea4241SDamien Bergamini 987ceaec73dSDamien Bergamini case IEEE80211_S_INIT: 988acea4241SDamien Bergamini sc->flags &= ~IWI_FLAG_SCANNING; 989ceaec73dSDamien Bergamini break; 990ceaec73dSDamien Bergamini } 991ceaec73dSDamien Bergamini 992ceaec73dSDamien Bergamini ic->ic_state = nstate; 993ceaec73dSDamien Bergamini return 0; 994ceaec73dSDamien Bergamini } 995ceaec73dSDamien Bergamini 996fb533d55SDamien Bergamini /* 997fb533d55SDamien Bergamini * WME parameters coming from IEEE 802.11e specification. These values are 998fb533d55SDamien Bergamini * already declared in ieee80211_proto.c, but they are static so they can't 999fb533d55SDamien Bergamini * be reused here. 1000fb533d55SDamien Bergamini */ 1001fb533d55SDamien Bergamini static const struct wmeParams iwi_wme_cck_params[WME_NUM_AC] = { 1002fb533d55SDamien Bergamini { 0, 3, 5, 7, 0 }, /* WME_AC_BE */ 1003fb533d55SDamien Bergamini { 0, 3, 5, 10, 0 }, /* WME_AC_BK */ 1004fb533d55SDamien Bergamini { 0, 2, 4, 5, 188 }, /* WME_AC_VI */ 1005fb533d55SDamien Bergamini { 0, 2, 3, 4, 102 } /* WME_AC_VO */ 1006fb533d55SDamien Bergamini }; 1007fb533d55SDamien Bergamini 1008fb533d55SDamien Bergamini static const struct wmeParams iwi_wme_ofdm_params[WME_NUM_AC] = { 1009fb533d55SDamien Bergamini { 0, 3, 4, 6, 0 }, /* WME_AC_BE */ 1010fb533d55SDamien Bergamini { 0, 3, 4, 10, 0 }, /* WME_AC_BK */ 1011fb533d55SDamien Bergamini { 0, 2, 3, 4, 94 }, /* WME_AC_VI */ 1012fb533d55SDamien Bergamini { 0, 2, 2, 3, 47 } /* WME_AC_VO */ 1013fb533d55SDamien Bergamini }; 1014fb533d55SDamien Bergamini 1015ec01dc2bSDamien Bergamini static int 1016ec01dc2bSDamien Bergamini iwi_wme_update(struct ieee80211com *ic) 1017ec01dc2bSDamien Bergamini { 1018fb533d55SDamien Bergamini #define IWI_EXP2(v) htole16((1 << (v)) - 1) 1019fb533d55SDamien Bergamini #define IWI_USEC(v) htole16(IEEE80211_TXOP_TO_US(v)) 1020fb533d55SDamien Bergamini struct iwi_softc *sc = ic->ic_ifp->if_softc; 1021fb533d55SDamien Bergamini struct iwi_wme_params wme[3]; 1022fb533d55SDamien Bergamini const struct wmeParams *wmep; 1023fb533d55SDamien Bergamini int ac; 1024ec01dc2bSDamien Bergamini 1025fb533d55SDamien Bergamini /* 1026fb533d55SDamien Bergamini * We shall not override firmware default WME values if WME is not 1027fb533d55SDamien Bergamini * actually enabled. 1028fb533d55SDamien Bergamini */ 1029fb533d55SDamien Bergamini if (!(ic->ic_flags & IEEE80211_F_WME)) 1030ec01dc2bSDamien Bergamini return 0; 1031fb533d55SDamien Bergamini 1032fb533d55SDamien Bergamini for (ac = 0; ac < WME_NUM_AC; ac++) { 1033fb533d55SDamien Bergamini /* set WME values for current operating mode */ 1034fb533d55SDamien Bergamini wmep = &ic->ic_wme.wme_chanParams.cap_wmeParams[ac]; 1035fb533d55SDamien Bergamini wme[0].aifsn[ac] = wmep->wmep_aifsn; 1036fb533d55SDamien Bergamini wme[0].cwmin[ac] = IWI_EXP2(wmep->wmep_logcwmin); 1037fb533d55SDamien Bergamini wme[0].cwmax[ac] = IWI_EXP2(wmep->wmep_logcwmax); 1038fb533d55SDamien Bergamini wme[0].burst[ac] = IWI_USEC(wmep->wmep_txopLimit); 1039fb533d55SDamien Bergamini wme[0].acm[ac] = wmep->wmep_acm; 1040fb533d55SDamien Bergamini 1041fb533d55SDamien Bergamini /* set WME values for CCK modulation */ 1042fb533d55SDamien Bergamini wmep = &iwi_wme_cck_params[ac]; 1043fb533d55SDamien Bergamini wme[1].aifsn[ac] = wmep->wmep_aifsn; 1044fb533d55SDamien Bergamini wme[1].cwmin[ac] = IWI_EXP2(wmep->wmep_logcwmin); 1045fb533d55SDamien Bergamini wme[1].cwmax[ac] = IWI_EXP2(wmep->wmep_logcwmax); 1046fb533d55SDamien Bergamini wme[1].burst[ac] = IWI_USEC(wmep->wmep_txopLimit); 1047fb533d55SDamien Bergamini wme[1].acm[ac] = wmep->wmep_acm; 1048fb533d55SDamien Bergamini 1049fb533d55SDamien Bergamini /* set WME values for OFDM modulation */ 1050fb533d55SDamien Bergamini wmep = &iwi_wme_ofdm_params[ac]; 1051fb533d55SDamien Bergamini wme[2].aifsn[ac] = wmep->wmep_aifsn; 1052fb533d55SDamien Bergamini wme[2].cwmin[ac] = IWI_EXP2(wmep->wmep_logcwmin); 1053fb533d55SDamien Bergamini wme[2].cwmax[ac] = IWI_EXP2(wmep->wmep_logcwmax); 1054fb533d55SDamien Bergamini wme[2].burst[ac] = IWI_USEC(wmep->wmep_txopLimit); 1055fb533d55SDamien Bergamini wme[2].acm[ac] = wmep->wmep_acm; 1056fb533d55SDamien Bergamini } 1057fb533d55SDamien Bergamini 1058fb533d55SDamien Bergamini DPRINTF(("Setting WME parameters\n")); 1059fb533d55SDamien Bergamini return iwi_cmd(sc, IWI_CMD_SET_WME_PARAMS, wme, sizeof wme, 1); 1060fb533d55SDamien Bergamini #undef IWI_USEC 1061fb533d55SDamien Bergamini #undef IWI_EXP2 1062ec01dc2bSDamien Bergamini } 1063ec01dc2bSDamien Bergamini 1064ceaec73dSDamien Bergamini /* 1065ceaec73dSDamien Bergamini * Read 16 bits at address 'addr' from the serial EEPROM. 1066ceaec73dSDamien Bergamini */ 1067ceaec73dSDamien Bergamini static uint16_t 1068ceaec73dSDamien Bergamini iwi_read_prom_word(struct iwi_softc *sc, uint8_t addr) 1069ceaec73dSDamien Bergamini { 1070ceaec73dSDamien Bergamini uint32_t tmp; 1071ceaec73dSDamien Bergamini uint16_t val; 1072ceaec73dSDamien Bergamini int n; 1073ceaec73dSDamien Bergamini 1074ceaec73dSDamien Bergamini /* clock C once before the first command */ 1075ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, 0); 1076ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S); 1077ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_C); 1078ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S); 1079ceaec73dSDamien Bergamini 1080ceaec73dSDamien Bergamini /* write start bit (1) */ 1081ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D); 1082ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D | IWI_EEPROM_C); 1083ceaec73dSDamien Bergamini 1084ceaec73dSDamien Bergamini /* write READ opcode (10) */ 1085ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D); 1086ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D | IWI_EEPROM_C); 1087ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S); 1088ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_C); 1089ceaec73dSDamien Bergamini 1090ceaec73dSDamien Bergamini /* write address A7-A0 */ 1091ceaec73dSDamien Bergamini for (n = 7; n >= 0; n--) { 1092ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S | 1093ceaec73dSDamien Bergamini (((addr >> n) & 1) << IWI_EEPROM_SHIFT_D)); 1094ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S | 1095ceaec73dSDamien Bergamini (((addr >> n) & 1) << IWI_EEPROM_SHIFT_D) | IWI_EEPROM_C); 1096ceaec73dSDamien Bergamini } 1097ceaec73dSDamien Bergamini 1098ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S); 1099ceaec73dSDamien Bergamini 1100ceaec73dSDamien Bergamini /* read data Q15-Q0 */ 1101ceaec73dSDamien Bergamini val = 0; 1102ceaec73dSDamien Bergamini for (n = 15; n >= 0; n--) { 1103ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_C); 1104ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S); 1105ceaec73dSDamien Bergamini tmp = MEM_READ_4(sc, IWI_MEM_EEPROM_CTL); 1106ceaec73dSDamien Bergamini val |= ((tmp & IWI_EEPROM_Q) >> IWI_EEPROM_SHIFT_Q) << n; 1107ceaec73dSDamien Bergamini } 1108ceaec73dSDamien Bergamini 1109ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, 0); 1110ceaec73dSDamien Bergamini 1111ceaec73dSDamien Bergamini /* clear Chip Select and clock C */ 1112ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_S); 1113ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, 0); 1114ceaec73dSDamien Bergamini IWI_EEPROM_CTL(sc, IWI_EEPROM_C); 1115ceaec73dSDamien Bergamini 111681e6343cSDamien Bergamini return val; 1117ceaec73dSDamien Bergamini } 1118ceaec73dSDamien Bergamini 1119ceaec73dSDamien Bergamini /* 1120ceaec73dSDamien Bergamini * XXX: Hack to set the current channel to the value advertised in beacons or 1121ceaec73dSDamien Bergamini * probe responses. Only used during AP detection. 1122ceaec73dSDamien Bergamini */ 1123ceaec73dSDamien Bergamini static void 1124ceaec73dSDamien Bergamini iwi_fix_channel(struct ieee80211com *ic, struct mbuf *m) 1125ceaec73dSDamien Bergamini { 1126ceaec73dSDamien Bergamini struct ieee80211_frame *wh; 1127ceaec73dSDamien Bergamini uint8_t subtype; 1128ceaec73dSDamien Bergamini uint8_t *frm, *efrm; 1129ceaec73dSDamien Bergamini 1130ceaec73dSDamien Bergamini wh = mtod(m, struct ieee80211_frame *); 1131ceaec73dSDamien Bergamini 1132ceaec73dSDamien Bergamini if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) != IEEE80211_FC0_TYPE_MGT) 1133ceaec73dSDamien Bergamini return; 1134ceaec73dSDamien Bergamini 1135ceaec73dSDamien Bergamini subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK; 1136ceaec73dSDamien Bergamini 1137ceaec73dSDamien Bergamini if (subtype != IEEE80211_FC0_SUBTYPE_BEACON && 1138ceaec73dSDamien Bergamini subtype != IEEE80211_FC0_SUBTYPE_PROBE_RESP) 1139ceaec73dSDamien Bergamini return; 1140ceaec73dSDamien Bergamini 1141ceaec73dSDamien Bergamini frm = (uint8_t *)(wh + 1); 1142ceaec73dSDamien Bergamini efrm = mtod(m, uint8_t *) + m->m_len; 1143ceaec73dSDamien Bergamini 1144ceaec73dSDamien Bergamini frm += 12; /* skip tstamp, bintval and capinfo fields */ 1145ceaec73dSDamien Bergamini while (frm < efrm) { 1146ceaec73dSDamien Bergamini if (*frm == IEEE80211_ELEMID_DSPARMS) 1147ceaec73dSDamien Bergamini #if IEEE80211_CHAN_MAX < 255 1148ceaec73dSDamien Bergamini if (frm[2] <= IEEE80211_CHAN_MAX) 1149ceaec73dSDamien Bergamini #endif 115045f3f78cSJohn Baldwin ic->ic_curchan = &ic->ic_channels[frm[2]]; 1151ceaec73dSDamien Bergamini 1152ceaec73dSDamien Bergamini frm += frm[1] + 2; 1153ceaec73dSDamien Bergamini } 1154ceaec73dSDamien Bergamini } 1155ceaec73dSDamien Bergamini 1156ceaec73dSDamien Bergamini static void 1157ceaec73dSDamien Bergamini iwi_frame_intr(struct iwi_softc *sc, struct iwi_rx_data *data, int i, 1158ceaec73dSDamien Bergamini struct iwi_frame *frame) 1159ceaec73dSDamien Bergamini { 1160ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 1161ceaec73dSDamien Bergamini struct ifnet *ifp = ic->ic_ifp; 116246c34436SDamien Bergamini struct mbuf *mnew, *m; 1163ceaec73dSDamien Bergamini struct ieee80211_frame *wh; 1164ceaec73dSDamien Bergamini struct ieee80211_node *ni; 1165ceaec73dSDamien Bergamini int error; 1166ceaec73dSDamien Bergamini 1167ceaec73dSDamien Bergamini DPRINTFN(5, ("received frame len=%u chan=%u rssi=%u\n", 1168ceaec73dSDamien Bergamini le16toh(frame->len), frame->chan, frame->rssi_dbm)); 1169ceaec73dSDamien Bergamini 1170acea4241SDamien Bergamini if (le16toh(frame->len) < sizeof (struct ieee80211_frame)) 1171acea4241SDamien Bergamini return; 1172acea4241SDamien Bergamini 117346c34436SDamien Bergamini /* 117446c34436SDamien Bergamini * Try to allocate a new mbuf for this ring element and load it before 117546c34436SDamien Bergamini * processing the current mbuf. If the ring element cannot be loaded, 117646c34436SDamien Bergamini * drop the received packet and reuse the old mbuf. In the unlikely 117746c34436SDamien Bergamini * case that the old mbuf can't be reloaded either, explicitly panic. 117846c34436SDamien Bergamini */ 117946c34436SDamien Bergamini mnew = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR); 118046c34436SDamien Bergamini if (mnew == NULL) { 118146c34436SDamien Bergamini ifp->if_ierrors++; 118246c34436SDamien Bergamini return; 118346c34436SDamien Bergamini } 118446c34436SDamien Bergamini 1185ceaec73dSDamien Bergamini bus_dmamap_unload(sc->rxq.data_dmat, data->map); 1186ceaec73dSDamien Bergamini 118746c34436SDamien Bergamini error = bus_dmamap_load(sc->rxq.data_dmat, data->map, 118846c34436SDamien Bergamini mtod(mnew, void *), MCLBYTES, iwi_dma_map_addr, &data->physaddr, 118946c34436SDamien Bergamini 0); 119046c34436SDamien Bergamini if (error != 0) { 119146c34436SDamien Bergamini m_freem(mnew); 119246c34436SDamien Bergamini 119346c34436SDamien Bergamini /* try to reload the old mbuf */ 119446c34436SDamien Bergamini error = bus_dmamap_load(sc->rxq.data_dmat, data->map, 119546c34436SDamien Bergamini mtod(data->m, void *), MCLBYTES, iwi_dma_map_addr, 119646c34436SDamien Bergamini &data->physaddr, 0); 119746c34436SDamien Bergamini if (error != 0) { 119846c34436SDamien Bergamini /* very unlikely that it will fail... */ 119946c34436SDamien Bergamini panic("%s: could not load old rx mbuf", 120046c34436SDamien Bergamini device_get_name(sc->sc_dev)); 120146c34436SDamien Bergamini } 120246c34436SDamien Bergamini ifp->if_ierrors++; 120346c34436SDamien Bergamini return; 120446c34436SDamien Bergamini } 120546c34436SDamien Bergamini 120646c34436SDamien Bergamini /* 120746c34436SDamien Bergamini * New mbuf successfully loaded, update Rx ring and continue 120846c34436SDamien Bergamini * processing. 120946c34436SDamien Bergamini */ 1210ceaec73dSDamien Bergamini m = data->m; 121146c34436SDamien Bergamini data->m = mnew; 121246c34436SDamien Bergamini CSR_WRITE_4(sc, data->reg, data->physaddr); 121346c34436SDamien Bergamini 121446c34436SDamien Bergamini /* finalize mbuf */ 1215ceaec73dSDamien Bergamini m->m_pkthdr.rcvif = ifp; 1216ceaec73dSDamien Bergamini m->m_pkthdr.len = m->m_len = sizeof (struct iwi_hdr) + 1217ceaec73dSDamien Bergamini sizeof (struct iwi_frame) + le16toh(frame->len); 1218ceaec73dSDamien Bergamini 1219ceaec73dSDamien Bergamini m_adj(m, sizeof (struct iwi_hdr) + sizeof (struct iwi_frame)); 1220ceaec73dSDamien Bergamini 1221ceaec73dSDamien Bergamini if (ic->ic_state == IEEE80211_S_SCAN) 1222ceaec73dSDamien Bergamini iwi_fix_channel(ic, m); 1223ceaec73dSDamien Bergamini 1224ceaec73dSDamien Bergamini if (sc->sc_drvbpf != NULL) { 1225ceaec73dSDamien Bergamini struct iwi_rx_radiotap_header *tap = &sc->sc_rxtap; 1226ceaec73dSDamien Bergamini 1227ceaec73dSDamien Bergamini tap->wr_flags = 0; 1228ceaec73dSDamien Bergamini tap->wr_rate = frame->rate; 1229ceaec73dSDamien Bergamini tap->wr_chan_freq = 1230ceaec73dSDamien Bergamini htole16(ic->ic_channels[frame->chan].ic_freq); 1231ceaec73dSDamien Bergamini tap->wr_chan_flags = 1232ceaec73dSDamien Bergamini htole16(ic->ic_channels[frame->chan].ic_flags); 1233ceaec73dSDamien Bergamini tap->wr_antsignal = frame->signal; 1234ceaec73dSDamien Bergamini tap->wr_antenna = frame->antenna; 1235ceaec73dSDamien Bergamini 1236ceaec73dSDamien Bergamini bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m); 1237ceaec73dSDamien Bergamini } 1238ceaec73dSDamien Bergamini 1239ceaec73dSDamien Bergamini wh = mtod(m, struct ieee80211_frame *); 1240ceaec73dSDamien Bergamini ni = ieee80211_find_rxnode(ic, (struct ieee80211_frame_min *)wh); 1241ceaec73dSDamien Bergamini 1242ceaec73dSDamien Bergamini /* send the frame to the 802.11 layer */ 1243acea4241SDamien Bergamini ieee80211_input(ic, m, ni, frame->rssi_dbm, 0); 1244ceaec73dSDamien Bergamini 1245ceaec73dSDamien Bergamini /* node is no longer needed */ 1246ceaec73dSDamien Bergamini ieee80211_free_node(ni); 1247ceaec73dSDamien Bergamini } 1248ceaec73dSDamien Bergamini 1249ceaec73dSDamien Bergamini static void 1250ceaec73dSDamien Bergamini iwi_notification_intr(struct iwi_softc *sc, struct iwi_notif *notif) 1251ceaec73dSDamien Bergamini { 1252ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 1253ceaec73dSDamien Bergamini struct iwi_notif_scan_channel *chan; 1254ceaec73dSDamien Bergamini struct iwi_notif_scan_complete *scan; 1255ceaec73dSDamien Bergamini struct iwi_notif_authentication *auth; 1256ceaec73dSDamien Bergamini struct iwi_notif_association *assoc; 1257ceaec73dSDamien Bergamini 1258ceaec73dSDamien Bergamini switch (notif->type) { 1259ceaec73dSDamien Bergamini case IWI_NOTIF_TYPE_SCAN_CHANNEL: 1260ceaec73dSDamien Bergamini chan = (struct iwi_notif_scan_channel *)(notif + 1); 1261ceaec73dSDamien Bergamini 1262ceaec73dSDamien Bergamini DPRINTFN(2, ("Scanning channel (%u)\n", chan->nchan)); 1263ceaec73dSDamien Bergamini break; 1264ceaec73dSDamien Bergamini 1265ceaec73dSDamien Bergamini case IWI_NOTIF_TYPE_SCAN_COMPLETE: 1266ceaec73dSDamien Bergamini scan = (struct iwi_notif_scan_complete *)(notif + 1); 1267ceaec73dSDamien Bergamini 1268ceaec73dSDamien Bergamini DPRINTFN(2, ("Scan completed (%u, %u)\n", scan->nchan, 1269ceaec73dSDamien Bergamini scan->status)); 1270ceaec73dSDamien Bergamini 1271acea4241SDamien Bergamini /* monitor mode uses scan to set the channel ... */ 1272acea4241SDamien Bergamini if (ic->ic_opmode != IEEE80211_M_MONITOR) { 1273acea4241SDamien Bergamini sc->flags &= ~IWI_FLAG_SCANNING; 1274ceaec73dSDamien Bergamini ieee80211_end_scan(ic); 1275acea4241SDamien Bergamini } else 1276acea4241SDamien Bergamini iwi_set_chan(sc, ic->ic_ibss_chan); 1277ceaec73dSDamien Bergamini break; 1278ceaec73dSDamien Bergamini 1279ceaec73dSDamien Bergamini case IWI_NOTIF_TYPE_AUTHENTICATION: 1280ceaec73dSDamien Bergamini auth = (struct iwi_notif_authentication *)(notif + 1); 1281ceaec73dSDamien Bergamini 1282ceaec73dSDamien Bergamini DPRINTFN(2, ("Authentication (%u)\n", auth->state)); 1283ceaec73dSDamien Bergamini 1284ceaec73dSDamien Bergamini switch (auth->state) { 1285ceaec73dSDamien Bergamini case IWI_AUTHENTICATED: 1286e4918ecdSSam Leffler ieee80211_node_authorize(ic->ic_bss); 1287ceaec73dSDamien Bergamini ieee80211_new_state(ic, IEEE80211_S_ASSOC, -1); 1288ceaec73dSDamien Bergamini break; 1289ceaec73dSDamien Bergamini 1290ceaec73dSDamien Bergamini case IWI_DEAUTHENTICATED: 1291ceaec73dSDamien Bergamini break; 1292ceaec73dSDamien Bergamini 1293ceaec73dSDamien Bergamini default: 1294ceaec73dSDamien Bergamini device_printf(sc->sc_dev, 1295ceaec73dSDamien Bergamini "unknown authentication state %u\n", auth->state); 1296ceaec73dSDamien Bergamini } 1297ceaec73dSDamien Bergamini break; 1298ceaec73dSDamien Bergamini 1299ceaec73dSDamien Bergamini case IWI_NOTIF_TYPE_ASSOCIATION: 1300ceaec73dSDamien Bergamini assoc = (struct iwi_notif_association *)(notif + 1); 1301ceaec73dSDamien Bergamini 1302ceaec73dSDamien Bergamini DPRINTFN(2, ("Association (%u, %u)\n", assoc->state, 1303ceaec73dSDamien Bergamini assoc->status)); 1304ceaec73dSDamien Bergamini 1305ceaec73dSDamien Bergamini switch (assoc->state) { 1306ceaec73dSDamien Bergamini case IWI_AUTHENTICATED: 1307ceaec73dSDamien Bergamini /* re-association, do nothing */ 1308ceaec73dSDamien Bergamini break; 1309ceaec73dSDamien Bergamini 1310ceaec73dSDamien Bergamini case IWI_ASSOCIATED: 1311ceaec73dSDamien Bergamini ieee80211_new_state(ic, IEEE80211_S_RUN, -1); 1312ceaec73dSDamien Bergamini break; 1313ceaec73dSDamien Bergamini 1314ceaec73dSDamien Bergamini case IWI_DEASSOCIATED: 1315ceaec73dSDamien Bergamini ieee80211_begin_scan(ic, 1); 1316ceaec73dSDamien Bergamini break; 1317ceaec73dSDamien Bergamini 1318ceaec73dSDamien Bergamini default: 1319ceaec73dSDamien Bergamini device_printf(sc->sc_dev, 1320ceaec73dSDamien Bergamini "unknown association state %u\n", assoc->state); 1321ceaec73dSDamien Bergamini } 1322ceaec73dSDamien Bergamini break; 1323ceaec73dSDamien Bergamini 1324ceaec73dSDamien Bergamini case IWI_NOTIF_TYPE_CALIBRATION: 1325ceaec73dSDamien Bergamini case IWI_NOTIF_TYPE_BEACON: 1326ceaec73dSDamien Bergamini case IWI_NOTIF_TYPE_NOISE: 1327ceaec73dSDamien Bergamini DPRINTFN(5, ("Notification (%u)\n", notif->type)); 1328ceaec73dSDamien Bergamini break; 1329ceaec73dSDamien Bergamini 1330ceaec73dSDamien Bergamini default: 1331ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "unknown notification type %u\n", 1332ceaec73dSDamien Bergamini notif->type); 1333ceaec73dSDamien Bergamini } 1334ceaec73dSDamien Bergamini } 1335ceaec73dSDamien Bergamini 1336ceaec73dSDamien Bergamini static void 1337ceaec73dSDamien Bergamini iwi_rx_intr(struct iwi_softc *sc) 1338ceaec73dSDamien Bergamini { 1339ceaec73dSDamien Bergamini struct iwi_rx_data *data; 1340ceaec73dSDamien Bergamini struct iwi_hdr *hdr; 1341ceaec73dSDamien Bergamini uint32_t hw; 1342ceaec73dSDamien Bergamini 1343ceaec73dSDamien Bergamini hw = CSR_READ_4(sc, IWI_CSR_RX_RIDX); 1344ceaec73dSDamien Bergamini 1345ceaec73dSDamien Bergamini for (; sc->rxq.cur != hw;) { 1346ceaec73dSDamien Bergamini data = &sc->rxq.data[sc->rxq.cur]; 1347ceaec73dSDamien Bergamini 1348ceaec73dSDamien Bergamini bus_dmamap_sync(sc->rxq.data_dmat, data->map, 1349ceaec73dSDamien Bergamini BUS_DMASYNC_POSTREAD); 1350ceaec73dSDamien Bergamini 1351ceaec73dSDamien Bergamini hdr = mtod(data->m, struct iwi_hdr *); 1352ceaec73dSDamien Bergamini 1353ceaec73dSDamien Bergamini switch (hdr->type) { 1354ceaec73dSDamien Bergamini case IWI_HDR_TYPE_FRAME: 1355ceaec73dSDamien Bergamini iwi_frame_intr(sc, data, sc->rxq.cur, 1356ceaec73dSDamien Bergamini (struct iwi_frame *)(hdr + 1)); 1357ceaec73dSDamien Bergamini break; 1358ceaec73dSDamien Bergamini 1359ceaec73dSDamien Bergamini case IWI_HDR_TYPE_NOTIF: 1360ceaec73dSDamien Bergamini iwi_notification_intr(sc, 1361ceaec73dSDamien Bergamini (struct iwi_notif *)(hdr + 1)); 1362ceaec73dSDamien Bergamini break; 1363ceaec73dSDamien Bergamini 1364ceaec73dSDamien Bergamini default: 1365ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "unknown hdr type %u\n", 1366ceaec73dSDamien Bergamini hdr->type); 1367ceaec73dSDamien Bergamini } 1368ceaec73dSDamien Bergamini 1369ceaec73dSDamien Bergamini DPRINTFN(15, ("rx done idx=%u\n", sc->rxq.cur)); 1370ceaec73dSDamien Bergamini 1371ceaec73dSDamien Bergamini sc->rxq.cur = (sc->rxq.cur + 1) % IWI_RX_RING_COUNT; 1372ceaec73dSDamien Bergamini } 1373ceaec73dSDamien Bergamini 1374ceaec73dSDamien Bergamini /* tell the firmware what we have processed */ 1375ceaec73dSDamien Bergamini hw = (hw == 0) ? IWI_RX_RING_COUNT - 1 : hw - 1; 1376ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_RX_WIDX, hw); 1377ceaec73dSDamien Bergamini } 1378ceaec73dSDamien Bergamini 1379ceaec73dSDamien Bergamini static void 1380ec01dc2bSDamien Bergamini iwi_tx_intr(struct iwi_softc *sc, struct iwi_tx_ring *txq) 1381ceaec73dSDamien Bergamini { 1382ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 1383ceaec73dSDamien Bergamini struct ifnet *ifp = ic->ic_ifp; 1384ceaec73dSDamien Bergamini struct iwi_tx_data *data; 1385ceaec73dSDamien Bergamini uint32_t hw; 1386ceaec73dSDamien Bergamini 1387ec01dc2bSDamien Bergamini hw = CSR_READ_4(sc, txq->csr_ridx); 1388ceaec73dSDamien Bergamini 1389ec01dc2bSDamien Bergamini for (; txq->next != hw;) { 1390ec01dc2bSDamien Bergamini data = &txq->data[txq->next]; 1391ceaec73dSDamien Bergamini 1392ec01dc2bSDamien Bergamini bus_dmamap_sync(txq->data_dmat, data->map, 1393ceaec73dSDamien Bergamini BUS_DMASYNC_POSTWRITE); 1394ec01dc2bSDamien Bergamini bus_dmamap_unload(txq->data_dmat, data->map); 1395ceaec73dSDamien Bergamini m_freem(data->m); 1396ceaec73dSDamien Bergamini data->m = NULL; 1397ceaec73dSDamien Bergamini ieee80211_free_node(data->ni); 1398ceaec73dSDamien Bergamini data->ni = NULL; 1399ceaec73dSDamien Bergamini 1400ec01dc2bSDamien Bergamini DPRINTFN(15, ("tx done idx=%u\n", txq->next)); 1401ceaec73dSDamien Bergamini 1402ceaec73dSDamien Bergamini ifp->if_opackets++; 1403ceaec73dSDamien Bergamini 1404ec01dc2bSDamien Bergamini txq->queued--; 1405ec01dc2bSDamien Bergamini txq->next = (txq->next + 1) % IWI_TX_RING_COUNT; 1406ceaec73dSDamien Bergamini } 1407ceaec73dSDamien Bergamini 1408ceaec73dSDamien Bergamini sc->sc_tx_timer = 0; 140913f4c340SRobert Watson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1410ceaec73dSDamien Bergamini iwi_start(ifp); 1411ceaec73dSDamien Bergamini } 1412ceaec73dSDamien Bergamini 1413ceaec73dSDamien Bergamini static void 1414ceaec73dSDamien Bergamini iwi_intr(void *arg) 1415ceaec73dSDamien Bergamini { 1416ceaec73dSDamien Bergamini struct iwi_softc *sc = arg; 1417ceaec73dSDamien Bergamini uint32_t r; 1418ceaec73dSDamien Bergamini 1419ceaec73dSDamien Bergamini IWI_LOCK(sc); 1420ceaec73dSDamien Bergamini 1421ceaec73dSDamien Bergamini if ((r = CSR_READ_4(sc, IWI_CSR_INTR)) == 0 || r == 0xffffffff) { 1422ceaec73dSDamien Bergamini IWI_UNLOCK(sc); 1423ceaec73dSDamien Bergamini return; 1424ceaec73dSDamien Bergamini } 1425ceaec73dSDamien Bergamini 1426ceaec73dSDamien Bergamini /* disable interrupts */ 1427ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, 0); 1428ceaec73dSDamien Bergamini 1429ceaec73dSDamien Bergamini if (r & (IWI_INTR_FATAL_ERROR | IWI_INTR_PARITY_ERROR)) { 1430ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "fatal error\n"); 1431ceaec73dSDamien Bergamini sc->sc_ic.ic_ifp->if_flags &= ~IFF_UP; 1432ceaec73dSDamien Bergamini iwi_stop(sc); 1433ceaec73dSDamien Bergamini } 1434ceaec73dSDamien Bergamini 1435ceaec73dSDamien Bergamini if (r & IWI_INTR_FW_INITED) { 1436ceaec73dSDamien Bergamini if (!(r & (IWI_INTR_FATAL_ERROR | IWI_INTR_PARITY_ERROR))) 1437ceaec73dSDamien Bergamini wakeup(sc); 1438ceaec73dSDamien Bergamini } 1439ceaec73dSDamien Bergamini 1440ceaec73dSDamien Bergamini if (r & IWI_INTR_RADIO_OFF) { 1441ceaec73dSDamien Bergamini DPRINTF(("radio transmitter turned off\n")); 1442ceaec73dSDamien Bergamini sc->sc_ic.ic_ifp->if_flags &= ~IFF_UP; 1443ceaec73dSDamien Bergamini iwi_stop(sc); 1444ceaec73dSDamien Bergamini } 1445ceaec73dSDamien Bergamini 1446ceaec73dSDamien Bergamini if (r & IWI_INTR_CMD_DONE) 1447ceaec73dSDamien Bergamini wakeup(sc); 1448ceaec73dSDamien Bergamini 1449ceaec73dSDamien Bergamini if (r & IWI_INTR_TX1_DONE) 1450ec01dc2bSDamien Bergamini iwi_tx_intr(sc, &sc->txq[0]); 1451ec01dc2bSDamien Bergamini 1452ec01dc2bSDamien Bergamini if (r & IWI_INTR_TX2_DONE) 1453ec01dc2bSDamien Bergamini iwi_tx_intr(sc, &sc->txq[1]); 1454ec01dc2bSDamien Bergamini 1455ec01dc2bSDamien Bergamini if (r & IWI_INTR_TX3_DONE) 1456ec01dc2bSDamien Bergamini iwi_tx_intr(sc, &sc->txq[2]); 1457ec01dc2bSDamien Bergamini 1458ec01dc2bSDamien Bergamini if (r & IWI_INTR_TX4_DONE) 1459ec01dc2bSDamien Bergamini iwi_tx_intr(sc, &sc->txq[3]); 1460ec01dc2bSDamien Bergamini 1461ec01dc2bSDamien Bergamini if (r & IWI_INTR_RX_DONE) 1462ec01dc2bSDamien Bergamini iwi_rx_intr(sc); 1463ceaec73dSDamien Bergamini 1464ceaec73dSDamien Bergamini /* acknowledge interrupts */ 1465ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_INTR, r); 1466ceaec73dSDamien Bergamini 1467ceaec73dSDamien Bergamini /* re-enable interrupts */ 1468ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, IWI_INTR_MASK); 1469ceaec73dSDamien Bergamini 1470ceaec73dSDamien Bergamini IWI_UNLOCK(sc); 1471ceaec73dSDamien Bergamini } 1472ceaec73dSDamien Bergamini 1473ceaec73dSDamien Bergamini static int 1474ceaec73dSDamien Bergamini iwi_cmd(struct iwi_softc *sc, uint8_t type, void *data, uint8_t len, int async) 1475ceaec73dSDamien Bergamini { 1476ceaec73dSDamien Bergamini struct iwi_cmd_desc *desc; 1477ceaec73dSDamien Bergamini 1478ceaec73dSDamien Bergamini desc = &sc->cmdq.desc[sc->cmdq.cur]; 1479ceaec73dSDamien Bergamini 1480ceaec73dSDamien Bergamini desc->hdr.type = IWI_HDR_TYPE_COMMAND; 1481ceaec73dSDamien Bergamini desc->hdr.flags = IWI_HDR_FLAG_IRQ; 1482ceaec73dSDamien Bergamini desc->type = type; 1483ceaec73dSDamien Bergamini desc->len = len; 1484ceaec73dSDamien Bergamini memcpy(desc->data, data, len); 1485ceaec73dSDamien Bergamini 1486ceaec73dSDamien Bergamini bus_dmamap_sync(sc->cmdq.desc_dmat, sc->cmdq.desc_map, 1487ceaec73dSDamien Bergamini BUS_DMASYNC_PREWRITE); 1488ceaec73dSDamien Bergamini 1489ceaec73dSDamien Bergamini DPRINTFN(2, ("sending command idx=%u type=%u len=%u\n", sc->cmdq.cur, 1490ceaec73dSDamien Bergamini type, len)); 1491ceaec73dSDamien Bergamini 1492ceaec73dSDamien Bergamini sc->cmdq.cur = (sc->cmdq.cur + 1) % IWI_CMD_RING_COUNT; 1493ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_CMD_WIDX, sc->cmdq.cur); 1494ceaec73dSDamien Bergamini 1495ceaec73dSDamien Bergamini return async ? 0 : msleep(sc, &sc->sc_mtx, 0, "iwicmd", hz); 1496ceaec73dSDamien Bergamini } 1497ceaec73dSDamien Bergamini 149828a38073SDamien Bergamini static void 149928a38073SDamien Bergamini iwi_write_ibssnode(struct iwi_softc *sc, const struct iwi_node *in) 150028a38073SDamien Bergamini { 150128a38073SDamien Bergamini struct iwi_ibssnode node; 150228a38073SDamien Bergamini 150328a38073SDamien Bergamini /* write node information into NIC memory */ 150428a38073SDamien Bergamini memset(&node, 0, sizeof node); 150528a38073SDamien Bergamini IEEE80211_ADDR_COPY(node.bssid, in->in_node.ni_macaddr); 150628a38073SDamien Bergamini 150728a38073SDamien Bergamini CSR_WRITE_REGION_1(sc, 150828a38073SDamien Bergamini IWI_CSR_NODE_BASE + in->in_station * sizeof node, 150928a38073SDamien Bergamini (uint8_t *)&node, sizeof node); 151028a38073SDamien Bergamini } 151128a38073SDamien Bergamini 1512ceaec73dSDamien Bergamini static int 15130b74a285SDamien Bergamini iwi_tx_start(struct ifnet *ifp, struct mbuf *m0, struct ieee80211_node *ni, 15140b74a285SDamien Bergamini int ac) 1515ceaec73dSDamien Bergamini { 1516ceaec73dSDamien Bergamini struct iwi_softc *sc = ifp->if_softc; 1517ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 151828a38073SDamien Bergamini struct iwi_node *in = (struct iwi_node *)ni; 1519ec01dc2bSDamien Bergamini struct ieee80211_frame *wh; 1520acea4241SDamien Bergamini struct ieee80211_key *k; 1521ec01dc2bSDamien Bergamini const struct chanAccParams *cap; 15220b74a285SDamien Bergamini struct iwi_tx_ring *txq = &sc->txq[ac]; 1523ceaec73dSDamien Bergamini struct iwi_tx_data *data; 1524ceaec73dSDamien Bergamini struct iwi_tx_desc *desc; 1525ceaec73dSDamien Bergamini struct mbuf *mnew; 1526ceaec73dSDamien Bergamini bus_dma_segment_t segs[IWI_MAX_NSEG]; 152728a38073SDamien Bergamini int error, nsegs, hdrlen, i, noack = 0; 1528ceaec73dSDamien Bergamini 1529ec01dc2bSDamien Bergamini wh = mtod(m0, struct ieee80211_frame *); 1530ec01dc2bSDamien Bergamini 1531ec01dc2bSDamien Bergamini if (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_QOS) { 1532ec01dc2bSDamien Bergamini hdrlen = sizeof (struct ieee80211_qosframe); 1533ec01dc2bSDamien Bergamini cap = &ic->ic_wme.wme_chanParams; 1534ec01dc2bSDamien Bergamini noack = cap->cap_wmeParams[ac].wmep_noackPolicy; 15350b74a285SDamien Bergamini } else 1536ec01dc2bSDamien Bergamini hdrlen = sizeof (struct ieee80211_frame); 1537ec01dc2bSDamien Bergamini 153828a38073SDamien Bergamini /* 153928a38073SDamien Bergamini * This is only used in IBSS mode where the firmware expect an index 154028a38073SDamien Bergamini * in a h/w table instead of a destination address. 154128a38073SDamien Bergamini */ 154228a38073SDamien Bergamini if (ic->ic_opmode == IEEE80211_M_IBSS && in->in_station == -1) { 154328a38073SDamien Bergamini in->in_station = alloc_unr(sc->sc_unr); 154428a38073SDamien Bergamini if (in->in_station == -1) { /* h/w table is full */ 1545ec01dc2bSDamien Bergamini m_freem(m0); 15460b74a285SDamien Bergamini ieee80211_free_node(ni); 15470b74a285SDamien Bergamini ifp->if_oerrors++; 1548ec01dc2bSDamien Bergamini return 0; 1549ec01dc2bSDamien Bergamini } 155028a38073SDamien Bergamini iwi_write_ibssnode(sc, in); 15510b74a285SDamien Bergamini } 1552ec01dc2bSDamien Bergamini 1553ec01dc2bSDamien Bergamini if (wh->i_fc[1] & IEEE80211_FC1_WEP) { 1554acea4241SDamien Bergamini k = ieee80211_crypto_encap(ic, ni, m0); 155582145663SSam Leffler if (k == NULL) { 155682145663SSam Leffler m_freem(m0); 1557acea4241SDamien Bergamini return ENOBUFS; 1558acea4241SDamien Bergamini } 1559ec01dc2bSDamien Bergamini 1560ec01dc2bSDamien Bergamini /* packet header may have moved, reset our local pointer */ 1561ec01dc2bSDamien Bergamini wh = mtod(m0, struct ieee80211_frame *); 156282145663SSam Leffler } 1563acea4241SDamien Bergamini 1564ceaec73dSDamien Bergamini if (sc->sc_drvbpf != NULL) { 1565ceaec73dSDamien Bergamini struct iwi_tx_radiotap_header *tap = &sc->sc_txtap; 1566ceaec73dSDamien Bergamini 1567ceaec73dSDamien Bergamini tap->wt_flags = 0; 1568acea4241SDamien Bergamini tap->wt_chan_freq = htole16(ic->ic_ibss_chan->ic_freq); 1569acea4241SDamien Bergamini tap->wt_chan_flags = htole16(ic->ic_ibss_chan->ic_flags); 1570ceaec73dSDamien Bergamini 1571ceaec73dSDamien Bergamini bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0); 1572ceaec73dSDamien Bergamini } 1573ceaec73dSDamien Bergamini 1574ec01dc2bSDamien Bergamini data = &txq->data[txq->cur]; 1575ec01dc2bSDamien Bergamini desc = &txq->desc[txq->cur]; 1576ceaec73dSDamien Bergamini 1577ec01dc2bSDamien Bergamini /* save and trim IEEE802.11 header */ 1578ec01dc2bSDamien Bergamini m_copydata(m0, 0, hdrlen, (caddr_t)&desc->wh); 1579ec01dc2bSDamien Bergamini m_adj(m0, hdrlen); 1580ceaec73dSDamien Bergamini 1581ec01dc2bSDamien Bergamini error = bus_dmamap_load_mbuf_sg(txq->data_dmat, data->map, m0, segs, 1582ceaec73dSDamien Bergamini &nsegs, 0); 1583ceaec73dSDamien Bergamini if (error != 0 && error != EFBIG) { 1584ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not map mbuf (error %d)\n", 1585ceaec73dSDamien Bergamini error); 1586ceaec73dSDamien Bergamini m_freem(m0); 1587ceaec73dSDamien Bergamini return error; 1588ceaec73dSDamien Bergamini } 1589ceaec73dSDamien Bergamini if (error != 0) { 1590ceaec73dSDamien Bergamini mnew = m_defrag(m0, M_DONTWAIT); 1591ceaec73dSDamien Bergamini if (mnew == NULL) { 1592ceaec73dSDamien Bergamini device_printf(sc->sc_dev, 1593ceaec73dSDamien Bergamini "could not defragment mbuf\n"); 1594ceaec73dSDamien Bergamini m_freem(m0); 1595ceaec73dSDamien Bergamini return ENOBUFS; 1596ceaec73dSDamien Bergamini } 1597ceaec73dSDamien Bergamini m0 = mnew; 1598ceaec73dSDamien Bergamini 1599ec01dc2bSDamien Bergamini error = bus_dmamap_load_mbuf_sg(txq->data_dmat, data->map, 1600ceaec73dSDamien Bergamini m0, segs, &nsegs, 0); 1601ceaec73dSDamien Bergamini if (error != 0) { 1602ceaec73dSDamien Bergamini device_printf(sc->sc_dev, 1603ceaec73dSDamien Bergamini "could not map mbuf (error %d)\n", error); 1604ceaec73dSDamien Bergamini m_freem(m0); 1605ceaec73dSDamien Bergamini return error; 1606ceaec73dSDamien Bergamini } 1607ceaec73dSDamien Bergamini } 1608ceaec73dSDamien Bergamini 1609ceaec73dSDamien Bergamini data->m = m0; 1610ceaec73dSDamien Bergamini data->ni = ni; 1611ceaec73dSDamien Bergamini 1612ceaec73dSDamien Bergamini desc->hdr.type = IWI_HDR_TYPE_DATA; 1613ceaec73dSDamien Bergamini desc->hdr.flags = IWI_HDR_FLAG_IRQ; 161428a38073SDamien Bergamini desc->station = 161528a38073SDamien Bergamini (ic->ic_opmode == IEEE80211_M_IBSS) ? in->in_station : 0; 1616ceaec73dSDamien Bergamini desc->cmd = IWI_DATA_CMD_TX; 1617ceaec73dSDamien Bergamini desc->len = htole16(m0->m_pkthdr.len); 1618ceaec73dSDamien Bergamini desc->flags = 0; 1619ec01dc2bSDamien Bergamini desc->xflags = 0; 1620ceaec73dSDamien Bergamini 1621ec01dc2bSDamien Bergamini if (!noack && !IEEE80211_IS_MULTICAST(desc->wh.i_addr1)) 1622ceaec73dSDamien Bergamini desc->flags |= IWI_DATA_FLAG_NEED_ACK; 1623ceaec73dSDamien Bergamini 1624acea4241SDamien Bergamini #if 0 1625ceaec73dSDamien Bergamini if (ic->ic_flags & IEEE80211_F_PRIVACY) { 1626ec01dc2bSDamien Bergamini desc->wh.i_fc[1] |= IEEE80211_FC1_WEP; 1627ceaec73dSDamien Bergamini desc->wep_txkey = ic->ic_crypto.cs_def_txkey; 1628ceaec73dSDamien Bergamini } else 1629acea4241SDamien Bergamini #endif 1630ceaec73dSDamien Bergamini desc->flags |= IWI_DATA_FLAG_NO_WEP; 1631ceaec73dSDamien Bergamini 1632ceaec73dSDamien Bergamini if (ic->ic_flags & IEEE80211_F_SHPREAMBLE) 1633ceaec73dSDamien Bergamini desc->flags |= IWI_DATA_FLAG_SHPREAMBLE; 1634ceaec73dSDamien Bergamini 1635ec01dc2bSDamien Bergamini if (desc->wh.i_fc[0] & IEEE80211_FC0_SUBTYPE_QOS) 1636ec01dc2bSDamien Bergamini desc->xflags |= IWI_DATA_XFLAG_QOS; 1637ec01dc2bSDamien Bergamini 1638ceaec73dSDamien Bergamini desc->nseg = htole32(nsegs); 1639ceaec73dSDamien Bergamini for (i = 0; i < nsegs; i++) { 1640ceaec73dSDamien Bergamini desc->seg_addr[i] = htole32(segs[i].ds_addr); 164181e6343cSDamien Bergamini desc->seg_len[i] = htole16(segs[i].ds_len); 1642ceaec73dSDamien Bergamini } 1643ceaec73dSDamien Bergamini 1644ec01dc2bSDamien Bergamini bus_dmamap_sync(txq->data_dmat, data->map, BUS_DMASYNC_PREWRITE); 1645ec01dc2bSDamien Bergamini bus_dmamap_sync(txq->desc_dmat, txq->desc_map, BUS_DMASYNC_PREWRITE); 1646ceaec73dSDamien Bergamini 1647ec01dc2bSDamien Bergamini DPRINTFN(5, ("sending data frame txq=%u idx=%u len=%u nseg=%u\n", 164881e6343cSDamien Bergamini ac, txq->cur, le16toh(desc->len), nsegs)); 1649ceaec73dSDamien Bergamini 1650ec01dc2bSDamien Bergamini txq->queued++; 1651ec01dc2bSDamien Bergamini txq->cur = (txq->cur + 1) % IWI_TX_RING_COUNT; 1652ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, txq->csr_widx, txq->cur); 1653ceaec73dSDamien Bergamini 1654ceaec73dSDamien Bergamini return 0; 1655ceaec73dSDamien Bergamini } 1656ceaec73dSDamien Bergamini 1657ceaec73dSDamien Bergamini static void 1658ceaec73dSDamien Bergamini iwi_start(struct ifnet *ifp) 1659ceaec73dSDamien Bergamini { 1660ceaec73dSDamien Bergamini struct iwi_softc *sc = ifp->if_softc; 1661ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 1662ceaec73dSDamien Bergamini struct mbuf *m0; 1663ceaec73dSDamien Bergamini struct ether_header *eh; 1664ceaec73dSDamien Bergamini struct ieee80211_node *ni; 16650b74a285SDamien Bergamini int ac; 1666ceaec73dSDamien Bergamini 1667ceaec73dSDamien Bergamini IWI_LOCK(sc); 1668ceaec73dSDamien Bergamini 1669ceaec73dSDamien Bergamini if (ic->ic_state != IEEE80211_S_RUN) { 1670ceaec73dSDamien Bergamini IWI_UNLOCK(sc); 1671ceaec73dSDamien Bergamini return; 1672ceaec73dSDamien Bergamini } 1673ceaec73dSDamien Bergamini 1674ceaec73dSDamien Bergamini for (;;) { 1675ceaec73dSDamien Bergamini IFQ_DRV_DEQUEUE(&ifp->if_snd, m0); 1676ceaec73dSDamien Bergamini if (m0 == NULL) 1677ceaec73dSDamien Bergamini break; 1678ceaec73dSDamien Bergamini 1679ceaec73dSDamien Bergamini if (m0->m_len < sizeof (struct ether_header) && 16800b74a285SDamien Bergamini (m0 = m_pullup(m0, sizeof (struct ether_header))) == NULL) { 16810b74a285SDamien Bergamini ifp->if_oerrors++; 1682ceaec73dSDamien Bergamini continue; 16830b74a285SDamien Bergamini } 1684ceaec73dSDamien Bergamini eh = mtod(m0, struct ether_header *); 1685ceaec73dSDamien Bergamini ni = ieee80211_find_txnode(ic, eh->ether_dhost); 1686ceaec73dSDamien Bergamini if (ni == NULL) { 1687ceaec73dSDamien Bergamini m_freem(m0); 16880b74a285SDamien Bergamini ifp->if_oerrors++; 1689ceaec73dSDamien Bergamini continue; 1690ceaec73dSDamien Bergamini } 16910b74a285SDamien Bergamini 16920b74a285SDamien Bergamini /* classify mbuf so we can find which tx ring to use */ 1693ec01dc2bSDamien Bergamini if (ieee80211_classify(ic, m0, ni) != 0) { 1694ec01dc2bSDamien Bergamini m_freem(m0); 16950b74a285SDamien Bergamini ieee80211_free_node(ni); 16960b74a285SDamien Bergamini ifp->if_oerrors++; 1697ec01dc2bSDamien Bergamini continue; 1698ec01dc2bSDamien Bergamini } 16990b74a285SDamien Bergamini 17000b74a285SDamien Bergamini /* no QoS encapsulation for EAPOL frames */ 17010b74a285SDamien Bergamini ac = (eh->ether_type != htons(ETHERTYPE_PAE)) ? 17020b74a285SDamien Bergamini M_WME_GETAC(m0) : WME_AC_BE; 17030b74a285SDamien Bergamini 17040b74a285SDamien Bergamini if (sc->txq[ac].queued > IWI_TX_RING_COUNT - 8) { 17050b74a285SDamien Bergamini /* there is no place left in this ring */ 17060b74a285SDamien Bergamini IFQ_DRV_PREPEND(&ifp->if_snd, m0); 17070b74a285SDamien Bergamini ifp->if_drv_flags |= IFF_DRV_OACTIVE; 17080b74a285SDamien Bergamini break; 17090b74a285SDamien Bergamini } 17100b74a285SDamien Bergamini 1711ceaec73dSDamien Bergamini BPF_MTAP(ifp, m0); 1712ceaec73dSDamien Bergamini 1713ceaec73dSDamien Bergamini m0 = ieee80211_encap(ic, m0, ni); 17140a5ae7ccSSam Leffler if (m0 == NULL) { 17150a5ae7ccSSam Leffler ieee80211_free_node(ni); 17160b74a285SDamien Bergamini ifp->if_oerrors++; 1717ceaec73dSDamien Bergamini continue; 17180a5ae7ccSSam Leffler } 1719ceaec73dSDamien Bergamini 1720ceaec73dSDamien Bergamini if (ic->ic_rawbpf != NULL) 1721ceaec73dSDamien Bergamini bpf_mtap(ic->ic_rawbpf, m0); 1722ceaec73dSDamien Bergamini 17230b74a285SDamien Bergamini if (iwi_tx_start(ifp, m0, ni, ac) != 0) { 1724ceaec73dSDamien Bergamini ieee80211_free_node(ni); 1725ceaec73dSDamien Bergamini ifp->if_oerrors++; 1726ceaec73dSDamien Bergamini break; 1727ceaec73dSDamien Bergamini } 1728ceaec73dSDamien Bergamini 1729ceaec73dSDamien Bergamini sc->sc_tx_timer = 5; 1730ceaec73dSDamien Bergamini ifp->if_timer = 1; 1731ceaec73dSDamien Bergamini } 1732ceaec73dSDamien Bergamini 1733ceaec73dSDamien Bergamini IWI_UNLOCK(sc); 1734ceaec73dSDamien Bergamini } 1735ceaec73dSDamien Bergamini 1736ceaec73dSDamien Bergamini static void 1737ceaec73dSDamien Bergamini iwi_watchdog(struct ifnet *ifp) 1738ceaec73dSDamien Bergamini { 1739ceaec73dSDamien Bergamini struct iwi_softc *sc = ifp->if_softc; 1740ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 1741ceaec73dSDamien Bergamini 1742ceaec73dSDamien Bergamini IWI_LOCK(sc); 1743ceaec73dSDamien Bergamini 1744ceaec73dSDamien Bergamini ifp->if_timer = 0; 1745ceaec73dSDamien Bergamini 1746ceaec73dSDamien Bergamini if (sc->sc_tx_timer > 0) { 1747ceaec73dSDamien Bergamini if (--sc->sc_tx_timer == 0) { 1748ceaec73dSDamien Bergamini if_printf(ifp, "device timeout\n"); 1749ceaec73dSDamien Bergamini ifp->if_oerrors++; 1750ceaec73dSDamien Bergamini ifp->if_flags &= ~IFF_UP; 1751ceaec73dSDamien Bergamini iwi_stop(sc); 1752ceaec73dSDamien Bergamini IWI_UNLOCK(sc); 1753ceaec73dSDamien Bergamini return; 1754ceaec73dSDamien Bergamini } 1755ceaec73dSDamien Bergamini ifp->if_timer = 1; 1756ceaec73dSDamien Bergamini } 1757ceaec73dSDamien Bergamini 1758ceaec73dSDamien Bergamini ieee80211_watchdog(ic); 1759ceaec73dSDamien Bergamini 1760ceaec73dSDamien Bergamini IWI_UNLOCK(sc); 1761ceaec73dSDamien Bergamini } 1762ceaec73dSDamien Bergamini 1763ceaec73dSDamien Bergamini static int 1764ceaec73dSDamien Bergamini iwi_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 1765ceaec73dSDamien Bergamini { 1766ceaec73dSDamien Bergamini struct iwi_softc *sc = ifp->if_softc; 1767ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 1768ceaec73dSDamien Bergamini int error = 0; 1769ceaec73dSDamien Bergamini 1770ceaec73dSDamien Bergamini IWI_LOCK(sc); 1771ceaec73dSDamien Bergamini 1772ceaec73dSDamien Bergamini switch (cmd) { 1773ceaec73dSDamien Bergamini case SIOCSIFFLAGS: 1774ceaec73dSDamien Bergamini if (ifp->if_flags & IFF_UP) { 177513f4c340SRobert Watson if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) 1776ceaec73dSDamien Bergamini iwi_init(sc); 1777ceaec73dSDamien Bergamini } else { 177813f4c340SRobert Watson if (ifp->if_drv_flags & IFF_DRV_RUNNING) 1779ceaec73dSDamien Bergamini iwi_stop(sc); 1780ceaec73dSDamien Bergamini } 1781ceaec73dSDamien Bergamini break; 1782ceaec73dSDamien Bergamini 1783ceaec73dSDamien Bergamini default: 1784ceaec73dSDamien Bergamini error = ieee80211_ioctl(ic, cmd, data); 1785ceaec73dSDamien Bergamini } 1786ceaec73dSDamien Bergamini 1787ceaec73dSDamien Bergamini if (error == ENETRESET) { 178813f4c340SRobert Watson if ((ifp->if_flags & IFF_UP) && 1789e0454c26SDamien Bergamini (ifp->if_drv_flags & IFF_DRV_RUNNING) && 1790e0454c26SDamien Bergamini (ic->ic_roaming != IEEE80211_ROAMING_MANUAL)) 1791ceaec73dSDamien Bergamini iwi_init(sc); 1792ceaec73dSDamien Bergamini error = 0; 1793ceaec73dSDamien Bergamini } 1794ceaec73dSDamien Bergamini 1795ceaec73dSDamien Bergamini IWI_UNLOCK(sc); 1796ceaec73dSDamien Bergamini 1797ceaec73dSDamien Bergamini return error; 1798ceaec73dSDamien Bergamini } 1799ceaec73dSDamien Bergamini 1800ceaec73dSDamien Bergamini static void 1801ceaec73dSDamien Bergamini iwi_stop_master(struct iwi_softc *sc) 1802ceaec73dSDamien Bergamini { 1803ceaec73dSDamien Bergamini uint32_t tmp; 1804ceaec73dSDamien Bergamini int ntries; 1805ceaec73dSDamien Bergamini 1806ceaec73dSDamien Bergamini /* disable interrupts */ 1807ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, 0); 1808ceaec73dSDamien Bergamini 1809ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_RST, IWI_RST_STOP_MASTER); 1810ceaec73dSDamien Bergamini for (ntries = 0; ntries < 5; ntries++) { 1811ceaec73dSDamien Bergamini if (CSR_READ_4(sc, IWI_CSR_RST) & IWI_RST_MASTER_DISABLED) 1812ceaec73dSDamien Bergamini break; 1813ceaec73dSDamien Bergamini DELAY(10); 1814ceaec73dSDamien Bergamini } 1815ceaec73dSDamien Bergamini if (ntries == 5) 1816ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "timeout waiting for master\n"); 1817ceaec73dSDamien Bergamini 1818ceaec73dSDamien Bergamini tmp = CSR_READ_4(sc, IWI_CSR_RST); 1819ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_RST, tmp | IWI_RST_PRINCETON_RESET); 1820ceaec73dSDamien Bergamini 1821ceaec73dSDamien Bergamini sc->flags &= ~IWI_FLAG_FW_INITED; 1822ceaec73dSDamien Bergamini } 1823ceaec73dSDamien Bergamini 1824ceaec73dSDamien Bergamini static int 1825ceaec73dSDamien Bergamini iwi_reset(struct iwi_softc *sc) 1826ceaec73dSDamien Bergamini { 1827ceaec73dSDamien Bergamini uint32_t tmp; 1828ceaec73dSDamien Bergamini int i, ntries; 1829ceaec73dSDamien Bergamini 1830ceaec73dSDamien Bergamini iwi_stop_master(sc); 1831ceaec73dSDamien Bergamini 1832ceaec73dSDamien Bergamini tmp = CSR_READ_4(sc, IWI_CSR_CTL); 1833ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_CTL, tmp | IWI_CTL_INIT); 1834ceaec73dSDamien Bergamini 1835ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_READ_INT, IWI_READ_INT_INIT_HOST); 1836ceaec73dSDamien Bergamini 1837ceaec73dSDamien Bergamini /* wait for clock stabilization */ 1838ceaec73dSDamien Bergamini for (ntries = 0; ntries < 1000; ntries++) { 1839ceaec73dSDamien Bergamini if (CSR_READ_4(sc, IWI_CSR_CTL) & IWI_CTL_CLOCK_READY) 1840ceaec73dSDamien Bergamini break; 1841ceaec73dSDamien Bergamini DELAY(200); 1842ceaec73dSDamien Bergamini } 1843ceaec73dSDamien Bergamini if (ntries == 1000) { 1844ceaec73dSDamien Bergamini device_printf(sc->sc_dev, 1845ceaec73dSDamien Bergamini "timeout waiting for clock stabilization\n"); 1846ceaec73dSDamien Bergamini return EIO; 1847ceaec73dSDamien Bergamini } 1848ceaec73dSDamien Bergamini 1849ceaec73dSDamien Bergamini tmp = CSR_READ_4(sc, IWI_CSR_RST); 1850ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_RST, tmp | IWI_RST_SOFT_RESET); 1851ceaec73dSDamien Bergamini 1852ceaec73dSDamien Bergamini DELAY(10); 1853ceaec73dSDamien Bergamini 1854ceaec73dSDamien Bergamini tmp = CSR_READ_4(sc, IWI_CSR_CTL); 1855ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_CTL, tmp | IWI_CTL_INIT); 1856ceaec73dSDamien Bergamini 1857ceaec73dSDamien Bergamini /* clear NIC memory */ 1858ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_AUTOINC_ADDR, 0); 1859ceaec73dSDamien Bergamini for (i = 0; i < 0xc000; i++) 1860ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, 0); 1861ceaec73dSDamien Bergamini 1862ceaec73dSDamien Bergamini return 0; 1863ceaec73dSDamien Bergamini } 1864ceaec73dSDamien Bergamini 1865ceaec73dSDamien Bergamini static int 1866408146edSDamien Bergamini iwi_load_ucode(struct iwi_softc *sc, const char *name) 1867ceaec73dSDamien Bergamini { 1868ceaec73dSDamien Bergamini uint32_t tmp; 1869ceaec73dSDamien Bergamini uint16_t *w; 1870408146edSDamien Bergamini char *uc; 1871408146edSDamien Bergamini int i, size, ntries, error; 1872408146edSDamien Bergamini 1873408146edSDamien Bergamini IWI_UNLOCK(sc); 1874408146edSDamien Bergamini error = iwi_read_firmware(name, &uc, &size); 1875408146edSDamien Bergamini IWI_LOCK(sc); 1876408146edSDamien Bergamini if (error != 0) { 1877408146edSDamien Bergamini device_printf(sc->sc_dev, "could not read ucode image\n"); 1878408146edSDamien Bergamini goto fail1; 1879408146edSDamien Bergamini } 1880408146edSDamien Bergamini 1881408146edSDamien Bergamini if (size < sizeof (struct iwi_firmware_hdr)) { 1882408146edSDamien Bergamini error = EINVAL; 1883408146edSDamien Bergamini goto fail2; 1884408146edSDamien Bergamini } 1885408146edSDamien Bergamini 1886408146edSDamien Bergamini uc += sizeof (struct iwi_firmware_hdr); 1887408146edSDamien Bergamini size -= sizeof (struct iwi_firmware_hdr); 1888ceaec73dSDamien Bergamini 1889ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_RST, CSR_READ_4(sc, IWI_CSR_RST) | 1890ceaec73dSDamien Bergamini IWI_RST_STOP_MASTER); 1891ceaec73dSDamien Bergamini for (ntries = 0; ntries < 5; ntries++) { 1892ceaec73dSDamien Bergamini if (CSR_READ_4(sc, IWI_CSR_RST) & IWI_RST_MASTER_DISABLED) 1893ceaec73dSDamien Bergamini break; 1894ceaec73dSDamien Bergamini DELAY(10); 1895ceaec73dSDamien Bergamini } 1896ceaec73dSDamien Bergamini if (ntries == 5) { 1897ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "timeout waiting for master\n"); 1898408146edSDamien Bergamini error = EIO; 1899408146edSDamien Bergamini goto fail2; 1900ceaec73dSDamien Bergamini } 1901ceaec73dSDamien Bergamini 1902ceaec73dSDamien Bergamini MEM_WRITE_4(sc, 0x3000e0, 0x80000000); 1903ceaec73dSDamien Bergamini DELAY(5000); 1904ceaec73dSDamien Bergamini 1905ceaec73dSDamien Bergamini tmp = CSR_READ_4(sc, IWI_CSR_RST); 1906ceaec73dSDamien Bergamini tmp &= ~IWI_RST_PRINCETON_RESET; 1907ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_RST, tmp); 1908ceaec73dSDamien Bergamini 1909ceaec73dSDamien Bergamini DELAY(5000); 1910ceaec73dSDamien Bergamini MEM_WRITE_4(sc, 0x3000e0, 0); 1911ceaec73dSDamien Bergamini DELAY(1000); 1912ceaec73dSDamien Bergamini MEM_WRITE_4(sc, 0x300004, 1); 1913ceaec73dSDamien Bergamini DELAY(1000); 1914ceaec73dSDamien Bergamini MEM_WRITE_4(sc, 0x300004, 0); 1915ceaec73dSDamien Bergamini DELAY(1000); 1916ceaec73dSDamien Bergamini MEM_WRITE_1(sc, 0x200000, 0x00); 1917ceaec73dSDamien Bergamini MEM_WRITE_1(sc, 0x200000, 0x40); 1918ceaec73dSDamien Bergamini DELAY(1000); 1919ceaec73dSDamien Bergamini 1920ceaec73dSDamien Bergamini /* write microcode into adapter memory */ 1921408146edSDamien Bergamini for (w = (uint16_t *)uc; size > 0; w++, size -= 2) 192281e6343cSDamien Bergamini MEM_WRITE_2(sc, 0x200010, htole16(*w)); 1923ceaec73dSDamien Bergamini 1924ceaec73dSDamien Bergamini MEM_WRITE_1(sc, 0x200000, 0x00); 1925ceaec73dSDamien Bergamini MEM_WRITE_1(sc, 0x200000, 0x80); 1926ceaec73dSDamien Bergamini 1927ceaec73dSDamien Bergamini /* wait until we get an answer */ 1928ceaec73dSDamien Bergamini for (ntries = 0; ntries < 100; ntries++) { 1929ceaec73dSDamien Bergamini if (MEM_READ_1(sc, 0x200000) & 1) 1930ceaec73dSDamien Bergamini break; 1931ceaec73dSDamien Bergamini DELAY(100); 1932ceaec73dSDamien Bergamini } 1933ceaec73dSDamien Bergamini if (ntries == 100) { 1934ceaec73dSDamien Bergamini device_printf(sc->sc_dev, 1935ceaec73dSDamien Bergamini "timeout waiting for ucode to initialize\n"); 1936408146edSDamien Bergamini error = EIO; 1937408146edSDamien Bergamini goto fail2; 1938ceaec73dSDamien Bergamini } 1939ceaec73dSDamien Bergamini 1940ceaec73dSDamien Bergamini /* read the answer or the firmware will not initialize properly */ 1941ceaec73dSDamien Bergamini for (i = 0; i < 7; i++) 1942ceaec73dSDamien Bergamini MEM_READ_4(sc, 0x200004); 1943ceaec73dSDamien Bergamini 1944ceaec73dSDamien Bergamini MEM_WRITE_1(sc, 0x200000, 0x00); 1945ceaec73dSDamien Bergamini 1946408146edSDamien Bergamini fail2: free(uc, M_DEVBUF); 1947408146edSDamien Bergamini fail1: 1948408146edSDamien Bergamini return error; 1949ceaec73dSDamien Bergamini } 1950ceaec73dSDamien Bergamini 1951ceaec73dSDamien Bergamini /* macro to handle unaligned little endian data in firmware image */ 1952ceaec73dSDamien Bergamini #define GETLE32(p) ((p)[0] | (p)[1] << 8 | (p)[2] << 16 | (p)[3] << 24) 1953ceaec73dSDamien Bergamini 1954ceaec73dSDamien Bergamini static int 1955408146edSDamien Bergamini iwi_load_firmware(struct iwi_softc *sc, const char *name) 1956ceaec73dSDamien Bergamini { 1957ceaec73dSDamien Bergamini bus_dma_tag_t dmat; 1958ceaec73dSDamien Bergamini bus_dmamap_t map; 1959ceaec73dSDamien Bergamini bus_addr_t physaddr; 1960ceaec73dSDamien Bergamini void *virtaddr; 1961408146edSDamien Bergamini char *fw; 1962ceaec73dSDamien Bergamini u_char *p, *end; 1963ceaec73dSDamien Bergamini uint32_t sentinel, ctl, src, dst, sum, len, mlen, tmp; 1964408146edSDamien Bergamini int size, ntries, error; 1965408146edSDamien Bergamini 1966408146edSDamien Bergamini /* read firmware image from filesystem */ 1967408146edSDamien Bergamini IWI_UNLOCK(sc); 1968408146edSDamien Bergamini error = iwi_read_firmware(name, &fw, &size); 1969408146edSDamien Bergamini IWI_LOCK(sc); 1970408146edSDamien Bergamini if (error != 0) { 1971408146edSDamien Bergamini device_printf(sc->sc_dev, "could not read firmware image\n"); 1972408146edSDamien Bergamini goto fail1; 1973408146edSDamien Bergamini } 1974408146edSDamien Bergamini 1975408146edSDamien Bergamini if (size < sizeof (struct iwi_firmware_hdr)) { 1976408146edSDamien Bergamini error = EINVAL; 1977408146edSDamien Bergamini goto fail2; 1978408146edSDamien Bergamini } 1979408146edSDamien Bergamini 1980408146edSDamien Bergamini fw += sizeof (struct iwi_firmware_hdr); 1981408146edSDamien Bergamini size -= sizeof (struct iwi_firmware_hdr); 1982ceaec73dSDamien Bergamini 1983ceaec73dSDamien Bergamini /* allocate DMA memory for mapping firmware image */ 1984ceaec73dSDamien Bergamini error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT, 1985ceaec73dSDamien Bergamini BUS_SPACE_MAXADDR, NULL, NULL, size, 1, size, 0, NULL, NULL, &dmat); 1986ceaec73dSDamien Bergamini if (error != 0) { 1987ceaec73dSDamien Bergamini device_printf(sc->sc_dev, 1988ceaec73dSDamien Bergamini "could not create firmware DMA tag\n"); 1989408146edSDamien Bergamini goto fail2; 1990ceaec73dSDamien Bergamini } 1991ceaec73dSDamien Bergamini 1992ceaec73dSDamien Bergamini error = bus_dmamem_alloc(dmat, &virtaddr, BUS_DMA_NOWAIT, &map); 1993ceaec73dSDamien Bergamini if (error != 0) { 1994ceaec73dSDamien Bergamini device_printf(sc->sc_dev, 1995ceaec73dSDamien Bergamini "could not allocate firmware DMA memory\n"); 1996408146edSDamien Bergamini goto fail3; 1997ceaec73dSDamien Bergamini } 1998ceaec73dSDamien Bergamini 1999ceaec73dSDamien Bergamini error = bus_dmamap_load(dmat, map, virtaddr, size, iwi_dma_map_addr, 2000ceaec73dSDamien Bergamini &physaddr, 0); 2001ceaec73dSDamien Bergamini if (error != 0) { 2002ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not load firmware DMA map\n"); 2003408146edSDamien Bergamini goto fail4; 2004ceaec73dSDamien Bergamini } 2005ceaec73dSDamien Bergamini 2006ceaec73dSDamien Bergamini /* copy firmware image to DMA memory */ 2007ceaec73dSDamien Bergamini memcpy(virtaddr, fw, size); 2008ceaec73dSDamien Bergamini 2009ceaec73dSDamien Bergamini /* make sure the adapter will get up-to-date values */ 2010ceaec73dSDamien Bergamini bus_dmamap_sync(dmat, map, BUS_DMASYNC_PREWRITE); 2011ceaec73dSDamien Bergamini 2012ceaec73dSDamien Bergamini /* tell the adapter where the command blocks are stored */ 2013ceaec73dSDamien Bergamini MEM_WRITE_4(sc, 0x3000a0, 0x27000); 2014ceaec73dSDamien Bergamini 2015ceaec73dSDamien Bergamini /* 2016ceaec73dSDamien Bergamini * Store command blocks into adapter's internal memory using register 2017ceaec73dSDamien Bergamini * indirections. The adapter will read the firmware image through DMA 2018ceaec73dSDamien Bergamini * using information stored in command blocks. 2019ceaec73dSDamien Bergamini */ 2020ceaec73dSDamien Bergamini src = physaddr; 2021ceaec73dSDamien Bergamini p = virtaddr; 2022ceaec73dSDamien Bergamini end = p + size; 2023ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_AUTOINC_ADDR, 0x27000); 2024ceaec73dSDamien Bergamini 2025ceaec73dSDamien Bergamini while (p < end) { 2026ceaec73dSDamien Bergamini dst = GETLE32(p); p += 4; src += 4; 2027ceaec73dSDamien Bergamini len = GETLE32(p); p += 4; src += 4; 2028ceaec73dSDamien Bergamini p += len; 2029ceaec73dSDamien Bergamini 2030ceaec73dSDamien Bergamini while (len > 0) { 2031ceaec73dSDamien Bergamini mlen = min(len, IWI_CB_MAXDATALEN); 2032ceaec73dSDamien Bergamini 2033ceaec73dSDamien Bergamini ctl = IWI_CB_DEFAULT_CTL | mlen; 2034ceaec73dSDamien Bergamini sum = ctl ^ src ^ dst; 2035ceaec73dSDamien Bergamini 2036ceaec73dSDamien Bergamini /* write a command block */ 2037ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, ctl); 2038ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, src); 2039ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, dst); 2040ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, sum); 2041ceaec73dSDamien Bergamini 2042ceaec73dSDamien Bergamini src += mlen; 2043ceaec73dSDamien Bergamini dst += mlen; 2044ceaec73dSDamien Bergamini len -= mlen; 2045ceaec73dSDamien Bergamini } 2046ceaec73dSDamien Bergamini } 2047ceaec73dSDamien Bergamini 2048ceaec73dSDamien Bergamini /* write a fictive final command block (sentinel) */ 2049ceaec73dSDamien Bergamini sentinel = CSR_READ_4(sc, IWI_CSR_AUTOINC_ADDR); 2050ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, 0); 2051ceaec73dSDamien Bergamini 2052ceaec73dSDamien Bergamini tmp = CSR_READ_4(sc, IWI_CSR_RST); 2053ceaec73dSDamien Bergamini tmp &= ~(IWI_RST_MASTER_DISABLED | IWI_RST_STOP_MASTER); 2054ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_RST, tmp); 2055ceaec73dSDamien Bergamini 2056ceaec73dSDamien Bergamini /* tell the adapter to start processing command blocks */ 2057ceaec73dSDamien Bergamini MEM_WRITE_4(sc, 0x3000a4, 0x540100); 2058ceaec73dSDamien Bergamini 2059408146edSDamien Bergamini /* wait until the adapter reaches the sentinel */ 2060ceaec73dSDamien Bergamini for (ntries = 0; ntries < 400; ntries++) { 2061ceaec73dSDamien Bergamini if (MEM_READ_4(sc, 0x3000d0) >= sentinel) 2062ceaec73dSDamien Bergamini break; 2063ceaec73dSDamien Bergamini DELAY(100); 2064ceaec73dSDamien Bergamini } 2065ceaec73dSDamien Bergamini if (ntries == 400) { 2066ceaec73dSDamien Bergamini device_printf(sc->sc_dev, 2067ceaec73dSDamien Bergamini "timeout processing command blocks\n"); 2068ceaec73dSDamien Bergamini error = EIO; 2069408146edSDamien Bergamini goto fail5; 2070ceaec73dSDamien Bergamini } 2071ceaec73dSDamien Bergamini 2072ceaec73dSDamien Bergamini /* we're done with command blocks processing */ 2073ceaec73dSDamien Bergamini MEM_WRITE_4(sc, 0x3000a4, 0x540c00); 2074ceaec73dSDamien Bergamini 2075408146edSDamien Bergamini /* allow interrupts so we know when the firmware is ready */ 2076ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, IWI_INTR_MASK); 2077ceaec73dSDamien Bergamini 2078ceaec73dSDamien Bergamini /* tell the adapter to initialize the firmware */ 2079ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_RST, 0); 2080ceaec73dSDamien Bergamini 2081ceaec73dSDamien Bergamini tmp = CSR_READ_4(sc, IWI_CSR_CTL); 2082ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_CTL, tmp | IWI_CTL_ALLOW_STANDBY); 2083ceaec73dSDamien Bergamini 2084ceaec73dSDamien Bergamini /* wait at most one second for firmware initialization to complete */ 2085ceaec73dSDamien Bergamini if ((error = msleep(sc, &sc->sc_mtx, 0, "iwiinit", hz)) != 0) { 2086ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "timeout waiting for firmware " 2087ceaec73dSDamien Bergamini "initialization to complete\n"); 2088ceaec73dSDamien Bergamini } 2089ceaec73dSDamien Bergamini 2090408146edSDamien Bergamini fail5: bus_dmamap_sync(dmat, map, BUS_DMASYNC_POSTWRITE); 2091ceaec73dSDamien Bergamini bus_dmamap_unload(dmat, map); 2092408146edSDamien Bergamini fail4: bus_dmamem_free(dmat, virtaddr, map); 2093408146edSDamien Bergamini fail3: bus_dma_tag_destroy(dmat); 2094408146edSDamien Bergamini fail2: free(fw, M_DEVBUF); 2095ceaec73dSDamien Bergamini fail1: 2096ceaec73dSDamien Bergamini return error; 2097ceaec73dSDamien Bergamini } 2098ceaec73dSDamien Bergamini 2099ceaec73dSDamien Bergamini static int 2100ceaec73dSDamien Bergamini iwi_config(struct iwi_softc *sc) 2101ceaec73dSDamien Bergamini { 2102ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 2103ceaec73dSDamien Bergamini struct ifnet *ifp = ic->ic_ifp; 2104ceaec73dSDamien Bergamini struct iwi_configuration config; 2105ceaec73dSDamien Bergamini struct iwi_rateset rs; 2106ceaec73dSDamien Bergamini struct iwi_txpower power; 2107ceaec73dSDamien Bergamini struct ieee80211_key *wk; 2108ceaec73dSDamien Bergamini struct iwi_wep_key wepkey; 2109ceaec73dSDamien Bergamini uint32_t data; 2110ceaec73dSDamien Bergamini int error, i; 2111ceaec73dSDamien Bergamini 2112ceaec73dSDamien Bergamini IEEE80211_ADDR_COPY(ic->ic_myaddr, IF_LLADDR(ifp)); 2113ceaec73dSDamien Bergamini DPRINTF(("Setting MAC address to %6D\n", ic->ic_myaddr, ":")); 2114ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_MAC_ADDRESS, ic->ic_myaddr, 2115ceaec73dSDamien Bergamini IEEE80211_ADDR_LEN, 0); 2116ceaec73dSDamien Bergamini if (error != 0) 2117ceaec73dSDamien Bergamini return error; 2118ceaec73dSDamien Bergamini 2119ceaec73dSDamien Bergamini memset(&config, 0, sizeof config); 2120ceaec73dSDamien Bergamini config.bluetooth_coexistence = sc->bluetooth; 2121acea4241SDamien Bergamini config.antenna = sc->antenna; 2122ceaec73dSDamien Bergamini config.multicast_enabled = 1; 2123acea4241SDamien Bergamini config.answer_pbreq = (ic->ic_opmode == IEEE80211_M_IBSS) ? 1 : 0; 2124acea4241SDamien Bergamini config.disable_unicast_decryption = 1; 2125acea4241SDamien Bergamini config.disable_multicast_decryption = 1; 2126ceaec73dSDamien Bergamini DPRINTF(("Configuring adapter\n")); 2127ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_CONFIG, &config, sizeof config, 0); 2128ceaec73dSDamien Bergamini if (error != 0) 2129ceaec73dSDamien Bergamini return error; 2130ceaec73dSDamien Bergamini 2131ceaec73dSDamien Bergamini data = htole32(IWI_POWER_MODE_CAM); 2132ceaec73dSDamien Bergamini DPRINTF(("Setting power mode to %u\n", le32toh(data))); 2133ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_POWER_MODE, &data, sizeof data, 0); 2134ceaec73dSDamien Bergamini if (error != 0) 2135ceaec73dSDamien Bergamini return error; 2136ceaec73dSDamien Bergamini 2137ceaec73dSDamien Bergamini data = htole32(ic->ic_rtsthreshold); 2138ceaec73dSDamien Bergamini DPRINTF(("Setting RTS threshold to %u\n", le32toh(data))); 2139ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_RTS_THRESHOLD, &data, sizeof data, 0); 2140ceaec73dSDamien Bergamini if (error != 0) 2141ceaec73dSDamien Bergamini return error; 2142ceaec73dSDamien Bergamini 2143acea4241SDamien Bergamini data = htole32(ic->ic_fragthreshold); 2144acea4241SDamien Bergamini DPRINTF(("Setting fragmentation threshold to %u\n", le32toh(data))); 2145acea4241SDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_FRAG_THRESHOLD, &data, sizeof data, 0); 2146acea4241SDamien Bergamini if (error != 0) 2147acea4241SDamien Bergamini return error; 2148acea4241SDamien Bergamini 2149ceaec73dSDamien Bergamini if (ic->ic_opmode == IEEE80211_M_IBSS) { 2150ceaec73dSDamien Bergamini power.mode = IWI_MODE_11B; 2151ceaec73dSDamien Bergamini power.nchan = 11; 2152ceaec73dSDamien Bergamini for (i = 0; i < 11; i++) { 2153ceaec73dSDamien Bergamini power.chan[i].chan = i + 1; 2154ceaec73dSDamien Bergamini power.chan[i].power = IWI_TXPOWER_MAX; 2155ceaec73dSDamien Bergamini } 2156ceaec73dSDamien Bergamini DPRINTF(("Setting .11b channels tx power\n")); 2157ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_TX_POWER, &power, sizeof power, 2158ceaec73dSDamien Bergamini 0); 2159ceaec73dSDamien Bergamini if (error != 0) 2160ceaec73dSDamien Bergamini return error; 2161ceaec73dSDamien Bergamini 2162ceaec73dSDamien Bergamini power.mode = IWI_MODE_11G; 2163ceaec73dSDamien Bergamini DPRINTF(("Setting .11g channels tx power\n")); 2164ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_TX_POWER, &power, sizeof power, 2165ceaec73dSDamien Bergamini 0); 2166ceaec73dSDamien Bergamini if (error != 0) 2167ceaec73dSDamien Bergamini return error; 2168ceaec73dSDamien Bergamini } 2169ceaec73dSDamien Bergamini 2170ceaec73dSDamien Bergamini rs.mode = IWI_MODE_11G; 2171ceaec73dSDamien Bergamini rs.type = IWI_RATESET_TYPE_SUPPORTED; 2172ceaec73dSDamien Bergamini rs.nrates = ic->ic_sup_rates[IEEE80211_MODE_11G].rs_nrates; 2173ceaec73dSDamien Bergamini memcpy(rs.rates, ic->ic_sup_rates[IEEE80211_MODE_11G].rs_rates, 2174ceaec73dSDamien Bergamini rs.nrates); 2175ceaec73dSDamien Bergamini DPRINTF(("Setting .11bg supported rates (%u)\n", rs.nrates)); 2176ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_RATES, &rs, sizeof rs, 0); 2177ceaec73dSDamien Bergamini if (error != 0) 2178ceaec73dSDamien Bergamini return error; 2179ceaec73dSDamien Bergamini 2180ceaec73dSDamien Bergamini rs.mode = IWI_MODE_11A; 2181ceaec73dSDamien Bergamini rs.type = IWI_RATESET_TYPE_SUPPORTED; 2182ceaec73dSDamien Bergamini rs.nrates = ic->ic_sup_rates[IEEE80211_MODE_11A].rs_nrates; 2183ceaec73dSDamien Bergamini memcpy(rs.rates, ic->ic_sup_rates[IEEE80211_MODE_11A].rs_rates, 2184ceaec73dSDamien Bergamini rs.nrates); 2185ceaec73dSDamien Bergamini DPRINTF(("Setting .11a supported rates (%u)\n", rs.nrates)); 2186ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_RATES, &rs, sizeof rs, 0); 2187ceaec73dSDamien Bergamini if (error != 0) 2188ceaec73dSDamien Bergamini return error; 2189ceaec73dSDamien Bergamini 21900b74a285SDamien Bergamini /* if we have a desired ESSID, set it now */ 21910b74a285SDamien Bergamini if (ic->ic_des_esslen != 0) { 21920b74a285SDamien Bergamini #ifdef IWI_DEBUG 21930b74a285SDamien Bergamini if (iwi_debug > 0) { 21940b74a285SDamien Bergamini printf("Setting desired ESSID to "); 21950b74a285SDamien Bergamini ieee80211_print_essid(ic->ic_des_essid, 21960b74a285SDamien Bergamini ic->ic_des_esslen); 21970b74a285SDamien Bergamini printf("\n"); 21980b74a285SDamien Bergamini } 21990b74a285SDamien Bergamini #endif 22000b74a285SDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_ESSID, ic->ic_des_essid, 22017e47fb02SDamien Bergamini ic->ic_des_esslen, 0); 22020b74a285SDamien Bergamini if (error != 0) 22030b74a285SDamien Bergamini return error; 22040b74a285SDamien Bergamini } 22050b74a285SDamien Bergamini 2206ceaec73dSDamien Bergamini data = htole32(arc4random()); 2207ceaec73dSDamien Bergamini DPRINTF(("Setting initialization vector to %u\n", le32toh(data))); 2208ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_IV, &data, sizeof data, 0); 2209ceaec73dSDamien Bergamini if (error != 0) 2210ceaec73dSDamien Bergamini return error; 2211ceaec73dSDamien Bergamini 2212ceaec73dSDamien Bergamini for (i = 0; i < IEEE80211_WEP_NKID; i++) { 2213ceaec73dSDamien Bergamini wk = &ic->ic_crypto.cs_nw_keys[i]; 2214ceaec73dSDamien Bergamini 2215ceaec73dSDamien Bergamini wepkey.cmd = IWI_WEP_KEY_CMD_SETKEY; 2216ceaec73dSDamien Bergamini wepkey.idx = i; 2217ceaec73dSDamien Bergamini wepkey.len = wk->wk_keylen; 2218ceaec73dSDamien Bergamini memset(wepkey.key, 0, sizeof wepkey.key); 2219ceaec73dSDamien Bergamini memcpy(wepkey.key, wk->wk_key, wk->wk_keylen); 2220ceaec73dSDamien Bergamini DPRINTF(("Setting wep key index %u len %u\n", wepkey.idx, 2221ceaec73dSDamien Bergamini wepkey.len)); 2222ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_WEP_KEY, &wepkey, 2223ceaec73dSDamien Bergamini sizeof wepkey, 0); 2224ceaec73dSDamien Bergamini if (error != 0) 2225ceaec73dSDamien Bergamini return error; 2226ceaec73dSDamien Bergamini } 2227ceaec73dSDamien Bergamini 2228ceaec73dSDamien Bergamini /* enable adapter */ 2229ceaec73dSDamien Bergamini DPRINTF(("Enabling adapter\n")); 2230ceaec73dSDamien Bergamini return iwi_cmd(sc, IWI_CMD_ENABLE, NULL, 0, 0); 2231ceaec73dSDamien Bergamini } 2232ceaec73dSDamien Bergamini 2233ceaec73dSDamien Bergamini static int 2234acea4241SDamien Bergamini iwi_set_chan(struct iwi_softc *sc, struct ieee80211_channel *chan) 2235acea4241SDamien Bergamini { 2236acea4241SDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 2237acea4241SDamien Bergamini struct iwi_scan scan; 2238acea4241SDamien Bergamini 2239acea4241SDamien Bergamini memset(&scan, 0, sizeof scan); 224071016a24SDamien Bergamini memset(scan.type, IWI_SCAN_TYPE_PASSIVE, sizeof scan.type); 224180e1a712SDamien Bergamini scan.passive = htole16(2000); 224280e1a712SDamien Bergamini scan.channels[0] = 1 | 224380e1a712SDamien Bergamini (IEEE80211_IS_CHAN_5GHZ(chan) ? IWI_CHAN_5GHZ : IWI_CHAN_2GHZ); 2244acea4241SDamien Bergamini scan.channels[1] = ieee80211_chan2ieee(ic, chan); 2245acea4241SDamien Bergamini 2246acea4241SDamien Bergamini DPRINTF(("Setting channel to %u\n", ieee80211_chan2ieee(ic, chan))); 2247acea4241SDamien Bergamini return iwi_cmd(sc, IWI_CMD_SCAN, &scan, sizeof scan, 1); 2248acea4241SDamien Bergamini } 2249acea4241SDamien Bergamini 2250acea4241SDamien Bergamini static int 2251ceaec73dSDamien Bergamini iwi_scan(struct iwi_softc *sc) 2252ceaec73dSDamien Bergamini { 2253ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 2254ceaec73dSDamien Bergamini struct iwi_scan scan; 2255ceaec73dSDamien Bergamini uint8_t *p; 2256ceaec73dSDamien Bergamini int i, count; 2257ceaec73dSDamien Bergamini 2258ceaec73dSDamien Bergamini memset(&scan, 0, sizeof scan); 225980e1a712SDamien Bergamini 226080e1a712SDamien Bergamini if (ic->ic_des_esslen != 0) { 226180e1a712SDamien Bergamini scan.bdirected = htole16(sc->dwelltime); 226271016a24SDamien Bergamini memset(scan.type, IWI_SCAN_TYPE_BDIRECTED, sizeof scan.type); 226380e1a712SDamien Bergamini } else { 226480e1a712SDamien Bergamini scan.broadcast = htole16(sc->dwelltime); 226571016a24SDamien Bergamini memset(scan.type, IWI_SCAN_TYPE_BROADCAST, sizeof scan.type); 226680e1a712SDamien Bergamini } 2267ceaec73dSDamien Bergamini 2268ceaec73dSDamien Bergamini p = scan.channels; 2269ceaec73dSDamien Bergamini count = 0; 2270ceaec73dSDamien Bergamini for (i = 0; i <= IEEE80211_CHAN_MAX; i++) { 2271ceaec73dSDamien Bergamini if (IEEE80211_IS_CHAN_5GHZ(&ic->ic_channels[i]) && 2272ceaec73dSDamien Bergamini isset(ic->ic_chan_active, i)) { 2273ceaec73dSDamien Bergamini *++p = i; 2274ceaec73dSDamien Bergamini count++; 2275ceaec73dSDamien Bergamini } 2276ceaec73dSDamien Bergamini } 2277ceaec73dSDamien Bergamini *(p - count) = IWI_CHAN_5GHZ | count; 2278ceaec73dSDamien Bergamini 2279ceaec73dSDamien Bergamini count = 0; 2280ceaec73dSDamien Bergamini for (i = 0; i <= IEEE80211_CHAN_MAX; i++) { 2281ceaec73dSDamien Bergamini if (IEEE80211_IS_CHAN_2GHZ(&ic->ic_channels[i]) && 2282ceaec73dSDamien Bergamini isset(ic->ic_chan_active, i)) { 2283ceaec73dSDamien Bergamini *++p = i; 2284ceaec73dSDamien Bergamini count++; 2285ceaec73dSDamien Bergamini } 2286ceaec73dSDamien Bergamini } 2287ceaec73dSDamien Bergamini *(p - count) = IWI_CHAN_2GHZ | count; 2288ceaec73dSDamien Bergamini 2289ceaec73dSDamien Bergamini DPRINTF(("Start scanning\n")); 2290ceaec73dSDamien Bergamini return iwi_cmd(sc, IWI_CMD_SCAN, &scan, sizeof scan, 1); 2291ceaec73dSDamien Bergamini } 2292ceaec73dSDamien Bergamini 2293ceaec73dSDamien Bergamini static int 2294ceaec73dSDamien Bergamini iwi_auth_and_assoc(struct iwi_softc *sc) 2295ceaec73dSDamien Bergamini { 2296ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 2297ceaec73dSDamien Bergamini struct ifnet *ifp = ic->ic_ifp; 2298ceaec73dSDamien Bergamini struct ieee80211_node *ni = ic->ic_bss; 2299ec01dc2bSDamien Bergamini struct ieee80211_wme_info wme; 2300ceaec73dSDamien Bergamini struct iwi_configuration config; 2301ceaec73dSDamien Bergamini struct iwi_associate assoc; 2302ceaec73dSDamien Bergamini struct iwi_rateset rs; 2303acea4241SDamien Bergamini uint16_t capinfo; 2304ceaec73dSDamien Bergamini uint32_t data; 2305ceaec73dSDamien Bergamini int error; 2306ceaec73dSDamien Bergamini 2307ceaec73dSDamien Bergamini if (IEEE80211_IS_CHAN_2GHZ(ni->ni_chan)) { 2308ceaec73dSDamien Bergamini memset(&config, 0, sizeof config); 2309ceaec73dSDamien Bergamini config.bluetooth_coexistence = sc->bluetooth; 2310acea4241SDamien Bergamini config.antenna = sc->antenna; 2311ceaec73dSDamien Bergamini config.multicast_enabled = 1; 2312ceaec73dSDamien Bergamini config.use_protection = 1; 2313acea4241SDamien Bergamini config.answer_pbreq = 2314acea4241SDamien Bergamini (ic->ic_opmode == IEEE80211_M_IBSS) ? 1 : 0; 2315acea4241SDamien Bergamini config.disable_unicast_decryption = 1; 2316acea4241SDamien Bergamini config.disable_multicast_decryption = 1; 2317ceaec73dSDamien Bergamini DPRINTF(("Configuring adapter\n")); 2318ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_CONFIG, &config, sizeof config, 2319ceaec73dSDamien Bergamini 1); 2320ceaec73dSDamien Bergamini if (error != 0) 2321ceaec73dSDamien Bergamini return error; 2322ceaec73dSDamien Bergamini } 2323ceaec73dSDamien Bergamini 2324ceaec73dSDamien Bergamini #ifdef IWI_DEBUG 2325ceaec73dSDamien Bergamini if (iwi_debug > 0) { 2326ceaec73dSDamien Bergamini printf("Setting ESSID to "); 2327ceaec73dSDamien Bergamini ieee80211_print_essid(ni->ni_essid, ni->ni_esslen); 2328ceaec73dSDamien Bergamini printf("\n"); 2329ceaec73dSDamien Bergamini } 2330ceaec73dSDamien Bergamini #endif 2331ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_ESSID, ni->ni_essid, ni->ni_esslen, 1); 2332ceaec73dSDamien Bergamini if (error != 0) 2333ceaec73dSDamien Bergamini return error; 2334ceaec73dSDamien Bergamini 233580e1a712SDamien Bergamini /* the rate set has already been "negotiated" */ 2336ceaec73dSDamien Bergamini rs.mode = IEEE80211_IS_CHAN_5GHZ(ni->ni_chan) ? IWI_MODE_11A : 2337ceaec73dSDamien Bergamini IWI_MODE_11G; 233880e1a712SDamien Bergamini rs.type = IWI_RATESET_TYPE_NEGOTIATED; 2339ceaec73dSDamien Bergamini rs.nrates = ni->ni_rates.rs_nrates; 2340ceaec73dSDamien Bergamini memcpy(rs.rates, ni->ni_rates.rs_rates, rs.nrates); 2341ceaec73dSDamien Bergamini DPRINTF(("Setting negociated rates (%u)\n", rs.nrates)); 2342ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_RATES, &rs, sizeof rs, 1); 2343ceaec73dSDamien Bergamini if (error != 0) 2344ceaec73dSDamien Bergamini return error; 2345ceaec73dSDamien Bergamini 2346ec01dc2bSDamien Bergamini if ((ic->ic_flags & IEEE80211_F_WME) && ni->ni_wme_ie != NULL) { 2347ec01dc2bSDamien Bergamini wme.wme_id = IEEE80211_ELEMID_VENDOR; 2348ec01dc2bSDamien Bergamini wme.wme_len = sizeof (struct ieee80211_wme_info) - 2; 2349ec01dc2bSDamien Bergamini wme.wme_oui[0] = 0x00; 2350ec01dc2bSDamien Bergamini wme.wme_oui[1] = 0x50; 2351ec01dc2bSDamien Bergamini wme.wme_oui[2] = 0xf2; 2352ec01dc2bSDamien Bergamini wme.wme_type = WME_OUI_TYPE; 2353ec01dc2bSDamien Bergamini wme.wme_subtype = WME_INFO_OUI_SUBTYPE; 2354ec01dc2bSDamien Bergamini wme.wme_version = WME_VERSION; 2355ec01dc2bSDamien Bergamini wme.wme_info = 0; 2356ec01dc2bSDamien Bergamini 2357ec01dc2bSDamien Bergamini DPRINTF(("Setting WME IE (len=%u)\n", wme.wme_len)); 2358ec01dc2bSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_WMEIE, &wme, sizeof wme, 1); 2359ec01dc2bSDamien Bergamini if (error != 0) 2360ec01dc2bSDamien Bergamini return error; 2361ec01dc2bSDamien Bergamini } 2362ec01dc2bSDamien Bergamini 2363acea4241SDamien Bergamini if (ic->ic_opt_ie != NULL) { 2364acea4241SDamien Bergamini DPRINTF(("Setting optional IE (len=%u)\n", ic->ic_opt_ie_len)); 2365acea4241SDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_OPTIE, ic->ic_opt_ie, 2366acea4241SDamien Bergamini ic->ic_opt_ie_len, 1); 2367acea4241SDamien Bergamini if (error != 0) 2368acea4241SDamien Bergamini return error; 2369acea4241SDamien Bergamini } 2370acea4241SDamien Bergamini 2371ceaec73dSDamien Bergamini data = htole32(ni->ni_rssi); 2372ceaec73dSDamien Bergamini DPRINTF(("Setting sensitivity to %d\n", (int8_t)ni->ni_rssi)); 2373ceaec73dSDamien Bergamini error = iwi_cmd(sc, IWI_CMD_SET_SENSITIVITY, &data, sizeof data, 1); 2374ceaec73dSDamien Bergamini if (error != 0) 2375ceaec73dSDamien Bergamini return error; 2376ceaec73dSDamien Bergamini 2377ceaec73dSDamien Bergamini memset(&assoc, 0, sizeof assoc); 2378ceaec73dSDamien Bergamini assoc.mode = IEEE80211_IS_CHAN_5GHZ(ni->ni_chan) ? IWI_MODE_11A : 2379ceaec73dSDamien Bergamini IWI_MODE_11G; 2380ceaec73dSDamien Bergamini assoc.chan = ieee80211_chan2ieee(ic, ni->ni_chan); 2381ceaec73dSDamien Bergamini if (ni->ni_authmode == IEEE80211_AUTH_SHARED) 2382ceaec73dSDamien Bergamini assoc.auth = ic->ic_crypto.cs_def_txkey << 4 | IWI_AUTH_SHARED; 2383ec01dc2bSDamien Bergamini if ((ic->ic_flags & IEEE80211_F_WME) && ni->ni_wme_ie != NULL) 2384ec01dc2bSDamien Bergamini assoc.policy |= htole16(IWI_POLICY_WME); 2385acea4241SDamien Bergamini if (ic->ic_opt_ie != NULL) 2386ec01dc2bSDamien Bergamini assoc.policy |= htole16(IWI_POLICY_WPA); 2387ceaec73dSDamien Bergamini memcpy(assoc.tstamp, ni->ni_tstamp.data, 8); 2388acea4241SDamien Bergamini 2389acea4241SDamien Bergamini if (ic->ic_opmode == IEEE80211_M_IBSS) 2390acea4241SDamien Bergamini capinfo = IEEE80211_CAPINFO_IBSS; 2391acea4241SDamien Bergamini else 2392acea4241SDamien Bergamini capinfo = IEEE80211_CAPINFO_ESS; 2393acea4241SDamien Bergamini if (ic->ic_flags & IEEE80211_F_PRIVACY) 2394acea4241SDamien Bergamini capinfo |= IEEE80211_CAPINFO_PRIVACY; 2395acea4241SDamien Bergamini if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) && 2396acea4241SDamien Bergamini IEEE80211_IS_CHAN_2GHZ(ni->ni_chan)) 2397acea4241SDamien Bergamini capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE; 2398acea4241SDamien Bergamini if (ic->ic_flags & IEEE80211_F_SHSLOT) 2399acea4241SDamien Bergamini capinfo |= IEEE80211_CAPINFO_SHORT_SLOTTIME; 2400acea4241SDamien Bergamini assoc.capinfo = htole16(capinfo); 2401acea4241SDamien Bergamini 2402ceaec73dSDamien Bergamini assoc.lintval = htole16(ic->ic_lintval); 2403ceaec73dSDamien Bergamini assoc.intval = htole16(ni->ni_intval); 2404ceaec73dSDamien Bergamini IEEE80211_ADDR_COPY(assoc.bssid, ni->ni_bssid); 2405ceaec73dSDamien Bergamini if (ic->ic_opmode == IEEE80211_M_IBSS) 2406ceaec73dSDamien Bergamini IEEE80211_ADDR_COPY(assoc.dst, ifp->if_broadcastaddr); 2407ceaec73dSDamien Bergamini else 2408ceaec73dSDamien Bergamini IEEE80211_ADDR_COPY(assoc.dst, ni->ni_bssid); 2409ceaec73dSDamien Bergamini 2410ceaec73dSDamien Bergamini DPRINTF(("Trying to associate to %6D channel %u auth %u\n", 2411ceaec73dSDamien Bergamini assoc.bssid, ":", assoc.chan, assoc.auth)); 2412ceaec73dSDamien Bergamini return iwi_cmd(sc, IWI_CMD_ASSOCIATE, &assoc, sizeof assoc, 1); 2413ceaec73dSDamien Bergamini } 2414ceaec73dSDamien Bergamini 2415ceaec73dSDamien Bergamini static void 2416ceaec73dSDamien Bergamini iwi_init(void *priv) 2417ceaec73dSDamien Bergamini { 2418ceaec73dSDamien Bergamini struct iwi_softc *sc = priv; 2419ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 2420ceaec73dSDamien Bergamini struct ifnet *ifp = ic->ic_ifp; 2421ceaec73dSDamien Bergamini struct iwi_rx_data *data; 2422408146edSDamien Bergamini const char *uc, *fw; 2423ceaec73dSDamien Bergamini int i; 2424ceaec73dSDamien Bergamini 2425ceaec73dSDamien Bergamini iwi_stop(sc); 2426ceaec73dSDamien Bergamini 2427ceaec73dSDamien Bergamini if (iwi_reset(sc) != 0) { 2428ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not reset adapter\n"); 2429ceaec73dSDamien Bergamini goto fail; 2430ceaec73dSDamien Bergamini } 2431ceaec73dSDamien Bergamini 2432408146edSDamien Bergamini switch (ic->ic_opmode) { 2433408146edSDamien Bergamini case IEEE80211_M_STA: 2434408146edSDamien Bergamini uc = "iwi-ucode-bss"; 2435408146edSDamien Bergamini fw = "iwi-bss"; 2436408146edSDamien Bergamini break; 2437408146edSDamien Bergamini 2438408146edSDamien Bergamini case IEEE80211_M_IBSS: 2439408146edSDamien Bergamini uc = "iwi-ucode-ibss"; 2440408146edSDamien Bergamini fw = "iwi-ibss"; 2441408146edSDamien Bergamini break; 2442408146edSDamien Bergamini 2443408146edSDamien Bergamini case IEEE80211_M_MONITOR: 2444408146edSDamien Bergamini uc = "iwi-ucode-monitor"; 2445408146edSDamien Bergamini fw = "iwi-monitor"; 2446408146edSDamien Bergamini break; 2447408146edSDamien Bergamini 2448408146edSDamien Bergamini default: 2449408146edSDamien Bergamini uc = fw = NULL; /* should not get there */ 2450408146edSDamien Bergamini break; 2451408146edSDamien Bergamini } 2452408146edSDamien Bergamini 2453408146edSDamien Bergamini if (iwi_load_firmware(sc, "iwi-boot") != 0) { 2454ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not load boot firmware\n"); 2455ceaec73dSDamien Bergamini goto fail; 2456ceaec73dSDamien Bergamini } 2457ceaec73dSDamien Bergamini 2458408146edSDamien Bergamini if (iwi_load_ucode(sc, uc) != 0) { 2459ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not load microcode\n"); 2460ceaec73dSDamien Bergamini goto fail; 2461ceaec73dSDamien Bergamini } 2462ceaec73dSDamien Bergamini 2463ceaec73dSDamien Bergamini iwi_stop_master(sc); 2464ceaec73dSDamien Bergamini 2465ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_CMD_BASE, sc->cmdq.physaddr); 2466ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_CMD_SIZE, sc->cmdq.count); 2467ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_CMD_WIDX, sc->cmdq.cur); 2468ceaec73dSDamien Bergamini 2469ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX1_BASE, sc->txq[0].physaddr); 2470ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX1_SIZE, sc->txq[0].count); 2471ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX1_WIDX, sc->txq[0].cur); 2472ceaec73dSDamien Bergamini 2473ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX2_BASE, sc->txq[1].physaddr); 2474ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX2_SIZE, sc->txq[1].count); 2475ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX2_WIDX, sc->txq[1].cur); 2476ceaec73dSDamien Bergamini 2477ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX3_BASE, sc->txq[2].physaddr); 2478ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX3_SIZE, sc->txq[2].count); 2479ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX3_WIDX, sc->txq[2].cur); 2480ceaec73dSDamien Bergamini 2481ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX4_BASE, sc->txq[3].physaddr); 2482ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX4_SIZE, sc->txq[3].count); 2483ec01dc2bSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_TX4_WIDX, sc->txq[3].cur); 2484ceaec73dSDamien Bergamini 2485ceaec73dSDamien Bergamini for (i = 0; i < sc->rxq.count; i++) { 2486ceaec73dSDamien Bergamini data = &sc->rxq.data[i]; 2487ceaec73dSDamien Bergamini CSR_WRITE_4(sc, data->reg, data->physaddr); 2488ceaec73dSDamien Bergamini } 2489ceaec73dSDamien Bergamini 2490ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_RX_WIDX, sc->rxq.count - 1); 2491ceaec73dSDamien Bergamini 2492408146edSDamien Bergamini if (iwi_load_firmware(sc, fw) != 0) { 2493ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "could not load main firmware\n"); 2494ceaec73dSDamien Bergamini goto fail; 2495ceaec73dSDamien Bergamini } 2496ceaec73dSDamien Bergamini 2497ceaec73dSDamien Bergamini sc->flags |= IWI_FLAG_FW_INITED; 2498ceaec73dSDamien Bergamini 2499ceaec73dSDamien Bergamini if (iwi_config(sc) != 0) { 2500ceaec73dSDamien Bergamini device_printf(sc->sc_dev, "device configuration failed\n"); 2501ceaec73dSDamien Bergamini goto fail; 2502ceaec73dSDamien Bergamini } 2503ceaec73dSDamien Bergamini 2504e0454c26SDamien Bergamini if (ic->ic_opmode != IEEE80211_M_MONITOR) { 2505e0454c26SDamien Bergamini if (ic->ic_roaming != IEEE80211_ROAMING_MANUAL) 2506acea4241SDamien Bergamini ieee80211_new_state(ic, IEEE80211_S_SCAN, -1); 2507e0454c26SDamien Bergamini } else 2508e0454c26SDamien Bergamini ieee80211_new_state(ic, IEEE80211_S_RUN, -1); 2509ceaec73dSDamien Bergamini 251013f4c340SRobert Watson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 251113f4c340SRobert Watson ifp->if_drv_flags |= IFF_DRV_RUNNING; 2512ceaec73dSDamien Bergamini 2513ceaec73dSDamien Bergamini return; 2514ceaec73dSDamien Bergamini 2515ceaec73dSDamien Bergamini fail: ifp->if_flags &= ~IFF_UP; 2516ceaec73dSDamien Bergamini iwi_stop(sc); 2517ceaec73dSDamien Bergamini } 2518ceaec73dSDamien Bergamini 2519ceaec73dSDamien Bergamini static void 2520ceaec73dSDamien Bergamini iwi_stop(void *priv) 2521ceaec73dSDamien Bergamini { 2522ceaec73dSDamien Bergamini struct iwi_softc *sc = priv; 2523ceaec73dSDamien Bergamini struct ieee80211com *ic = &sc->sc_ic; 2524ceaec73dSDamien Bergamini struct ifnet *ifp = ic->ic_ifp; 2525ceaec73dSDamien Bergamini 2526ceaec73dSDamien Bergamini iwi_stop_master(sc); 2527ceaec73dSDamien Bergamini 2528ceaec73dSDamien Bergamini CSR_WRITE_4(sc, IWI_CSR_RST, IWI_RST_SOFT_RESET); 2529ceaec73dSDamien Bergamini 2530ceaec73dSDamien Bergamini /* reset rings */ 2531ceaec73dSDamien Bergamini iwi_reset_cmd_ring(sc, &sc->cmdq); 2532ec01dc2bSDamien Bergamini iwi_reset_tx_ring(sc, &sc->txq[0]); 2533ec01dc2bSDamien Bergamini iwi_reset_tx_ring(sc, &sc->txq[1]); 2534ec01dc2bSDamien Bergamini iwi_reset_tx_ring(sc, &sc->txq[2]); 2535ec01dc2bSDamien Bergamini iwi_reset_tx_ring(sc, &sc->txq[3]); 2536ceaec73dSDamien Bergamini iwi_reset_rx_ring(sc, &sc->rxq); 2537ceaec73dSDamien Bergamini 2538ceaec73dSDamien Bergamini sc->sc_tx_timer = 0; 2539ceaec73dSDamien Bergamini ifp->if_timer = 0; 254013f4c340SRobert Watson ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 2541ceaec73dSDamien Bergamini 2542ceaec73dSDamien Bergamini ieee80211_new_state(ic, IEEE80211_S_INIT, -1); 2543ceaec73dSDamien Bergamini } 2544ceaec73dSDamien Bergamini 2545408146edSDamien Bergamini /* 2546408146edSDamien Bergamini * Read firmware image from the filesystem and load it into kernel memory. 2547408146edSDamien Bergamini * Must be called from a process context. 2548408146edSDamien Bergamini */ 2549408146edSDamien Bergamini static int 2550408146edSDamien Bergamini iwi_read_firmware(const char *name, caddr_t *bufp, size_t *len) 2551408146edSDamien Bergamini { 2552408146edSDamien Bergamini char path[64]; 2553408146edSDamien Bergamini struct thread *td = curthread; 2554408146edSDamien Bergamini struct nameidata nd; 2555408146edSDamien Bergamini struct vattr va; 2556408146edSDamien Bergamini struct iovec iov; 2557408146edSDamien Bergamini struct uio uio; 2558408146edSDamien Bergamini caddr_t buf; 2559408146edSDamien Bergamini int vfslocked, error; 2560408146edSDamien Bergamini 2561408146edSDamien Bergamini snprintf(path, sizeof path, "/etc/firmware/%s.fw", name); 2562408146edSDamien Bergamini 2563408146edSDamien Bergamini NDINIT(&nd, LOOKUP, NOFOLLOW | LOCKLEAF | MPSAFE, UIO_SYSSPACE, path, 2564408146edSDamien Bergamini td); 2565408146edSDamien Bergamini if ((error = namei(&nd)) != 0) 2566408146edSDamien Bergamini goto fail1; 2567408146edSDamien Bergamini 2568408146edSDamien Bergamini vfslocked = NDHASGIANT(&nd); 2569408146edSDamien Bergamini 2570408146edSDamien Bergamini if ((error = VOP_GETATTR(nd.ni_vp, &va, td->td_ucred, td)) != 0) 2571408146edSDamien Bergamini goto fail2; 2572408146edSDamien Bergamini 2573408146edSDamien Bergamini /* limit firmware size to 256KB */ 2574408146edSDamien Bergamini if (va.va_size > 256 * 1024) { 2575408146edSDamien Bergamini error = E2BIG; 2576408146edSDamien Bergamini goto fail2; 2577408146edSDamien Bergamini } 2578408146edSDamien Bergamini 2579408146edSDamien Bergamini if ((buf = malloc(va.va_size, M_DEVBUF, M_NOWAIT)) == NULL) { 2580408146edSDamien Bergamini error = ENOMEM; 2581408146edSDamien Bergamini goto fail2; 2582408146edSDamien Bergamini } 2583408146edSDamien Bergamini 2584408146edSDamien Bergamini /* read the whole image at once */ 2585408146edSDamien Bergamini uio.uio_iov = &iov; 2586408146edSDamien Bergamini uio.uio_iovcnt = 1; 2587408146edSDamien Bergamini iov.iov_base = buf; 2588408146edSDamien Bergamini iov.iov_len = va.va_size; 2589408146edSDamien Bergamini uio.uio_offset = 0; 2590408146edSDamien Bergamini uio.uio_resid = va.va_size; 2591408146edSDamien Bergamini uio.uio_segflg = UIO_SYSSPACE; 2592408146edSDamien Bergamini uio.uio_rw = UIO_READ; 2593408146edSDamien Bergamini uio.uio_td = td; 2594408146edSDamien Bergamini 2595408146edSDamien Bergamini if ((error = VOP_READ(nd.ni_vp, &uio, 0, NOCRED)) != 0) 2596408146edSDamien Bergamini goto fail3; 2597408146edSDamien Bergamini 2598408146edSDamien Bergamini *bufp = buf; 2599408146edSDamien Bergamini *len = va.va_size; 2600408146edSDamien Bergamini 2601408146edSDamien Bergamini vput(nd.ni_vp); 2602408146edSDamien Bergamini VFS_UNLOCK_GIANT(vfslocked); 2603408146edSDamien Bergamini 2604408146edSDamien Bergamini return 0; 2605408146edSDamien Bergamini 2606408146edSDamien Bergamini fail3: free(buf, M_DEVBUF); 2607408146edSDamien Bergamini fail2: vput(nd.ni_vp); 2608408146edSDamien Bergamini VFS_UNLOCK_GIANT(vfslocked); 2609408146edSDamien Bergamini fail1: 2610408146edSDamien Bergamini return error; 2611408146edSDamien Bergamini } 2612408146edSDamien Bergamini 2613ceaec73dSDamien Bergamini static int 2614ceaec73dSDamien Bergamini iwi_sysctl_stats(SYSCTL_HANDLER_ARGS) 2615ceaec73dSDamien Bergamini { 2616ceaec73dSDamien Bergamini struct iwi_softc *sc = arg1; 2617ceaec73dSDamien Bergamini uint32_t size, buf[128]; 2618ceaec73dSDamien Bergamini 2619ceaec73dSDamien Bergamini if (!(sc->flags & IWI_FLAG_FW_INITED)) { 2620ceaec73dSDamien Bergamini memset(buf, 0, sizeof buf); 2621ceaec73dSDamien Bergamini return SYSCTL_OUT(req, buf, sizeof buf); 2622ceaec73dSDamien Bergamini } 2623ceaec73dSDamien Bergamini 2624ceaec73dSDamien Bergamini size = min(CSR_READ_4(sc, IWI_CSR_TABLE0_SIZE), 128 - 1); 2625ceaec73dSDamien Bergamini CSR_READ_REGION_4(sc, IWI_CSR_TABLE0_BASE, &buf[1], size); 2626ceaec73dSDamien Bergamini 2627ceaec73dSDamien Bergamini return SYSCTL_OUT(req, buf, sizeof buf); 2628ceaec73dSDamien Bergamini } 2629ceaec73dSDamien Bergamini 2630ceaec73dSDamien Bergamini static int 2631ceaec73dSDamien Bergamini iwi_sysctl_radio(SYSCTL_HANDLER_ARGS) 2632ceaec73dSDamien Bergamini { 2633ceaec73dSDamien Bergamini struct iwi_softc *sc = arg1; 2634ceaec73dSDamien Bergamini int val; 2635ceaec73dSDamien Bergamini 2636ceaec73dSDamien Bergamini val = (CSR_READ_4(sc, IWI_CSR_IO) & IWI_IO_RADIO_ENABLED) ? 1 : 0; 2637ceaec73dSDamien Bergamini 2638ceaec73dSDamien Bergamini return SYSCTL_OUT(req, &val, sizeof val); 2639ceaec73dSDamien Bergamini } 2640