145d9abdbSWeongyo Jeong /*- 245d9abdbSWeongyo Jeong * Copyright (c) 2009-2010 Weongyo Jeong <weongyo@freebsd.org> 345d9abdbSWeongyo Jeong * All rights reserved. 445d9abdbSWeongyo Jeong * 545d9abdbSWeongyo Jeong * Redistribution and use in source and binary forms, with or without 645d9abdbSWeongyo Jeong * modification, are permitted provided that the following conditions 745d9abdbSWeongyo Jeong * are met: 845d9abdbSWeongyo Jeong * 1. Redistributions of source code must retain the above copyright 945d9abdbSWeongyo Jeong * notice, this list of conditions and the following disclaimer, 1045d9abdbSWeongyo Jeong * without modification. 1145d9abdbSWeongyo Jeong * 2. Redistributions in binary form must reproduce at minimum a disclaimer 1245d9abdbSWeongyo Jeong * similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any 1345d9abdbSWeongyo Jeong * redistribution must be conditioned upon including a substantially 1445d9abdbSWeongyo Jeong * similar Disclaimer requirement for further binary redistribution. 1545d9abdbSWeongyo Jeong * 1645d9abdbSWeongyo Jeong * NO WARRANTY 1745d9abdbSWeongyo Jeong * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 1845d9abdbSWeongyo Jeong * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 1945d9abdbSWeongyo Jeong * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY 2045d9abdbSWeongyo Jeong * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL 2145d9abdbSWeongyo Jeong * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, 2245d9abdbSWeongyo Jeong * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 2345d9abdbSWeongyo Jeong * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 2445d9abdbSWeongyo Jeong * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER 2545d9abdbSWeongyo Jeong * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 2645d9abdbSWeongyo Jeong * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 2745d9abdbSWeongyo Jeong * THE POSSIBILITY OF SUCH DAMAGES. 2845d9abdbSWeongyo Jeong */ 2945d9abdbSWeongyo Jeong 3045d9abdbSWeongyo Jeong #include <sys/cdefs.h> 3145d9abdbSWeongyo Jeong __FBSDID("$FreeBSD$"); 3245d9abdbSWeongyo Jeong 3345d9abdbSWeongyo Jeong /* 3445d9abdbSWeongyo Jeong * The Broadcom Wireless LAN controller driver. 3545d9abdbSWeongyo Jeong */ 3645d9abdbSWeongyo Jeong 3745d9abdbSWeongyo Jeong #include <sys/param.h> 3845d9abdbSWeongyo Jeong #include <sys/systm.h> 3945d9abdbSWeongyo Jeong #include <sys/kernel.h> 408ec07310SGleb Smirnoff #include <sys/malloc.h> 418ec07310SGleb Smirnoff #include <sys/module.h> 4245d9abdbSWeongyo Jeong #include <sys/endian.h> 4345d9abdbSWeongyo Jeong #include <sys/errno.h> 4445d9abdbSWeongyo Jeong #include <sys/firmware.h> 4545d9abdbSWeongyo Jeong #include <sys/lock.h> 4645d9abdbSWeongyo Jeong #include <sys/mutex.h> 4745d9abdbSWeongyo Jeong #include <machine/bus.h> 4845d9abdbSWeongyo Jeong #include <machine/resource.h> 4945d9abdbSWeongyo Jeong #include <sys/bus.h> 5045d9abdbSWeongyo Jeong #include <sys/rman.h> 5145d9abdbSWeongyo Jeong #include <sys/socket.h> 5245d9abdbSWeongyo Jeong #include <sys/sockio.h> 5345d9abdbSWeongyo Jeong 5445d9abdbSWeongyo Jeong #include <net/ethernet.h> 5545d9abdbSWeongyo Jeong #include <net/if.h> 5676039bc8SGleb Smirnoff #include <net/if_var.h> 5745d9abdbSWeongyo Jeong #include <net/if_arp.h> 5845d9abdbSWeongyo Jeong #include <net/if_dl.h> 5945d9abdbSWeongyo Jeong #include <net/if_llc.h> 6045d9abdbSWeongyo Jeong #include <net/if_media.h> 6145d9abdbSWeongyo Jeong #include <net/if_types.h> 6245d9abdbSWeongyo Jeong 6345d9abdbSWeongyo Jeong #include <dev/pci/pcivar.h> 6445d9abdbSWeongyo Jeong #include <dev/pci/pcireg.h> 6545d9abdbSWeongyo Jeong #include <dev/siba/siba_ids.h> 6645d9abdbSWeongyo Jeong #include <dev/siba/sibareg.h> 6745d9abdbSWeongyo Jeong #include <dev/siba/sibavar.h> 6845d9abdbSWeongyo Jeong 6945d9abdbSWeongyo Jeong #include <net80211/ieee80211_var.h> 7045d9abdbSWeongyo Jeong #include <net80211/ieee80211_radiotap.h> 7145d9abdbSWeongyo Jeong #include <net80211/ieee80211_regdomain.h> 7245d9abdbSWeongyo Jeong #include <net80211/ieee80211_phy.h> 73b6108616SRui Paulo #include <net80211/ieee80211_ratectl.h> 7445d9abdbSWeongyo Jeong 7545d9abdbSWeongyo Jeong #include <dev/bwn/if_bwnreg.h> 7645d9abdbSWeongyo Jeong #include <dev/bwn/if_bwnvar.h> 7745d9abdbSWeongyo Jeong 78*d546e47aSAdrian Chadd #include <dev/bwn/if_bwn_debug.h> 79b9768303SAdrian Chadd #include <dev/bwn/if_bwn_misc.h> 80*d546e47aSAdrian Chadd #include <dev/bwn/if_bwn_phy_g.h> 81b9768303SAdrian Chadd #include <dev/bwn/if_bwn_phy_lp.h> 82b9768303SAdrian Chadd 836472ac3dSEd Schouten static SYSCTL_NODE(_hw, OID_AUTO, bwn, CTLFLAG_RD, 0, 846472ac3dSEd Schouten "Broadcom driver parameters"); 8545d9abdbSWeongyo Jeong 8645d9abdbSWeongyo Jeong /* 8745d9abdbSWeongyo Jeong * Tunable & sysctl variables. 8845d9abdbSWeongyo Jeong */ 8945d9abdbSWeongyo Jeong 9045d9abdbSWeongyo Jeong #ifdef BWN_DEBUG 9145d9abdbSWeongyo Jeong static int bwn_debug = 0; 92af3b2549SHans Petter Selasky SYSCTL_INT(_hw_bwn, OID_AUTO, debug, CTLFLAG_RWTUN, &bwn_debug, 0, 9345d9abdbSWeongyo Jeong "Broadcom debugging printfs"); 9445d9abdbSWeongyo Jeong #endif 9545d9abdbSWeongyo Jeong 9645d9abdbSWeongyo Jeong static int bwn_bfp = 0; /* use "Bad Frames Preemption" */ 9745d9abdbSWeongyo Jeong SYSCTL_INT(_hw_bwn, OID_AUTO, bfp, CTLFLAG_RW, &bwn_bfp, 0, 9845d9abdbSWeongyo Jeong "uses Bad Frames Preemption"); 9945d9abdbSWeongyo Jeong static int bwn_bluetooth = 1; 10045d9abdbSWeongyo Jeong SYSCTL_INT(_hw_bwn, OID_AUTO, bluetooth, CTLFLAG_RW, &bwn_bluetooth, 0, 10145d9abdbSWeongyo Jeong "turns on Bluetooth Coexistence"); 10245d9abdbSWeongyo Jeong static int bwn_hwpctl = 0; 10345d9abdbSWeongyo Jeong SYSCTL_INT(_hw_bwn, OID_AUTO, hwpctl, CTLFLAG_RW, &bwn_hwpctl, 0, 10445d9abdbSWeongyo Jeong "uses H/W power control"); 10545d9abdbSWeongyo Jeong static int bwn_msi_disable = 0; /* MSI disabled */ 10645d9abdbSWeongyo Jeong TUNABLE_INT("hw.bwn.msi_disable", &bwn_msi_disable); 10745d9abdbSWeongyo Jeong static int bwn_usedma = 1; 10845d9abdbSWeongyo Jeong SYSCTL_INT(_hw_bwn, OID_AUTO, usedma, CTLFLAG_RD, &bwn_usedma, 0, 10945d9abdbSWeongyo Jeong "uses DMA"); 11045d9abdbSWeongyo Jeong TUNABLE_INT("hw.bwn.usedma", &bwn_usedma); 11145d9abdbSWeongyo Jeong static int bwn_wme = 1; 11245d9abdbSWeongyo Jeong SYSCTL_INT(_hw_bwn, OID_AUTO, wme, CTLFLAG_RW, &bwn_wme, 0, 11345d9abdbSWeongyo Jeong "uses WME support"); 11445d9abdbSWeongyo Jeong 1157a79cebfSGleb Smirnoff static void bwn_attach_pre(struct bwn_softc *); 11645d9abdbSWeongyo Jeong static int bwn_attach_post(struct bwn_softc *); 117b9b64aa5SWeongyo Jeong static void bwn_sprom_bugfixes(device_t); 1187a79cebfSGleb Smirnoff static int bwn_init(struct bwn_softc *); 1197a79cebfSGleb Smirnoff static void bwn_parent(struct ieee80211com *); 1207a79cebfSGleb Smirnoff static void bwn_start(struct bwn_softc *); 1217a79cebfSGleb Smirnoff static int bwn_transmit(struct ieee80211com *, struct mbuf *); 12245d9abdbSWeongyo Jeong static int bwn_attach_core(struct bwn_mac *); 12345d9abdbSWeongyo Jeong static int bwn_phy_getinfo(struct bwn_mac *, int); 12445d9abdbSWeongyo Jeong static int bwn_chiptest(struct bwn_mac *); 12545d9abdbSWeongyo Jeong static int bwn_setup_channels(struct bwn_mac *, int, int); 12645d9abdbSWeongyo Jeong static void bwn_shm_ctlword(struct bwn_mac *, uint16_t, 12745d9abdbSWeongyo Jeong uint16_t); 12845d9abdbSWeongyo Jeong static void bwn_addchannels(struct ieee80211_channel [], int, int *, 12945d9abdbSWeongyo Jeong const struct bwn_channelinfo *, int); 13045d9abdbSWeongyo Jeong static int bwn_raw_xmit(struct ieee80211_node *, struct mbuf *, 13145d9abdbSWeongyo Jeong const struct ieee80211_bpf_params *); 132272f6adeSGleb Smirnoff static void bwn_updateslot(struct ieee80211com *); 133272f6adeSGleb Smirnoff static void bwn_update_promisc(struct ieee80211com *); 13445d9abdbSWeongyo Jeong static void bwn_wme_init(struct bwn_mac *); 13545d9abdbSWeongyo Jeong static int bwn_wme_update(struct ieee80211com *); 13645d9abdbSWeongyo Jeong static void bwn_wme_clear(struct bwn_softc *); 13745d9abdbSWeongyo Jeong static void bwn_wme_load(struct bwn_mac *); 13845d9abdbSWeongyo Jeong static void bwn_wme_loadparams(struct bwn_mac *, 13945d9abdbSWeongyo Jeong const struct wmeParams *, uint16_t); 14045d9abdbSWeongyo Jeong static void bwn_scan_start(struct ieee80211com *); 14145d9abdbSWeongyo Jeong static void bwn_scan_end(struct ieee80211com *); 14245d9abdbSWeongyo Jeong static void bwn_set_channel(struct ieee80211com *); 14345d9abdbSWeongyo Jeong static struct ieee80211vap *bwn_vap_create(struct ieee80211com *, 144fcd9500fSBernhard Schmidt const char [IFNAMSIZ], int, enum ieee80211_opmode, int, 145fcd9500fSBernhard Schmidt const uint8_t [IEEE80211_ADDR_LEN], 14645d9abdbSWeongyo Jeong const uint8_t [IEEE80211_ADDR_LEN]); 14745d9abdbSWeongyo Jeong static void bwn_vap_delete(struct ieee80211vap *); 1487a79cebfSGleb Smirnoff static void bwn_stop(struct bwn_softc *); 14945d9abdbSWeongyo Jeong static int bwn_core_init(struct bwn_mac *); 15045d9abdbSWeongyo Jeong static void bwn_core_start(struct bwn_mac *); 15145d9abdbSWeongyo Jeong static void bwn_core_exit(struct bwn_mac *); 15245d9abdbSWeongyo Jeong static void bwn_bt_disable(struct bwn_mac *); 15345d9abdbSWeongyo Jeong static int bwn_chip_init(struct bwn_mac *); 15445d9abdbSWeongyo Jeong static void bwn_set_txretry(struct bwn_mac *, int, int); 15545d9abdbSWeongyo Jeong static void bwn_rate_init(struct bwn_mac *); 15645d9abdbSWeongyo Jeong static void bwn_set_phytxctl(struct bwn_mac *); 15745d9abdbSWeongyo Jeong static void bwn_spu_setdelay(struct bwn_mac *, int); 15845d9abdbSWeongyo Jeong static void bwn_bt_enable(struct bwn_mac *); 15945d9abdbSWeongyo Jeong static void bwn_set_macaddr(struct bwn_mac *); 16045d9abdbSWeongyo Jeong static void bwn_crypt_init(struct bwn_mac *); 16145d9abdbSWeongyo Jeong static void bwn_chip_exit(struct bwn_mac *); 16245d9abdbSWeongyo Jeong static int bwn_fw_fillinfo(struct bwn_mac *); 16345d9abdbSWeongyo Jeong static int bwn_fw_loaducode(struct bwn_mac *); 16445d9abdbSWeongyo Jeong static int bwn_gpio_init(struct bwn_mac *); 16545d9abdbSWeongyo Jeong static int bwn_fw_loadinitvals(struct bwn_mac *); 16645d9abdbSWeongyo Jeong static int bwn_phy_init(struct bwn_mac *); 16745d9abdbSWeongyo Jeong static void bwn_set_txantenna(struct bwn_mac *, int); 16845d9abdbSWeongyo Jeong static void bwn_set_opmode(struct bwn_mac *); 16945d9abdbSWeongyo Jeong static void bwn_rate_write(struct bwn_mac *, uint16_t, int); 17045d9abdbSWeongyo Jeong static uint8_t bwn_plcp_getcck(const uint8_t); 17145d9abdbSWeongyo Jeong static uint8_t bwn_plcp_getofdm(const uint8_t); 17245d9abdbSWeongyo Jeong static void bwn_pio_init(struct bwn_mac *); 17345d9abdbSWeongyo Jeong static uint16_t bwn_pio_idx2base(struct bwn_mac *, int); 17445d9abdbSWeongyo Jeong static void bwn_pio_set_txqueue(struct bwn_mac *, struct bwn_pio_txqueue *, 17545d9abdbSWeongyo Jeong int); 17645d9abdbSWeongyo Jeong static void bwn_pio_setupqueue_rx(struct bwn_mac *, 17745d9abdbSWeongyo Jeong struct bwn_pio_rxqueue *, int); 17845d9abdbSWeongyo Jeong static void bwn_destroy_queue_tx(struct bwn_pio_txqueue *); 17945d9abdbSWeongyo Jeong static uint16_t bwn_pio_read_2(struct bwn_mac *, struct bwn_pio_txqueue *, 18045d9abdbSWeongyo Jeong uint16_t); 18145d9abdbSWeongyo Jeong static void bwn_pio_cancel_tx_packets(struct bwn_pio_txqueue *); 18245d9abdbSWeongyo Jeong static int bwn_pio_rx(struct bwn_pio_rxqueue *); 18345d9abdbSWeongyo Jeong static uint8_t bwn_pio_rxeof(struct bwn_pio_rxqueue *); 18445d9abdbSWeongyo Jeong static void bwn_pio_handle_txeof(struct bwn_mac *, 18545d9abdbSWeongyo Jeong const struct bwn_txstatus *); 18645d9abdbSWeongyo Jeong static uint16_t bwn_pio_rx_read_2(struct bwn_pio_rxqueue *, uint16_t); 18745d9abdbSWeongyo Jeong static uint32_t bwn_pio_rx_read_4(struct bwn_pio_rxqueue *, uint16_t); 18845d9abdbSWeongyo Jeong static void bwn_pio_rx_write_2(struct bwn_pio_rxqueue *, uint16_t, 18945d9abdbSWeongyo Jeong uint16_t); 19045d9abdbSWeongyo Jeong static void bwn_pio_rx_write_4(struct bwn_pio_rxqueue *, uint16_t, 19145d9abdbSWeongyo Jeong uint32_t); 19245d9abdbSWeongyo Jeong static int bwn_pio_tx_start(struct bwn_mac *, struct ieee80211_node *, 19345d9abdbSWeongyo Jeong struct mbuf *); 19445d9abdbSWeongyo Jeong static struct bwn_pio_txqueue *bwn_pio_select(struct bwn_mac *, uint8_t); 19545d9abdbSWeongyo Jeong static uint32_t bwn_pio_write_multi_4(struct bwn_mac *, 19645d9abdbSWeongyo Jeong struct bwn_pio_txqueue *, uint32_t, const void *, int); 19745d9abdbSWeongyo Jeong static void bwn_pio_write_4(struct bwn_mac *, struct bwn_pio_txqueue *, 19845d9abdbSWeongyo Jeong uint16_t, uint32_t); 19945d9abdbSWeongyo Jeong static uint16_t bwn_pio_write_multi_2(struct bwn_mac *, 20045d9abdbSWeongyo Jeong struct bwn_pio_txqueue *, uint16_t, const void *, int); 20145d9abdbSWeongyo Jeong static uint16_t bwn_pio_write_mbuf_2(struct bwn_mac *, 20245d9abdbSWeongyo Jeong struct bwn_pio_txqueue *, uint16_t, struct mbuf *); 20345d9abdbSWeongyo Jeong static struct bwn_pio_txqueue *bwn_pio_parse_cookie(struct bwn_mac *, 20445d9abdbSWeongyo Jeong uint16_t, struct bwn_pio_txpkt **); 20545d9abdbSWeongyo Jeong static void bwn_dma_init(struct bwn_mac *); 20645d9abdbSWeongyo Jeong static void bwn_dma_rxdirectfifo(struct bwn_mac *, int, uint8_t); 20745d9abdbSWeongyo Jeong static int bwn_dma_mask2type(uint64_t); 20845d9abdbSWeongyo Jeong static uint64_t bwn_dma_mask(struct bwn_mac *); 20945d9abdbSWeongyo Jeong static uint16_t bwn_dma_base(int, int); 21045d9abdbSWeongyo Jeong static void bwn_dma_ringfree(struct bwn_dma_ring **); 21145d9abdbSWeongyo Jeong static void bwn_dma_32_getdesc(struct bwn_dma_ring *, 21245d9abdbSWeongyo Jeong int, struct bwn_dmadesc_generic **, 21345d9abdbSWeongyo Jeong struct bwn_dmadesc_meta **); 21445d9abdbSWeongyo Jeong static void bwn_dma_32_setdesc(struct bwn_dma_ring *, 21545d9abdbSWeongyo Jeong struct bwn_dmadesc_generic *, bus_addr_t, uint16_t, int, 21645d9abdbSWeongyo Jeong int, int); 21745d9abdbSWeongyo Jeong static void bwn_dma_32_start_transfer(struct bwn_dma_ring *, int); 21845d9abdbSWeongyo Jeong static void bwn_dma_32_suspend(struct bwn_dma_ring *); 21945d9abdbSWeongyo Jeong static void bwn_dma_32_resume(struct bwn_dma_ring *); 22045d9abdbSWeongyo Jeong static int bwn_dma_32_get_curslot(struct bwn_dma_ring *); 22145d9abdbSWeongyo Jeong static void bwn_dma_32_set_curslot(struct bwn_dma_ring *, int); 22245d9abdbSWeongyo Jeong static void bwn_dma_64_getdesc(struct bwn_dma_ring *, 22345d9abdbSWeongyo Jeong int, struct bwn_dmadesc_generic **, 22445d9abdbSWeongyo Jeong struct bwn_dmadesc_meta **); 22545d9abdbSWeongyo Jeong static void bwn_dma_64_setdesc(struct bwn_dma_ring *, 22645d9abdbSWeongyo Jeong struct bwn_dmadesc_generic *, bus_addr_t, uint16_t, int, 22745d9abdbSWeongyo Jeong int, int); 22845d9abdbSWeongyo Jeong static void bwn_dma_64_start_transfer(struct bwn_dma_ring *, int); 22945d9abdbSWeongyo Jeong static void bwn_dma_64_suspend(struct bwn_dma_ring *); 23045d9abdbSWeongyo Jeong static void bwn_dma_64_resume(struct bwn_dma_ring *); 23145d9abdbSWeongyo Jeong static int bwn_dma_64_get_curslot(struct bwn_dma_ring *); 23245d9abdbSWeongyo Jeong static void bwn_dma_64_set_curslot(struct bwn_dma_ring *, int); 23345d9abdbSWeongyo Jeong static int bwn_dma_allocringmemory(struct bwn_dma_ring *); 23445d9abdbSWeongyo Jeong static void bwn_dma_setup(struct bwn_dma_ring *); 23545d9abdbSWeongyo Jeong static void bwn_dma_free_ringmemory(struct bwn_dma_ring *); 23645d9abdbSWeongyo Jeong static void bwn_dma_cleanup(struct bwn_dma_ring *); 23745d9abdbSWeongyo Jeong static void bwn_dma_free_descbufs(struct bwn_dma_ring *); 23845d9abdbSWeongyo Jeong static int bwn_dma_tx_reset(struct bwn_mac *, uint16_t, int); 23945d9abdbSWeongyo Jeong static void bwn_dma_rx(struct bwn_dma_ring *); 24045d9abdbSWeongyo Jeong static int bwn_dma_rx_reset(struct bwn_mac *, uint16_t, int); 24145d9abdbSWeongyo Jeong static void bwn_dma_free_descbuf(struct bwn_dma_ring *, 24245d9abdbSWeongyo Jeong struct bwn_dmadesc_meta *); 24345d9abdbSWeongyo Jeong static void bwn_dma_set_redzone(struct bwn_dma_ring *, struct mbuf *); 24445d9abdbSWeongyo Jeong static int bwn_dma_gettype(struct bwn_mac *); 24545d9abdbSWeongyo Jeong static void bwn_dma_ring_addr(void *, bus_dma_segment_t *, int, int); 24645d9abdbSWeongyo Jeong static int bwn_dma_freeslot(struct bwn_dma_ring *); 24745d9abdbSWeongyo Jeong static int bwn_dma_nextslot(struct bwn_dma_ring *, int); 24845d9abdbSWeongyo Jeong static void bwn_dma_rxeof(struct bwn_dma_ring *, int *); 24945d9abdbSWeongyo Jeong static int bwn_dma_newbuf(struct bwn_dma_ring *, 25045d9abdbSWeongyo Jeong struct bwn_dmadesc_generic *, struct bwn_dmadesc_meta *, 25145d9abdbSWeongyo Jeong int); 25245d9abdbSWeongyo Jeong static void bwn_dma_buf_addr(void *, bus_dma_segment_t *, int, 25345d9abdbSWeongyo Jeong bus_size_t, int); 25445d9abdbSWeongyo Jeong static uint8_t bwn_dma_check_redzone(struct bwn_dma_ring *, struct mbuf *); 25545d9abdbSWeongyo Jeong static void bwn_dma_handle_txeof(struct bwn_mac *, 25645d9abdbSWeongyo Jeong const struct bwn_txstatus *); 25745d9abdbSWeongyo Jeong static int bwn_dma_tx_start(struct bwn_mac *, struct ieee80211_node *, 25845d9abdbSWeongyo Jeong struct mbuf *); 25945d9abdbSWeongyo Jeong static int bwn_dma_getslot(struct bwn_dma_ring *); 26045d9abdbSWeongyo Jeong static struct bwn_dma_ring *bwn_dma_select(struct bwn_mac *, 26145d9abdbSWeongyo Jeong uint8_t); 26245d9abdbSWeongyo Jeong static int bwn_dma_attach(struct bwn_mac *); 26345d9abdbSWeongyo Jeong static struct bwn_dma_ring *bwn_dma_ringsetup(struct bwn_mac *, 26445d9abdbSWeongyo Jeong int, int, int); 26545d9abdbSWeongyo Jeong static struct bwn_dma_ring *bwn_dma_parse_cookie(struct bwn_mac *, 26645d9abdbSWeongyo Jeong const struct bwn_txstatus *, uint16_t, int *); 26745d9abdbSWeongyo Jeong static void bwn_dma_free(struct bwn_mac *); 26845d9abdbSWeongyo Jeong static int bwn_fw_gets(struct bwn_mac *, enum bwn_fwtype); 26945d9abdbSWeongyo Jeong static int bwn_fw_get(struct bwn_mac *, enum bwn_fwtype, 27045d9abdbSWeongyo Jeong const char *, struct bwn_fwfile *); 27145d9abdbSWeongyo Jeong static void bwn_release_firmware(struct bwn_mac *); 27245d9abdbSWeongyo Jeong static void bwn_do_release_fw(struct bwn_fwfile *); 27345d9abdbSWeongyo Jeong static uint16_t bwn_fwcaps_read(struct bwn_mac *); 27445d9abdbSWeongyo Jeong static int bwn_fwinitvals_write(struct bwn_mac *, 27545d9abdbSWeongyo Jeong const struct bwn_fwinitvals *, size_t, size_t); 27645d9abdbSWeongyo Jeong static uint16_t bwn_ant2phy(int); 27745d9abdbSWeongyo Jeong static void bwn_mac_write_bssid(struct bwn_mac *); 27845d9abdbSWeongyo Jeong static void bwn_mac_setfilter(struct bwn_mac *, uint16_t, 27945d9abdbSWeongyo Jeong const uint8_t *); 28045d9abdbSWeongyo Jeong static void bwn_key_dowrite(struct bwn_mac *, uint8_t, uint8_t, 28145d9abdbSWeongyo Jeong const uint8_t *, size_t, const uint8_t *); 28245d9abdbSWeongyo Jeong static void bwn_key_macwrite(struct bwn_mac *, uint8_t, 28345d9abdbSWeongyo Jeong const uint8_t *); 28445d9abdbSWeongyo Jeong static void bwn_key_write(struct bwn_mac *, uint8_t, uint8_t, 28545d9abdbSWeongyo Jeong const uint8_t *); 28645d9abdbSWeongyo Jeong static void bwn_phy_exit(struct bwn_mac *); 28745d9abdbSWeongyo Jeong static void bwn_core_stop(struct bwn_mac *); 28845d9abdbSWeongyo Jeong static int bwn_switch_band(struct bwn_softc *, 28945d9abdbSWeongyo Jeong struct ieee80211_channel *); 29045d9abdbSWeongyo Jeong static void bwn_phy_reset(struct bwn_mac *); 29145d9abdbSWeongyo Jeong static int bwn_newstate(struct ieee80211vap *, enum ieee80211_state, int); 29245d9abdbSWeongyo Jeong static void bwn_set_pretbtt(struct bwn_mac *); 29345d9abdbSWeongyo Jeong static int bwn_intr(void *); 29445d9abdbSWeongyo Jeong static void bwn_intrtask(void *, int); 29545d9abdbSWeongyo Jeong static void bwn_restart(struct bwn_mac *, const char *); 29645d9abdbSWeongyo Jeong static void bwn_intr_ucode_debug(struct bwn_mac *); 29745d9abdbSWeongyo Jeong static void bwn_intr_tbtt_indication(struct bwn_mac *); 29845d9abdbSWeongyo Jeong static void bwn_intr_atim_end(struct bwn_mac *); 29945d9abdbSWeongyo Jeong static void bwn_intr_beacon(struct bwn_mac *); 30045d9abdbSWeongyo Jeong static void bwn_intr_pmq(struct bwn_mac *); 30145d9abdbSWeongyo Jeong static void bwn_intr_noise(struct bwn_mac *); 30245d9abdbSWeongyo Jeong static void bwn_intr_txeof(struct bwn_mac *); 30345d9abdbSWeongyo Jeong static void bwn_hwreset(void *, int); 30445d9abdbSWeongyo Jeong static void bwn_handle_fwpanic(struct bwn_mac *); 30545d9abdbSWeongyo Jeong static void bwn_load_beacon0(struct bwn_mac *); 30645d9abdbSWeongyo Jeong static void bwn_load_beacon1(struct bwn_mac *); 30745d9abdbSWeongyo Jeong static uint32_t bwn_jssi_read(struct bwn_mac *); 30845d9abdbSWeongyo Jeong static void bwn_noise_gensample(struct bwn_mac *); 30945d9abdbSWeongyo Jeong static void bwn_handle_txeof(struct bwn_mac *, 31045d9abdbSWeongyo Jeong const struct bwn_txstatus *); 31145d9abdbSWeongyo Jeong static void bwn_rxeof(struct bwn_mac *, struct mbuf *, const void *); 31245d9abdbSWeongyo Jeong static void bwn_phy_txpower_check(struct bwn_mac *, uint32_t); 31345d9abdbSWeongyo Jeong static int bwn_tx_start(struct bwn_softc *, struct ieee80211_node *, 31445d9abdbSWeongyo Jeong struct mbuf *); 31545d9abdbSWeongyo Jeong static int bwn_tx_isfull(struct bwn_softc *, struct mbuf *); 31645d9abdbSWeongyo Jeong static int bwn_set_txhdr(struct bwn_mac *, 31745d9abdbSWeongyo Jeong struct ieee80211_node *, struct mbuf *, struct bwn_txhdr *, 31845d9abdbSWeongyo Jeong uint16_t); 31945d9abdbSWeongyo Jeong static void bwn_plcp_genhdr(struct bwn_plcp4 *, const uint16_t, 32045d9abdbSWeongyo Jeong const uint8_t); 32145d9abdbSWeongyo Jeong static uint8_t bwn_antenna_sanitize(struct bwn_mac *, uint8_t); 32245d9abdbSWeongyo Jeong static uint8_t bwn_get_fbrate(uint8_t); 32345d9abdbSWeongyo Jeong static void bwn_txpwr(void *, int); 32445d9abdbSWeongyo Jeong static void bwn_tasks(void *); 32545d9abdbSWeongyo Jeong static void bwn_task_15s(struct bwn_mac *); 32645d9abdbSWeongyo Jeong static void bwn_task_30s(struct bwn_mac *); 32745d9abdbSWeongyo Jeong static void bwn_task_60s(struct bwn_mac *); 32845d9abdbSWeongyo Jeong static int bwn_plcp_get_ofdmrate(struct bwn_mac *, struct bwn_plcp6 *, 32945d9abdbSWeongyo Jeong uint8_t); 33045d9abdbSWeongyo Jeong static int bwn_plcp_get_cckrate(struct bwn_mac *, struct bwn_plcp6 *); 33145d9abdbSWeongyo Jeong static void bwn_rx_radiotap(struct bwn_mac *, struct mbuf *, 33245d9abdbSWeongyo Jeong const struct bwn_rxhdr4 *, struct bwn_plcp6 *, int, 33345d9abdbSWeongyo Jeong int, int); 33445d9abdbSWeongyo Jeong static void bwn_tsf_read(struct bwn_mac *, uint64_t *); 33545d9abdbSWeongyo Jeong static void bwn_set_slot_time(struct bwn_mac *, uint16_t); 33645d9abdbSWeongyo Jeong static void bwn_watchdog(void *); 33745d9abdbSWeongyo Jeong static void bwn_dma_stop(struct bwn_mac *); 33845d9abdbSWeongyo Jeong static void bwn_pio_stop(struct bwn_mac *); 33945d9abdbSWeongyo Jeong static void bwn_dma_ringstop(struct bwn_dma_ring **); 34045d9abdbSWeongyo Jeong static void bwn_led_attach(struct bwn_mac *); 34145d9abdbSWeongyo Jeong static void bwn_led_newstate(struct bwn_mac *, enum ieee80211_state); 34245d9abdbSWeongyo Jeong static void bwn_led_event(struct bwn_mac *, int); 34345d9abdbSWeongyo Jeong static void bwn_led_blink_start(struct bwn_mac *, int, int); 34445d9abdbSWeongyo Jeong static void bwn_led_blink_next(void *); 34545d9abdbSWeongyo Jeong static void bwn_led_blink_end(void *); 34645d9abdbSWeongyo Jeong static void bwn_rfswitch(void *); 34745d9abdbSWeongyo Jeong static void bwn_rf_turnon(struct bwn_mac *); 34845d9abdbSWeongyo Jeong static void bwn_rf_turnoff(struct bwn_mac *); 349d2ee7771SWeongyo Jeong static void bwn_sysctl_node(struct bwn_softc *); 35045d9abdbSWeongyo Jeong 35145d9abdbSWeongyo Jeong static struct resource_spec bwn_res_spec_legacy[] = { 35245d9abdbSWeongyo Jeong { SYS_RES_IRQ, 0, RF_ACTIVE | RF_SHAREABLE }, 35345d9abdbSWeongyo Jeong { -1, 0, 0 } 35445d9abdbSWeongyo Jeong }; 35545d9abdbSWeongyo Jeong 35645d9abdbSWeongyo Jeong static struct resource_spec bwn_res_spec_msi[] = { 35745d9abdbSWeongyo Jeong { SYS_RES_IRQ, 1, RF_ACTIVE }, 35845d9abdbSWeongyo Jeong { -1, 0, 0 } 35945d9abdbSWeongyo Jeong }; 36045d9abdbSWeongyo Jeong 36145d9abdbSWeongyo Jeong static const struct bwn_channelinfo bwn_chantable_bg = { 36245d9abdbSWeongyo Jeong .channels = { 36345d9abdbSWeongyo Jeong { 2412, 1, 30 }, { 2417, 2, 30 }, { 2422, 3, 30 }, 36445d9abdbSWeongyo Jeong { 2427, 4, 30 }, { 2432, 5, 30 }, { 2437, 6, 30 }, 36545d9abdbSWeongyo Jeong { 2442, 7, 30 }, { 2447, 8, 30 }, { 2452, 9, 30 }, 36645d9abdbSWeongyo Jeong { 2457, 10, 30 }, { 2462, 11, 30 }, { 2467, 12, 30 }, 36745d9abdbSWeongyo Jeong { 2472, 13, 30 }, { 2484, 14, 30 } }, 36845d9abdbSWeongyo Jeong .nchannels = 14 36945d9abdbSWeongyo Jeong }; 37045d9abdbSWeongyo Jeong 37145d9abdbSWeongyo Jeong static const struct bwn_channelinfo bwn_chantable_a = { 37245d9abdbSWeongyo Jeong .channels = { 37345d9abdbSWeongyo Jeong { 5170, 34, 30 }, { 5180, 36, 30 }, { 5190, 38, 30 }, 37445d9abdbSWeongyo Jeong { 5200, 40, 30 }, { 5210, 42, 30 }, { 5220, 44, 30 }, 37545d9abdbSWeongyo Jeong { 5230, 46, 30 }, { 5240, 48, 30 }, { 5260, 52, 30 }, 37645d9abdbSWeongyo Jeong { 5280, 56, 30 }, { 5300, 60, 30 }, { 5320, 64, 30 }, 37745d9abdbSWeongyo Jeong { 5500, 100, 30 }, { 5520, 104, 30 }, { 5540, 108, 30 }, 37845d9abdbSWeongyo Jeong { 5560, 112, 30 }, { 5580, 116, 30 }, { 5600, 120, 30 }, 37945d9abdbSWeongyo Jeong { 5620, 124, 30 }, { 5640, 128, 30 }, { 5660, 132, 30 }, 38045d9abdbSWeongyo Jeong { 5680, 136, 30 }, { 5700, 140, 30 }, { 5745, 149, 30 }, 38145d9abdbSWeongyo Jeong { 5765, 153, 30 }, { 5785, 157, 30 }, { 5805, 161, 30 }, 38245d9abdbSWeongyo Jeong { 5825, 165, 30 }, { 5920, 184, 30 }, { 5940, 188, 30 }, 38345d9abdbSWeongyo Jeong { 5960, 192, 30 }, { 5980, 196, 30 }, { 6000, 200, 30 }, 38445d9abdbSWeongyo Jeong { 6020, 204, 30 }, { 6040, 208, 30 }, { 6060, 212, 30 }, 38545d9abdbSWeongyo Jeong { 6080, 216, 30 } }, 38645d9abdbSWeongyo Jeong .nchannels = 37 38745d9abdbSWeongyo Jeong }; 38845d9abdbSWeongyo Jeong 38945d9abdbSWeongyo Jeong static const struct bwn_channelinfo bwn_chantable_n = { 39045d9abdbSWeongyo Jeong .channels = { 39145d9abdbSWeongyo Jeong { 5160, 32, 30 }, { 5170, 34, 30 }, { 5180, 36, 30 }, 39245d9abdbSWeongyo Jeong { 5190, 38, 30 }, { 5200, 40, 30 }, { 5210, 42, 30 }, 39345d9abdbSWeongyo Jeong { 5220, 44, 30 }, { 5230, 46, 30 }, { 5240, 48, 30 }, 39445d9abdbSWeongyo Jeong { 5250, 50, 30 }, { 5260, 52, 30 }, { 5270, 54, 30 }, 39545d9abdbSWeongyo Jeong { 5280, 56, 30 }, { 5290, 58, 30 }, { 5300, 60, 30 }, 39645d9abdbSWeongyo Jeong { 5310, 62, 30 }, { 5320, 64, 30 }, { 5330, 66, 30 }, 39745d9abdbSWeongyo Jeong { 5340, 68, 30 }, { 5350, 70, 30 }, { 5360, 72, 30 }, 39845d9abdbSWeongyo Jeong { 5370, 74, 30 }, { 5380, 76, 30 }, { 5390, 78, 30 }, 39945d9abdbSWeongyo Jeong { 5400, 80, 30 }, { 5410, 82, 30 }, { 5420, 84, 30 }, 40045d9abdbSWeongyo Jeong { 5430, 86, 30 }, { 5440, 88, 30 }, { 5450, 90, 30 }, 40145d9abdbSWeongyo Jeong { 5460, 92, 30 }, { 5470, 94, 30 }, { 5480, 96, 30 }, 40245d9abdbSWeongyo Jeong { 5490, 98, 30 }, { 5500, 100, 30 }, { 5510, 102, 30 }, 40345d9abdbSWeongyo Jeong { 5520, 104, 30 }, { 5530, 106, 30 }, { 5540, 108, 30 }, 40445d9abdbSWeongyo Jeong { 5550, 110, 30 }, { 5560, 112, 30 }, { 5570, 114, 30 }, 40545d9abdbSWeongyo Jeong { 5580, 116, 30 }, { 5590, 118, 30 }, { 5600, 120, 30 }, 40645d9abdbSWeongyo Jeong { 5610, 122, 30 }, { 5620, 124, 30 }, { 5630, 126, 30 }, 40745d9abdbSWeongyo Jeong { 5640, 128, 30 }, { 5650, 130, 30 }, { 5660, 132, 30 }, 40845d9abdbSWeongyo Jeong { 5670, 134, 30 }, { 5680, 136, 30 }, { 5690, 138, 30 }, 40945d9abdbSWeongyo Jeong { 5700, 140, 30 }, { 5710, 142, 30 }, { 5720, 144, 30 }, 41045d9abdbSWeongyo Jeong { 5725, 145, 30 }, { 5730, 146, 30 }, { 5735, 147, 30 }, 41145d9abdbSWeongyo Jeong { 5740, 148, 30 }, { 5745, 149, 30 }, { 5750, 150, 30 }, 41245d9abdbSWeongyo Jeong { 5755, 151, 30 }, { 5760, 152, 30 }, { 5765, 153, 30 }, 41345d9abdbSWeongyo Jeong { 5770, 154, 30 }, { 5775, 155, 30 }, { 5780, 156, 30 }, 41445d9abdbSWeongyo Jeong { 5785, 157, 30 }, { 5790, 158, 30 }, { 5795, 159, 30 }, 41545d9abdbSWeongyo Jeong { 5800, 160, 30 }, { 5805, 161, 30 }, { 5810, 162, 30 }, 41645d9abdbSWeongyo Jeong { 5815, 163, 30 }, { 5820, 164, 30 }, { 5825, 165, 30 }, 41745d9abdbSWeongyo Jeong { 5830, 166, 30 }, { 5840, 168, 30 }, { 5850, 170, 30 }, 41845d9abdbSWeongyo Jeong { 5860, 172, 30 }, { 5870, 174, 30 }, { 5880, 176, 30 }, 41945d9abdbSWeongyo Jeong { 5890, 178, 30 }, { 5900, 180, 30 }, { 5910, 182, 30 }, 42045d9abdbSWeongyo Jeong { 5920, 184, 30 }, { 5930, 186, 30 }, { 5940, 188, 30 }, 42145d9abdbSWeongyo Jeong { 5950, 190, 30 }, { 5960, 192, 30 }, { 5970, 194, 30 }, 42245d9abdbSWeongyo Jeong { 5980, 196, 30 }, { 5990, 198, 30 }, { 6000, 200, 30 }, 42345d9abdbSWeongyo Jeong { 6010, 202, 30 }, { 6020, 204, 30 }, { 6030, 206, 30 }, 42445d9abdbSWeongyo Jeong { 6040, 208, 30 }, { 6050, 210, 30 }, { 6060, 212, 30 }, 42545d9abdbSWeongyo Jeong { 6070, 214, 30 }, { 6080, 216, 30 }, { 6090, 218, 30 }, 42645d9abdbSWeongyo Jeong { 6100, 220, 30 }, { 6110, 222, 30 }, { 6120, 224, 30 }, 42745d9abdbSWeongyo Jeong { 6130, 226, 30 }, { 6140, 228, 30 } }, 42845d9abdbSWeongyo Jeong .nchannels = 110 42945d9abdbSWeongyo Jeong }; 43045d9abdbSWeongyo Jeong 43145d9abdbSWeongyo Jeong #define VENDOR_LED_ACT(vendor) \ 43245d9abdbSWeongyo Jeong { \ 43345d9abdbSWeongyo Jeong .vid = PCI_VENDOR_##vendor, \ 43445d9abdbSWeongyo Jeong .led_act = { BWN_VENDOR_LED_ACT_##vendor } \ 43545d9abdbSWeongyo Jeong } 43645d9abdbSWeongyo Jeong 43745d9abdbSWeongyo Jeong static const struct { 43845d9abdbSWeongyo Jeong uint16_t vid; 43945d9abdbSWeongyo Jeong uint8_t led_act[BWN_LED_MAX]; 44045d9abdbSWeongyo Jeong } bwn_vendor_led_act[] = { 44145d9abdbSWeongyo Jeong VENDOR_LED_ACT(COMPAQ), 44245d9abdbSWeongyo Jeong VENDOR_LED_ACT(ASUSTEK) 44345d9abdbSWeongyo Jeong }; 44445d9abdbSWeongyo Jeong 44545d9abdbSWeongyo Jeong static const uint8_t bwn_default_led_act[BWN_LED_MAX] = 44645d9abdbSWeongyo Jeong { BWN_VENDOR_LED_ACT_DEFAULT }; 44745d9abdbSWeongyo Jeong 44845d9abdbSWeongyo Jeong #undef VENDOR_LED_ACT 44945d9abdbSWeongyo Jeong 45045d9abdbSWeongyo Jeong static const struct { 45145d9abdbSWeongyo Jeong int on_dur; 45245d9abdbSWeongyo Jeong int off_dur; 45345d9abdbSWeongyo Jeong } bwn_led_duration[109] = { 45445d9abdbSWeongyo Jeong [0] = { 400, 100 }, 45545d9abdbSWeongyo Jeong [2] = { 150, 75 }, 45645d9abdbSWeongyo Jeong [4] = { 90, 45 }, 45745d9abdbSWeongyo Jeong [11] = { 66, 34 }, 45845d9abdbSWeongyo Jeong [12] = { 53, 26 }, 45945d9abdbSWeongyo Jeong [18] = { 42, 21 }, 46045d9abdbSWeongyo Jeong [22] = { 35, 17 }, 46145d9abdbSWeongyo Jeong [24] = { 32, 16 }, 46245d9abdbSWeongyo Jeong [36] = { 21, 10 }, 46345d9abdbSWeongyo Jeong [48] = { 16, 8 }, 46445d9abdbSWeongyo Jeong [72] = { 11, 5 }, 46545d9abdbSWeongyo Jeong [96] = { 9, 4 }, 46645d9abdbSWeongyo Jeong [108] = { 7, 3 } 46745d9abdbSWeongyo Jeong }; 46845d9abdbSWeongyo Jeong 46945d9abdbSWeongyo Jeong static const uint16_t bwn_wme_shm_offsets[] = { 47045d9abdbSWeongyo Jeong [0] = BWN_WME_BESTEFFORT, 47145d9abdbSWeongyo Jeong [1] = BWN_WME_BACKGROUND, 47245d9abdbSWeongyo Jeong [2] = BWN_WME_VOICE, 47345d9abdbSWeongyo Jeong [3] = BWN_WME_VIDEO, 47445d9abdbSWeongyo Jeong }; 47545d9abdbSWeongyo Jeong 47645d9abdbSWeongyo Jeong static const struct siba_devid bwn_devs[] = { 47745d9abdbSWeongyo Jeong SIBA_DEV(BROADCOM, 80211, 5, "Revision 5"), 47845d9abdbSWeongyo Jeong SIBA_DEV(BROADCOM, 80211, 6, "Revision 6"), 47945d9abdbSWeongyo Jeong SIBA_DEV(BROADCOM, 80211, 7, "Revision 7"), 48045d9abdbSWeongyo Jeong SIBA_DEV(BROADCOM, 80211, 9, "Revision 9"), 48145d9abdbSWeongyo Jeong SIBA_DEV(BROADCOM, 80211, 10, "Revision 10"), 48245d9abdbSWeongyo Jeong SIBA_DEV(BROADCOM, 80211, 11, "Revision 11"), 48345d9abdbSWeongyo Jeong SIBA_DEV(BROADCOM, 80211, 13, "Revision 13"), 48445d9abdbSWeongyo Jeong SIBA_DEV(BROADCOM, 80211, 15, "Revision 15"), 48545d9abdbSWeongyo Jeong SIBA_DEV(BROADCOM, 80211, 16, "Revision 16") 48645d9abdbSWeongyo Jeong }; 48745d9abdbSWeongyo Jeong 48845d9abdbSWeongyo Jeong static int 48945d9abdbSWeongyo Jeong bwn_probe(device_t dev) 49045d9abdbSWeongyo Jeong { 49145d9abdbSWeongyo Jeong int i; 49245d9abdbSWeongyo Jeong 49373a1170aSPedro F. Giffuni for (i = 0; i < nitems(bwn_devs); i++) { 494b9b64aa5SWeongyo Jeong if (siba_get_vendor(dev) == bwn_devs[i].sd_vendor && 495b9b64aa5SWeongyo Jeong siba_get_device(dev) == bwn_devs[i].sd_device && 496b9b64aa5SWeongyo Jeong siba_get_revid(dev) == bwn_devs[i].sd_rev) 49745d9abdbSWeongyo Jeong return (BUS_PROBE_DEFAULT); 49845d9abdbSWeongyo Jeong } 49945d9abdbSWeongyo Jeong 50045d9abdbSWeongyo Jeong return (ENXIO); 50145d9abdbSWeongyo Jeong } 50245d9abdbSWeongyo Jeong 50345d9abdbSWeongyo Jeong static int 50445d9abdbSWeongyo Jeong bwn_attach(device_t dev) 50545d9abdbSWeongyo Jeong { 50645d9abdbSWeongyo Jeong struct bwn_mac *mac; 50745d9abdbSWeongyo Jeong struct bwn_softc *sc = device_get_softc(dev); 50845d9abdbSWeongyo Jeong int error, i, msic, reg; 50945d9abdbSWeongyo Jeong 51045d9abdbSWeongyo Jeong sc->sc_dev = dev; 51145d9abdbSWeongyo Jeong #ifdef BWN_DEBUG 51245d9abdbSWeongyo Jeong sc->sc_debug = bwn_debug; 51345d9abdbSWeongyo Jeong #endif 51445d9abdbSWeongyo Jeong 51545d9abdbSWeongyo Jeong if ((sc->sc_flags & BWN_FLAG_ATTACHED) == 0) { 5167a79cebfSGleb Smirnoff bwn_attach_pre(sc); 517b9b64aa5SWeongyo Jeong bwn_sprom_bugfixes(dev); 51845d9abdbSWeongyo Jeong sc->sc_flags |= BWN_FLAG_ATTACHED; 51945d9abdbSWeongyo Jeong } 52045d9abdbSWeongyo Jeong 52145d9abdbSWeongyo Jeong if (!TAILQ_EMPTY(&sc->sc_maclist)) { 522b9b64aa5SWeongyo Jeong if (siba_get_pci_device(dev) != 0x4313 && 523b9b64aa5SWeongyo Jeong siba_get_pci_device(dev) != 0x431a && 524b9b64aa5SWeongyo Jeong siba_get_pci_device(dev) != 0x4321) { 52545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 52645d9abdbSWeongyo Jeong "skip 802.11 cores\n"); 52745d9abdbSWeongyo Jeong return (ENODEV); 52845d9abdbSWeongyo Jeong } 52945d9abdbSWeongyo Jeong } 53045d9abdbSWeongyo Jeong 5317a79cebfSGleb Smirnoff mac = malloc(sizeof(*mac), M_DEVBUF, M_WAITOK | M_ZERO); 53245d9abdbSWeongyo Jeong mac->mac_sc = sc; 53345d9abdbSWeongyo Jeong mac->mac_status = BWN_MAC_STATUS_UNINIT; 53445d9abdbSWeongyo Jeong if (bwn_bfp != 0) 53545d9abdbSWeongyo Jeong mac->mac_flags |= BWN_MAC_FLAG_BADFRAME_PREEMP; 53645d9abdbSWeongyo Jeong 53745d9abdbSWeongyo Jeong TASK_INIT(&mac->mac_hwreset, 0, bwn_hwreset, mac); 53845d9abdbSWeongyo Jeong TASK_INIT(&mac->mac_intrtask, 0, bwn_intrtask, mac); 53945d9abdbSWeongyo Jeong TASK_INIT(&mac->mac_txpower, 0, bwn_txpwr, mac); 54045d9abdbSWeongyo Jeong 54145d9abdbSWeongyo Jeong error = bwn_attach_core(mac); 54245d9abdbSWeongyo Jeong if (error) 54345d9abdbSWeongyo Jeong goto fail0; 54445d9abdbSWeongyo Jeong bwn_led_attach(mac); 54545d9abdbSWeongyo Jeong 54645d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "WLAN (chipid %#x rev %u) " 54745d9abdbSWeongyo Jeong "PHY (analog %d type %d rev %d) RADIO (manuf %#x ver %#x rev %d)\n", 548b9b64aa5SWeongyo Jeong siba_get_chipid(sc->sc_dev), siba_get_revid(sc->sc_dev), 54945d9abdbSWeongyo Jeong mac->mac_phy.analog, mac->mac_phy.type, mac->mac_phy.rev, 55045d9abdbSWeongyo Jeong mac->mac_phy.rf_manuf, mac->mac_phy.rf_ver, 55145d9abdbSWeongyo Jeong mac->mac_phy.rf_rev); 55245d9abdbSWeongyo Jeong if (mac->mac_flags & BWN_MAC_FLAG_DMA) 55345d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "DMA (%d bits)\n", 55445d9abdbSWeongyo Jeong mac->mac_method.dma.dmatype); 55545d9abdbSWeongyo Jeong else 55645d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "PIO\n"); 55745d9abdbSWeongyo Jeong 55845d9abdbSWeongyo Jeong /* 55945d9abdbSWeongyo Jeong * setup PCI resources and interrupt. 56045d9abdbSWeongyo Jeong */ 5613b0a4aefSJohn Baldwin if (pci_find_cap(dev, PCIY_EXPRESS, ®) == 0) { 56245d9abdbSWeongyo Jeong msic = pci_msi_count(dev); 56345d9abdbSWeongyo Jeong if (bootverbose) 56445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "MSI count : %d\n", msic); 56545d9abdbSWeongyo Jeong } else 56645d9abdbSWeongyo Jeong msic = 0; 56745d9abdbSWeongyo Jeong 56845d9abdbSWeongyo Jeong mac->mac_intr_spec = bwn_res_spec_legacy; 56945d9abdbSWeongyo Jeong if (msic == BWN_MSI_MESSAGES && bwn_msi_disable == 0) { 57045d9abdbSWeongyo Jeong if (pci_alloc_msi(dev, &msic) == 0) { 57145d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 57245d9abdbSWeongyo Jeong "Using %d MSI messages\n", msic); 57345d9abdbSWeongyo Jeong mac->mac_intr_spec = bwn_res_spec_msi; 57445d9abdbSWeongyo Jeong mac->mac_msi = 1; 57545d9abdbSWeongyo Jeong } 57645d9abdbSWeongyo Jeong } 57745d9abdbSWeongyo Jeong 57845d9abdbSWeongyo Jeong error = bus_alloc_resources(dev, mac->mac_intr_spec, 57945d9abdbSWeongyo Jeong mac->mac_res_irq); 58045d9abdbSWeongyo Jeong if (error) { 58145d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 58245d9abdbSWeongyo Jeong "couldn't allocate IRQ resources (%d)\n", error); 58345d9abdbSWeongyo Jeong goto fail1; 58445d9abdbSWeongyo Jeong } 58545d9abdbSWeongyo Jeong 58645d9abdbSWeongyo Jeong if (mac->mac_msi == 0) 58745d9abdbSWeongyo Jeong error = bus_setup_intr(dev, mac->mac_res_irq[0], 58845d9abdbSWeongyo Jeong INTR_TYPE_NET | INTR_MPSAFE, bwn_intr, NULL, mac, 58945d9abdbSWeongyo Jeong &mac->mac_intrhand[0]); 59045d9abdbSWeongyo Jeong else { 59145d9abdbSWeongyo Jeong for (i = 0; i < BWN_MSI_MESSAGES; i++) { 59245d9abdbSWeongyo Jeong error = bus_setup_intr(dev, mac->mac_res_irq[i], 59345d9abdbSWeongyo Jeong INTR_TYPE_NET | INTR_MPSAFE, bwn_intr, NULL, mac, 59445d9abdbSWeongyo Jeong &mac->mac_intrhand[i]); 59545d9abdbSWeongyo Jeong if (error != 0) { 59645d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 59745d9abdbSWeongyo Jeong "couldn't setup interrupt (%d)\n", error); 59845d9abdbSWeongyo Jeong break; 59945d9abdbSWeongyo Jeong } 60045d9abdbSWeongyo Jeong } 60145d9abdbSWeongyo Jeong } 60245d9abdbSWeongyo Jeong 60345d9abdbSWeongyo Jeong TAILQ_INSERT_TAIL(&sc->sc_maclist, mac, mac_list); 60445d9abdbSWeongyo Jeong 60545d9abdbSWeongyo Jeong /* 60645d9abdbSWeongyo Jeong * calls attach-post routine 60745d9abdbSWeongyo Jeong */ 60845d9abdbSWeongyo Jeong if ((sc->sc_flags & BWN_FLAG_ATTACHED) != 0) 60945d9abdbSWeongyo Jeong bwn_attach_post(sc); 61045d9abdbSWeongyo Jeong 61145d9abdbSWeongyo Jeong return (0); 61245d9abdbSWeongyo Jeong fail1: 61345d9abdbSWeongyo Jeong if (msic == BWN_MSI_MESSAGES && bwn_msi_disable == 0) 61445d9abdbSWeongyo Jeong pci_release_msi(dev); 61545d9abdbSWeongyo Jeong fail0: 61645d9abdbSWeongyo Jeong free(mac, M_DEVBUF); 61745d9abdbSWeongyo Jeong return (error); 61845d9abdbSWeongyo Jeong } 61945d9abdbSWeongyo Jeong 62045d9abdbSWeongyo Jeong static int 62145d9abdbSWeongyo Jeong bwn_is_valid_ether_addr(uint8_t *addr) 62245d9abdbSWeongyo Jeong { 62345d9abdbSWeongyo Jeong char zero_addr[6] = { 0, 0, 0, 0, 0, 0 }; 62445d9abdbSWeongyo Jeong 62545d9abdbSWeongyo Jeong if ((addr[0] & 1) || (!bcmp(addr, zero_addr, ETHER_ADDR_LEN))) 62645d9abdbSWeongyo Jeong return (FALSE); 62745d9abdbSWeongyo Jeong 62845d9abdbSWeongyo Jeong return (TRUE); 62945d9abdbSWeongyo Jeong } 63045d9abdbSWeongyo Jeong 63145d9abdbSWeongyo Jeong static int 63245d9abdbSWeongyo Jeong bwn_attach_post(struct bwn_softc *sc) 63345d9abdbSWeongyo Jeong { 6347a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 63545d9abdbSWeongyo Jeong 63659686fe9SGleb Smirnoff ic->ic_softc = sc; 637c8550c02SGleb Smirnoff ic->ic_name = device_get_nameunit(sc->sc_dev); 63845d9abdbSWeongyo Jeong /* XXX not right but it's not used anywhere important */ 63945d9abdbSWeongyo Jeong ic->ic_phytype = IEEE80211_T_OFDM; 64045d9abdbSWeongyo Jeong ic->ic_opmode = IEEE80211_M_STA; 64145d9abdbSWeongyo Jeong ic->ic_caps = 64245d9abdbSWeongyo Jeong IEEE80211_C_STA /* station mode supported */ 64345d9abdbSWeongyo Jeong | IEEE80211_C_MONITOR /* monitor mode */ 6447478ae97SWeongyo Jeong | IEEE80211_C_AHDEMO /* adhoc demo mode */ 64545d9abdbSWeongyo Jeong | IEEE80211_C_SHPREAMBLE /* short preamble supported */ 64645d9abdbSWeongyo Jeong | IEEE80211_C_SHSLOT /* short slot time supported */ 64745d9abdbSWeongyo Jeong | IEEE80211_C_WME /* WME/WMM supported */ 64845d9abdbSWeongyo Jeong | IEEE80211_C_WPA /* capable of WPA1+WPA2 */ 64945d9abdbSWeongyo Jeong | IEEE80211_C_BGSCAN /* capable of bg scanning */ 65045d9abdbSWeongyo Jeong | IEEE80211_C_TXPMGT /* capable of txpow mgt */ 65145d9abdbSWeongyo Jeong ; 65245d9abdbSWeongyo Jeong 6532fe9b8d4SWeongyo Jeong ic->ic_flags_ext |= IEEE80211_FEXT_SWBMISS; /* s/w bmiss */ 6542fe9b8d4SWeongyo Jeong 6557a79cebfSGleb Smirnoff IEEE80211_ADDR_COPY(ic->ic_macaddr, 656b9b64aa5SWeongyo Jeong bwn_is_valid_ether_addr(siba_sprom_get_mac_80211a(sc->sc_dev)) ? 657b9b64aa5SWeongyo Jeong siba_sprom_get_mac_80211a(sc->sc_dev) : 658b9b64aa5SWeongyo Jeong siba_sprom_get_mac_80211bg(sc->sc_dev)); 65945d9abdbSWeongyo Jeong 6607a79cebfSGleb Smirnoff /* call MI attach routine. */ 6617a79cebfSGleb Smirnoff ieee80211_ifattach(ic); 6627a79cebfSGleb Smirnoff 66345d9abdbSWeongyo Jeong ic->ic_headroom = sizeof(struct bwn_txhdr); 66445d9abdbSWeongyo Jeong 66545d9abdbSWeongyo Jeong /* override default methods */ 66645d9abdbSWeongyo Jeong ic->ic_raw_xmit = bwn_raw_xmit; 66745d9abdbSWeongyo Jeong ic->ic_updateslot = bwn_updateslot; 66845d9abdbSWeongyo Jeong ic->ic_update_promisc = bwn_update_promisc; 66945d9abdbSWeongyo Jeong ic->ic_wme.wme_update = bwn_wme_update; 67045d9abdbSWeongyo Jeong ic->ic_scan_start = bwn_scan_start; 67145d9abdbSWeongyo Jeong ic->ic_scan_end = bwn_scan_end; 67245d9abdbSWeongyo Jeong ic->ic_set_channel = bwn_set_channel; 67345d9abdbSWeongyo Jeong ic->ic_vap_create = bwn_vap_create; 67445d9abdbSWeongyo Jeong ic->ic_vap_delete = bwn_vap_delete; 6757a79cebfSGleb Smirnoff ic->ic_transmit = bwn_transmit; 6767a79cebfSGleb Smirnoff ic->ic_parent = bwn_parent; 67745d9abdbSWeongyo Jeong 67845d9abdbSWeongyo Jeong ieee80211_radiotap_attach(ic, 67945d9abdbSWeongyo Jeong &sc->sc_tx_th.wt_ihdr, sizeof(sc->sc_tx_th), 68045d9abdbSWeongyo Jeong BWN_TX_RADIOTAP_PRESENT, 68145d9abdbSWeongyo Jeong &sc->sc_rx_th.wr_ihdr, sizeof(sc->sc_rx_th), 68245d9abdbSWeongyo Jeong BWN_RX_RADIOTAP_PRESENT); 68345d9abdbSWeongyo Jeong 684d2ee7771SWeongyo Jeong bwn_sysctl_node(sc); 68545d9abdbSWeongyo Jeong 68645d9abdbSWeongyo Jeong if (bootverbose) 68745d9abdbSWeongyo Jeong ieee80211_announce(ic); 68845d9abdbSWeongyo Jeong return (0); 68945d9abdbSWeongyo Jeong } 69045d9abdbSWeongyo Jeong 69145d9abdbSWeongyo Jeong static void 69245d9abdbSWeongyo Jeong bwn_phy_detach(struct bwn_mac *mac) 69345d9abdbSWeongyo Jeong { 69445d9abdbSWeongyo Jeong 69545d9abdbSWeongyo Jeong if (mac->mac_phy.detach != NULL) 69645d9abdbSWeongyo Jeong mac->mac_phy.detach(mac); 69745d9abdbSWeongyo Jeong } 69845d9abdbSWeongyo Jeong 69945d9abdbSWeongyo Jeong static int 70045d9abdbSWeongyo Jeong bwn_detach(device_t dev) 70145d9abdbSWeongyo Jeong { 70245d9abdbSWeongyo Jeong struct bwn_softc *sc = device_get_softc(dev); 70345d9abdbSWeongyo Jeong struct bwn_mac *mac = sc->sc_curmac; 7047a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 70545d9abdbSWeongyo Jeong int i; 70645d9abdbSWeongyo Jeong 70745d9abdbSWeongyo Jeong sc->sc_flags |= BWN_FLAG_INVALID; 70845d9abdbSWeongyo Jeong 70945d9abdbSWeongyo Jeong if (device_is_attached(sc->sc_dev)) { 7107a79cebfSGleb Smirnoff BWN_LOCK(sc); 7117a79cebfSGleb Smirnoff bwn_stop(sc); 7127a79cebfSGleb Smirnoff BWN_UNLOCK(sc); 71345d9abdbSWeongyo Jeong bwn_dma_free(mac); 71445d9abdbSWeongyo Jeong callout_drain(&sc->sc_led_blink_ch); 71545d9abdbSWeongyo Jeong callout_drain(&sc->sc_rfswitch_ch); 71645d9abdbSWeongyo Jeong callout_drain(&sc->sc_task_ch); 71745d9abdbSWeongyo Jeong callout_drain(&sc->sc_watchdog_ch); 71845d9abdbSWeongyo Jeong bwn_phy_detach(mac); 71945d9abdbSWeongyo Jeong ieee80211_draintask(ic, &mac->mac_hwreset); 72045d9abdbSWeongyo Jeong ieee80211_draintask(ic, &mac->mac_txpower); 72145d9abdbSWeongyo Jeong ieee80211_ifdetach(ic); 72245d9abdbSWeongyo Jeong } 72345d9abdbSWeongyo Jeong taskqueue_drain(sc->sc_tq, &mac->mac_intrtask); 72445d9abdbSWeongyo Jeong taskqueue_free(sc->sc_tq); 72545d9abdbSWeongyo Jeong 72645d9abdbSWeongyo Jeong for (i = 0; i < BWN_MSI_MESSAGES; i++) { 72745d9abdbSWeongyo Jeong if (mac->mac_intrhand[i] != NULL) { 72845d9abdbSWeongyo Jeong bus_teardown_intr(dev, mac->mac_res_irq[i], 72945d9abdbSWeongyo Jeong mac->mac_intrhand[i]); 73045d9abdbSWeongyo Jeong mac->mac_intrhand[i] = NULL; 73145d9abdbSWeongyo Jeong } 73245d9abdbSWeongyo Jeong } 73345d9abdbSWeongyo Jeong bus_release_resources(dev, mac->mac_intr_spec, mac->mac_res_irq); 73445d9abdbSWeongyo Jeong if (mac->mac_msi != 0) 73545d9abdbSWeongyo Jeong pci_release_msi(dev); 7367a79cebfSGleb Smirnoff mbufq_drain(&sc->sc_snd); 73745d9abdbSWeongyo Jeong BWN_LOCK_DESTROY(sc); 73845d9abdbSWeongyo Jeong return (0); 73945d9abdbSWeongyo Jeong } 74045d9abdbSWeongyo Jeong 7417a79cebfSGleb Smirnoff static void 74245d9abdbSWeongyo Jeong bwn_attach_pre(struct bwn_softc *sc) 74345d9abdbSWeongyo Jeong { 74445d9abdbSWeongyo Jeong 74545d9abdbSWeongyo Jeong BWN_LOCK_INIT(sc); 74645d9abdbSWeongyo Jeong TAILQ_INIT(&sc->sc_maclist); 74745d9abdbSWeongyo Jeong callout_init_mtx(&sc->sc_rfswitch_ch, &sc->sc_mtx, 0); 74845d9abdbSWeongyo Jeong callout_init_mtx(&sc->sc_task_ch, &sc->sc_mtx, 0); 74945d9abdbSWeongyo Jeong callout_init_mtx(&sc->sc_watchdog_ch, &sc->sc_mtx, 0); 7507a79cebfSGleb Smirnoff mbufq_init(&sc->sc_snd, ifqmaxlen); 75145d9abdbSWeongyo Jeong sc->sc_tq = taskqueue_create_fast("bwn_taskq", M_NOWAIT, 75245d9abdbSWeongyo Jeong taskqueue_thread_enqueue, &sc->sc_tq); 75345d9abdbSWeongyo Jeong taskqueue_start_threads(&sc->sc_tq, 1, PI_NET, 75445d9abdbSWeongyo Jeong "%s taskq", device_get_nameunit(sc->sc_dev)); 75545d9abdbSWeongyo Jeong } 75645d9abdbSWeongyo Jeong 75745d9abdbSWeongyo Jeong static void 758b9b64aa5SWeongyo Jeong bwn_sprom_bugfixes(device_t dev) 75945d9abdbSWeongyo Jeong { 76045d9abdbSWeongyo Jeong #define BWN_ISDEV(_vendor, _device, _subvendor, _subdevice) \ 761b9b64aa5SWeongyo Jeong ((siba_get_pci_vendor(dev) == PCI_VENDOR_##_vendor) && \ 762b9b64aa5SWeongyo Jeong (siba_get_pci_device(dev) == _device) && \ 763b9b64aa5SWeongyo Jeong (siba_get_pci_subvendor(dev) == PCI_VENDOR_##_subvendor) && \ 764b9b64aa5SWeongyo Jeong (siba_get_pci_subdevice(dev) == _subdevice)) 76545d9abdbSWeongyo Jeong 766b9b64aa5SWeongyo Jeong if (siba_get_pci_subvendor(dev) == PCI_VENDOR_APPLE && 767b9b64aa5SWeongyo Jeong siba_get_pci_subdevice(dev) == 0x4e && 768b9b64aa5SWeongyo Jeong siba_get_pci_revid(dev) > 0x40) 769b9b64aa5SWeongyo Jeong siba_sprom_set_bf_lo(dev, 770b9b64aa5SWeongyo Jeong siba_sprom_get_bf_lo(dev) | BWN_BFL_PACTRL); 771b9b64aa5SWeongyo Jeong if (siba_get_pci_subvendor(dev) == SIBA_BOARDVENDOR_DELL && 772b9b64aa5SWeongyo Jeong siba_get_chipid(dev) == 0x4301 && siba_get_pci_revid(dev) == 0x74) 773b9b64aa5SWeongyo Jeong siba_sprom_set_bf_lo(dev, 774b9b64aa5SWeongyo Jeong siba_sprom_get_bf_lo(dev) | BWN_BFL_BTCOEXIST); 775b9b64aa5SWeongyo Jeong if (siba_get_type(dev) == SIBA_TYPE_PCI) { 77645d9abdbSWeongyo Jeong if (BWN_ISDEV(BROADCOM, 0x4318, ASUSTEK, 0x100f) || 77745d9abdbSWeongyo Jeong BWN_ISDEV(BROADCOM, 0x4320, DELL, 0x0003) || 77845d9abdbSWeongyo Jeong BWN_ISDEV(BROADCOM, 0x4320, HP, 0x12f8) || 77945d9abdbSWeongyo Jeong BWN_ISDEV(BROADCOM, 0x4320, LINKSYS, 0x0013) || 78045d9abdbSWeongyo Jeong BWN_ISDEV(BROADCOM, 0x4320, LINKSYS, 0x0014) || 78145d9abdbSWeongyo Jeong BWN_ISDEV(BROADCOM, 0x4320, LINKSYS, 0x0015) || 78245d9abdbSWeongyo Jeong BWN_ISDEV(BROADCOM, 0x4320, MOTOROLA, 0x7010)) 783b9b64aa5SWeongyo Jeong siba_sprom_set_bf_lo(dev, 784b9b64aa5SWeongyo Jeong siba_sprom_get_bf_lo(dev) & ~BWN_BFL_BTCOEXIST); 78545d9abdbSWeongyo Jeong } 78645d9abdbSWeongyo Jeong #undef BWN_ISDEV 78745d9abdbSWeongyo Jeong } 78845d9abdbSWeongyo Jeong 78945d9abdbSWeongyo Jeong static void 7907a79cebfSGleb Smirnoff bwn_parent(struct ieee80211com *ic) 79145d9abdbSWeongyo Jeong { 7927a79cebfSGleb Smirnoff struct bwn_softc *sc = ic->ic_softc; 7937a79cebfSGleb Smirnoff int startall = 0; 794ba2c1fbcSAdrian Chadd 795ba2c1fbcSAdrian Chadd BWN_LOCK(sc); 7967a79cebfSGleb Smirnoff if (ic->ic_nrunning > 0) { 7977a79cebfSGleb Smirnoff if ((sc->sc_flags & BWN_FLAG_RUNNING) == 0) { 7987a79cebfSGleb Smirnoff bwn_init(sc); 7997a79cebfSGleb Smirnoff startall = 1; 8007a79cebfSGleb Smirnoff } else 8017a79cebfSGleb Smirnoff bwn_update_promisc(ic); 8027a79cebfSGleb Smirnoff } else if (sc->sc_flags & BWN_FLAG_RUNNING) 8037a79cebfSGleb Smirnoff bwn_stop(sc); 804ba2c1fbcSAdrian Chadd BWN_UNLOCK(sc); 8057a79cebfSGleb Smirnoff 8067a79cebfSGleb Smirnoff if (startall) 8077a79cebfSGleb Smirnoff ieee80211_start_all(ic); 8087a79cebfSGleb Smirnoff } 8097a79cebfSGleb Smirnoff 8107a79cebfSGleb Smirnoff static int 8117a79cebfSGleb Smirnoff bwn_transmit(struct ieee80211com *ic, struct mbuf *m) 8127a79cebfSGleb Smirnoff { 8137a79cebfSGleb Smirnoff struct bwn_softc *sc = ic->ic_softc; 8147a79cebfSGleb Smirnoff int error; 8157a79cebfSGleb Smirnoff 8167a79cebfSGleb Smirnoff BWN_LOCK(sc); 8177a79cebfSGleb Smirnoff if ((sc->sc_flags & BWN_FLAG_RUNNING) == 0) { 8187a79cebfSGleb Smirnoff BWN_UNLOCK(sc); 8197a79cebfSGleb Smirnoff return (ENXIO); 8207a79cebfSGleb Smirnoff } 8217a79cebfSGleb Smirnoff error = mbufq_enqueue(&sc->sc_snd, m); 8227a79cebfSGleb Smirnoff if (error) { 8237a79cebfSGleb Smirnoff BWN_UNLOCK(sc); 8247a79cebfSGleb Smirnoff return (error); 8257a79cebfSGleb Smirnoff } 8267a79cebfSGleb Smirnoff bwn_start(sc); 8277a79cebfSGleb Smirnoff BWN_UNLOCK(sc); 8287a79cebfSGleb Smirnoff return (0); 829ba2c1fbcSAdrian Chadd } 830ba2c1fbcSAdrian Chadd 831ba2c1fbcSAdrian Chadd static void 8327a79cebfSGleb Smirnoff bwn_start(struct bwn_softc *sc) 833ba2c1fbcSAdrian Chadd { 83445d9abdbSWeongyo Jeong struct bwn_mac *mac = sc->sc_curmac; 83545d9abdbSWeongyo Jeong struct ieee80211_frame *wh; 83645d9abdbSWeongyo Jeong struct ieee80211_node *ni; 83745d9abdbSWeongyo Jeong struct ieee80211_key *k; 83845d9abdbSWeongyo Jeong struct mbuf *m; 83945d9abdbSWeongyo Jeong 84045d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 84145d9abdbSWeongyo Jeong 8427a79cebfSGleb Smirnoff if ((sc->sc_flags & BWN_FLAG_RUNNING) == 0 || mac == NULL || 84345d9abdbSWeongyo Jeong mac->mac_status < BWN_MAC_STATUS_STARTED) 84445d9abdbSWeongyo Jeong return; 84545d9abdbSWeongyo Jeong 8467a79cebfSGleb Smirnoff while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) { 84745d9abdbSWeongyo Jeong if (bwn_tx_isfull(sc, m)) 84845d9abdbSWeongyo Jeong break; 84945d9abdbSWeongyo Jeong ni = (struct ieee80211_node *) m->m_pkthdr.rcvif; 85045d9abdbSWeongyo Jeong if (ni == NULL) { 85145d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "unexpected NULL ni\n"); 85245d9abdbSWeongyo Jeong m_freem(m); 8537a79cebfSGleb Smirnoff counter_u64_add(sc->sc_ic.ic_oerrors, 1); 85445d9abdbSWeongyo Jeong continue; 85545d9abdbSWeongyo Jeong } 85645d9abdbSWeongyo Jeong wh = mtod(m, struct ieee80211_frame *); 8575945b5f5SKevin Lo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 85845d9abdbSWeongyo Jeong k = ieee80211_crypto_encap(ni, m); 85945d9abdbSWeongyo Jeong if (k == NULL) { 8607a79cebfSGleb Smirnoff if_inc_counter(ni->ni_vap->iv_ifp, 8617a79cebfSGleb Smirnoff IFCOUNTER_OERRORS, 1); 86245d9abdbSWeongyo Jeong ieee80211_free_node(ni); 86345d9abdbSWeongyo Jeong m_freem(m); 86445d9abdbSWeongyo Jeong continue; 86545d9abdbSWeongyo Jeong } 86645d9abdbSWeongyo Jeong } 86745d9abdbSWeongyo Jeong wh = NULL; /* Catch any invalid use */ 86845d9abdbSWeongyo Jeong if (bwn_tx_start(sc, ni, m) != 0) { 8697a79cebfSGleb Smirnoff if (ni != NULL) { 8707a79cebfSGleb Smirnoff if_inc_counter(ni->ni_vap->iv_ifp, 8717a79cebfSGleb Smirnoff IFCOUNTER_OERRORS, 1); 87245d9abdbSWeongyo Jeong ieee80211_free_node(ni); 8737a79cebfSGleb Smirnoff } 87445d9abdbSWeongyo Jeong continue; 87545d9abdbSWeongyo Jeong } 87645d9abdbSWeongyo Jeong sc->sc_watchdog_timer = 5; 87745d9abdbSWeongyo Jeong } 87845d9abdbSWeongyo Jeong } 87945d9abdbSWeongyo Jeong 88045d9abdbSWeongyo Jeong static int 88145d9abdbSWeongyo Jeong bwn_tx_isfull(struct bwn_softc *sc, struct mbuf *m) 88245d9abdbSWeongyo Jeong { 88345d9abdbSWeongyo Jeong struct bwn_dma_ring *dr; 88445d9abdbSWeongyo Jeong struct bwn_mac *mac = sc->sc_curmac; 88545d9abdbSWeongyo Jeong struct bwn_pio_txqueue *tq; 88645d9abdbSWeongyo Jeong int pktlen = roundup(m->m_pkthdr.len + BWN_HDRSIZE(mac), 4); 88745d9abdbSWeongyo Jeong 88845d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 88945d9abdbSWeongyo Jeong 89045d9abdbSWeongyo Jeong if (mac->mac_flags & BWN_MAC_FLAG_DMA) { 89145d9abdbSWeongyo Jeong dr = bwn_dma_select(mac, M_WME_GETAC(m)); 89245d9abdbSWeongyo Jeong if (dr->dr_stop == 1 || 89345d9abdbSWeongyo Jeong bwn_dma_freeslot(dr) < BWN_TX_SLOTS_PER_FRAME) { 89445d9abdbSWeongyo Jeong dr->dr_stop = 1; 89545d9abdbSWeongyo Jeong goto full; 89645d9abdbSWeongyo Jeong } 89745d9abdbSWeongyo Jeong } else { 89845d9abdbSWeongyo Jeong tq = bwn_pio_select(mac, M_WME_GETAC(m)); 89945d9abdbSWeongyo Jeong if (tq->tq_free == 0 || pktlen > tq->tq_size || 9007a79cebfSGleb Smirnoff pktlen > (tq->tq_size - tq->tq_used)) 90145d9abdbSWeongyo Jeong goto full; 90245d9abdbSWeongyo Jeong } 90345d9abdbSWeongyo Jeong return (0); 90445d9abdbSWeongyo Jeong full: 9057a79cebfSGleb Smirnoff mbufq_prepend(&sc->sc_snd, m); 90645d9abdbSWeongyo Jeong return (1); 90745d9abdbSWeongyo Jeong } 90845d9abdbSWeongyo Jeong 90945d9abdbSWeongyo Jeong static int 91045d9abdbSWeongyo Jeong bwn_tx_start(struct bwn_softc *sc, struct ieee80211_node *ni, struct mbuf *m) 91145d9abdbSWeongyo Jeong { 91245d9abdbSWeongyo Jeong struct bwn_mac *mac = sc->sc_curmac; 91345d9abdbSWeongyo Jeong int error; 91445d9abdbSWeongyo Jeong 91545d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 91645d9abdbSWeongyo Jeong 91745d9abdbSWeongyo Jeong if (m->m_pkthdr.len < IEEE80211_MIN_LEN || mac == NULL) { 91845d9abdbSWeongyo Jeong m_freem(m); 91945d9abdbSWeongyo Jeong return (ENXIO); 92045d9abdbSWeongyo Jeong } 92145d9abdbSWeongyo Jeong 92245d9abdbSWeongyo Jeong error = (mac->mac_flags & BWN_MAC_FLAG_DMA) ? 92345d9abdbSWeongyo Jeong bwn_dma_tx_start(mac, ni, m) : bwn_pio_tx_start(mac, ni, m); 92445d9abdbSWeongyo Jeong if (error) { 92545d9abdbSWeongyo Jeong m_freem(m); 92645d9abdbSWeongyo Jeong return (error); 92745d9abdbSWeongyo Jeong } 92845d9abdbSWeongyo Jeong return (0); 92945d9abdbSWeongyo Jeong } 93045d9abdbSWeongyo Jeong 93145d9abdbSWeongyo Jeong static int 93245d9abdbSWeongyo Jeong bwn_pio_tx_start(struct bwn_mac *mac, struct ieee80211_node *ni, struct mbuf *m) 93345d9abdbSWeongyo Jeong { 93445d9abdbSWeongyo Jeong struct bwn_pio_txpkt *tp; 93545d9abdbSWeongyo Jeong struct bwn_pio_txqueue *tq = bwn_pio_select(mac, M_WME_GETAC(m)); 93645d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 93745d9abdbSWeongyo Jeong struct bwn_txhdr txhdr; 93845d9abdbSWeongyo Jeong struct mbuf *m_new; 93945d9abdbSWeongyo Jeong uint32_t ctl32; 94045d9abdbSWeongyo Jeong int error; 94145d9abdbSWeongyo Jeong uint16_t ctl16; 94245d9abdbSWeongyo Jeong 94345d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 94445d9abdbSWeongyo Jeong 94545d9abdbSWeongyo Jeong /* XXX TODO send packets after DTIM */ 94645d9abdbSWeongyo Jeong 94745d9abdbSWeongyo Jeong KASSERT(!TAILQ_EMPTY(&tq->tq_pktlist), ("%s: fail", __func__)); 94845d9abdbSWeongyo Jeong tp = TAILQ_FIRST(&tq->tq_pktlist); 94945d9abdbSWeongyo Jeong tp->tp_ni = ni; 95045d9abdbSWeongyo Jeong tp->tp_m = m; 95145d9abdbSWeongyo Jeong 95245d9abdbSWeongyo Jeong error = bwn_set_txhdr(mac, ni, m, &txhdr, BWN_PIO_COOKIE(tq, tp)); 95345d9abdbSWeongyo Jeong if (error) { 95445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "tx fail\n"); 95545d9abdbSWeongyo Jeong return (error); 95645d9abdbSWeongyo Jeong } 95745d9abdbSWeongyo Jeong 95845d9abdbSWeongyo Jeong TAILQ_REMOVE(&tq->tq_pktlist, tp, tp_list); 95945d9abdbSWeongyo Jeong tq->tq_used += roundup(m->m_pkthdr.len + BWN_HDRSIZE(mac), 4); 96045d9abdbSWeongyo Jeong tq->tq_free--; 96145d9abdbSWeongyo Jeong 962b9b64aa5SWeongyo Jeong if (siba_get_revid(sc->sc_dev) >= 8) { 96345d9abdbSWeongyo Jeong /* 96445d9abdbSWeongyo Jeong * XXX please removes m_defrag(9) 96545d9abdbSWeongyo Jeong */ 966c6499eccSGleb Smirnoff m_new = m_defrag(m, M_NOWAIT); 96745d9abdbSWeongyo Jeong if (m_new == NULL) { 96845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 96945d9abdbSWeongyo Jeong "%s: can't defrag TX buffer\n", 97045d9abdbSWeongyo Jeong __func__); 97145d9abdbSWeongyo Jeong return (ENOBUFS); 97245d9abdbSWeongyo Jeong } 97345d9abdbSWeongyo Jeong if (m_new->m_next != NULL) 97445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 97545d9abdbSWeongyo Jeong "TODO: fragmented packets for PIO\n"); 97645d9abdbSWeongyo Jeong tp->tp_m = m_new; 97745d9abdbSWeongyo Jeong 97845d9abdbSWeongyo Jeong /* send HEADER */ 97945d9abdbSWeongyo Jeong ctl32 = bwn_pio_write_multi_4(mac, tq, 98045d9abdbSWeongyo Jeong (BWN_PIO_READ_4(mac, tq, BWN_PIO8_TXCTL) | 98145d9abdbSWeongyo Jeong BWN_PIO8_TXCTL_FRAMEREADY) & ~BWN_PIO8_TXCTL_EOF, 98245d9abdbSWeongyo Jeong (const uint8_t *)&txhdr, BWN_HDRSIZE(mac)); 98345d9abdbSWeongyo Jeong /* send BODY */ 98445d9abdbSWeongyo Jeong ctl32 = bwn_pio_write_multi_4(mac, tq, ctl32, 98545d9abdbSWeongyo Jeong mtod(m_new, const void *), m_new->m_pkthdr.len); 98645d9abdbSWeongyo Jeong bwn_pio_write_4(mac, tq, BWN_PIO_TXCTL, 98745d9abdbSWeongyo Jeong ctl32 | BWN_PIO8_TXCTL_EOF); 98845d9abdbSWeongyo Jeong } else { 98945d9abdbSWeongyo Jeong ctl16 = bwn_pio_write_multi_2(mac, tq, 99045d9abdbSWeongyo Jeong (bwn_pio_read_2(mac, tq, BWN_PIO_TXCTL) | 99145d9abdbSWeongyo Jeong BWN_PIO_TXCTL_FRAMEREADY) & ~BWN_PIO_TXCTL_EOF, 99245d9abdbSWeongyo Jeong (const uint8_t *)&txhdr, BWN_HDRSIZE(mac)); 99345d9abdbSWeongyo Jeong ctl16 = bwn_pio_write_mbuf_2(mac, tq, ctl16, m); 99445d9abdbSWeongyo Jeong BWN_PIO_WRITE_2(mac, tq, BWN_PIO_TXCTL, 99545d9abdbSWeongyo Jeong ctl16 | BWN_PIO_TXCTL_EOF); 99645d9abdbSWeongyo Jeong } 99745d9abdbSWeongyo Jeong 99845d9abdbSWeongyo Jeong return (0); 99945d9abdbSWeongyo Jeong } 100045d9abdbSWeongyo Jeong 100145d9abdbSWeongyo Jeong static struct bwn_pio_txqueue * 100245d9abdbSWeongyo Jeong bwn_pio_select(struct bwn_mac *mac, uint8_t prio) 100345d9abdbSWeongyo Jeong { 100445d9abdbSWeongyo Jeong 100545d9abdbSWeongyo Jeong if ((mac->mac_flags & BWN_MAC_FLAG_WME) == 0) 100645d9abdbSWeongyo Jeong return (&mac->mac_method.pio.wme[WME_AC_BE]); 100745d9abdbSWeongyo Jeong 100845d9abdbSWeongyo Jeong switch (prio) { 100945d9abdbSWeongyo Jeong case 0: 101045d9abdbSWeongyo Jeong return (&mac->mac_method.pio.wme[WME_AC_BE]); 101145d9abdbSWeongyo Jeong case 1: 101245d9abdbSWeongyo Jeong return (&mac->mac_method.pio.wme[WME_AC_BK]); 101345d9abdbSWeongyo Jeong case 2: 101445d9abdbSWeongyo Jeong return (&mac->mac_method.pio.wme[WME_AC_VI]); 101545d9abdbSWeongyo Jeong case 3: 101645d9abdbSWeongyo Jeong return (&mac->mac_method.pio.wme[WME_AC_VO]); 101745d9abdbSWeongyo Jeong } 101845d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 10190d05eee2SWarner Losh return (NULL); 102045d9abdbSWeongyo Jeong } 102145d9abdbSWeongyo Jeong 102245d9abdbSWeongyo Jeong static int 102345d9abdbSWeongyo Jeong bwn_dma_tx_start(struct bwn_mac *mac, struct ieee80211_node *ni, struct mbuf *m) 102445d9abdbSWeongyo Jeong { 102545d9abdbSWeongyo Jeong #define BWN_GET_TXHDRCACHE(slot) \ 102645d9abdbSWeongyo Jeong &(txhdr_cache[(slot / BWN_TX_SLOTS_PER_FRAME) * BWN_HDRSIZE(mac)]) 102745d9abdbSWeongyo Jeong struct bwn_dma *dma = &mac->mac_method.dma; 102845d9abdbSWeongyo Jeong struct bwn_dma_ring *dr = bwn_dma_select(mac, M_WME_GETAC(m)); 102945d9abdbSWeongyo Jeong struct bwn_dmadesc_generic *desc; 103045d9abdbSWeongyo Jeong struct bwn_dmadesc_meta *mt; 103145d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 103245d9abdbSWeongyo Jeong uint8_t *txhdr_cache = (uint8_t *)dr->dr_txhdr_cache; 103345d9abdbSWeongyo Jeong int error, slot, backup[2] = { dr->dr_curslot, dr->dr_usedslot }; 103445d9abdbSWeongyo Jeong 103545d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 103645d9abdbSWeongyo Jeong KASSERT(!dr->dr_stop, ("%s:%d: fail", __func__, __LINE__)); 103745d9abdbSWeongyo Jeong 103845d9abdbSWeongyo Jeong /* XXX send after DTIM */ 103945d9abdbSWeongyo Jeong 104045d9abdbSWeongyo Jeong slot = bwn_dma_getslot(dr); 104145d9abdbSWeongyo Jeong dr->getdesc(dr, slot, &desc, &mt); 104245d9abdbSWeongyo Jeong KASSERT(mt->mt_txtype == BWN_DMADESC_METATYPE_HEADER, 104345d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 104445d9abdbSWeongyo Jeong 104545d9abdbSWeongyo Jeong error = bwn_set_txhdr(dr->dr_mac, ni, m, 104645d9abdbSWeongyo Jeong (struct bwn_txhdr *)BWN_GET_TXHDRCACHE(slot), 104745d9abdbSWeongyo Jeong BWN_DMA_COOKIE(dr, slot)); 104845d9abdbSWeongyo Jeong if (error) 104945d9abdbSWeongyo Jeong goto fail; 105045d9abdbSWeongyo Jeong error = bus_dmamap_load(dr->dr_txring_dtag, mt->mt_dmap, 105145d9abdbSWeongyo Jeong BWN_GET_TXHDRCACHE(slot), BWN_HDRSIZE(mac), bwn_dma_ring_addr, 105245d9abdbSWeongyo Jeong &mt->mt_paddr, BUS_DMA_NOWAIT); 105345d9abdbSWeongyo Jeong if (error) { 10547a79cebfSGleb Smirnoff device_printf(sc->sc_dev, "%s: can't load TX buffer (1) %d\n", 105545d9abdbSWeongyo Jeong __func__, error); 105645d9abdbSWeongyo Jeong goto fail; 105745d9abdbSWeongyo Jeong } 105845d9abdbSWeongyo Jeong bus_dmamap_sync(dr->dr_txring_dtag, mt->mt_dmap, 105945d9abdbSWeongyo Jeong BUS_DMASYNC_PREWRITE); 106045d9abdbSWeongyo Jeong dr->setdesc(dr, desc, mt->mt_paddr, BWN_HDRSIZE(mac), 1, 0, 0); 106145d9abdbSWeongyo Jeong bus_dmamap_sync(dr->dr_ring_dtag, dr->dr_ring_dmap, 106245d9abdbSWeongyo Jeong BUS_DMASYNC_PREWRITE); 106345d9abdbSWeongyo Jeong 106445d9abdbSWeongyo Jeong slot = bwn_dma_getslot(dr); 106545d9abdbSWeongyo Jeong dr->getdesc(dr, slot, &desc, &mt); 106645d9abdbSWeongyo Jeong KASSERT(mt->mt_txtype == BWN_DMADESC_METATYPE_BODY && 106745d9abdbSWeongyo Jeong mt->mt_islast == 1, ("%s:%d: fail", __func__, __LINE__)); 106845d9abdbSWeongyo Jeong mt->mt_m = m; 106945d9abdbSWeongyo Jeong mt->mt_ni = ni; 107045d9abdbSWeongyo Jeong 107145d9abdbSWeongyo Jeong error = bus_dmamap_load_mbuf(dma->txbuf_dtag, mt->mt_dmap, m, 107245d9abdbSWeongyo Jeong bwn_dma_buf_addr, &mt->mt_paddr, BUS_DMA_NOWAIT); 107345d9abdbSWeongyo Jeong if (error && error != EFBIG) { 10747a79cebfSGleb Smirnoff device_printf(sc->sc_dev, "%s: can't load TX buffer (1) %d\n", 107545d9abdbSWeongyo Jeong __func__, error); 107645d9abdbSWeongyo Jeong goto fail; 107745d9abdbSWeongyo Jeong } 107845d9abdbSWeongyo Jeong if (error) { /* error == EFBIG */ 107945d9abdbSWeongyo Jeong struct mbuf *m_new; 108045d9abdbSWeongyo Jeong 1081c6499eccSGleb Smirnoff m_new = m_defrag(m, M_NOWAIT); 108245d9abdbSWeongyo Jeong if (m_new == NULL) { 10837a79cebfSGleb Smirnoff device_printf(sc->sc_dev, 10847a79cebfSGleb Smirnoff "%s: can't defrag TX buffer\n", 108545d9abdbSWeongyo Jeong __func__); 108645d9abdbSWeongyo Jeong error = ENOBUFS; 108745d9abdbSWeongyo Jeong goto fail; 108845d9abdbSWeongyo Jeong } else { 108945d9abdbSWeongyo Jeong m = m_new; 109045d9abdbSWeongyo Jeong } 109145d9abdbSWeongyo Jeong 109245d9abdbSWeongyo Jeong mt->mt_m = m; 109345d9abdbSWeongyo Jeong error = bus_dmamap_load_mbuf(dma->txbuf_dtag, mt->mt_dmap, 109445d9abdbSWeongyo Jeong m, bwn_dma_buf_addr, &mt->mt_paddr, BUS_DMA_NOWAIT); 109545d9abdbSWeongyo Jeong if (error) { 10967a79cebfSGleb Smirnoff device_printf(sc->sc_dev, 10977a79cebfSGleb Smirnoff "%s: can't load TX buffer (2) %d\n", 109845d9abdbSWeongyo Jeong __func__, error); 109945d9abdbSWeongyo Jeong goto fail; 110045d9abdbSWeongyo Jeong } 110145d9abdbSWeongyo Jeong } 110245d9abdbSWeongyo Jeong bus_dmamap_sync(dma->txbuf_dtag, mt->mt_dmap, BUS_DMASYNC_PREWRITE); 110345d9abdbSWeongyo Jeong dr->setdesc(dr, desc, mt->mt_paddr, m->m_pkthdr.len, 0, 1, 1); 110445d9abdbSWeongyo Jeong bus_dmamap_sync(dr->dr_ring_dtag, dr->dr_ring_dmap, 110545d9abdbSWeongyo Jeong BUS_DMASYNC_PREWRITE); 110645d9abdbSWeongyo Jeong 110745d9abdbSWeongyo Jeong /* XXX send after DTIM */ 110845d9abdbSWeongyo Jeong 110945d9abdbSWeongyo Jeong dr->start_transfer(dr, bwn_dma_nextslot(dr, slot)); 111045d9abdbSWeongyo Jeong return (0); 111145d9abdbSWeongyo Jeong fail: 111245d9abdbSWeongyo Jeong dr->dr_curslot = backup[0]; 111345d9abdbSWeongyo Jeong dr->dr_usedslot = backup[1]; 111445d9abdbSWeongyo Jeong return (error); 111545d9abdbSWeongyo Jeong #undef BWN_GET_TXHDRCACHE 111645d9abdbSWeongyo Jeong } 111745d9abdbSWeongyo Jeong 111845d9abdbSWeongyo Jeong static void 111945d9abdbSWeongyo Jeong bwn_watchdog(void *arg) 112045d9abdbSWeongyo Jeong { 112145d9abdbSWeongyo Jeong struct bwn_softc *sc = arg; 112245d9abdbSWeongyo Jeong 112345d9abdbSWeongyo Jeong if (sc->sc_watchdog_timer != 0 && --sc->sc_watchdog_timer == 0) { 11247a79cebfSGleb Smirnoff device_printf(sc->sc_dev, "device timeout\n"); 11257a79cebfSGleb Smirnoff counter_u64_add(sc->sc_ic.ic_oerrors, 1); 112645d9abdbSWeongyo Jeong } 112745d9abdbSWeongyo Jeong callout_schedule(&sc->sc_watchdog_ch, hz); 112845d9abdbSWeongyo Jeong } 112945d9abdbSWeongyo Jeong 113045d9abdbSWeongyo Jeong static int 113145d9abdbSWeongyo Jeong bwn_attach_core(struct bwn_mac *mac) 113245d9abdbSWeongyo Jeong { 113345d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 113445d9abdbSWeongyo Jeong int error, have_bg = 0, have_a = 0; 113545d9abdbSWeongyo Jeong uint32_t high; 113645d9abdbSWeongyo Jeong 1137b9b64aa5SWeongyo Jeong KASSERT(siba_get_revid(sc->sc_dev) >= 5, 1138b9b64aa5SWeongyo Jeong ("unsupported revision %d", siba_get_revid(sc->sc_dev))); 113945d9abdbSWeongyo Jeong 1140b9b64aa5SWeongyo Jeong siba_powerup(sc->sc_dev, 0); 114145d9abdbSWeongyo Jeong 1142b9b64aa5SWeongyo Jeong high = siba_read_4(sc->sc_dev, SIBA_TGSHIGH); 114345d9abdbSWeongyo Jeong bwn_reset_core(mac, 114445d9abdbSWeongyo Jeong (high & BWN_TGSHIGH_HAVE_2GHZ) ? BWN_TGSLOW_SUPPORT_G : 0); 114545d9abdbSWeongyo Jeong error = bwn_phy_getinfo(mac, high); 114645d9abdbSWeongyo Jeong if (error) 114745d9abdbSWeongyo Jeong goto fail; 114845d9abdbSWeongyo Jeong 114945d9abdbSWeongyo Jeong have_a = (high & BWN_TGSHIGH_HAVE_5GHZ) ? 1 : 0; 115045d9abdbSWeongyo Jeong have_bg = (high & BWN_TGSHIGH_HAVE_2GHZ) ? 1 : 0; 1151b9b64aa5SWeongyo Jeong if (siba_get_pci_device(sc->sc_dev) != 0x4312 && 1152b9b64aa5SWeongyo Jeong siba_get_pci_device(sc->sc_dev) != 0x4319 && 1153b9b64aa5SWeongyo Jeong siba_get_pci_device(sc->sc_dev) != 0x4324) { 115445d9abdbSWeongyo Jeong have_a = have_bg = 0; 115545d9abdbSWeongyo Jeong if (mac->mac_phy.type == BWN_PHYTYPE_A) 115645d9abdbSWeongyo Jeong have_a = 1; 115745d9abdbSWeongyo Jeong else if (mac->mac_phy.type == BWN_PHYTYPE_G || 115845d9abdbSWeongyo Jeong mac->mac_phy.type == BWN_PHYTYPE_N || 115945d9abdbSWeongyo Jeong mac->mac_phy.type == BWN_PHYTYPE_LP) 116045d9abdbSWeongyo Jeong have_bg = 1; 116145d9abdbSWeongyo Jeong else 116245d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s: unknown phy type (%d)", __func__, 116345d9abdbSWeongyo Jeong mac->mac_phy.type)); 116445d9abdbSWeongyo Jeong } 116545d9abdbSWeongyo Jeong /* XXX turns off PHY A because it's not supported */ 116645d9abdbSWeongyo Jeong if (mac->mac_phy.type != BWN_PHYTYPE_LP && 116745d9abdbSWeongyo Jeong mac->mac_phy.type != BWN_PHYTYPE_N) { 116845d9abdbSWeongyo Jeong have_a = 0; 116945d9abdbSWeongyo Jeong have_bg = 1; 117045d9abdbSWeongyo Jeong } 117145d9abdbSWeongyo Jeong 117245d9abdbSWeongyo Jeong if (mac->mac_phy.type == BWN_PHYTYPE_G) { 117345d9abdbSWeongyo Jeong mac->mac_phy.attach = bwn_phy_g_attach; 117445d9abdbSWeongyo Jeong mac->mac_phy.detach = bwn_phy_g_detach; 117545d9abdbSWeongyo Jeong mac->mac_phy.prepare_hw = bwn_phy_g_prepare_hw; 117645d9abdbSWeongyo Jeong mac->mac_phy.init_pre = bwn_phy_g_init_pre; 117745d9abdbSWeongyo Jeong mac->mac_phy.init = bwn_phy_g_init; 117845d9abdbSWeongyo Jeong mac->mac_phy.exit = bwn_phy_g_exit; 117945d9abdbSWeongyo Jeong mac->mac_phy.phy_read = bwn_phy_g_read; 118045d9abdbSWeongyo Jeong mac->mac_phy.phy_write = bwn_phy_g_write; 118145d9abdbSWeongyo Jeong mac->mac_phy.rf_read = bwn_phy_g_rf_read; 118245d9abdbSWeongyo Jeong mac->mac_phy.rf_write = bwn_phy_g_rf_write; 118345d9abdbSWeongyo Jeong mac->mac_phy.use_hwpctl = bwn_phy_g_hwpctl; 118445d9abdbSWeongyo Jeong mac->mac_phy.rf_onoff = bwn_phy_g_rf_onoff; 118545d9abdbSWeongyo Jeong mac->mac_phy.switch_analog = bwn_phy_switch_analog; 118645d9abdbSWeongyo Jeong mac->mac_phy.switch_channel = bwn_phy_g_switch_channel; 118745d9abdbSWeongyo Jeong mac->mac_phy.get_default_chan = bwn_phy_g_get_default_chan; 118845d9abdbSWeongyo Jeong mac->mac_phy.set_antenna = bwn_phy_g_set_antenna; 118945d9abdbSWeongyo Jeong mac->mac_phy.set_im = bwn_phy_g_im; 119045d9abdbSWeongyo Jeong mac->mac_phy.recalc_txpwr = bwn_phy_g_recalc_txpwr; 119145d9abdbSWeongyo Jeong mac->mac_phy.set_txpwr = bwn_phy_g_set_txpwr; 119245d9abdbSWeongyo Jeong mac->mac_phy.task_15s = bwn_phy_g_task_15s; 119345d9abdbSWeongyo Jeong mac->mac_phy.task_60s = bwn_phy_g_task_60s; 119445d9abdbSWeongyo Jeong } else if (mac->mac_phy.type == BWN_PHYTYPE_LP) { 119545d9abdbSWeongyo Jeong mac->mac_phy.init_pre = bwn_phy_lp_init_pre; 119645d9abdbSWeongyo Jeong mac->mac_phy.init = bwn_phy_lp_init; 119745d9abdbSWeongyo Jeong mac->mac_phy.phy_read = bwn_phy_lp_read; 119845d9abdbSWeongyo Jeong mac->mac_phy.phy_write = bwn_phy_lp_write; 119945d9abdbSWeongyo Jeong mac->mac_phy.phy_maskset = bwn_phy_lp_maskset; 120045d9abdbSWeongyo Jeong mac->mac_phy.rf_read = bwn_phy_lp_rf_read; 120145d9abdbSWeongyo Jeong mac->mac_phy.rf_write = bwn_phy_lp_rf_write; 120245d9abdbSWeongyo Jeong mac->mac_phy.rf_onoff = bwn_phy_lp_rf_onoff; 120345d9abdbSWeongyo Jeong mac->mac_phy.switch_analog = bwn_phy_lp_switch_analog; 120445d9abdbSWeongyo Jeong mac->mac_phy.switch_channel = bwn_phy_lp_switch_channel; 120545d9abdbSWeongyo Jeong mac->mac_phy.get_default_chan = bwn_phy_lp_get_default_chan; 120645d9abdbSWeongyo Jeong mac->mac_phy.set_antenna = bwn_phy_lp_set_antenna; 120745d9abdbSWeongyo Jeong mac->mac_phy.task_60s = bwn_phy_lp_task_60s; 120845d9abdbSWeongyo Jeong } else { 120945d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "unsupported PHY type (%d)\n", 121045d9abdbSWeongyo Jeong mac->mac_phy.type); 121145d9abdbSWeongyo Jeong error = ENXIO; 121245d9abdbSWeongyo Jeong goto fail; 121345d9abdbSWeongyo Jeong } 121445d9abdbSWeongyo Jeong 121545d9abdbSWeongyo Jeong mac->mac_phy.gmode = have_bg; 121645d9abdbSWeongyo Jeong if (mac->mac_phy.attach != NULL) { 121745d9abdbSWeongyo Jeong error = mac->mac_phy.attach(mac); 121845d9abdbSWeongyo Jeong if (error) { 121945d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "failed\n"); 122045d9abdbSWeongyo Jeong goto fail; 122145d9abdbSWeongyo Jeong } 122245d9abdbSWeongyo Jeong } 122345d9abdbSWeongyo Jeong 122445d9abdbSWeongyo Jeong bwn_reset_core(mac, have_bg ? BWN_TGSLOW_SUPPORT_G : 0); 122545d9abdbSWeongyo Jeong 122645d9abdbSWeongyo Jeong error = bwn_chiptest(mac); 122745d9abdbSWeongyo Jeong if (error) 122845d9abdbSWeongyo Jeong goto fail; 122945d9abdbSWeongyo Jeong error = bwn_setup_channels(mac, have_bg, have_a); 123045d9abdbSWeongyo Jeong if (error) { 123145d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "failed to setup channels\n"); 123245d9abdbSWeongyo Jeong goto fail; 123345d9abdbSWeongyo Jeong } 123445d9abdbSWeongyo Jeong 123545d9abdbSWeongyo Jeong if (sc->sc_curmac == NULL) 123645d9abdbSWeongyo Jeong sc->sc_curmac = mac; 123745d9abdbSWeongyo Jeong 123845d9abdbSWeongyo Jeong error = bwn_dma_attach(mac); 123945d9abdbSWeongyo Jeong if (error != 0) { 124045d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "failed to initialize DMA\n"); 124145d9abdbSWeongyo Jeong goto fail; 124245d9abdbSWeongyo Jeong } 124345d9abdbSWeongyo Jeong 124445d9abdbSWeongyo Jeong mac->mac_phy.switch_analog(mac, 0); 124545d9abdbSWeongyo Jeong 1246b9b64aa5SWeongyo Jeong siba_dev_down(sc->sc_dev, 0); 124745d9abdbSWeongyo Jeong fail: 1248b9b64aa5SWeongyo Jeong siba_powerdown(sc->sc_dev); 124945d9abdbSWeongyo Jeong return (error); 125045d9abdbSWeongyo Jeong } 125145d9abdbSWeongyo Jeong 1252*d546e47aSAdrian Chadd void 125345d9abdbSWeongyo Jeong bwn_reset_core(struct bwn_mac *mac, uint32_t flags) 125445d9abdbSWeongyo Jeong { 1255b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 125645d9abdbSWeongyo Jeong uint32_t low, ctl; 125745d9abdbSWeongyo Jeong 125845d9abdbSWeongyo Jeong flags |= (BWN_TGSLOW_PHYCLOCK_ENABLE | BWN_TGSLOW_PHYRESET); 125945d9abdbSWeongyo Jeong 1260b9b64aa5SWeongyo Jeong siba_dev_up(sc->sc_dev, flags); 126145d9abdbSWeongyo Jeong DELAY(2000); 126245d9abdbSWeongyo Jeong 1263b9b64aa5SWeongyo Jeong low = (siba_read_4(sc->sc_dev, SIBA_TGSLOW) | SIBA_TGSLOW_FGC) & 126445d9abdbSWeongyo Jeong ~BWN_TGSLOW_PHYRESET; 1265b9b64aa5SWeongyo Jeong siba_write_4(sc->sc_dev, SIBA_TGSLOW, low); 1266b9b64aa5SWeongyo Jeong siba_read_4(sc->sc_dev, SIBA_TGSLOW); 126745d9abdbSWeongyo Jeong DELAY(1000); 1268b9b64aa5SWeongyo Jeong siba_write_4(sc->sc_dev, SIBA_TGSLOW, low & ~SIBA_TGSLOW_FGC); 1269b9b64aa5SWeongyo Jeong siba_read_4(sc->sc_dev, SIBA_TGSLOW); 127045d9abdbSWeongyo Jeong DELAY(1000); 127145d9abdbSWeongyo Jeong 127245d9abdbSWeongyo Jeong if (mac->mac_phy.switch_analog != NULL) 127345d9abdbSWeongyo Jeong mac->mac_phy.switch_analog(mac, 1); 127445d9abdbSWeongyo Jeong 127545d9abdbSWeongyo Jeong ctl = BWN_READ_4(mac, BWN_MACCTL) & ~BWN_MACCTL_GMODE; 127645d9abdbSWeongyo Jeong if (flags & BWN_TGSLOW_SUPPORT_G) 127745d9abdbSWeongyo Jeong ctl |= BWN_MACCTL_GMODE; 127845d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, ctl | BWN_MACCTL_IHR_ON); 127945d9abdbSWeongyo Jeong } 128045d9abdbSWeongyo Jeong 128145d9abdbSWeongyo Jeong static int 128245d9abdbSWeongyo Jeong bwn_phy_getinfo(struct bwn_mac *mac, int tgshigh) 128345d9abdbSWeongyo Jeong { 128445d9abdbSWeongyo Jeong struct bwn_phy *phy = &mac->mac_phy; 128545d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 128645d9abdbSWeongyo Jeong uint32_t tmp; 128745d9abdbSWeongyo Jeong 128845d9abdbSWeongyo Jeong /* PHY */ 128945d9abdbSWeongyo Jeong tmp = BWN_READ_2(mac, BWN_PHYVER); 129045d9abdbSWeongyo Jeong phy->gmode = (tgshigh & BWN_TGSHIGH_HAVE_2GHZ) ? 1 : 0; 129145d9abdbSWeongyo Jeong phy->rf_on = 1; 129245d9abdbSWeongyo Jeong phy->analog = (tmp & BWN_PHYVER_ANALOG) >> 12; 129345d9abdbSWeongyo Jeong phy->type = (tmp & BWN_PHYVER_TYPE) >> 8; 129445d9abdbSWeongyo Jeong phy->rev = (tmp & BWN_PHYVER_VERSION); 129545d9abdbSWeongyo Jeong if ((phy->type == BWN_PHYTYPE_A && phy->rev >= 4) || 129645d9abdbSWeongyo Jeong (phy->type == BWN_PHYTYPE_B && phy->rev != 2 && 129745d9abdbSWeongyo Jeong phy->rev != 4 && phy->rev != 6 && phy->rev != 7) || 129845d9abdbSWeongyo Jeong (phy->type == BWN_PHYTYPE_G && phy->rev > 9) || 129945d9abdbSWeongyo Jeong (phy->type == BWN_PHYTYPE_N && phy->rev > 4) || 130045d9abdbSWeongyo Jeong (phy->type == BWN_PHYTYPE_LP && phy->rev > 2)) 130145d9abdbSWeongyo Jeong goto unsupphy; 130245d9abdbSWeongyo Jeong 130345d9abdbSWeongyo Jeong /* RADIO */ 1304b9b64aa5SWeongyo Jeong if (siba_get_chipid(sc->sc_dev) == 0x4317) { 1305b9b64aa5SWeongyo Jeong if (siba_get_chiprev(sc->sc_dev) == 0) 130645d9abdbSWeongyo Jeong tmp = 0x3205017f; 1307b9b64aa5SWeongyo Jeong else if (siba_get_chiprev(sc->sc_dev) == 1) 130845d9abdbSWeongyo Jeong tmp = 0x4205017f; 130945d9abdbSWeongyo Jeong else 131045d9abdbSWeongyo Jeong tmp = 0x5205017f; 131145d9abdbSWeongyo Jeong } else { 131245d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_RFCTL, BWN_RFCTL_ID); 131345d9abdbSWeongyo Jeong tmp = BWN_READ_2(mac, BWN_RFDATALO); 131445d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_RFCTL, BWN_RFCTL_ID); 131545d9abdbSWeongyo Jeong tmp |= (uint32_t)BWN_READ_2(mac, BWN_RFDATAHI) << 16; 131645d9abdbSWeongyo Jeong } 131745d9abdbSWeongyo Jeong phy->rf_rev = (tmp & 0xf0000000) >> 28; 131845d9abdbSWeongyo Jeong phy->rf_ver = (tmp & 0x0ffff000) >> 12; 131945d9abdbSWeongyo Jeong phy->rf_manuf = (tmp & 0x00000fff); 132045d9abdbSWeongyo Jeong if (phy->rf_manuf != 0x17f) /* 0x17f is broadcom */ 132145d9abdbSWeongyo Jeong goto unsupradio; 132245d9abdbSWeongyo Jeong if ((phy->type == BWN_PHYTYPE_A && (phy->rf_ver != 0x2060 || 132345d9abdbSWeongyo Jeong phy->rf_rev != 1 || phy->rf_manuf != 0x17f)) || 132445d9abdbSWeongyo Jeong (phy->type == BWN_PHYTYPE_B && (phy->rf_ver & 0xfff0) != 0x2050) || 132545d9abdbSWeongyo Jeong (phy->type == BWN_PHYTYPE_G && phy->rf_ver != 0x2050) || 132645d9abdbSWeongyo Jeong (phy->type == BWN_PHYTYPE_N && 132745d9abdbSWeongyo Jeong phy->rf_ver != 0x2055 && phy->rf_ver != 0x2056) || 132845d9abdbSWeongyo Jeong (phy->type == BWN_PHYTYPE_LP && 132945d9abdbSWeongyo Jeong phy->rf_ver != 0x2062 && phy->rf_ver != 0x2063)) 133045d9abdbSWeongyo Jeong goto unsupradio; 133145d9abdbSWeongyo Jeong 133245d9abdbSWeongyo Jeong return (0); 133345d9abdbSWeongyo Jeong unsupphy: 133445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "unsupported PHY (type %#x, rev %#x, " 133545d9abdbSWeongyo Jeong "analog %#x)\n", 133645d9abdbSWeongyo Jeong phy->type, phy->rev, phy->analog); 133745d9abdbSWeongyo Jeong return (ENXIO); 133845d9abdbSWeongyo Jeong unsupradio: 133945d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "unsupported radio (manuf %#x, ver %#x, " 134045d9abdbSWeongyo Jeong "rev %#x)\n", 134145d9abdbSWeongyo Jeong phy->rf_manuf, phy->rf_ver, phy->rf_rev); 134245d9abdbSWeongyo Jeong return (ENXIO); 134345d9abdbSWeongyo Jeong } 134445d9abdbSWeongyo Jeong 134545d9abdbSWeongyo Jeong static int 134645d9abdbSWeongyo Jeong bwn_chiptest(struct bwn_mac *mac) 134745d9abdbSWeongyo Jeong { 134845d9abdbSWeongyo Jeong #define TESTVAL0 0x55aaaa55 134945d9abdbSWeongyo Jeong #define TESTVAL1 0xaa5555aa 135045d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 135145d9abdbSWeongyo Jeong uint32_t v, backup; 135245d9abdbSWeongyo Jeong 135345d9abdbSWeongyo Jeong BWN_LOCK(sc); 135445d9abdbSWeongyo Jeong 135545d9abdbSWeongyo Jeong backup = bwn_shm_read_4(mac, BWN_SHARED, 0); 135645d9abdbSWeongyo Jeong 135745d9abdbSWeongyo Jeong bwn_shm_write_4(mac, BWN_SHARED, 0, TESTVAL0); 135845d9abdbSWeongyo Jeong if (bwn_shm_read_4(mac, BWN_SHARED, 0) != TESTVAL0) 135945d9abdbSWeongyo Jeong goto error; 136045d9abdbSWeongyo Jeong bwn_shm_write_4(mac, BWN_SHARED, 0, TESTVAL1); 136145d9abdbSWeongyo Jeong if (bwn_shm_read_4(mac, BWN_SHARED, 0) != TESTVAL1) 136245d9abdbSWeongyo Jeong goto error; 136345d9abdbSWeongyo Jeong 136445d9abdbSWeongyo Jeong bwn_shm_write_4(mac, BWN_SHARED, 0, backup); 136545d9abdbSWeongyo Jeong 1366b9b64aa5SWeongyo Jeong if ((siba_get_revid(sc->sc_dev) >= 3) && 1367b9b64aa5SWeongyo Jeong (siba_get_revid(sc->sc_dev) <= 10)) { 136845d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_TSF_CFP_START, 0xaaaa); 136945d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_TSF_CFP_START, 0xccccbbbb); 137045d9abdbSWeongyo Jeong if (BWN_READ_2(mac, BWN_TSF_CFP_START_LOW) != 0xbbbb) 137145d9abdbSWeongyo Jeong goto error; 137245d9abdbSWeongyo Jeong if (BWN_READ_2(mac, BWN_TSF_CFP_START_HIGH) != 0xcccc) 137345d9abdbSWeongyo Jeong goto error; 137445d9abdbSWeongyo Jeong } 137545d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_TSF_CFP_START, 0); 137645d9abdbSWeongyo Jeong 137745d9abdbSWeongyo Jeong v = BWN_READ_4(mac, BWN_MACCTL) | BWN_MACCTL_GMODE; 137845d9abdbSWeongyo Jeong if (v != (BWN_MACCTL_GMODE | BWN_MACCTL_IHR_ON)) 137945d9abdbSWeongyo Jeong goto error; 138045d9abdbSWeongyo Jeong 138145d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 138245d9abdbSWeongyo Jeong return (0); 138345d9abdbSWeongyo Jeong error: 138445d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 138545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "failed to validate the chipaccess\n"); 138645d9abdbSWeongyo Jeong return (ENODEV); 138745d9abdbSWeongyo Jeong } 138845d9abdbSWeongyo Jeong 138945d9abdbSWeongyo Jeong #define IEEE80211_CHAN_HTG (IEEE80211_CHAN_HT | IEEE80211_CHAN_G) 139045d9abdbSWeongyo Jeong #define IEEE80211_CHAN_HTA (IEEE80211_CHAN_HT | IEEE80211_CHAN_A) 139145d9abdbSWeongyo Jeong 139245d9abdbSWeongyo Jeong static int 139345d9abdbSWeongyo Jeong bwn_setup_channels(struct bwn_mac *mac, int have_bg, int have_a) 139445d9abdbSWeongyo Jeong { 139545d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 13967a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 139745d9abdbSWeongyo Jeong 139845d9abdbSWeongyo Jeong memset(ic->ic_channels, 0, sizeof(ic->ic_channels)); 139945d9abdbSWeongyo Jeong ic->ic_nchans = 0; 140045d9abdbSWeongyo Jeong 140145d9abdbSWeongyo Jeong if (have_bg) 140245d9abdbSWeongyo Jeong bwn_addchannels(ic->ic_channels, IEEE80211_CHAN_MAX, 140345d9abdbSWeongyo Jeong &ic->ic_nchans, &bwn_chantable_bg, IEEE80211_CHAN_G); 140445d9abdbSWeongyo Jeong if (mac->mac_phy.type == BWN_PHYTYPE_N) { 140545d9abdbSWeongyo Jeong if (have_a) 140645d9abdbSWeongyo Jeong bwn_addchannels(ic->ic_channels, IEEE80211_CHAN_MAX, 140745d9abdbSWeongyo Jeong &ic->ic_nchans, &bwn_chantable_n, 140845d9abdbSWeongyo Jeong IEEE80211_CHAN_HTA); 140945d9abdbSWeongyo Jeong } else { 141045d9abdbSWeongyo Jeong if (have_a) 141145d9abdbSWeongyo Jeong bwn_addchannels(ic->ic_channels, IEEE80211_CHAN_MAX, 141245d9abdbSWeongyo Jeong &ic->ic_nchans, &bwn_chantable_a, 141345d9abdbSWeongyo Jeong IEEE80211_CHAN_A); 141445d9abdbSWeongyo Jeong } 141545d9abdbSWeongyo Jeong 141645d9abdbSWeongyo Jeong mac->mac_phy.supports_2ghz = have_bg; 141745d9abdbSWeongyo Jeong mac->mac_phy.supports_5ghz = have_a; 141845d9abdbSWeongyo Jeong 141945d9abdbSWeongyo Jeong return (ic->ic_nchans == 0 ? ENXIO : 0); 142045d9abdbSWeongyo Jeong } 142145d9abdbSWeongyo Jeong 1422*d546e47aSAdrian Chadd uint32_t 142345d9abdbSWeongyo Jeong bwn_shm_read_4(struct bwn_mac *mac, uint16_t way, uint16_t offset) 142445d9abdbSWeongyo Jeong { 142545d9abdbSWeongyo Jeong uint32_t ret; 142645d9abdbSWeongyo Jeong 14270d05eee2SWarner Losh BWN_ASSERT_LOCKED(mac->mac_sc); 142845d9abdbSWeongyo Jeong 142945d9abdbSWeongyo Jeong if (way == BWN_SHARED) { 143045d9abdbSWeongyo Jeong KASSERT((offset & 0x0001) == 0, 143145d9abdbSWeongyo Jeong ("%s:%d warn", __func__, __LINE__)); 143245d9abdbSWeongyo Jeong if (offset & 0x0003) { 143345d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, way, offset >> 2); 143445d9abdbSWeongyo Jeong ret = BWN_READ_2(mac, BWN_SHM_DATA_UNALIGNED); 143545d9abdbSWeongyo Jeong ret <<= 16; 143645d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, way, (offset >> 2) + 1); 143745d9abdbSWeongyo Jeong ret |= BWN_READ_2(mac, BWN_SHM_DATA); 143845d9abdbSWeongyo Jeong goto out; 143945d9abdbSWeongyo Jeong } 144045d9abdbSWeongyo Jeong offset >>= 2; 144145d9abdbSWeongyo Jeong } 144245d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, way, offset); 144345d9abdbSWeongyo Jeong ret = BWN_READ_4(mac, BWN_SHM_DATA); 144445d9abdbSWeongyo Jeong out: 144545d9abdbSWeongyo Jeong return (ret); 144645d9abdbSWeongyo Jeong } 144745d9abdbSWeongyo Jeong 1448*d546e47aSAdrian Chadd uint16_t 144945d9abdbSWeongyo Jeong bwn_shm_read_2(struct bwn_mac *mac, uint16_t way, uint16_t offset) 145045d9abdbSWeongyo Jeong { 145145d9abdbSWeongyo Jeong uint16_t ret; 145245d9abdbSWeongyo Jeong 14530d05eee2SWarner Losh BWN_ASSERT_LOCKED(mac->mac_sc); 145445d9abdbSWeongyo Jeong 145545d9abdbSWeongyo Jeong if (way == BWN_SHARED) { 145645d9abdbSWeongyo Jeong KASSERT((offset & 0x0001) == 0, 145745d9abdbSWeongyo Jeong ("%s:%d warn", __func__, __LINE__)); 145845d9abdbSWeongyo Jeong if (offset & 0x0003) { 145945d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, way, offset >> 2); 146045d9abdbSWeongyo Jeong ret = BWN_READ_2(mac, BWN_SHM_DATA_UNALIGNED); 146145d9abdbSWeongyo Jeong goto out; 146245d9abdbSWeongyo Jeong } 146345d9abdbSWeongyo Jeong offset >>= 2; 146445d9abdbSWeongyo Jeong } 146545d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, way, offset); 146645d9abdbSWeongyo Jeong ret = BWN_READ_2(mac, BWN_SHM_DATA); 146745d9abdbSWeongyo Jeong out: 146845d9abdbSWeongyo Jeong 146945d9abdbSWeongyo Jeong return (ret); 147045d9abdbSWeongyo Jeong } 147145d9abdbSWeongyo Jeong 147245d9abdbSWeongyo Jeong static void 147345d9abdbSWeongyo Jeong bwn_shm_ctlword(struct bwn_mac *mac, uint16_t way, 147445d9abdbSWeongyo Jeong uint16_t offset) 147545d9abdbSWeongyo Jeong { 147645d9abdbSWeongyo Jeong uint32_t control; 147745d9abdbSWeongyo Jeong 147845d9abdbSWeongyo Jeong control = way; 147945d9abdbSWeongyo Jeong control <<= 16; 148045d9abdbSWeongyo Jeong control |= offset; 148145d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_SHM_CONTROL, control); 148245d9abdbSWeongyo Jeong } 148345d9abdbSWeongyo Jeong 1484*d546e47aSAdrian Chadd void 148545d9abdbSWeongyo Jeong bwn_shm_write_4(struct bwn_mac *mac, uint16_t way, uint16_t offset, 148645d9abdbSWeongyo Jeong uint32_t value) 148745d9abdbSWeongyo Jeong { 14880d05eee2SWarner Losh BWN_ASSERT_LOCKED(mac->mac_sc); 148945d9abdbSWeongyo Jeong 149045d9abdbSWeongyo Jeong if (way == BWN_SHARED) { 149145d9abdbSWeongyo Jeong KASSERT((offset & 0x0001) == 0, 149245d9abdbSWeongyo Jeong ("%s:%d warn", __func__, __LINE__)); 149345d9abdbSWeongyo Jeong if (offset & 0x0003) { 149445d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, way, offset >> 2); 149545d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_SHM_DATA_UNALIGNED, 149645d9abdbSWeongyo Jeong (value >> 16) & 0xffff); 149745d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, way, (offset >> 2) + 1); 149845d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_SHM_DATA, value & 0xffff); 149945d9abdbSWeongyo Jeong return; 150045d9abdbSWeongyo Jeong } 150145d9abdbSWeongyo Jeong offset >>= 2; 150245d9abdbSWeongyo Jeong } 150345d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, way, offset); 150445d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_SHM_DATA, value); 150545d9abdbSWeongyo Jeong } 150645d9abdbSWeongyo Jeong 1507*d546e47aSAdrian Chadd void 150845d9abdbSWeongyo Jeong bwn_shm_write_2(struct bwn_mac *mac, uint16_t way, uint16_t offset, 150945d9abdbSWeongyo Jeong uint16_t value) 151045d9abdbSWeongyo Jeong { 15110d05eee2SWarner Losh BWN_ASSERT_LOCKED(mac->mac_sc); 151245d9abdbSWeongyo Jeong 151345d9abdbSWeongyo Jeong if (way == BWN_SHARED) { 151445d9abdbSWeongyo Jeong KASSERT((offset & 0x0001) == 0, 151545d9abdbSWeongyo Jeong ("%s:%d warn", __func__, __LINE__)); 151645d9abdbSWeongyo Jeong if (offset & 0x0003) { 151745d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, way, offset >> 2); 151845d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_SHM_DATA_UNALIGNED, value); 151945d9abdbSWeongyo Jeong return; 152045d9abdbSWeongyo Jeong } 152145d9abdbSWeongyo Jeong offset >>= 2; 152245d9abdbSWeongyo Jeong } 152345d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, way, offset); 152445d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_SHM_DATA, value); 152545d9abdbSWeongyo Jeong } 152645d9abdbSWeongyo Jeong 152745d9abdbSWeongyo Jeong static void 152845d9abdbSWeongyo Jeong bwn_addchan(struct ieee80211_channel *c, int freq, int flags, int ieee, 152945d9abdbSWeongyo Jeong int txpow) 153045d9abdbSWeongyo Jeong { 153145d9abdbSWeongyo Jeong 153245d9abdbSWeongyo Jeong c->ic_freq = freq; 153345d9abdbSWeongyo Jeong c->ic_flags = flags; 153445d9abdbSWeongyo Jeong c->ic_ieee = ieee; 153545d9abdbSWeongyo Jeong c->ic_minpower = 0; 153645d9abdbSWeongyo Jeong c->ic_maxpower = 2 * txpow; 153745d9abdbSWeongyo Jeong c->ic_maxregpower = txpow; 153845d9abdbSWeongyo Jeong } 153945d9abdbSWeongyo Jeong 154045d9abdbSWeongyo Jeong static void 154145d9abdbSWeongyo Jeong bwn_addchannels(struct ieee80211_channel chans[], int maxchans, int *nchans, 154245d9abdbSWeongyo Jeong const struct bwn_channelinfo *ci, int flags) 154345d9abdbSWeongyo Jeong { 154445d9abdbSWeongyo Jeong struct ieee80211_channel *c; 154545d9abdbSWeongyo Jeong int i; 154645d9abdbSWeongyo Jeong 154745d9abdbSWeongyo Jeong c = &chans[*nchans]; 154845d9abdbSWeongyo Jeong 154945d9abdbSWeongyo Jeong for (i = 0; i < ci->nchannels; i++) { 155045d9abdbSWeongyo Jeong const struct bwn_channel *hc; 155145d9abdbSWeongyo Jeong 155245d9abdbSWeongyo Jeong hc = &ci->channels[i]; 155345d9abdbSWeongyo Jeong if (*nchans >= maxchans) 155445d9abdbSWeongyo Jeong break; 155545d9abdbSWeongyo Jeong bwn_addchan(c, hc->freq, flags, hc->ieee, hc->maxTxPow); 155645d9abdbSWeongyo Jeong c++, (*nchans)++; 155745d9abdbSWeongyo Jeong if (flags == IEEE80211_CHAN_G || flags == IEEE80211_CHAN_HTG) { 155845d9abdbSWeongyo Jeong /* g channel have a separate b-only entry */ 155945d9abdbSWeongyo Jeong if (*nchans >= maxchans) 156045d9abdbSWeongyo Jeong break; 156145d9abdbSWeongyo Jeong c[0] = c[-1]; 156245d9abdbSWeongyo Jeong c[-1].ic_flags = IEEE80211_CHAN_B; 156345d9abdbSWeongyo Jeong c++, (*nchans)++; 156445d9abdbSWeongyo Jeong } 156545d9abdbSWeongyo Jeong if (flags == IEEE80211_CHAN_HTG) { 156645d9abdbSWeongyo Jeong /* HT g channel have a separate g-only entry */ 156745d9abdbSWeongyo Jeong if (*nchans >= maxchans) 156845d9abdbSWeongyo Jeong break; 156945d9abdbSWeongyo Jeong c[-1].ic_flags = IEEE80211_CHAN_G; 157045d9abdbSWeongyo Jeong c[0] = c[-1]; 157145d9abdbSWeongyo Jeong c[0].ic_flags &= ~IEEE80211_CHAN_HT; 157245d9abdbSWeongyo Jeong c[0].ic_flags |= IEEE80211_CHAN_HT20; /* HT20 */ 157345d9abdbSWeongyo Jeong c++, (*nchans)++; 157445d9abdbSWeongyo Jeong } 157545d9abdbSWeongyo Jeong if (flags == IEEE80211_CHAN_HTA) { 157645d9abdbSWeongyo Jeong /* HT a channel have a separate a-only entry */ 157745d9abdbSWeongyo Jeong if (*nchans >= maxchans) 157845d9abdbSWeongyo Jeong break; 157945d9abdbSWeongyo Jeong c[-1].ic_flags = IEEE80211_CHAN_A; 158045d9abdbSWeongyo Jeong c[0] = c[-1]; 158145d9abdbSWeongyo Jeong c[0].ic_flags &= ~IEEE80211_CHAN_HT; 158245d9abdbSWeongyo Jeong c[0].ic_flags |= IEEE80211_CHAN_HT20; /* HT20 */ 158345d9abdbSWeongyo Jeong c++, (*nchans)++; 158445d9abdbSWeongyo Jeong } 158545d9abdbSWeongyo Jeong } 158645d9abdbSWeongyo Jeong } 158745d9abdbSWeongyo Jeong 158845d9abdbSWeongyo Jeong static int 158945d9abdbSWeongyo Jeong bwn_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 159045d9abdbSWeongyo Jeong const struct ieee80211_bpf_params *params) 159145d9abdbSWeongyo Jeong { 159245d9abdbSWeongyo Jeong struct ieee80211com *ic = ni->ni_ic; 15932cb71df1SAdrian Chadd struct bwn_softc *sc = ic->ic_softc; 159445d9abdbSWeongyo Jeong struct bwn_mac *mac = sc->sc_curmac; 1595d957a93aSAdrian Chadd int error; 159645d9abdbSWeongyo Jeong 15977a79cebfSGleb Smirnoff if ((sc->sc_flags & BWN_FLAG_RUNNING) == 0 || 159845d9abdbSWeongyo Jeong mac->mac_status < BWN_MAC_STATUS_STARTED) { 159945d9abdbSWeongyo Jeong m_freem(m); 160045d9abdbSWeongyo Jeong return (ENETDOWN); 160145d9abdbSWeongyo Jeong } 160245d9abdbSWeongyo Jeong 160345d9abdbSWeongyo Jeong BWN_LOCK(sc); 160445d9abdbSWeongyo Jeong if (bwn_tx_isfull(sc, m)) { 160545d9abdbSWeongyo Jeong m_freem(m); 160645d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 160745d9abdbSWeongyo Jeong return (ENOBUFS); 160845d9abdbSWeongyo Jeong } 160945d9abdbSWeongyo Jeong 1610d957a93aSAdrian Chadd error = bwn_tx_start(sc, ni, m); 1611d957a93aSAdrian Chadd if (error == 0) 161245d9abdbSWeongyo Jeong sc->sc_watchdog_timer = 5; 161345d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 1614d957a93aSAdrian Chadd return (error); 161545d9abdbSWeongyo Jeong } 161645d9abdbSWeongyo Jeong 161745d9abdbSWeongyo Jeong /* 161845d9abdbSWeongyo Jeong * Callback from the 802.11 layer to update the slot time 161945d9abdbSWeongyo Jeong * based on the current setting. We use it to notify the 162045d9abdbSWeongyo Jeong * firmware of ERP changes and the f/w takes care of things 162145d9abdbSWeongyo Jeong * like slot time and preamble. 162245d9abdbSWeongyo Jeong */ 162345d9abdbSWeongyo Jeong static void 1624272f6adeSGleb Smirnoff bwn_updateslot(struct ieee80211com *ic) 162545d9abdbSWeongyo Jeong { 1626272f6adeSGleb Smirnoff struct bwn_softc *sc = ic->ic_softc; 162745d9abdbSWeongyo Jeong struct bwn_mac *mac; 162845d9abdbSWeongyo Jeong 162945d9abdbSWeongyo Jeong BWN_LOCK(sc); 16307a79cebfSGleb Smirnoff if (sc->sc_flags & BWN_FLAG_RUNNING) { 163145d9abdbSWeongyo Jeong mac = (struct bwn_mac *)sc->sc_curmac; 1632bdfff33fSAndriy Voskoboinyk bwn_set_slot_time(mac, IEEE80211_GET_SLOTTIME(ic)); 163345d9abdbSWeongyo Jeong } 163445d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 163545d9abdbSWeongyo Jeong } 163645d9abdbSWeongyo Jeong 163745d9abdbSWeongyo Jeong /* 163845d9abdbSWeongyo Jeong * Callback from the 802.11 layer after a promiscuous mode change. 163945d9abdbSWeongyo Jeong * Note this interface does not check the operating mode as this 164045d9abdbSWeongyo Jeong * is an internal callback and we are expected to honor the current 164145d9abdbSWeongyo Jeong * state (e.g. this is used for setting the interface in promiscuous 164245d9abdbSWeongyo Jeong * mode when operating in hostap mode to do ACS). 164345d9abdbSWeongyo Jeong */ 164445d9abdbSWeongyo Jeong static void 1645272f6adeSGleb Smirnoff bwn_update_promisc(struct ieee80211com *ic) 164645d9abdbSWeongyo Jeong { 1647272f6adeSGleb Smirnoff struct bwn_softc *sc = ic->ic_softc; 164845d9abdbSWeongyo Jeong struct bwn_mac *mac = sc->sc_curmac; 164945d9abdbSWeongyo Jeong 165045d9abdbSWeongyo Jeong BWN_LOCK(sc); 165145d9abdbSWeongyo Jeong mac = sc->sc_curmac; 165245d9abdbSWeongyo Jeong if (mac != NULL && mac->mac_status >= BWN_MAC_STATUS_INITED) { 16537a79cebfSGleb Smirnoff if (ic->ic_promisc > 0) 165445d9abdbSWeongyo Jeong sc->sc_filters |= BWN_MACCTL_PROMISC; 165545d9abdbSWeongyo Jeong else 165645d9abdbSWeongyo Jeong sc->sc_filters &= ~BWN_MACCTL_PROMISC; 165745d9abdbSWeongyo Jeong bwn_set_opmode(mac); 165845d9abdbSWeongyo Jeong } 165945d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 166045d9abdbSWeongyo Jeong } 166145d9abdbSWeongyo Jeong 166245d9abdbSWeongyo Jeong /* 166345d9abdbSWeongyo Jeong * Callback from the 802.11 layer to update WME parameters. 166445d9abdbSWeongyo Jeong */ 166545d9abdbSWeongyo Jeong static int 166645d9abdbSWeongyo Jeong bwn_wme_update(struct ieee80211com *ic) 166745d9abdbSWeongyo Jeong { 16682cb71df1SAdrian Chadd struct bwn_softc *sc = ic->ic_softc; 166945d9abdbSWeongyo Jeong struct bwn_mac *mac = sc->sc_curmac; 167045d9abdbSWeongyo Jeong struct wmeParams *wmep; 167145d9abdbSWeongyo Jeong int i; 167245d9abdbSWeongyo Jeong 167345d9abdbSWeongyo Jeong BWN_LOCK(sc); 167445d9abdbSWeongyo Jeong mac = sc->sc_curmac; 167545d9abdbSWeongyo Jeong if (mac != NULL && mac->mac_status >= BWN_MAC_STATUS_INITED) { 167645d9abdbSWeongyo Jeong bwn_mac_suspend(mac); 167745d9abdbSWeongyo Jeong for (i = 0; i < N(sc->sc_wmeParams); i++) { 167845d9abdbSWeongyo Jeong wmep = &ic->ic_wme.wme_chanParams.cap_wmeParams[i]; 167945d9abdbSWeongyo Jeong bwn_wme_loadparams(mac, wmep, bwn_wme_shm_offsets[i]); 168045d9abdbSWeongyo Jeong } 168145d9abdbSWeongyo Jeong bwn_mac_enable(mac); 168245d9abdbSWeongyo Jeong } 168345d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 168445d9abdbSWeongyo Jeong return (0); 168545d9abdbSWeongyo Jeong } 168645d9abdbSWeongyo Jeong 168745d9abdbSWeongyo Jeong static void 168845d9abdbSWeongyo Jeong bwn_scan_start(struct ieee80211com *ic) 168945d9abdbSWeongyo Jeong { 16902cb71df1SAdrian Chadd struct bwn_softc *sc = ic->ic_softc; 169145d9abdbSWeongyo Jeong struct bwn_mac *mac; 169245d9abdbSWeongyo Jeong 169345d9abdbSWeongyo Jeong BWN_LOCK(sc); 169445d9abdbSWeongyo Jeong mac = sc->sc_curmac; 169545d9abdbSWeongyo Jeong if (mac != NULL && mac->mac_status >= BWN_MAC_STATUS_INITED) { 169645d9abdbSWeongyo Jeong sc->sc_filters |= BWN_MACCTL_BEACON_PROMISC; 169745d9abdbSWeongyo Jeong bwn_set_opmode(mac); 169845d9abdbSWeongyo Jeong /* disable CFP update during scan */ 169945d9abdbSWeongyo Jeong bwn_hf_write(mac, bwn_hf_read(mac) | BWN_HF_SKIP_CFP_UPDATE); 170045d9abdbSWeongyo Jeong } 170145d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 170245d9abdbSWeongyo Jeong } 170345d9abdbSWeongyo Jeong 170445d9abdbSWeongyo Jeong static void 170545d9abdbSWeongyo Jeong bwn_scan_end(struct ieee80211com *ic) 170645d9abdbSWeongyo Jeong { 17072cb71df1SAdrian Chadd struct bwn_softc *sc = ic->ic_softc; 170845d9abdbSWeongyo Jeong struct bwn_mac *mac; 170945d9abdbSWeongyo Jeong 171045d9abdbSWeongyo Jeong BWN_LOCK(sc); 171145d9abdbSWeongyo Jeong mac = sc->sc_curmac; 171245d9abdbSWeongyo Jeong if (mac != NULL && mac->mac_status >= BWN_MAC_STATUS_INITED) { 171345d9abdbSWeongyo Jeong sc->sc_filters &= ~BWN_MACCTL_BEACON_PROMISC; 171445d9abdbSWeongyo Jeong bwn_set_opmode(mac); 171545d9abdbSWeongyo Jeong bwn_hf_write(mac, bwn_hf_read(mac) & ~BWN_HF_SKIP_CFP_UPDATE); 171645d9abdbSWeongyo Jeong } 171745d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 171845d9abdbSWeongyo Jeong } 171945d9abdbSWeongyo Jeong 172045d9abdbSWeongyo Jeong static void 172145d9abdbSWeongyo Jeong bwn_set_channel(struct ieee80211com *ic) 172245d9abdbSWeongyo Jeong { 17232cb71df1SAdrian Chadd struct bwn_softc *sc = ic->ic_softc; 172445d9abdbSWeongyo Jeong struct bwn_mac *mac = sc->sc_curmac; 172545d9abdbSWeongyo Jeong struct bwn_phy *phy = &mac->mac_phy; 172645d9abdbSWeongyo Jeong int chan, error; 172745d9abdbSWeongyo Jeong 172845d9abdbSWeongyo Jeong BWN_LOCK(sc); 172945d9abdbSWeongyo Jeong 173045d9abdbSWeongyo Jeong error = bwn_switch_band(sc, ic->ic_curchan); 173145d9abdbSWeongyo Jeong if (error) 17327df9d5acSKevin Lo goto fail; 173345d9abdbSWeongyo Jeong bwn_mac_suspend(mac); 173445d9abdbSWeongyo Jeong bwn_set_txretry(mac, BWN_RETRY_SHORT, BWN_RETRY_LONG); 173545d9abdbSWeongyo Jeong chan = ieee80211_chan2ieee(ic, ic->ic_curchan); 173645d9abdbSWeongyo Jeong if (chan != phy->chan) 173745d9abdbSWeongyo Jeong bwn_switch_channel(mac, chan); 173845d9abdbSWeongyo Jeong 173945d9abdbSWeongyo Jeong /* TX power level */ 174045d9abdbSWeongyo Jeong if (ic->ic_curchan->ic_maxpower != 0 && 174145d9abdbSWeongyo Jeong ic->ic_curchan->ic_maxpower != phy->txpower) { 174245d9abdbSWeongyo Jeong phy->txpower = ic->ic_curchan->ic_maxpower / 2; 174345d9abdbSWeongyo Jeong bwn_phy_txpower_check(mac, BWN_TXPWR_IGNORE_TIME | 174445d9abdbSWeongyo Jeong BWN_TXPWR_IGNORE_TSSI); 174545d9abdbSWeongyo Jeong } 174645d9abdbSWeongyo Jeong 174745d9abdbSWeongyo Jeong bwn_set_txantenna(mac, BWN_ANT_DEFAULT); 174845d9abdbSWeongyo Jeong if (phy->set_antenna) 174945d9abdbSWeongyo Jeong phy->set_antenna(mac, BWN_ANT_DEFAULT); 175045d9abdbSWeongyo Jeong 175145d9abdbSWeongyo Jeong if (sc->sc_rf_enabled != phy->rf_on) { 175245d9abdbSWeongyo Jeong if (sc->sc_rf_enabled) { 175345d9abdbSWeongyo Jeong bwn_rf_turnon(mac); 175445d9abdbSWeongyo Jeong if (!(mac->mac_flags & BWN_MAC_FLAG_RADIO_ON)) 175545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 17564e33fc94SJoel Dahl "please turn on the RF switch\n"); 175745d9abdbSWeongyo Jeong } else 175845d9abdbSWeongyo Jeong bwn_rf_turnoff(mac); 175945d9abdbSWeongyo Jeong } 176045d9abdbSWeongyo Jeong 176145d9abdbSWeongyo Jeong bwn_mac_enable(mac); 176245d9abdbSWeongyo Jeong 176345d9abdbSWeongyo Jeong fail: 176445d9abdbSWeongyo Jeong /* 176545d9abdbSWeongyo Jeong * Setup radio tap channel freq and flags 176645d9abdbSWeongyo Jeong */ 176745d9abdbSWeongyo Jeong sc->sc_tx_th.wt_chan_freq = sc->sc_rx_th.wr_chan_freq = 176845d9abdbSWeongyo Jeong htole16(ic->ic_curchan->ic_freq); 176945d9abdbSWeongyo Jeong sc->sc_tx_th.wt_chan_flags = sc->sc_rx_th.wr_chan_flags = 177045d9abdbSWeongyo Jeong htole16(ic->ic_curchan->ic_flags & 0xffff); 177145d9abdbSWeongyo Jeong 177245d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 177345d9abdbSWeongyo Jeong } 177445d9abdbSWeongyo Jeong 177545d9abdbSWeongyo Jeong static struct ieee80211vap * 1776fcd9500fSBernhard Schmidt bwn_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit, 1777fcd9500fSBernhard Schmidt enum ieee80211_opmode opmode, int flags, 177845d9abdbSWeongyo Jeong const uint8_t bssid[IEEE80211_ADDR_LEN], 17797a79cebfSGleb Smirnoff const uint8_t mac[IEEE80211_ADDR_LEN]) 178045d9abdbSWeongyo Jeong { 178145d9abdbSWeongyo Jeong struct ieee80211vap *vap; 178245d9abdbSWeongyo Jeong struct bwn_vap *bvp; 178345d9abdbSWeongyo Jeong 178445d9abdbSWeongyo Jeong switch (opmode) { 178545d9abdbSWeongyo Jeong case IEEE80211_M_HOSTAP: 178645d9abdbSWeongyo Jeong case IEEE80211_M_MBSS: 178745d9abdbSWeongyo Jeong case IEEE80211_M_STA: 178845d9abdbSWeongyo Jeong case IEEE80211_M_WDS: 178945d9abdbSWeongyo Jeong case IEEE80211_M_MONITOR: 179045d9abdbSWeongyo Jeong case IEEE80211_M_IBSS: 179145d9abdbSWeongyo Jeong case IEEE80211_M_AHDEMO: 179245d9abdbSWeongyo Jeong break; 179345d9abdbSWeongyo Jeong default: 179445d9abdbSWeongyo Jeong return (NULL); 179545d9abdbSWeongyo Jeong } 179645d9abdbSWeongyo Jeong 17977a79cebfSGleb Smirnoff bvp = malloc(sizeof(struct bwn_vap), M_80211_VAP, M_WAITOK | M_ZERO); 179845d9abdbSWeongyo Jeong vap = &bvp->bv_vap; 17997a79cebfSGleb Smirnoff ieee80211_vap_setup(ic, vap, name, unit, opmode, flags, bssid); 180045d9abdbSWeongyo Jeong /* override with driver methods */ 180145d9abdbSWeongyo Jeong bvp->bv_newstate = vap->iv_newstate; 180245d9abdbSWeongyo Jeong vap->iv_newstate = bwn_newstate; 180345d9abdbSWeongyo Jeong 180445d9abdbSWeongyo Jeong /* override max aid so sta's cannot assoc when we're out of sta id's */ 180545d9abdbSWeongyo Jeong vap->iv_max_aid = BWN_STAID_MAX; 180645d9abdbSWeongyo Jeong 1807b6108616SRui Paulo ieee80211_ratectl_init(vap); 180845d9abdbSWeongyo Jeong 180945d9abdbSWeongyo Jeong /* complete setup */ 181045d9abdbSWeongyo Jeong ieee80211_vap_attach(vap, ieee80211_media_change, 18117a79cebfSGleb Smirnoff ieee80211_media_status, mac); 181245d9abdbSWeongyo Jeong return (vap); 181345d9abdbSWeongyo Jeong } 181445d9abdbSWeongyo Jeong 181545d9abdbSWeongyo Jeong static void 181645d9abdbSWeongyo Jeong bwn_vap_delete(struct ieee80211vap *vap) 181745d9abdbSWeongyo Jeong { 181845d9abdbSWeongyo Jeong struct bwn_vap *bvp = BWN_VAP(vap); 181945d9abdbSWeongyo Jeong 1820b6108616SRui Paulo ieee80211_ratectl_deinit(vap); 182145d9abdbSWeongyo Jeong ieee80211_vap_detach(vap); 182245d9abdbSWeongyo Jeong free(bvp, M_80211_VAP); 182345d9abdbSWeongyo Jeong } 182445d9abdbSWeongyo Jeong 182545d9abdbSWeongyo Jeong static int 18267a79cebfSGleb Smirnoff bwn_init(struct bwn_softc *sc) 182745d9abdbSWeongyo Jeong { 182845d9abdbSWeongyo Jeong struct bwn_mac *mac; 182945d9abdbSWeongyo Jeong int error; 183045d9abdbSWeongyo Jeong 183145d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 183245d9abdbSWeongyo Jeong 183345d9abdbSWeongyo Jeong bzero(sc->sc_bssid, IEEE80211_ADDR_LEN); 183445d9abdbSWeongyo Jeong sc->sc_flags |= BWN_FLAG_NEED_BEACON_TP; 183545d9abdbSWeongyo Jeong sc->sc_filters = 0; 183645d9abdbSWeongyo Jeong bwn_wme_clear(sc); 183745d9abdbSWeongyo Jeong sc->sc_beacons[0] = sc->sc_beacons[1] = 0; 183845d9abdbSWeongyo Jeong sc->sc_rf_enabled = 1; 183945d9abdbSWeongyo Jeong 184045d9abdbSWeongyo Jeong mac = sc->sc_curmac; 184145d9abdbSWeongyo Jeong if (mac->mac_status == BWN_MAC_STATUS_UNINIT) { 184245d9abdbSWeongyo Jeong error = bwn_core_init(mac); 184345d9abdbSWeongyo Jeong if (error != 0) 184445d9abdbSWeongyo Jeong return (error); 184545d9abdbSWeongyo Jeong } 184645d9abdbSWeongyo Jeong if (mac->mac_status == BWN_MAC_STATUS_INITED) 184745d9abdbSWeongyo Jeong bwn_core_start(mac); 184845d9abdbSWeongyo Jeong 184945d9abdbSWeongyo Jeong bwn_set_opmode(mac); 185045d9abdbSWeongyo Jeong bwn_set_pretbtt(mac); 185145d9abdbSWeongyo Jeong bwn_spu_setdelay(mac, 0); 185245d9abdbSWeongyo Jeong bwn_set_macaddr(mac); 185345d9abdbSWeongyo Jeong 18547a79cebfSGleb Smirnoff sc->sc_flags |= BWN_FLAG_RUNNING; 185545d9abdbSWeongyo Jeong callout_reset(&sc->sc_rfswitch_ch, hz, bwn_rfswitch, sc); 185645d9abdbSWeongyo Jeong callout_reset(&sc->sc_watchdog_ch, hz, bwn_watchdog, sc); 185745d9abdbSWeongyo Jeong 185845d9abdbSWeongyo Jeong return (0); 185945d9abdbSWeongyo Jeong } 186045d9abdbSWeongyo Jeong 186145d9abdbSWeongyo Jeong static void 18627a79cebfSGleb Smirnoff bwn_stop(struct bwn_softc *sc) 186345d9abdbSWeongyo Jeong { 186445d9abdbSWeongyo Jeong struct bwn_mac *mac = sc->sc_curmac; 186545d9abdbSWeongyo Jeong 186645d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 186745d9abdbSWeongyo Jeong 186845d9abdbSWeongyo Jeong if (mac->mac_status >= BWN_MAC_STATUS_INITED) { 186945d9abdbSWeongyo Jeong /* XXX FIXME opmode not based on VAP */ 187045d9abdbSWeongyo Jeong bwn_set_opmode(mac); 187145d9abdbSWeongyo Jeong bwn_set_macaddr(mac); 187245d9abdbSWeongyo Jeong } 187345d9abdbSWeongyo Jeong 187445d9abdbSWeongyo Jeong if (mac->mac_status >= BWN_MAC_STATUS_STARTED) 187545d9abdbSWeongyo Jeong bwn_core_stop(mac); 187645d9abdbSWeongyo Jeong 187745d9abdbSWeongyo Jeong callout_stop(&sc->sc_led_blink_ch); 187845d9abdbSWeongyo Jeong sc->sc_led_blinking = 0; 187945d9abdbSWeongyo Jeong 188045d9abdbSWeongyo Jeong bwn_core_exit(mac); 188145d9abdbSWeongyo Jeong sc->sc_rf_enabled = 0; 188245d9abdbSWeongyo Jeong 18837a79cebfSGleb Smirnoff sc->sc_flags &= ~BWN_FLAG_RUNNING; 188445d9abdbSWeongyo Jeong } 188545d9abdbSWeongyo Jeong 188645d9abdbSWeongyo Jeong static void 188745d9abdbSWeongyo Jeong bwn_wme_clear(struct bwn_softc *sc) 188845d9abdbSWeongyo Jeong { 188945d9abdbSWeongyo Jeong #define MS(_v, _f) (((_v) & _f) >> _f##_S) 189045d9abdbSWeongyo Jeong struct wmeParams *p; 189145d9abdbSWeongyo Jeong unsigned int i; 189245d9abdbSWeongyo Jeong 189345d9abdbSWeongyo Jeong KASSERT(N(bwn_wme_shm_offsets) == N(sc->sc_wmeParams), 189445d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 189545d9abdbSWeongyo Jeong 189645d9abdbSWeongyo Jeong for (i = 0; i < N(sc->sc_wmeParams); i++) { 189745d9abdbSWeongyo Jeong p = &(sc->sc_wmeParams[i]); 189845d9abdbSWeongyo Jeong 189945d9abdbSWeongyo Jeong switch (bwn_wme_shm_offsets[i]) { 190045d9abdbSWeongyo Jeong case BWN_WME_VOICE: 190145d9abdbSWeongyo Jeong p->wmep_txopLimit = 0; 190245d9abdbSWeongyo Jeong p->wmep_aifsn = 2; 190345d9abdbSWeongyo Jeong /* XXX FIXME: log2(cwmin) */ 190445d9abdbSWeongyo Jeong p->wmep_logcwmin = MS(0x0001, WME_PARAM_LOGCWMIN); 190545d9abdbSWeongyo Jeong p->wmep_logcwmax = MS(0x0001, WME_PARAM_LOGCWMAX); 190645d9abdbSWeongyo Jeong break; 190745d9abdbSWeongyo Jeong case BWN_WME_VIDEO: 190845d9abdbSWeongyo Jeong p->wmep_txopLimit = 0; 190945d9abdbSWeongyo Jeong p->wmep_aifsn = 2; 191045d9abdbSWeongyo Jeong /* XXX FIXME: log2(cwmin) */ 191145d9abdbSWeongyo Jeong p->wmep_logcwmin = MS(0x0001, WME_PARAM_LOGCWMIN); 191245d9abdbSWeongyo Jeong p->wmep_logcwmax = MS(0x0001, WME_PARAM_LOGCWMAX); 191345d9abdbSWeongyo Jeong break; 191445d9abdbSWeongyo Jeong case BWN_WME_BESTEFFORT: 191545d9abdbSWeongyo Jeong p->wmep_txopLimit = 0; 191645d9abdbSWeongyo Jeong p->wmep_aifsn = 3; 191745d9abdbSWeongyo Jeong /* XXX FIXME: log2(cwmin) */ 191845d9abdbSWeongyo Jeong p->wmep_logcwmin = MS(0x0001, WME_PARAM_LOGCWMIN); 191945d9abdbSWeongyo Jeong p->wmep_logcwmax = MS(0x03ff, WME_PARAM_LOGCWMAX); 192045d9abdbSWeongyo Jeong break; 192145d9abdbSWeongyo Jeong case BWN_WME_BACKGROUND: 192245d9abdbSWeongyo Jeong p->wmep_txopLimit = 0; 192345d9abdbSWeongyo Jeong p->wmep_aifsn = 7; 192445d9abdbSWeongyo Jeong /* XXX FIXME: log2(cwmin) */ 192545d9abdbSWeongyo Jeong p->wmep_logcwmin = MS(0x0001, WME_PARAM_LOGCWMIN); 192645d9abdbSWeongyo Jeong p->wmep_logcwmax = MS(0x03ff, WME_PARAM_LOGCWMAX); 192745d9abdbSWeongyo Jeong break; 192845d9abdbSWeongyo Jeong default: 192945d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 193045d9abdbSWeongyo Jeong } 193145d9abdbSWeongyo Jeong } 193245d9abdbSWeongyo Jeong } 193345d9abdbSWeongyo Jeong 193445d9abdbSWeongyo Jeong static int 193545d9abdbSWeongyo Jeong bwn_core_init(struct bwn_mac *mac) 193645d9abdbSWeongyo Jeong { 193745d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 193845d9abdbSWeongyo Jeong uint64_t hf; 193945d9abdbSWeongyo Jeong int error; 194045d9abdbSWeongyo Jeong 194145d9abdbSWeongyo Jeong KASSERT(mac->mac_status == BWN_MAC_STATUS_UNINIT, 194245d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 194345d9abdbSWeongyo Jeong 1944b9b64aa5SWeongyo Jeong siba_powerup(sc->sc_dev, 0); 1945b9b64aa5SWeongyo Jeong if (!siba_dev_isup(sc->sc_dev)) 194645d9abdbSWeongyo Jeong bwn_reset_core(mac, 194745d9abdbSWeongyo Jeong mac->mac_phy.gmode ? BWN_TGSLOW_SUPPORT_G : 0); 194845d9abdbSWeongyo Jeong 194945d9abdbSWeongyo Jeong mac->mac_flags &= ~BWN_MAC_FLAG_DFQVALID; 195045d9abdbSWeongyo Jeong mac->mac_flags |= BWN_MAC_FLAG_RADIO_ON; 195145d9abdbSWeongyo Jeong mac->mac_phy.hwpctl = (bwn_hwpctl) ? 1 : 0; 195245d9abdbSWeongyo Jeong BWN_GETTIME(mac->mac_phy.nexttime); 195345d9abdbSWeongyo Jeong mac->mac_phy.txerrors = BWN_TXERROR_MAX; 195445d9abdbSWeongyo Jeong bzero(&mac->mac_stats, sizeof(mac->mac_stats)); 195545d9abdbSWeongyo Jeong mac->mac_stats.link_noise = -95; 195645d9abdbSWeongyo Jeong mac->mac_reason_intr = 0; 195745d9abdbSWeongyo Jeong bzero(mac->mac_reason, sizeof(mac->mac_reason)); 195845d9abdbSWeongyo Jeong mac->mac_intr_mask = BWN_INTR_MASKTEMPLATE; 195945d9abdbSWeongyo Jeong #ifdef BWN_DEBUG 196045d9abdbSWeongyo Jeong if (sc->sc_debug & BWN_DEBUG_XMIT) 196145d9abdbSWeongyo Jeong mac->mac_intr_mask &= ~BWN_INTR_PHY_TXERR; 196245d9abdbSWeongyo Jeong #endif 196345d9abdbSWeongyo Jeong mac->mac_suspended = 1; 196445d9abdbSWeongyo Jeong mac->mac_task_state = 0; 196545d9abdbSWeongyo Jeong memset(&mac->mac_noise, 0, sizeof(mac->mac_noise)); 196645d9abdbSWeongyo Jeong 196745d9abdbSWeongyo Jeong mac->mac_phy.init_pre(mac); 196845d9abdbSWeongyo Jeong 1969b9b64aa5SWeongyo Jeong siba_pcicore_intr(sc->sc_dev); 197045d9abdbSWeongyo Jeong 1971b9b64aa5SWeongyo Jeong siba_fix_imcfglobug(sc->sc_dev); 197245d9abdbSWeongyo Jeong bwn_bt_disable(mac); 197345d9abdbSWeongyo Jeong if (mac->mac_phy.prepare_hw) { 197445d9abdbSWeongyo Jeong error = mac->mac_phy.prepare_hw(mac); 197545d9abdbSWeongyo Jeong if (error) 197645d9abdbSWeongyo Jeong goto fail0; 197745d9abdbSWeongyo Jeong } 197845d9abdbSWeongyo Jeong error = bwn_chip_init(mac); 197945d9abdbSWeongyo Jeong if (error) 198045d9abdbSWeongyo Jeong goto fail0; 198145d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_COREREV, 1982b9b64aa5SWeongyo Jeong siba_get_revid(sc->sc_dev)); 198345d9abdbSWeongyo Jeong hf = bwn_hf_read(mac); 198445d9abdbSWeongyo Jeong if (mac->mac_phy.type == BWN_PHYTYPE_G) { 198545d9abdbSWeongyo Jeong hf |= BWN_HF_GPHY_SYM_WORKAROUND; 1986b9b64aa5SWeongyo Jeong if (siba_sprom_get_bf_lo(sc->sc_dev) & BWN_BFL_PACTRL) 198745d9abdbSWeongyo Jeong hf |= BWN_HF_PAGAINBOOST_OFDM_ON; 198845d9abdbSWeongyo Jeong if (mac->mac_phy.rev == 1) 198945d9abdbSWeongyo Jeong hf |= BWN_HF_GPHY_DC_CANCELFILTER; 199045d9abdbSWeongyo Jeong } 199145d9abdbSWeongyo Jeong if (mac->mac_phy.rf_ver == 0x2050) { 199245d9abdbSWeongyo Jeong if (mac->mac_phy.rf_rev < 6) 199345d9abdbSWeongyo Jeong hf |= BWN_HF_FORCE_VCO_RECALC; 199445d9abdbSWeongyo Jeong if (mac->mac_phy.rf_rev == 6) 199545d9abdbSWeongyo Jeong hf |= BWN_HF_4318_TSSI; 199645d9abdbSWeongyo Jeong } 1997b9b64aa5SWeongyo Jeong if (siba_sprom_get_bf_lo(sc->sc_dev) & BWN_BFL_CRYSTAL_NOSLOW) 199845d9abdbSWeongyo Jeong hf |= BWN_HF_SLOWCLOCK_REQ_OFF; 1999b9b64aa5SWeongyo Jeong if ((siba_get_type(sc->sc_dev) == SIBA_TYPE_PCI) && 2000b9b64aa5SWeongyo Jeong (siba_get_pcicore_revid(sc->sc_dev) <= 10)) 200145d9abdbSWeongyo Jeong hf |= BWN_HF_PCI_SLOWCLOCK_WORKAROUND; 200245d9abdbSWeongyo Jeong hf &= ~BWN_HF_SKIP_CFP_UPDATE; 200345d9abdbSWeongyo Jeong bwn_hf_write(mac, hf); 200445d9abdbSWeongyo Jeong 200545d9abdbSWeongyo Jeong bwn_set_txretry(mac, BWN_RETRY_SHORT, BWN_RETRY_LONG); 200645d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_SHORT_RETRY_FALLBACK, 3); 200745d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_LONG_RETRY_FALLBACK, 2); 200845d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_PROBE_RESP_MAXTIME, 1); 200945d9abdbSWeongyo Jeong 201045d9abdbSWeongyo Jeong bwn_rate_init(mac); 201145d9abdbSWeongyo Jeong bwn_set_phytxctl(mac); 201245d9abdbSWeongyo Jeong 201345d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SCRATCH, BWN_SCRATCH_CONT_MIN, 201445d9abdbSWeongyo Jeong (mac->mac_phy.type == BWN_PHYTYPE_B) ? 0x1f : 0xf); 201545d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SCRATCH, BWN_SCRATCH_CONT_MAX, 0x3ff); 201645d9abdbSWeongyo Jeong 2017b9b64aa5SWeongyo Jeong if (siba_get_type(sc->sc_dev) == SIBA_TYPE_PCMCIA || bwn_usedma == 0) 201845d9abdbSWeongyo Jeong bwn_pio_init(mac); 201945d9abdbSWeongyo Jeong else 202045d9abdbSWeongyo Jeong bwn_dma_init(mac); 202145d9abdbSWeongyo Jeong bwn_wme_init(mac); 202245d9abdbSWeongyo Jeong bwn_spu_setdelay(mac, 1); 202345d9abdbSWeongyo Jeong bwn_bt_enable(mac); 202445d9abdbSWeongyo Jeong 2025b9b64aa5SWeongyo Jeong siba_powerup(sc->sc_dev, 2026b9b64aa5SWeongyo Jeong !(siba_sprom_get_bf_lo(sc->sc_dev) & BWN_BFL_CRYSTAL_NOSLOW)); 202745d9abdbSWeongyo Jeong bwn_set_macaddr(mac); 202845d9abdbSWeongyo Jeong bwn_crypt_init(mac); 202945d9abdbSWeongyo Jeong 203045d9abdbSWeongyo Jeong /* XXX LED initializatin */ 203145d9abdbSWeongyo Jeong 203245d9abdbSWeongyo Jeong mac->mac_status = BWN_MAC_STATUS_INITED; 203345d9abdbSWeongyo Jeong 203445d9abdbSWeongyo Jeong return (error); 203545d9abdbSWeongyo Jeong 203645d9abdbSWeongyo Jeong fail0: 2037b9b64aa5SWeongyo Jeong siba_powerdown(sc->sc_dev); 203845d9abdbSWeongyo Jeong KASSERT(mac->mac_status == BWN_MAC_STATUS_UNINIT, 203945d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 204045d9abdbSWeongyo Jeong return (error); 204145d9abdbSWeongyo Jeong } 204245d9abdbSWeongyo Jeong 204345d9abdbSWeongyo Jeong static void 204445d9abdbSWeongyo Jeong bwn_core_start(struct bwn_mac *mac) 204545d9abdbSWeongyo Jeong { 204645d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 204745d9abdbSWeongyo Jeong uint32_t tmp; 204845d9abdbSWeongyo Jeong 204945d9abdbSWeongyo Jeong KASSERT(mac->mac_status == BWN_MAC_STATUS_INITED, 205045d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 205145d9abdbSWeongyo Jeong 2052b9b64aa5SWeongyo Jeong if (siba_get_revid(sc->sc_dev) < 5) 205345d9abdbSWeongyo Jeong return; 205445d9abdbSWeongyo Jeong 205545d9abdbSWeongyo Jeong while (1) { 205645d9abdbSWeongyo Jeong tmp = BWN_READ_4(mac, BWN_XMITSTAT_0); 205745d9abdbSWeongyo Jeong if (!(tmp & 0x00000001)) 205845d9abdbSWeongyo Jeong break; 205945d9abdbSWeongyo Jeong tmp = BWN_READ_4(mac, BWN_XMITSTAT_1); 206045d9abdbSWeongyo Jeong } 206145d9abdbSWeongyo Jeong 206245d9abdbSWeongyo Jeong bwn_mac_enable(mac); 206345d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_INTR_MASK, mac->mac_intr_mask); 206445d9abdbSWeongyo Jeong callout_reset(&sc->sc_task_ch, hz * 15, bwn_tasks, mac); 206545d9abdbSWeongyo Jeong 206645d9abdbSWeongyo Jeong mac->mac_status = BWN_MAC_STATUS_STARTED; 206745d9abdbSWeongyo Jeong } 206845d9abdbSWeongyo Jeong 206945d9abdbSWeongyo Jeong static void 207045d9abdbSWeongyo Jeong bwn_core_exit(struct bwn_mac *mac) 207145d9abdbSWeongyo Jeong { 2072b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 207345d9abdbSWeongyo Jeong uint32_t macctl; 207445d9abdbSWeongyo Jeong 20750d05eee2SWarner Losh BWN_ASSERT_LOCKED(mac->mac_sc); 207645d9abdbSWeongyo Jeong 207745d9abdbSWeongyo Jeong KASSERT(mac->mac_status <= BWN_MAC_STATUS_INITED, 207845d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 207945d9abdbSWeongyo Jeong 208045d9abdbSWeongyo Jeong if (mac->mac_status != BWN_MAC_STATUS_INITED) 208145d9abdbSWeongyo Jeong return; 208245d9abdbSWeongyo Jeong mac->mac_status = BWN_MAC_STATUS_UNINIT; 208345d9abdbSWeongyo Jeong 208445d9abdbSWeongyo Jeong macctl = BWN_READ_4(mac, BWN_MACCTL); 208545d9abdbSWeongyo Jeong macctl &= ~BWN_MACCTL_MCODE_RUN; 208645d9abdbSWeongyo Jeong macctl |= BWN_MACCTL_MCODE_JMP0; 208745d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, macctl); 208845d9abdbSWeongyo Jeong 208945d9abdbSWeongyo Jeong bwn_dma_stop(mac); 209045d9abdbSWeongyo Jeong bwn_pio_stop(mac); 209145d9abdbSWeongyo Jeong bwn_chip_exit(mac); 209245d9abdbSWeongyo Jeong mac->mac_phy.switch_analog(mac, 0); 2093b9b64aa5SWeongyo Jeong siba_dev_down(sc->sc_dev, 0); 2094b9b64aa5SWeongyo Jeong siba_powerdown(sc->sc_dev); 209545d9abdbSWeongyo Jeong } 209645d9abdbSWeongyo Jeong 209745d9abdbSWeongyo Jeong static void 209845d9abdbSWeongyo Jeong bwn_bt_disable(struct bwn_mac *mac) 209945d9abdbSWeongyo Jeong { 210045d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 210145d9abdbSWeongyo Jeong 210245d9abdbSWeongyo Jeong (void)sc; 210345d9abdbSWeongyo Jeong /* XXX do nothing yet */ 210445d9abdbSWeongyo Jeong } 210545d9abdbSWeongyo Jeong 210645d9abdbSWeongyo Jeong static int 210745d9abdbSWeongyo Jeong bwn_chip_init(struct bwn_mac *mac) 210845d9abdbSWeongyo Jeong { 2109b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 211045d9abdbSWeongyo Jeong struct bwn_phy *phy = &mac->mac_phy; 211145d9abdbSWeongyo Jeong uint32_t macctl; 211245d9abdbSWeongyo Jeong int error; 211345d9abdbSWeongyo Jeong 211445d9abdbSWeongyo Jeong macctl = BWN_MACCTL_IHR_ON | BWN_MACCTL_SHM_ON | BWN_MACCTL_STA; 211545d9abdbSWeongyo Jeong if (phy->gmode) 211645d9abdbSWeongyo Jeong macctl |= BWN_MACCTL_GMODE; 211745d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, macctl); 211845d9abdbSWeongyo Jeong 211945d9abdbSWeongyo Jeong error = bwn_fw_fillinfo(mac); 212045d9abdbSWeongyo Jeong if (error) 212145d9abdbSWeongyo Jeong return (error); 212245d9abdbSWeongyo Jeong error = bwn_fw_loaducode(mac); 212345d9abdbSWeongyo Jeong if (error) 212445d9abdbSWeongyo Jeong return (error); 212545d9abdbSWeongyo Jeong 212645d9abdbSWeongyo Jeong error = bwn_gpio_init(mac); 212745d9abdbSWeongyo Jeong if (error) 212845d9abdbSWeongyo Jeong return (error); 212945d9abdbSWeongyo Jeong 213045d9abdbSWeongyo Jeong error = bwn_fw_loadinitvals(mac); 213145d9abdbSWeongyo Jeong if (error) { 2132b9b64aa5SWeongyo Jeong siba_gpio_set(sc->sc_dev, 0); 213345d9abdbSWeongyo Jeong return (error); 213445d9abdbSWeongyo Jeong } 213545d9abdbSWeongyo Jeong phy->switch_analog(mac, 1); 213645d9abdbSWeongyo Jeong error = bwn_phy_init(mac); 213745d9abdbSWeongyo Jeong if (error) { 2138b9b64aa5SWeongyo Jeong siba_gpio_set(sc->sc_dev, 0); 213945d9abdbSWeongyo Jeong return (error); 214045d9abdbSWeongyo Jeong } 214145d9abdbSWeongyo Jeong if (phy->set_im) 214245d9abdbSWeongyo Jeong phy->set_im(mac, BWN_IMMODE_NONE); 214345d9abdbSWeongyo Jeong if (phy->set_antenna) 214445d9abdbSWeongyo Jeong phy->set_antenna(mac, BWN_ANT_DEFAULT); 214545d9abdbSWeongyo Jeong bwn_set_txantenna(mac, BWN_ANT_DEFAULT); 214645d9abdbSWeongyo Jeong 214745d9abdbSWeongyo Jeong if (phy->type == BWN_PHYTYPE_B) 214845d9abdbSWeongyo Jeong BWN_WRITE_2(mac, 0x005e, BWN_READ_2(mac, 0x005e) | 0x0004); 214945d9abdbSWeongyo Jeong BWN_WRITE_4(mac, 0x0100, 0x01000000); 2150b9b64aa5SWeongyo Jeong if (siba_get_revid(sc->sc_dev) < 5) 215145d9abdbSWeongyo Jeong BWN_WRITE_4(mac, 0x010c, 0x01000000); 215245d9abdbSWeongyo Jeong 215345d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, 215445d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_MACCTL) & ~BWN_MACCTL_STA); 215545d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, 215645d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_MACCTL) | BWN_MACCTL_STA); 215745d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, 0x0074, 0x0000); 215845d9abdbSWeongyo Jeong 215945d9abdbSWeongyo Jeong bwn_set_opmode(mac); 2160b9b64aa5SWeongyo Jeong if (siba_get_revid(sc->sc_dev) < 3) { 216145d9abdbSWeongyo Jeong BWN_WRITE_2(mac, 0x060e, 0x0000); 216245d9abdbSWeongyo Jeong BWN_WRITE_2(mac, 0x0610, 0x8000); 216345d9abdbSWeongyo Jeong BWN_WRITE_2(mac, 0x0604, 0x0000); 216445d9abdbSWeongyo Jeong BWN_WRITE_2(mac, 0x0606, 0x0200); 216545d9abdbSWeongyo Jeong } else { 216645d9abdbSWeongyo Jeong BWN_WRITE_4(mac, 0x0188, 0x80000000); 216745d9abdbSWeongyo Jeong BWN_WRITE_4(mac, 0x018c, 0x02000000); 216845d9abdbSWeongyo Jeong } 216945d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_INTR_REASON, 0x00004000); 217045d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_DMA0_INTR_MASK, 0x0001dc00); 217145d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_DMA1_INTR_MASK, 0x0000dc00); 217245d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_DMA2_INTR_MASK, 0x0000dc00); 217345d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_DMA3_INTR_MASK, 0x0001dc00); 217445d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_DMA4_INTR_MASK, 0x0000dc00); 217545d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_DMA5_INTR_MASK, 0x0000dc00); 2176b9b64aa5SWeongyo Jeong siba_write_4(sc->sc_dev, SIBA_TGSLOW, 2177b9b64aa5SWeongyo Jeong siba_read_4(sc->sc_dev, SIBA_TGSLOW) | 0x00100000); 2178b9b64aa5SWeongyo Jeong BWN_WRITE_2(mac, BWN_POWERUP_DELAY, siba_get_cc_powerdelay(sc->sc_dev)); 217945d9abdbSWeongyo Jeong return (error); 218045d9abdbSWeongyo Jeong } 218145d9abdbSWeongyo Jeong 218245d9abdbSWeongyo Jeong /* read hostflags */ 2183b9768303SAdrian Chadd uint64_t 218445d9abdbSWeongyo Jeong bwn_hf_read(struct bwn_mac *mac) 218545d9abdbSWeongyo Jeong { 218645d9abdbSWeongyo Jeong uint64_t ret; 218745d9abdbSWeongyo Jeong 218845d9abdbSWeongyo Jeong ret = bwn_shm_read_2(mac, BWN_SHARED, BWN_SHARED_HFHI); 218945d9abdbSWeongyo Jeong ret <<= 16; 219045d9abdbSWeongyo Jeong ret |= bwn_shm_read_2(mac, BWN_SHARED, BWN_SHARED_HFMI); 219145d9abdbSWeongyo Jeong ret <<= 16; 219245d9abdbSWeongyo Jeong ret |= bwn_shm_read_2(mac, BWN_SHARED, BWN_SHARED_HFLO); 219345d9abdbSWeongyo Jeong return (ret); 219445d9abdbSWeongyo Jeong } 219545d9abdbSWeongyo Jeong 2196b9768303SAdrian Chadd void 219745d9abdbSWeongyo Jeong bwn_hf_write(struct bwn_mac *mac, uint64_t value) 219845d9abdbSWeongyo Jeong { 219945d9abdbSWeongyo Jeong 220045d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_HFLO, 220145d9abdbSWeongyo Jeong (value & 0x00000000ffffull)); 220245d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_HFMI, 220345d9abdbSWeongyo Jeong (value & 0x0000ffff0000ull) >> 16); 220445d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_HFHI, 220545d9abdbSWeongyo Jeong (value & 0xffff00000000ULL) >> 32); 220645d9abdbSWeongyo Jeong } 220745d9abdbSWeongyo Jeong 220845d9abdbSWeongyo Jeong static void 220945d9abdbSWeongyo Jeong bwn_set_txretry(struct bwn_mac *mac, int s, int l) 221045d9abdbSWeongyo Jeong { 221145d9abdbSWeongyo Jeong 221245d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SCRATCH, BWN_SCRATCH_SHORT_RETRY, MIN(s, 0xf)); 221345d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SCRATCH, BWN_SCRATCH_LONG_RETRY, MIN(l, 0xf)); 221445d9abdbSWeongyo Jeong } 221545d9abdbSWeongyo Jeong 221645d9abdbSWeongyo Jeong static void 221745d9abdbSWeongyo Jeong bwn_rate_init(struct bwn_mac *mac) 221845d9abdbSWeongyo Jeong { 221945d9abdbSWeongyo Jeong 222045d9abdbSWeongyo Jeong switch (mac->mac_phy.type) { 222145d9abdbSWeongyo Jeong case BWN_PHYTYPE_A: 222245d9abdbSWeongyo Jeong case BWN_PHYTYPE_G: 222345d9abdbSWeongyo Jeong case BWN_PHYTYPE_LP: 222445d9abdbSWeongyo Jeong case BWN_PHYTYPE_N: 222545d9abdbSWeongyo Jeong bwn_rate_write(mac, BWN_OFDM_RATE_6MB, 1); 222645d9abdbSWeongyo Jeong bwn_rate_write(mac, BWN_OFDM_RATE_12MB, 1); 222745d9abdbSWeongyo Jeong bwn_rate_write(mac, BWN_OFDM_RATE_18MB, 1); 222845d9abdbSWeongyo Jeong bwn_rate_write(mac, BWN_OFDM_RATE_24MB, 1); 222945d9abdbSWeongyo Jeong bwn_rate_write(mac, BWN_OFDM_RATE_36MB, 1); 223045d9abdbSWeongyo Jeong bwn_rate_write(mac, BWN_OFDM_RATE_48MB, 1); 223145d9abdbSWeongyo Jeong bwn_rate_write(mac, BWN_OFDM_RATE_54MB, 1); 223245d9abdbSWeongyo Jeong if (mac->mac_phy.type == BWN_PHYTYPE_A) 223345d9abdbSWeongyo Jeong break; 223445d9abdbSWeongyo Jeong /* FALLTHROUGH */ 223545d9abdbSWeongyo Jeong case BWN_PHYTYPE_B: 223645d9abdbSWeongyo Jeong bwn_rate_write(mac, BWN_CCK_RATE_1MB, 0); 223745d9abdbSWeongyo Jeong bwn_rate_write(mac, BWN_CCK_RATE_2MB, 0); 223845d9abdbSWeongyo Jeong bwn_rate_write(mac, BWN_CCK_RATE_5MB, 0); 223945d9abdbSWeongyo Jeong bwn_rate_write(mac, BWN_CCK_RATE_11MB, 0); 224045d9abdbSWeongyo Jeong break; 224145d9abdbSWeongyo Jeong default: 224245d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 224345d9abdbSWeongyo Jeong } 224445d9abdbSWeongyo Jeong } 224545d9abdbSWeongyo Jeong 224645d9abdbSWeongyo Jeong static void 224745d9abdbSWeongyo Jeong bwn_rate_write(struct bwn_mac *mac, uint16_t rate, int ofdm) 224845d9abdbSWeongyo Jeong { 224945d9abdbSWeongyo Jeong uint16_t offset; 225045d9abdbSWeongyo Jeong 225145d9abdbSWeongyo Jeong if (ofdm) { 225245d9abdbSWeongyo Jeong offset = 0x480; 225345d9abdbSWeongyo Jeong offset += (bwn_plcp_getofdm(rate) & 0x000f) * 2; 225445d9abdbSWeongyo Jeong } else { 225545d9abdbSWeongyo Jeong offset = 0x4c0; 225645d9abdbSWeongyo Jeong offset += (bwn_plcp_getcck(rate) & 0x000f) * 2; 225745d9abdbSWeongyo Jeong } 225845d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, offset + 0x20, 225945d9abdbSWeongyo Jeong bwn_shm_read_2(mac, BWN_SHARED, offset)); 226045d9abdbSWeongyo Jeong } 226145d9abdbSWeongyo Jeong 226245d9abdbSWeongyo Jeong static uint8_t 226345d9abdbSWeongyo Jeong bwn_plcp_getcck(const uint8_t bitrate) 226445d9abdbSWeongyo Jeong { 226545d9abdbSWeongyo Jeong 226645d9abdbSWeongyo Jeong switch (bitrate) { 226745d9abdbSWeongyo Jeong case BWN_CCK_RATE_1MB: 226845d9abdbSWeongyo Jeong return (0x0a); 226945d9abdbSWeongyo Jeong case BWN_CCK_RATE_2MB: 227045d9abdbSWeongyo Jeong return (0x14); 227145d9abdbSWeongyo Jeong case BWN_CCK_RATE_5MB: 227245d9abdbSWeongyo Jeong return (0x37); 227345d9abdbSWeongyo Jeong case BWN_CCK_RATE_11MB: 227445d9abdbSWeongyo Jeong return (0x6e); 227545d9abdbSWeongyo Jeong } 227645d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 227745d9abdbSWeongyo Jeong return (0); 227845d9abdbSWeongyo Jeong } 227945d9abdbSWeongyo Jeong 228045d9abdbSWeongyo Jeong static uint8_t 228145d9abdbSWeongyo Jeong bwn_plcp_getofdm(const uint8_t bitrate) 228245d9abdbSWeongyo Jeong { 228345d9abdbSWeongyo Jeong 228445d9abdbSWeongyo Jeong switch (bitrate) { 228545d9abdbSWeongyo Jeong case BWN_OFDM_RATE_6MB: 228645d9abdbSWeongyo Jeong return (0xb); 228745d9abdbSWeongyo Jeong case BWN_OFDM_RATE_9MB: 228845d9abdbSWeongyo Jeong return (0xf); 228945d9abdbSWeongyo Jeong case BWN_OFDM_RATE_12MB: 229045d9abdbSWeongyo Jeong return (0xa); 229145d9abdbSWeongyo Jeong case BWN_OFDM_RATE_18MB: 229245d9abdbSWeongyo Jeong return (0xe); 229345d9abdbSWeongyo Jeong case BWN_OFDM_RATE_24MB: 229445d9abdbSWeongyo Jeong return (0x9); 229545d9abdbSWeongyo Jeong case BWN_OFDM_RATE_36MB: 229645d9abdbSWeongyo Jeong return (0xd); 229745d9abdbSWeongyo Jeong case BWN_OFDM_RATE_48MB: 229845d9abdbSWeongyo Jeong return (0x8); 229945d9abdbSWeongyo Jeong case BWN_OFDM_RATE_54MB: 230045d9abdbSWeongyo Jeong return (0xc); 230145d9abdbSWeongyo Jeong } 230245d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 230345d9abdbSWeongyo Jeong return (0); 230445d9abdbSWeongyo Jeong } 230545d9abdbSWeongyo Jeong 230645d9abdbSWeongyo Jeong static void 230745d9abdbSWeongyo Jeong bwn_set_phytxctl(struct bwn_mac *mac) 230845d9abdbSWeongyo Jeong { 230945d9abdbSWeongyo Jeong uint16_t ctl; 231045d9abdbSWeongyo Jeong 231145d9abdbSWeongyo Jeong ctl = (BWN_TX_PHY_ENC_CCK | BWN_TX_PHY_ANT01AUTO | 231245d9abdbSWeongyo Jeong BWN_TX_PHY_TXPWR); 231345d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_BEACON_PHYCTL, ctl); 231445d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_ACKCTS_PHYCTL, ctl); 231545d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_PROBE_RESP_PHYCTL, ctl); 231645d9abdbSWeongyo Jeong } 231745d9abdbSWeongyo Jeong 231845d9abdbSWeongyo Jeong static void 231945d9abdbSWeongyo Jeong bwn_pio_init(struct bwn_mac *mac) 232045d9abdbSWeongyo Jeong { 232145d9abdbSWeongyo Jeong struct bwn_pio *pio = &mac->mac_method.pio; 232245d9abdbSWeongyo Jeong 232345d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, BWN_READ_4(mac, BWN_MACCTL) 232445d9abdbSWeongyo Jeong & ~BWN_MACCTL_BIGENDIAN); 232545d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_RX_PADOFFSET, 0); 232645d9abdbSWeongyo Jeong 232745d9abdbSWeongyo Jeong bwn_pio_set_txqueue(mac, &pio->wme[WME_AC_BK], 0); 232845d9abdbSWeongyo Jeong bwn_pio_set_txqueue(mac, &pio->wme[WME_AC_BE], 1); 232945d9abdbSWeongyo Jeong bwn_pio_set_txqueue(mac, &pio->wme[WME_AC_VI], 2); 233045d9abdbSWeongyo Jeong bwn_pio_set_txqueue(mac, &pio->wme[WME_AC_VO], 3); 233145d9abdbSWeongyo Jeong bwn_pio_set_txqueue(mac, &pio->mcast, 4); 233245d9abdbSWeongyo Jeong bwn_pio_setupqueue_rx(mac, &pio->rx, 0); 233345d9abdbSWeongyo Jeong } 233445d9abdbSWeongyo Jeong 233545d9abdbSWeongyo Jeong static void 233645d9abdbSWeongyo Jeong bwn_pio_set_txqueue(struct bwn_mac *mac, struct bwn_pio_txqueue *tq, 233745d9abdbSWeongyo Jeong int index) 233845d9abdbSWeongyo Jeong { 233945d9abdbSWeongyo Jeong struct bwn_pio_txpkt *tp; 2340b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 234145d9abdbSWeongyo Jeong unsigned int i; 234245d9abdbSWeongyo Jeong 234345d9abdbSWeongyo Jeong tq->tq_base = bwn_pio_idx2base(mac, index) + BWN_PIO_TXQOFFSET(mac); 234445d9abdbSWeongyo Jeong tq->tq_index = index; 234545d9abdbSWeongyo Jeong 234645d9abdbSWeongyo Jeong tq->tq_free = BWN_PIO_MAX_TXPACKETS; 2347b9b64aa5SWeongyo Jeong if (siba_get_revid(sc->sc_dev) >= 8) 234845d9abdbSWeongyo Jeong tq->tq_size = 1920; 234945d9abdbSWeongyo Jeong else { 235045d9abdbSWeongyo Jeong tq->tq_size = bwn_pio_read_2(mac, tq, BWN_PIO_TXQBUFSIZE); 235145d9abdbSWeongyo Jeong tq->tq_size -= 80; 235245d9abdbSWeongyo Jeong } 235345d9abdbSWeongyo Jeong 235445d9abdbSWeongyo Jeong TAILQ_INIT(&tq->tq_pktlist); 235545d9abdbSWeongyo Jeong for (i = 0; i < N(tq->tq_pkts); i++) { 235645d9abdbSWeongyo Jeong tp = &(tq->tq_pkts[i]); 235745d9abdbSWeongyo Jeong tp->tp_index = i; 235845d9abdbSWeongyo Jeong tp->tp_queue = tq; 235945d9abdbSWeongyo Jeong TAILQ_INSERT_TAIL(&tq->tq_pktlist, tp, tp_list); 236045d9abdbSWeongyo Jeong } 236145d9abdbSWeongyo Jeong } 236245d9abdbSWeongyo Jeong 236345d9abdbSWeongyo Jeong static uint16_t 236445d9abdbSWeongyo Jeong bwn_pio_idx2base(struct bwn_mac *mac, int index) 236545d9abdbSWeongyo Jeong { 236645d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 236745d9abdbSWeongyo Jeong static const uint16_t bases[] = { 236845d9abdbSWeongyo Jeong BWN_PIO_BASE0, 236945d9abdbSWeongyo Jeong BWN_PIO_BASE1, 237045d9abdbSWeongyo Jeong BWN_PIO_BASE2, 237145d9abdbSWeongyo Jeong BWN_PIO_BASE3, 237245d9abdbSWeongyo Jeong BWN_PIO_BASE4, 237345d9abdbSWeongyo Jeong BWN_PIO_BASE5, 237445d9abdbSWeongyo Jeong BWN_PIO_BASE6, 237545d9abdbSWeongyo Jeong BWN_PIO_BASE7, 237645d9abdbSWeongyo Jeong }; 237745d9abdbSWeongyo Jeong static const uint16_t bases_rev11[] = { 237845d9abdbSWeongyo Jeong BWN_PIO11_BASE0, 237945d9abdbSWeongyo Jeong BWN_PIO11_BASE1, 238045d9abdbSWeongyo Jeong BWN_PIO11_BASE2, 238145d9abdbSWeongyo Jeong BWN_PIO11_BASE3, 238245d9abdbSWeongyo Jeong BWN_PIO11_BASE4, 238345d9abdbSWeongyo Jeong BWN_PIO11_BASE5, 238445d9abdbSWeongyo Jeong }; 238545d9abdbSWeongyo Jeong 2386b9b64aa5SWeongyo Jeong if (siba_get_revid(sc->sc_dev) >= 11) { 238745d9abdbSWeongyo Jeong if (index >= N(bases_rev11)) 238845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: warning\n", __func__); 238945d9abdbSWeongyo Jeong return (bases_rev11[index]); 239045d9abdbSWeongyo Jeong } 239145d9abdbSWeongyo Jeong if (index >= N(bases)) 239245d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: warning\n", __func__); 239345d9abdbSWeongyo Jeong return (bases[index]); 239445d9abdbSWeongyo Jeong } 239545d9abdbSWeongyo Jeong 239645d9abdbSWeongyo Jeong static void 239745d9abdbSWeongyo Jeong bwn_pio_setupqueue_rx(struct bwn_mac *mac, struct bwn_pio_rxqueue *prq, 239845d9abdbSWeongyo Jeong int index) 239945d9abdbSWeongyo Jeong { 2400b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 240145d9abdbSWeongyo Jeong 240245d9abdbSWeongyo Jeong prq->prq_mac = mac; 2403b9b64aa5SWeongyo Jeong prq->prq_rev = siba_get_revid(sc->sc_dev); 240445d9abdbSWeongyo Jeong prq->prq_base = bwn_pio_idx2base(mac, index) + BWN_PIO_RXQOFFSET(mac); 240545d9abdbSWeongyo Jeong bwn_dma_rxdirectfifo(mac, index, 1); 240645d9abdbSWeongyo Jeong } 240745d9abdbSWeongyo Jeong 240845d9abdbSWeongyo Jeong static void 240945d9abdbSWeongyo Jeong bwn_destroy_pioqueue_tx(struct bwn_pio_txqueue *tq) 241045d9abdbSWeongyo Jeong { 241145d9abdbSWeongyo Jeong if (tq == NULL) 241245d9abdbSWeongyo Jeong return; 241345d9abdbSWeongyo Jeong bwn_pio_cancel_tx_packets(tq); 241445d9abdbSWeongyo Jeong } 241545d9abdbSWeongyo Jeong 241645d9abdbSWeongyo Jeong static void 241745d9abdbSWeongyo Jeong bwn_destroy_queue_tx(struct bwn_pio_txqueue *pio) 241845d9abdbSWeongyo Jeong { 241945d9abdbSWeongyo Jeong 242045d9abdbSWeongyo Jeong bwn_destroy_pioqueue_tx(pio); 242145d9abdbSWeongyo Jeong } 242245d9abdbSWeongyo Jeong 242345d9abdbSWeongyo Jeong static uint16_t 242445d9abdbSWeongyo Jeong bwn_pio_read_2(struct bwn_mac *mac, struct bwn_pio_txqueue *tq, 242545d9abdbSWeongyo Jeong uint16_t offset) 242645d9abdbSWeongyo Jeong { 242745d9abdbSWeongyo Jeong 242845d9abdbSWeongyo Jeong return (BWN_READ_2(mac, tq->tq_base + offset)); 242945d9abdbSWeongyo Jeong } 243045d9abdbSWeongyo Jeong 243145d9abdbSWeongyo Jeong static void 243245d9abdbSWeongyo Jeong bwn_dma_rxdirectfifo(struct bwn_mac *mac, int idx, uint8_t enable) 243345d9abdbSWeongyo Jeong { 243445d9abdbSWeongyo Jeong uint32_t ctl; 243545d9abdbSWeongyo Jeong int type; 243645d9abdbSWeongyo Jeong uint16_t base; 243745d9abdbSWeongyo Jeong 243845d9abdbSWeongyo Jeong type = bwn_dma_mask2type(bwn_dma_mask(mac)); 243945d9abdbSWeongyo Jeong base = bwn_dma_base(type, idx); 244045d9abdbSWeongyo Jeong if (type == BWN_DMA_64BIT) { 244145d9abdbSWeongyo Jeong ctl = BWN_READ_4(mac, base + BWN_DMA64_RXCTL); 244245d9abdbSWeongyo Jeong ctl &= ~BWN_DMA64_RXDIRECTFIFO; 244345d9abdbSWeongyo Jeong if (enable) 244445d9abdbSWeongyo Jeong ctl |= BWN_DMA64_RXDIRECTFIFO; 244545d9abdbSWeongyo Jeong BWN_WRITE_4(mac, base + BWN_DMA64_RXCTL, ctl); 244645d9abdbSWeongyo Jeong } else { 244745d9abdbSWeongyo Jeong ctl = BWN_READ_4(mac, base + BWN_DMA32_RXCTL); 244845d9abdbSWeongyo Jeong ctl &= ~BWN_DMA32_RXDIRECTFIFO; 244945d9abdbSWeongyo Jeong if (enable) 245045d9abdbSWeongyo Jeong ctl |= BWN_DMA32_RXDIRECTFIFO; 245145d9abdbSWeongyo Jeong BWN_WRITE_4(mac, base + BWN_DMA32_RXCTL, ctl); 245245d9abdbSWeongyo Jeong } 245345d9abdbSWeongyo Jeong } 245445d9abdbSWeongyo Jeong 245545d9abdbSWeongyo Jeong static uint64_t 245645d9abdbSWeongyo Jeong bwn_dma_mask(struct bwn_mac *mac) 245745d9abdbSWeongyo Jeong { 245845d9abdbSWeongyo Jeong uint32_t tmp; 245945d9abdbSWeongyo Jeong uint16_t base; 246045d9abdbSWeongyo Jeong 246145d9abdbSWeongyo Jeong tmp = BWN_READ_4(mac, SIBA_TGSHIGH); 246245d9abdbSWeongyo Jeong if (tmp & SIBA_TGSHIGH_DMA64) 246345d9abdbSWeongyo Jeong return (BWN_DMA_BIT_MASK(64)); 246445d9abdbSWeongyo Jeong base = bwn_dma_base(0, 0); 246545d9abdbSWeongyo Jeong BWN_WRITE_4(mac, base + BWN_DMA32_TXCTL, BWN_DMA32_TXADDREXT_MASK); 246645d9abdbSWeongyo Jeong tmp = BWN_READ_4(mac, base + BWN_DMA32_TXCTL); 246745d9abdbSWeongyo Jeong if (tmp & BWN_DMA32_TXADDREXT_MASK) 246845d9abdbSWeongyo Jeong return (BWN_DMA_BIT_MASK(32)); 246945d9abdbSWeongyo Jeong 247045d9abdbSWeongyo Jeong return (BWN_DMA_BIT_MASK(30)); 247145d9abdbSWeongyo Jeong } 247245d9abdbSWeongyo Jeong 247345d9abdbSWeongyo Jeong static int 247445d9abdbSWeongyo Jeong bwn_dma_mask2type(uint64_t dmamask) 247545d9abdbSWeongyo Jeong { 247645d9abdbSWeongyo Jeong 247745d9abdbSWeongyo Jeong if (dmamask == BWN_DMA_BIT_MASK(30)) 247845d9abdbSWeongyo Jeong return (BWN_DMA_30BIT); 247945d9abdbSWeongyo Jeong if (dmamask == BWN_DMA_BIT_MASK(32)) 248045d9abdbSWeongyo Jeong return (BWN_DMA_32BIT); 248145d9abdbSWeongyo Jeong if (dmamask == BWN_DMA_BIT_MASK(64)) 248245d9abdbSWeongyo Jeong return (BWN_DMA_64BIT); 248345d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 248445d9abdbSWeongyo Jeong return (BWN_DMA_30BIT); 248545d9abdbSWeongyo Jeong } 248645d9abdbSWeongyo Jeong 248745d9abdbSWeongyo Jeong static void 248845d9abdbSWeongyo Jeong bwn_pio_cancel_tx_packets(struct bwn_pio_txqueue *tq) 248945d9abdbSWeongyo Jeong { 249045d9abdbSWeongyo Jeong struct bwn_pio_txpkt *tp; 249145d9abdbSWeongyo Jeong unsigned int i; 249245d9abdbSWeongyo Jeong 249345d9abdbSWeongyo Jeong for (i = 0; i < N(tq->tq_pkts); i++) { 249445d9abdbSWeongyo Jeong tp = &(tq->tq_pkts[i]); 249545d9abdbSWeongyo Jeong if (tp->tp_m) { 249645d9abdbSWeongyo Jeong m_freem(tp->tp_m); 249745d9abdbSWeongyo Jeong tp->tp_m = NULL; 249845d9abdbSWeongyo Jeong } 249945d9abdbSWeongyo Jeong } 250045d9abdbSWeongyo Jeong } 250145d9abdbSWeongyo Jeong 250245d9abdbSWeongyo Jeong static uint16_t 250345d9abdbSWeongyo Jeong bwn_dma_base(int type, int controller_idx) 250445d9abdbSWeongyo Jeong { 250545d9abdbSWeongyo Jeong static const uint16_t map64[] = { 250645d9abdbSWeongyo Jeong BWN_DMA64_BASE0, 250745d9abdbSWeongyo Jeong BWN_DMA64_BASE1, 250845d9abdbSWeongyo Jeong BWN_DMA64_BASE2, 250945d9abdbSWeongyo Jeong BWN_DMA64_BASE3, 251045d9abdbSWeongyo Jeong BWN_DMA64_BASE4, 251145d9abdbSWeongyo Jeong BWN_DMA64_BASE5, 251245d9abdbSWeongyo Jeong }; 251345d9abdbSWeongyo Jeong static const uint16_t map32[] = { 251445d9abdbSWeongyo Jeong BWN_DMA32_BASE0, 251545d9abdbSWeongyo Jeong BWN_DMA32_BASE1, 251645d9abdbSWeongyo Jeong BWN_DMA32_BASE2, 251745d9abdbSWeongyo Jeong BWN_DMA32_BASE3, 251845d9abdbSWeongyo Jeong BWN_DMA32_BASE4, 251945d9abdbSWeongyo Jeong BWN_DMA32_BASE5, 252045d9abdbSWeongyo Jeong }; 252145d9abdbSWeongyo Jeong 252245d9abdbSWeongyo Jeong if (type == BWN_DMA_64BIT) { 252345d9abdbSWeongyo Jeong KASSERT(controller_idx >= 0 && controller_idx < N(map64), 252445d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 252545d9abdbSWeongyo Jeong return (map64[controller_idx]); 252645d9abdbSWeongyo Jeong } 252745d9abdbSWeongyo Jeong KASSERT(controller_idx >= 0 && controller_idx < N(map32), 252845d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 252945d9abdbSWeongyo Jeong return (map32[controller_idx]); 253045d9abdbSWeongyo Jeong } 253145d9abdbSWeongyo Jeong 253245d9abdbSWeongyo Jeong static void 253345d9abdbSWeongyo Jeong bwn_dma_init(struct bwn_mac *mac) 253445d9abdbSWeongyo Jeong { 253545d9abdbSWeongyo Jeong struct bwn_dma *dma = &mac->mac_method.dma; 253645d9abdbSWeongyo Jeong 253745d9abdbSWeongyo Jeong /* setup TX DMA channels. */ 253845d9abdbSWeongyo Jeong bwn_dma_setup(dma->wme[WME_AC_BK]); 253945d9abdbSWeongyo Jeong bwn_dma_setup(dma->wme[WME_AC_BE]); 254045d9abdbSWeongyo Jeong bwn_dma_setup(dma->wme[WME_AC_VI]); 254145d9abdbSWeongyo Jeong bwn_dma_setup(dma->wme[WME_AC_VO]); 254245d9abdbSWeongyo Jeong bwn_dma_setup(dma->mcast); 254345d9abdbSWeongyo Jeong /* setup RX DMA channel. */ 254445d9abdbSWeongyo Jeong bwn_dma_setup(dma->rx); 254545d9abdbSWeongyo Jeong } 254645d9abdbSWeongyo Jeong 254745d9abdbSWeongyo Jeong static struct bwn_dma_ring * 254845d9abdbSWeongyo Jeong bwn_dma_ringsetup(struct bwn_mac *mac, int controller_index, 254945d9abdbSWeongyo Jeong int for_tx, int type) 255045d9abdbSWeongyo Jeong { 255145d9abdbSWeongyo Jeong struct bwn_dma *dma = &mac->mac_method.dma; 255245d9abdbSWeongyo Jeong struct bwn_dma_ring *dr; 255345d9abdbSWeongyo Jeong struct bwn_dmadesc_generic *desc; 255445d9abdbSWeongyo Jeong struct bwn_dmadesc_meta *mt; 255545d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 255645d9abdbSWeongyo Jeong int error, i; 255745d9abdbSWeongyo Jeong 255845d9abdbSWeongyo Jeong dr = malloc(sizeof(*dr), M_DEVBUF, M_NOWAIT | M_ZERO); 255945d9abdbSWeongyo Jeong if (dr == NULL) 256045d9abdbSWeongyo Jeong goto out; 256145d9abdbSWeongyo Jeong dr->dr_numslots = BWN_RXRING_SLOTS; 256245d9abdbSWeongyo Jeong if (for_tx) 256345d9abdbSWeongyo Jeong dr->dr_numslots = BWN_TXRING_SLOTS; 256445d9abdbSWeongyo Jeong 256545d9abdbSWeongyo Jeong dr->dr_meta = malloc(dr->dr_numslots * sizeof(struct bwn_dmadesc_meta), 256645d9abdbSWeongyo Jeong M_DEVBUF, M_NOWAIT | M_ZERO); 256745d9abdbSWeongyo Jeong if (dr->dr_meta == NULL) 256845d9abdbSWeongyo Jeong goto fail0; 256945d9abdbSWeongyo Jeong 257045d9abdbSWeongyo Jeong dr->dr_type = type; 257145d9abdbSWeongyo Jeong dr->dr_mac = mac; 257245d9abdbSWeongyo Jeong dr->dr_base = bwn_dma_base(type, controller_index); 257345d9abdbSWeongyo Jeong dr->dr_index = controller_index; 257445d9abdbSWeongyo Jeong if (type == BWN_DMA_64BIT) { 257545d9abdbSWeongyo Jeong dr->getdesc = bwn_dma_64_getdesc; 257645d9abdbSWeongyo Jeong dr->setdesc = bwn_dma_64_setdesc; 257745d9abdbSWeongyo Jeong dr->start_transfer = bwn_dma_64_start_transfer; 257845d9abdbSWeongyo Jeong dr->suspend = bwn_dma_64_suspend; 257945d9abdbSWeongyo Jeong dr->resume = bwn_dma_64_resume; 258045d9abdbSWeongyo Jeong dr->get_curslot = bwn_dma_64_get_curslot; 258145d9abdbSWeongyo Jeong dr->set_curslot = bwn_dma_64_set_curslot; 258245d9abdbSWeongyo Jeong } else { 258345d9abdbSWeongyo Jeong dr->getdesc = bwn_dma_32_getdesc; 258445d9abdbSWeongyo Jeong dr->setdesc = bwn_dma_32_setdesc; 258545d9abdbSWeongyo Jeong dr->start_transfer = bwn_dma_32_start_transfer; 258645d9abdbSWeongyo Jeong dr->suspend = bwn_dma_32_suspend; 258745d9abdbSWeongyo Jeong dr->resume = bwn_dma_32_resume; 258845d9abdbSWeongyo Jeong dr->get_curslot = bwn_dma_32_get_curslot; 258945d9abdbSWeongyo Jeong dr->set_curslot = bwn_dma_32_set_curslot; 259045d9abdbSWeongyo Jeong } 259145d9abdbSWeongyo Jeong if (for_tx) { 259245d9abdbSWeongyo Jeong dr->dr_tx = 1; 259345d9abdbSWeongyo Jeong dr->dr_curslot = -1; 259445d9abdbSWeongyo Jeong } else { 259545d9abdbSWeongyo Jeong if (dr->dr_index == 0) { 259645d9abdbSWeongyo Jeong dr->dr_rx_bufsize = BWN_DMA0_RX_BUFFERSIZE; 259745d9abdbSWeongyo Jeong dr->dr_frameoffset = BWN_DMA0_RX_FRAMEOFFSET; 259845d9abdbSWeongyo Jeong } else 259945d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 260045d9abdbSWeongyo Jeong } 260145d9abdbSWeongyo Jeong 260245d9abdbSWeongyo Jeong error = bwn_dma_allocringmemory(dr); 260345d9abdbSWeongyo Jeong if (error) 260445d9abdbSWeongyo Jeong goto fail2; 260545d9abdbSWeongyo Jeong 260645d9abdbSWeongyo Jeong if (for_tx) { 260745d9abdbSWeongyo Jeong /* 260845d9abdbSWeongyo Jeong * Assumption: BWN_TXRING_SLOTS can be divided by 260945d9abdbSWeongyo Jeong * BWN_TX_SLOTS_PER_FRAME 261045d9abdbSWeongyo Jeong */ 261145d9abdbSWeongyo Jeong KASSERT(BWN_TXRING_SLOTS % BWN_TX_SLOTS_PER_FRAME == 0, 261245d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 261345d9abdbSWeongyo Jeong 261445d9abdbSWeongyo Jeong dr->dr_txhdr_cache = 261545d9abdbSWeongyo Jeong malloc((dr->dr_numslots / BWN_TX_SLOTS_PER_FRAME) * 261645d9abdbSWeongyo Jeong BWN_HDRSIZE(mac), M_DEVBUF, M_NOWAIT | M_ZERO); 261745d9abdbSWeongyo Jeong KASSERT(dr->dr_txhdr_cache != NULL, 261845d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 261945d9abdbSWeongyo Jeong 262045d9abdbSWeongyo Jeong /* 262145d9abdbSWeongyo Jeong * Create TX ring DMA stuffs 262245d9abdbSWeongyo Jeong */ 262345d9abdbSWeongyo Jeong error = bus_dma_tag_create(dma->parent_dtag, 262445d9abdbSWeongyo Jeong BWN_ALIGN, 0, 262545d9abdbSWeongyo Jeong BUS_SPACE_MAXADDR, 262645d9abdbSWeongyo Jeong BUS_SPACE_MAXADDR, 262745d9abdbSWeongyo Jeong NULL, NULL, 262845d9abdbSWeongyo Jeong BWN_HDRSIZE(mac), 262945d9abdbSWeongyo Jeong 1, 263045d9abdbSWeongyo Jeong BUS_SPACE_MAXSIZE_32BIT, 263145d9abdbSWeongyo Jeong 0, 263245d9abdbSWeongyo Jeong NULL, NULL, 263345d9abdbSWeongyo Jeong &dr->dr_txring_dtag); 263445d9abdbSWeongyo Jeong if (error) { 263545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 263645d9abdbSWeongyo Jeong "can't create TX ring DMA tag: TODO frees\n"); 263745d9abdbSWeongyo Jeong goto fail1; 263845d9abdbSWeongyo Jeong } 263945d9abdbSWeongyo Jeong 264045d9abdbSWeongyo Jeong for (i = 0; i < dr->dr_numslots; i += 2) { 264145d9abdbSWeongyo Jeong dr->getdesc(dr, i, &desc, &mt); 264245d9abdbSWeongyo Jeong 264345d9abdbSWeongyo Jeong mt->mt_txtype = BWN_DMADESC_METATYPE_HEADER; 264445d9abdbSWeongyo Jeong mt->mt_m = NULL; 264545d9abdbSWeongyo Jeong mt->mt_ni = NULL; 264645d9abdbSWeongyo Jeong mt->mt_islast = 0; 264745d9abdbSWeongyo Jeong error = bus_dmamap_create(dr->dr_txring_dtag, 0, 264845d9abdbSWeongyo Jeong &mt->mt_dmap); 264945d9abdbSWeongyo Jeong if (error) { 265045d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 265145d9abdbSWeongyo Jeong "can't create RX buf DMA map\n"); 265245d9abdbSWeongyo Jeong goto fail1; 265345d9abdbSWeongyo Jeong } 265445d9abdbSWeongyo Jeong 265545d9abdbSWeongyo Jeong dr->getdesc(dr, i + 1, &desc, &mt); 265645d9abdbSWeongyo Jeong 265745d9abdbSWeongyo Jeong mt->mt_txtype = BWN_DMADESC_METATYPE_BODY; 265845d9abdbSWeongyo Jeong mt->mt_m = NULL; 265945d9abdbSWeongyo Jeong mt->mt_ni = NULL; 266045d9abdbSWeongyo Jeong mt->mt_islast = 1; 266145d9abdbSWeongyo Jeong error = bus_dmamap_create(dma->txbuf_dtag, 0, 266245d9abdbSWeongyo Jeong &mt->mt_dmap); 266345d9abdbSWeongyo Jeong if (error) { 266445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 266545d9abdbSWeongyo Jeong "can't create RX buf DMA map\n"); 266645d9abdbSWeongyo Jeong goto fail1; 266745d9abdbSWeongyo Jeong } 266845d9abdbSWeongyo Jeong } 266945d9abdbSWeongyo Jeong } else { 267045d9abdbSWeongyo Jeong error = bus_dmamap_create(dma->rxbuf_dtag, 0, 267145d9abdbSWeongyo Jeong &dr->dr_spare_dmap); 267245d9abdbSWeongyo Jeong if (error) { 267345d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 267445d9abdbSWeongyo Jeong "can't create RX buf DMA map\n"); 267545d9abdbSWeongyo Jeong goto out; /* XXX wrong! */ 267645d9abdbSWeongyo Jeong } 267745d9abdbSWeongyo Jeong 267845d9abdbSWeongyo Jeong for (i = 0; i < dr->dr_numslots; i++) { 267945d9abdbSWeongyo Jeong dr->getdesc(dr, i, &desc, &mt); 268045d9abdbSWeongyo Jeong 268145d9abdbSWeongyo Jeong error = bus_dmamap_create(dma->rxbuf_dtag, 0, 268245d9abdbSWeongyo Jeong &mt->mt_dmap); 268345d9abdbSWeongyo Jeong if (error) { 268445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 268545d9abdbSWeongyo Jeong "can't create RX buf DMA map\n"); 268645d9abdbSWeongyo Jeong goto out; /* XXX wrong! */ 268745d9abdbSWeongyo Jeong } 268845d9abdbSWeongyo Jeong error = bwn_dma_newbuf(dr, desc, mt, 1); 268945d9abdbSWeongyo Jeong if (error) { 269045d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 269145d9abdbSWeongyo Jeong "failed to allocate RX buf\n"); 269245d9abdbSWeongyo Jeong goto out; /* XXX wrong! */ 269345d9abdbSWeongyo Jeong } 269445d9abdbSWeongyo Jeong } 269545d9abdbSWeongyo Jeong 269645d9abdbSWeongyo Jeong bus_dmamap_sync(dr->dr_ring_dtag, dr->dr_ring_dmap, 269745d9abdbSWeongyo Jeong BUS_DMASYNC_PREWRITE); 269845d9abdbSWeongyo Jeong 269945d9abdbSWeongyo Jeong dr->dr_usedslot = dr->dr_numslots; 270045d9abdbSWeongyo Jeong } 270145d9abdbSWeongyo Jeong 270245d9abdbSWeongyo Jeong out: 270345d9abdbSWeongyo Jeong return (dr); 270445d9abdbSWeongyo Jeong 270545d9abdbSWeongyo Jeong fail2: 270645d9abdbSWeongyo Jeong free(dr->dr_txhdr_cache, M_DEVBUF); 270745d9abdbSWeongyo Jeong fail1: 270845d9abdbSWeongyo Jeong free(dr->dr_meta, M_DEVBUF); 270945d9abdbSWeongyo Jeong fail0: 271045d9abdbSWeongyo Jeong free(dr, M_DEVBUF); 271145d9abdbSWeongyo Jeong return (NULL); 271245d9abdbSWeongyo Jeong } 271345d9abdbSWeongyo Jeong 271445d9abdbSWeongyo Jeong static void 271545d9abdbSWeongyo Jeong bwn_dma_ringfree(struct bwn_dma_ring **dr) 271645d9abdbSWeongyo Jeong { 271745d9abdbSWeongyo Jeong 271845d9abdbSWeongyo Jeong if (dr == NULL) 271945d9abdbSWeongyo Jeong return; 272045d9abdbSWeongyo Jeong 272145d9abdbSWeongyo Jeong bwn_dma_free_descbufs(*dr); 272245d9abdbSWeongyo Jeong bwn_dma_free_ringmemory(*dr); 272345d9abdbSWeongyo Jeong 272445d9abdbSWeongyo Jeong free((*dr)->dr_txhdr_cache, M_DEVBUF); 272545d9abdbSWeongyo Jeong free((*dr)->dr_meta, M_DEVBUF); 272645d9abdbSWeongyo Jeong free(*dr, M_DEVBUF); 272745d9abdbSWeongyo Jeong 272845d9abdbSWeongyo Jeong *dr = NULL; 272945d9abdbSWeongyo Jeong } 273045d9abdbSWeongyo Jeong 273145d9abdbSWeongyo Jeong static void 273245d9abdbSWeongyo Jeong bwn_dma_32_getdesc(struct bwn_dma_ring *dr, int slot, 273345d9abdbSWeongyo Jeong struct bwn_dmadesc_generic **gdesc, struct bwn_dmadesc_meta **meta) 273445d9abdbSWeongyo Jeong { 273545d9abdbSWeongyo Jeong struct bwn_dmadesc32 *desc; 273645d9abdbSWeongyo Jeong 273745d9abdbSWeongyo Jeong *meta = &(dr->dr_meta[slot]); 273845d9abdbSWeongyo Jeong desc = dr->dr_ring_descbase; 273945d9abdbSWeongyo Jeong desc = &(desc[slot]); 274045d9abdbSWeongyo Jeong 274145d9abdbSWeongyo Jeong *gdesc = (struct bwn_dmadesc_generic *)desc; 274245d9abdbSWeongyo Jeong } 274345d9abdbSWeongyo Jeong 274445d9abdbSWeongyo Jeong static void 274545d9abdbSWeongyo Jeong bwn_dma_32_setdesc(struct bwn_dma_ring *dr, 274645d9abdbSWeongyo Jeong struct bwn_dmadesc_generic *desc, bus_addr_t dmaaddr, uint16_t bufsize, 274745d9abdbSWeongyo Jeong int start, int end, int irq) 274845d9abdbSWeongyo Jeong { 274945d9abdbSWeongyo Jeong struct bwn_dmadesc32 *descbase = dr->dr_ring_descbase; 2750b9b64aa5SWeongyo Jeong struct bwn_softc *sc = dr->dr_mac->mac_sc; 275145d9abdbSWeongyo Jeong uint32_t addr, addrext, ctl; 275245d9abdbSWeongyo Jeong int slot; 275345d9abdbSWeongyo Jeong 275445d9abdbSWeongyo Jeong slot = (int)(&(desc->dma.dma32) - descbase); 275545d9abdbSWeongyo Jeong KASSERT(slot >= 0 && slot < dr->dr_numslots, 275645d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 275745d9abdbSWeongyo Jeong 275845d9abdbSWeongyo Jeong addr = (uint32_t) (dmaaddr & ~SIBA_DMA_TRANSLATION_MASK); 275945d9abdbSWeongyo Jeong addrext = (uint32_t) (dmaaddr & SIBA_DMA_TRANSLATION_MASK) >> 30; 2760b9b64aa5SWeongyo Jeong addr |= siba_dma_translation(sc->sc_dev); 276145d9abdbSWeongyo Jeong ctl = bufsize & BWN_DMA32_DCTL_BYTECNT; 276245d9abdbSWeongyo Jeong if (slot == dr->dr_numslots - 1) 276345d9abdbSWeongyo Jeong ctl |= BWN_DMA32_DCTL_DTABLEEND; 276445d9abdbSWeongyo Jeong if (start) 276545d9abdbSWeongyo Jeong ctl |= BWN_DMA32_DCTL_FRAMESTART; 276645d9abdbSWeongyo Jeong if (end) 276745d9abdbSWeongyo Jeong ctl |= BWN_DMA32_DCTL_FRAMEEND; 276845d9abdbSWeongyo Jeong if (irq) 276945d9abdbSWeongyo Jeong ctl |= BWN_DMA32_DCTL_IRQ; 277045d9abdbSWeongyo Jeong ctl |= (addrext << BWN_DMA32_DCTL_ADDREXT_SHIFT) 277145d9abdbSWeongyo Jeong & BWN_DMA32_DCTL_ADDREXT_MASK; 277245d9abdbSWeongyo Jeong 277345d9abdbSWeongyo Jeong desc->dma.dma32.control = htole32(ctl); 277445d9abdbSWeongyo Jeong desc->dma.dma32.address = htole32(addr); 277545d9abdbSWeongyo Jeong } 277645d9abdbSWeongyo Jeong 277745d9abdbSWeongyo Jeong static void 277845d9abdbSWeongyo Jeong bwn_dma_32_start_transfer(struct bwn_dma_ring *dr, int slot) 277945d9abdbSWeongyo Jeong { 278045d9abdbSWeongyo Jeong 278145d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA32_TXINDEX, 278245d9abdbSWeongyo Jeong (uint32_t)(slot * sizeof(struct bwn_dmadesc32))); 278345d9abdbSWeongyo Jeong } 278445d9abdbSWeongyo Jeong 278545d9abdbSWeongyo Jeong static void 278645d9abdbSWeongyo Jeong bwn_dma_32_suspend(struct bwn_dma_ring *dr) 278745d9abdbSWeongyo Jeong { 278845d9abdbSWeongyo Jeong 278945d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA32_TXCTL, 279045d9abdbSWeongyo Jeong BWN_DMA_READ(dr, BWN_DMA32_TXCTL) | BWN_DMA32_TXSUSPEND); 279145d9abdbSWeongyo Jeong } 279245d9abdbSWeongyo Jeong 279345d9abdbSWeongyo Jeong static void 279445d9abdbSWeongyo Jeong bwn_dma_32_resume(struct bwn_dma_ring *dr) 279545d9abdbSWeongyo Jeong { 279645d9abdbSWeongyo Jeong 279745d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA32_TXCTL, 279845d9abdbSWeongyo Jeong BWN_DMA_READ(dr, BWN_DMA32_TXCTL) & ~BWN_DMA32_TXSUSPEND); 279945d9abdbSWeongyo Jeong } 280045d9abdbSWeongyo Jeong 280145d9abdbSWeongyo Jeong static int 280245d9abdbSWeongyo Jeong bwn_dma_32_get_curslot(struct bwn_dma_ring *dr) 280345d9abdbSWeongyo Jeong { 280445d9abdbSWeongyo Jeong uint32_t val; 280545d9abdbSWeongyo Jeong 280645d9abdbSWeongyo Jeong val = BWN_DMA_READ(dr, BWN_DMA32_RXSTATUS); 280745d9abdbSWeongyo Jeong val &= BWN_DMA32_RXDPTR; 280845d9abdbSWeongyo Jeong 280945d9abdbSWeongyo Jeong return (val / sizeof(struct bwn_dmadesc32)); 281045d9abdbSWeongyo Jeong } 281145d9abdbSWeongyo Jeong 281245d9abdbSWeongyo Jeong static void 281345d9abdbSWeongyo Jeong bwn_dma_32_set_curslot(struct bwn_dma_ring *dr, int slot) 281445d9abdbSWeongyo Jeong { 281545d9abdbSWeongyo Jeong 281645d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA32_RXINDEX, 281745d9abdbSWeongyo Jeong (uint32_t) (slot * sizeof(struct bwn_dmadesc32))); 281845d9abdbSWeongyo Jeong } 281945d9abdbSWeongyo Jeong 282045d9abdbSWeongyo Jeong static void 282145d9abdbSWeongyo Jeong bwn_dma_64_getdesc(struct bwn_dma_ring *dr, int slot, 282245d9abdbSWeongyo Jeong struct bwn_dmadesc_generic **gdesc, struct bwn_dmadesc_meta **meta) 282345d9abdbSWeongyo Jeong { 282445d9abdbSWeongyo Jeong struct bwn_dmadesc64 *desc; 282545d9abdbSWeongyo Jeong 282645d9abdbSWeongyo Jeong *meta = &(dr->dr_meta[slot]); 282745d9abdbSWeongyo Jeong desc = dr->dr_ring_descbase; 282845d9abdbSWeongyo Jeong desc = &(desc[slot]); 282945d9abdbSWeongyo Jeong 283045d9abdbSWeongyo Jeong *gdesc = (struct bwn_dmadesc_generic *)desc; 283145d9abdbSWeongyo Jeong } 283245d9abdbSWeongyo Jeong 283345d9abdbSWeongyo Jeong static void 283445d9abdbSWeongyo Jeong bwn_dma_64_setdesc(struct bwn_dma_ring *dr, 283545d9abdbSWeongyo Jeong struct bwn_dmadesc_generic *desc, bus_addr_t dmaaddr, uint16_t bufsize, 283645d9abdbSWeongyo Jeong int start, int end, int irq) 283745d9abdbSWeongyo Jeong { 283845d9abdbSWeongyo Jeong struct bwn_dmadesc64 *descbase = dr->dr_ring_descbase; 2839b9b64aa5SWeongyo Jeong struct bwn_softc *sc = dr->dr_mac->mac_sc; 284045d9abdbSWeongyo Jeong int slot; 284145d9abdbSWeongyo Jeong uint32_t ctl0 = 0, ctl1 = 0; 284245d9abdbSWeongyo Jeong uint32_t addrlo, addrhi; 284345d9abdbSWeongyo Jeong uint32_t addrext; 284445d9abdbSWeongyo Jeong 284545d9abdbSWeongyo Jeong slot = (int)(&(desc->dma.dma64) - descbase); 284645d9abdbSWeongyo Jeong KASSERT(slot >= 0 && slot < dr->dr_numslots, 284745d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 284845d9abdbSWeongyo Jeong 284945d9abdbSWeongyo Jeong addrlo = (uint32_t) (dmaaddr & 0xffffffff); 285045d9abdbSWeongyo Jeong addrhi = (((uint64_t) dmaaddr >> 32) & ~SIBA_DMA_TRANSLATION_MASK); 285145d9abdbSWeongyo Jeong addrext = (((uint64_t) dmaaddr >> 32) & SIBA_DMA_TRANSLATION_MASK) >> 285245d9abdbSWeongyo Jeong 30; 2853b9b64aa5SWeongyo Jeong addrhi |= (siba_dma_translation(sc->sc_dev) << 1); 285445d9abdbSWeongyo Jeong if (slot == dr->dr_numslots - 1) 285545d9abdbSWeongyo Jeong ctl0 |= BWN_DMA64_DCTL0_DTABLEEND; 285645d9abdbSWeongyo Jeong if (start) 285745d9abdbSWeongyo Jeong ctl0 |= BWN_DMA64_DCTL0_FRAMESTART; 285845d9abdbSWeongyo Jeong if (end) 285945d9abdbSWeongyo Jeong ctl0 |= BWN_DMA64_DCTL0_FRAMEEND; 286045d9abdbSWeongyo Jeong if (irq) 286145d9abdbSWeongyo Jeong ctl0 |= BWN_DMA64_DCTL0_IRQ; 286245d9abdbSWeongyo Jeong ctl1 |= bufsize & BWN_DMA64_DCTL1_BYTECNT; 286345d9abdbSWeongyo Jeong ctl1 |= (addrext << BWN_DMA64_DCTL1_ADDREXT_SHIFT) 286445d9abdbSWeongyo Jeong & BWN_DMA64_DCTL1_ADDREXT_MASK; 286545d9abdbSWeongyo Jeong 286645d9abdbSWeongyo Jeong desc->dma.dma64.control0 = htole32(ctl0); 286745d9abdbSWeongyo Jeong desc->dma.dma64.control1 = htole32(ctl1); 286845d9abdbSWeongyo Jeong desc->dma.dma64.address_low = htole32(addrlo); 286945d9abdbSWeongyo Jeong desc->dma.dma64.address_high = htole32(addrhi); 287045d9abdbSWeongyo Jeong } 287145d9abdbSWeongyo Jeong 287245d9abdbSWeongyo Jeong static void 287345d9abdbSWeongyo Jeong bwn_dma_64_start_transfer(struct bwn_dma_ring *dr, int slot) 287445d9abdbSWeongyo Jeong { 287545d9abdbSWeongyo Jeong 287645d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_TXINDEX, 287745d9abdbSWeongyo Jeong (uint32_t)(slot * sizeof(struct bwn_dmadesc64))); 287845d9abdbSWeongyo Jeong } 287945d9abdbSWeongyo Jeong 288045d9abdbSWeongyo Jeong static void 288145d9abdbSWeongyo Jeong bwn_dma_64_suspend(struct bwn_dma_ring *dr) 288245d9abdbSWeongyo Jeong { 288345d9abdbSWeongyo Jeong 288445d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_TXCTL, 288545d9abdbSWeongyo Jeong BWN_DMA_READ(dr, BWN_DMA64_TXCTL) | BWN_DMA64_TXSUSPEND); 288645d9abdbSWeongyo Jeong } 288745d9abdbSWeongyo Jeong 288845d9abdbSWeongyo Jeong static void 288945d9abdbSWeongyo Jeong bwn_dma_64_resume(struct bwn_dma_ring *dr) 289045d9abdbSWeongyo Jeong { 289145d9abdbSWeongyo Jeong 289245d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_TXCTL, 289345d9abdbSWeongyo Jeong BWN_DMA_READ(dr, BWN_DMA64_TXCTL) & ~BWN_DMA64_TXSUSPEND); 289445d9abdbSWeongyo Jeong } 289545d9abdbSWeongyo Jeong 289645d9abdbSWeongyo Jeong static int 289745d9abdbSWeongyo Jeong bwn_dma_64_get_curslot(struct bwn_dma_ring *dr) 289845d9abdbSWeongyo Jeong { 289945d9abdbSWeongyo Jeong uint32_t val; 290045d9abdbSWeongyo Jeong 290145d9abdbSWeongyo Jeong val = BWN_DMA_READ(dr, BWN_DMA64_RXSTATUS); 290245d9abdbSWeongyo Jeong val &= BWN_DMA64_RXSTATDPTR; 290345d9abdbSWeongyo Jeong 290445d9abdbSWeongyo Jeong return (val / sizeof(struct bwn_dmadesc64)); 290545d9abdbSWeongyo Jeong } 290645d9abdbSWeongyo Jeong 290745d9abdbSWeongyo Jeong static void 290845d9abdbSWeongyo Jeong bwn_dma_64_set_curslot(struct bwn_dma_ring *dr, int slot) 290945d9abdbSWeongyo Jeong { 291045d9abdbSWeongyo Jeong 291145d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_RXINDEX, 291245d9abdbSWeongyo Jeong (uint32_t)(slot * sizeof(struct bwn_dmadesc64))); 291345d9abdbSWeongyo Jeong } 291445d9abdbSWeongyo Jeong 291545d9abdbSWeongyo Jeong static int 291645d9abdbSWeongyo Jeong bwn_dma_allocringmemory(struct bwn_dma_ring *dr) 291745d9abdbSWeongyo Jeong { 291845d9abdbSWeongyo Jeong struct bwn_mac *mac = dr->dr_mac; 291945d9abdbSWeongyo Jeong struct bwn_dma *dma = &mac->mac_method.dma; 292045d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 292145d9abdbSWeongyo Jeong int error; 292245d9abdbSWeongyo Jeong 292345d9abdbSWeongyo Jeong error = bus_dma_tag_create(dma->parent_dtag, 292445d9abdbSWeongyo Jeong BWN_ALIGN, 0, 292545d9abdbSWeongyo Jeong BUS_SPACE_MAXADDR, 292645d9abdbSWeongyo Jeong BUS_SPACE_MAXADDR, 292745d9abdbSWeongyo Jeong NULL, NULL, 292845d9abdbSWeongyo Jeong BWN_DMA_RINGMEMSIZE, 292945d9abdbSWeongyo Jeong 1, 293045d9abdbSWeongyo Jeong BUS_SPACE_MAXSIZE_32BIT, 293145d9abdbSWeongyo Jeong 0, 293245d9abdbSWeongyo Jeong NULL, NULL, 293345d9abdbSWeongyo Jeong &dr->dr_ring_dtag); 293445d9abdbSWeongyo Jeong if (error) { 293545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 293645d9abdbSWeongyo Jeong "can't create TX ring DMA tag: TODO frees\n"); 293745d9abdbSWeongyo Jeong return (-1); 293845d9abdbSWeongyo Jeong } 293945d9abdbSWeongyo Jeong 294045d9abdbSWeongyo Jeong error = bus_dmamem_alloc(dr->dr_ring_dtag, 294145d9abdbSWeongyo Jeong &dr->dr_ring_descbase, BUS_DMA_WAITOK | BUS_DMA_ZERO, 294245d9abdbSWeongyo Jeong &dr->dr_ring_dmap); 294345d9abdbSWeongyo Jeong if (error) { 294445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 294545d9abdbSWeongyo Jeong "can't allocate DMA mem: TODO frees\n"); 294645d9abdbSWeongyo Jeong return (-1); 294745d9abdbSWeongyo Jeong } 294845d9abdbSWeongyo Jeong error = bus_dmamap_load(dr->dr_ring_dtag, dr->dr_ring_dmap, 294945d9abdbSWeongyo Jeong dr->dr_ring_descbase, BWN_DMA_RINGMEMSIZE, 295045d9abdbSWeongyo Jeong bwn_dma_ring_addr, &dr->dr_ring_dmabase, BUS_DMA_NOWAIT); 295145d9abdbSWeongyo Jeong if (error) { 295245d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 295345d9abdbSWeongyo Jeong "can't load DMA mem: TODO free\n"); 295445d9abdbSWeongyo Jeong return (-1); 295545d9abdbSWeongyo Jeong } 295645d9abdbSWeongyo Jeong 295745d9abdbSWeongyo Jeong return (0); 295845d9abdbSWeongyo Jeong } 295945d9abdbSWeongyo Jeong 296045d9abdbSWeongyo Jeong static void 296145d9abdbSWeongyo Jeong bwn_dma_setup(struct bwn_dma_ring *dr) 296245d9abdbSWeongyo Jeong { 2963b9b64aa5SWeongyo Jeong struct bwn_softc *sc = dr->dr_mac->mac_sc; 296445d9abdbSWeongyo Jeong uint64_t ring64; 296545d9abdbSWeongyo Jeong uint32_t addrext, ring32, value; 2966b9b64aa5SWeongyo Jeong uint32_t trans = siba_dma_translation(sc->sc_dev); 296745d9abdbSWeongyo Jeong 296845d9abdbSWeongyo Jeong if (dr->dr_tx) { 296945d9abdbSWeongyo Jeong dr->dr_curslot = -1; 297045d9abdbSWeongyo Jeong 297145d9abdbSWeongyo Jeong if (dr->dr_type == BWN_DMA_64BIT) { 297245d9abdbSWeongyo Jeong ring64 = (uint64_t)(dr->dr_ring_dmabase); 297345d9abdbSWeongyo Jeong addrext = ((ring64 >> 32) & SIBA_DMA_TRANSLATION_MASK) 297445d9abdbSWeongyo Jeong >> 30; 297545d9abdbSWeongyo Jeong value = BWN_DMA64_TXENABLE; 297645d9abdbSWeongyo Jeong value |= (addrext << BWN_DMA64_TXADDREXT_SHIFT) 297745d9abdbSWeongyo Jeong & BWN_DMA64_TXADDREXT_MASK; 297845d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_TXCTL, value); 297945d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_TXRINGLO, 298045d9abdbSWeongyo Jeong (ring64 & 0xffffffff)); 298145d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_TXRINGHI, 298245d9abdbSWeongyo Jeong ((ring64 >> 32) & 298345d9abdbSWeongyo Jeong ~SIBA_DMA_TRANSLATION_MASK) | (trans << 1)); 298445d9abdbSWeongyo Jeong } else { 298545d9abdbSWeongyo Jeong ring32 = (uint32_t)(dr->dr_ring_dmabase); 298645d9abdbSWeongyo Jeong addrext = (ring32 & SIBA_DMA_TRANSLATION_MASK) >> 30; 298745d9abdbSWeongyo Jeong value = BWN_DMA32_TXENABLE; 298845d9abdbSWeongyo Jeong value |= (addrext << BWN_DMA32_TXADDREXT_SHIFT) 298945d9abdbSWeongyo Jeong & BWN_DMA32_TXADDREXT_MASK; 299045d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA32_TXCTL, value); 299145d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA32_TXRING, 299245d9abdbSWeongyo Jeong (ring32 & ~SIBA_DMA_TRANSLATION_MASK) | trans); 299345d9abdbSWeongyo Jeong } 299445d9abdbSWeongyo Jeong return; 299545d9abdbSWeongyo Jeong } 299645d9abdbSWeongyo Jeong 299745d9abdbSWeongyo Jeong /* 299845d9abdbSWeongyo Jeong * set for RX 299945d9abdbSWeongyo Jeong */ 300045d9abdbSWeongyo Jeong dr->dr_usedslot = dr->dr_numslots; 300145d9abdbSWeongyo Jeong 300245d9abdbSWeongyo Jeong if (dr->dr_type == BWN_DMA_64BIT) { 300345d9abdbSWeongyo Jeong ring64 = (uint64_t)(dr->dr_ring_dmabase); 300445d9abdbSWeongyo Jeong addrext = ((ring64 >> 32) & SIBA_DMA_TRANSLATION_MASK) >> 30; 300545d9abdbSWeongyo Jeong value = (dr->dr_frameoffset << BWN_DMA64_RXFROFF_SHIFT); 300645d9abdbSWeongyo Jeong value |= BWN_DMA64_RXENABLE; 300745d9abdbSWeongyo Jeong value |= (addrext << BWN_DMA64_RXADDREXT_SHIFT) 300845d9abdbSWeongyo Jeong & BWN_DMA64_RXADDREXT_MASK; 300945d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_RXCTL, value); 301045d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_RXRINGLO, (ring64 & 0xffffffff)); 301145d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_RXRINGHI, 301245d9abdbSWeongyo Jeong ((ring64 >> 32) & ~SIBA_DMA_TRANSLATION_MASK) 301345d9abdbSWeongyo Jeong | (trans << 1)); 301445d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_RXINDEX, dr->dr_numslots * 301545d9abdbSWeongyo Jeong sizeof(struct bwn_dmadesc64)); 301645d9abdbSWeongyo Jeong } else { 301745d9abdbSWeongyo Jeong ring32 = (uint32_t)(dr->dr_ring_dmabase); 301845d9abdbSWeongyo Jeong addrext = (ring32 & SIBA_DMA_TRANSLATION_MASK) >> 30; 301945d9abdbSWeongyo Jeong value = (dr->dr_frameoffset << BWN_DMA32_RXFROFF_SHIFT); 302045d9abdbSWeongyo Jeong value |= BWN_DMA32_RXENABLE; 302145d9abdbSWeongyo Jeong value |= (addrext << BWN_DMA32_RXADDREXT_SHIFT) 302245d9abdbSWeongyo Jeong & BWN_DMA32_RXADDREXT_MASK; 302345d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA32_RXCTL, value); 302445d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA32_RXRING, 302545d9abdbSWeongyo Jeong (ring32 & ~SIBA_DMA_TRANSLATION_MASK) | trans); 302645d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA32_RXINDEX, dr->dr_numslots * 302745d9abdbSWeongyo Jeong sizeof(struct bwn_dmadesc32)); 302845d9abdbSWeongyo Jeong } 302945d9abdbSWeongyo Jeong } 303045d9abdbSWeongyo Jeong 303145d9abdbSWeongyo Jeong static void 303245d9abdbSWeongyo Jeong bwn_dma_free_ringmemory(struct bwn_dma_ring *dr) 303345d9abdbSWeongyo Jeong { 303445d9abdbSWeongyo Jeong 303545d9abdbSWeongyo Jeong bus_dmamap_unload(dr->dr_ring_dtag, dr->dr_ring_dmap); 303645d9abdbSWeongyo Jeong bus_dmamem_free(dr->dr_ring_dtag, dr->dr_ring_descbase, 303745d9abdbSWeongyo Jeong dr->dr_ring_dmap); 303845d9abdbSWeongyo Jeong } 303945d9abdbSWeongyo Jeong 304045d9abdbSWeongyo Jeong static void 304145d9abdbSWeongyo Jeong bwn_dma_cleanup(struct bwn_dma_ring *dr) 304245d9abdbSWeongyo Jeong { 304345d9abdbSWeongyo Jeong 304445d9abdbSWeongyo Jeong if (dr->dr_tx) { 304545d9abdbSWeongyo Jeong bwn_dma_tx_reset(dr->dr_mac, dr->dr_base, dr->dr_type); 304645d9abdbSWeongyo Jeong if (dr->dr_type == BWN_DMA_64BIT) { 304745d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_TXRINGLO, 0); 304845d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_TXRINGHI, 0); 304945d9abdbSWeongyo Jeong } else 305045d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA32_TXRING, 0); 305145d9abdbSWeongyo Jeong } else { 305245d9abdbSWeongyo Jeong bwn_dma_rx_reset(dr->dr_mac, dr->dr_base, dr->dr_type); 305345d9abdbSWeongyo Jeong if (dr->dr_type == BWN_DMA_64BIT) { 305445d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_RXRINGLO, 0); 305545d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA64_RXRINGHI, 0); 305645d9abdbSWeongyo Jeong } else 305745d9abdbSWeongyo Jeong BWN_DMA_WRITE(dr, BWN_DMA32_RXRING, 0); 305845d9abdbSWeongyo Jeong } 305945d9abdbSWeongyo Jeong } 306045d9abdbSWeongyo Jeong 306145d9abdbSWeongyo Jeong static void 306245d9abdbSWeongyo Jeong bwn_dma_free_descbufs(struct bwn_dma_ring *dr) 306345d9abdbSWeongyo Jeong { 306445d9abdbSWeongyo Jeong struct bwn_dmadesc_generic *desc; 306545d9abdbSWeongyo Jeong struct bwn_dmadesc_meta *meta; 306645d9abdbSWeongyo Jeong struct bwn_mac *mac = dr->dr_mac; 306745d9abdbSWeongyo Jeong struct bwn_dma *dma = &mac->mac_method.dma; 306845d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 306945d9abdbSWeongyo Jeong int i; 307045d9abdbSWeongyo Jeong 307145d9abdbSWeongyo Jeong if (!dr->dr_usedslot) 307245d9abdbSWeongyo Jeong return; 307345d9abdbSWeongyo Jeong for (i = 0; i < dr->dr_numslots; i++) { 307445d9abdbSWeongyo Jeong dr->getdesc(dr, i, &desc, &meta); 307545d9abdbSWeongyo Jeong 307645d9abdbSWeongyo Jeong if (meta->mt_m == NULL) { 307745d9abdbSWeongyo Jeong if (!dr->dr_tx) 307845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: not TX?\n", 307945d9abdbSWeongyo Jeong __func__); 308045d9abdbSWeongyo Jeong continue; 308145d9abdbSWeongyo Jeong } 308245d9abdbSWeongyo Jeong if (dr->dr_tx) { 308345d9abdbSWeongyo Jeong if (meta->mt_txtype == BWN_DMADESC_METATYPE_HEADER) 308445d9abdbSWeongyo Jeong bus_dmamap_unload(dr->dr_txring_dtag, 308545d9abdbSWeongyo Jeong meta->mt_dmap); 308645d9abdbSWeongyo Jeong else if (meta->mt_txtype == BWN_DMADESC_METATYPE_BODY) 308745d9abdbSWeongyo Jeong bus_dmamap_unload(dma->txbuf_dtag, 308845d9abdbSWeongyo Jeong meta->mt_dmap); 308945d9abdbSWeongyo Jeong } else 309045d9abdbSWeongyo Jeong bus_dmamap_unload(dma->rxbuf_dtag, meta->mt_dmap); 309145d9abdbSWeongyo Jeong bwn_dma_free_descbuf(dr, meta); 309245d9abdbSWeongyo Jeong } 309345d9abdbSWeongyo Jeong } 309445d9abdbSWeongyo Jeong 309545d9abdbSWeongyo Jeong static int 309645d9abdbSWeongyo Jeong bwn_dma_tx_reset(struct bwn_mac *mac, uint16_t base, 309745d9abdbSWeongyo Jeong int type) 309845d9abdbSWeongyo Jeong { 309945d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 310045d9abdbSWeongyo Jeong uint32_t value; 310145d9abdbSWeongyo Jeong int i; 310245d9abdbSWeongyo Jeong uint16_t offset; 310345d9abdbSWeongyo Jeong 310445d9abdbSWeongyo Jeong for (i = 0; i < 10; i++) { 310545d9abdbSWeongyo Jeong offset = (type == BWN_DMA_64BIT) ? BWN_DMA64_TXSTATUS : 310645d9abdbSWeongyo Jeong BWN_DMA32_TXSTATUS; 310745d9abdbSWeongyo Jeong value = BWN_READ_4(mac, base + offset); 310845d9abdbSWeongyo Jeong if (type == BWN_DMA_64BIT) { 310945d9abdbSWeongyo Jeong value &= BWN_DMA64_TXSTAT; 311045d9abdbSWeongyo Jeong if (value == BWN_DMA64_TXSTAT_DISABLED || 311145d9abdbSWeongyo Jeong value == BWN_DMA64_TXSTAT_IDLEWAIT || 311245d9abdbSWeongyo Jeong value == BWN_DMA64_TXSTAT_STOPPED) 311345d9abdbSWeongyo Jeong break; 311445d9abdbSWeongyo Jeong } else { 311545d9abdbSWeongyo Jeong value &= BWN_DMA32_TXSTATE; 311645d9abdbSWeongyo Jeong if (value == BWN_DMA32_TXSTAT_DISABLED || 311745d9abdbSWeongyo Jeong value == BWN_DMA32_TXSTAT_IDLEWAIT || 311845d9abdbSWeongyo Jeong value == BWN_DMA32_TXSTAT_STOPPED) 311945d9abdbSWeongyo Jeong break; 312045d9abdbSWeongyo Jeong } 312145d9abdbSWeongyo Jeong DELAY(1000); 312245d9abdbSWeongyo Jeong } 312345d9abdbSWeongyo Jeong offset = (type == BWN_DMA_64BIT) ? BWN_DMA64_TXCTL : BWN_DMA32_TXCTL; 312445d9abdbSWeongyo Jeong BWN_WRITE_4(mac, base + offset, 0); 312545d9abdbSWeongyo Jeong for (i = 0; i < 10; i++) { 312645d9abdbSWeongyo Jeong offset = (type == BWN_DMA_64BIT) ? BWN_DMA64_TXSTATUS : 312745d9abdbSWeongyo Jeong BWN_DMA32_TXSTATUS; 312845d9abdbSWeongyo Jeong value = BWN_READ_4(mac, base + offset); 312945d9abdbSWeongyo Jeong if (type == BWN_DMA_64BIT) { 313045d9abdbSWeongyo Jeong value &= BWN_DMA64_TXSTAT; 313145d9abdbSWeongyo Jeong if (value == BWN_DMA64_TXSTAT_DISABLED) { 313245d9abdbSWeongyo Jeong i = -1; 313345d9abdbSWeongyo Jeong break; 313445d9abdbSWeongyo Jeong } 313545d9abdbSWeongyo Jeong } else { 313645d9abdbSWeongyo Jeong value &= BWN_DMA32_TXSTATE; 313745d9abdbSWeongyo Jeong if (value == BWN_DMA32_TXSTAT_DISABLED) { 313845d9abdbSWeongyo Jeong i = -1; 313945d9abdbSWeongyo Jeong break; 314045d9abdbSWeongyo Jeong } 314145d9abdbSWeongyo Jeong } 314245d9abdbSWeongyo Jeong DELAY(1000); 314345d9abdbSWeongyo Jeong } 314445d9abdbSWeongyo Jeong if (i != -1) { 314545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: timed out\n", __func__); 314645d9abdbSWeongyo Jeong return (ENODEV); 314745d9abdbSWeongyo Jeong } 314845d9abdbSWeongyo Jeong DELAY(1000); 314945d9abdbSWeongyo Jeong 315045d9abdbSWeongyo Jeong return (0); 315145d9abdbSWeongyo Jeong } 315245d9abdbSWeongyo Jeong 315345d9abdbSWeongyo Jeong static int 315445d9abdbSWeongyo Jeong bwn_dma_rx_reset(struct bwn_mac *mac, uint16_t base, 315545d9abdbSWeongyo Jeong int type) 315645d9abdbSWeongyo Jeong { 315745d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 315845d9abdbSWeongyo Jeong uint32_t value; 315945d9abdbSWeongyo Jeong int i; 316045d9abdbSWeongyo Jeong uint16_t offset; 316145d9abdbSWeongyo Jeong 316245d9abdbSWeongyo Jeong offset = (type == BWN_DMA_64BIT) ? BWN_DMA64_RXCTL : BWN_DMA32_RXCTL; 316345d9abdbSWeongyo Jeong BWN_WRITE_4(mac, base + offset, 0); 316445d9abdbSWeongyo Jeong for (i = 0; i < 10; i++) { 316545d9abdbSWeongyo Jeong offset = (type == BWN_DMA_64BIT) ? BWN_DMA64_RXSTATUS : 316645d9abdbSWeongyo Jeong BWN_DMA32_RXSTATUS; 316745d9abdbSWeongyo Jeong value = BWN_READ_4(mac, base + offset); 316845d9abdbSWeongyo Jeong if (type == BWN_DMA_64BIT) { 316945d9abdbSWeongyo Jeong value &= BWN_DMA64_RXSTAT; 317045d9abdbSWeongyo Jeong if (value == BWN_DMA64_RXSTAT_DISABLED) { 317145d9abdbSWeongyo Jeong i = -1; 317245d9abdbSWeongyo Jeong break; 317345d9abdbSWeongyo Jeong } 317445d9abdbSWeongyo Jeong } else { 317545d9abdbSWeongyo Jeong value &= BWN_DMA32_RXSTATE; 317645d9abdbSWeongyo Jeong if (value == BWN_DMA32_RXSTAT_DISABLED) { 317745d9abdbSWeongyo Jeong i = -1; 317845d9abdbSWeongyo Jeong break; 317945d9abdbSWeongyo Jeong } 318045d9abdbSWeongyo Jeong } 318145d9abdbSWeongyo Jeong DELAY(1000); 318245d9abdbSWeongyo Jeong } 318345d9abdbSWeongyo Jeong if (i != -1) { 318445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: timed out\n", __func__); 318545d9abdbSWeongyo Jeong return (ENODEV); 318645d9abdbSWeongyo Jeong } 318745d9abdbSWeongyo Jeong 318845d9abdbSWeongyo Jeong return (0); 318945d9abdbSWeongyo Jeong } 319045d9abdbSWeongyo Jeong 319145d9abdbSWeongyo Jeong static void 319245d9abdbSWeongyo Jeong bwn_dma_free_descbuf(struct bwn_dma_ring *dr, 319345d9abdbSWeongyo Jeong struct bwn_dmadesc_meta *meta) 319445d9abdbSWeongyo Jeong { 319545d9abdbSWeongyo Jeong 319645d9abdbSWeongyo Jeong if (meta->mt_m != NULL) { 319745d9abdbSWeongyo Jeong m_freem(meta->mt_m); 319845d9abdbSWeongyo Jeong meta->mt_m = NULL; 319945d9abdbSWeongyo Jeong } 320045d9abdbSWeongyo Jeong if (meta->mt_ni != NULL) { 320145d9abdbSWeongyo Jeong ieee80211_free_node(meta->mt_ni); 320245d9abdbSWeongyo Jeong meta->mt_ni = NULL; 320345d9abdbSWeongyo Jeong } 320445d9abdbSWeongyo Jeong } 320545d9abdbSWeongyo Jeong 320645d9abdbSWeongyo Jeong static void 320745d9abdbSWeongyo Jeong bwn_dma_set_redzone(struct bwn_dma_ring *dr, struct mbuf *m) 320845d9abdbSWeongyo Jeong { 320945d9abdbSWeongyo Jeong struct bwn_rxhdr4 *rxhdr; 321045d9abdbSWeongyo Jeong unsigned char *frame; 321145d9abdbSWeongyo Jeong 321245d9abdbSWeongyo Jeong rxhdr = mtod(m, struct bwn_rxhdr4 *); 321345d9abdbSWeongyo Jeong rxhdr->frame_len = 0; 321445d9abdbSWeongyo Jeong 321545d9abdbSWeongyo Jeong KASSERT(dr->dr_rx_bufsize >= dr->dr_frameoffset + 321645d9abdbSWeongyo Jeong sizeof(struct bwn_plcp6) + 2, 321745d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 321845d9abdbSWeongyo Jeong frame = mtod(m, char *) + dr->dr_frameoffset; 321945d9abdbSWeongyo Jeong memset(frame, 0xff, sizeof(struct bwn_plcp6) + 2 /* padding */); 322045d9abdbSWeongyo Jeong } 322145d9abdbSWeongyo Jeong 322245d9abdbSWeongyo Jeong static uint8_t 322345d9abdbSWeongyo Jeong bwn_dma_check_redzone(struct bwn_dma_ring *dr, struct mbuf *m) 322445d9abdbSWeongyo Jeong { 322545d9abdbSWeongyo Jeong unsigned char *f = mtod(m, char *) + dr->dr_frameoffset; 322645d9abdbSWeongyo Jeong 322745d9abdbSWeongyo Jeong return ((f[0] & f[1] & f[2] & f[3] & f[4] & f[5] & f[6] & f[7]) 322845d9abdbSWeongyo Jeong == 0xff); 322945d9abdbSWeongyo Jeong } 323045d9abdbSWeongyo Jeong 323145d9abdbSWeongyo Jeong static void 323245d9abdbSWeongyo Jeong bwn_wme_init(struct bwn_mac *mac) 323345d9abdbSWeongyo Jeong { 323445d9abdbSWeongyo Jeong 323545d9abdbSWeongyo Jeong bwn_wme_load(mac); 323645d9abdbSWeongyo Jeong 323745d9abdbSWeongyo Jeong /* enable WME support. */ 323845d9abdbSWeongyo Jeong bwn_hf_write(mac, bwn_hf_read(mac) | BWN_HF_EDCF); 323945d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_IFSCTL, BWN_READ_2(mac, BWN_IFSCTL) | 324045d9abdbSWeongyo Jeong BWN_IFSCTL_USE_EDCF); 324145d9abdbSWeongyo Jeong } 324245d9abdbSWeongyo Jeong 324345d9abdbSWeongyo Jeong static void 324445d9abdbSWeongyo Jeong bwn_spu_setdelay(struct bwn_mac *mac, int idle) 324545d9abdbSWeongyo Jeong { 324645d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 32477a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 324845d9abdbSWeongyo Jeong uint16_t delay; /* microsec */ 324945d9abdbSWeongyo Jeong 325045d9abdbSWeongyo Jeong delay = (mac->mac_phy.type == BWN_PHYTYPE_A) ? 3700 : 1050; 325145d9abdbSWeongyo Jeong if (ic->ic_opmode == IEEE80211_M_IBSS || idle) 325245d9abdbSWeongyo Jeong delay = 500; 325345d9abdbSWeongyo Jeong if ((mac->mac_phy.rf_ver == 0x2050) && (mac->mac_phy.rf_rev == 8)) 325445d9abdbSWeongyo Jeong delay = max(delay, (uint16_t)2400); 325545d9abdbSWeongyo Jeong 325645d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_SPU_WAKEUP, delay); 325745d9abdbSWeongyo Jeong } 325845d9abdbSWeongyo Jeong 325945d9abdbSWeongyo Jeong static void 326045d9abdbSWeongyo Jeong bwn_bt_enable(struct bwn_mac *mac) 326145d9abdbSWeongyo Jeong { 3262b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 326345d9abdbSWeongyo Jeong uint64_t hf; 326445d9abdbSWeongyo Jeong 326545d9abdbSWeongyo Jeong if (bwn_bluetooth == 0) 326645d9abdbSWeongyo Jeong return; 3267b9b64aa5SWeongyo Jeong if ((siba_sprom_get_bf_lo(sc->sc_dev) & BWN_BFL_BTCOEXIST) == 0) 326845d9abdbSWeongyo Jeong return; 326945d9abdbSWeongyo Jeong if (mac->mac_phy.type != BWN_PHYTYPE_B && !mac->mac_phy.gmode) 327045d9abdbSWeongyo Jeong return; 327145d9abdbSWeongyo Jeong 327245d9abdbSWeongyo Jeong hf = bwn_hf_read(mac); 3273b9b64aa5SWeongyo Jeong if (siba_sprom_get_bf_lo(sc->sc_dev) & BWN_BFL_BTCMOD) 327445d9abdbSWeongyo Jeong hf |= BWN_HF_BT_COEXISTALT; 327545d9abdbSWeongyo Jeong else 327645d9abdbSWeongyo Jeong hf |= BWN_HF_BT_COEXIST; 327745d9abdbSWeongyo Jeong bwn_hf_write(mac, hf); 327845d9abdbSWeongyo Jeong } 327945d9abdbSWeongyo Jeong 328045d9abdbSWeongyo Jeong static void 328145d9abdbSWeongyo Jeong bwn_set_macaddr(struct bwn_mac *mac) 328245d9abdbSWeongyo Jeong { 328345d9abdbSWeongyo Jeong 328445d9abdbSWeongyo Jeong bwn_mac_write_bssid(mac); 32857a79cebfSGleb Smirnoff bwn_mac_setfilter(mac, BWN_MACFILTER_SELF, 32867a79cebfSGleb Smirnoff mac->mac_sc->sc_ic.ic_macaddr); 328745d9abdbSWeongyo Jeong } 328845d9abdbSWeongyo Jeong 328945d9abdbSWeongyo Jeong static void 329045d9abdbSWeongyo Jeong bwn_clear_keys(struct bwn_mac *mac) 329145d9abdbSWeongyo Jeong { 329245d9abdbSWeongyo Jeong int i; 329345d9abdbSWeongyo Jeong 329445d9abdbSWeongyo Jeong for (i = 0; i < mac->mac_max_nr_keys; i++) { 329545d9abdbSWeongyo Jeong KASSERT(i >= 0 && i < mac->mac_max_nr_keys, 329645d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 329745d9abdbSWeongyo Jeong 329845d9abdbSWeongyo Jeong bwn_key_dowrite(mac, i, BWN_SEC_ALGO_NONE, 329945d9abdbSWeongyo Jeong NULL, BWN_SEC_KEYSIZE, NULL); 330045d9abdbSWeongyo Jeong if ((i <= 3) && !BWN_SEC_NEWAPI(mac)) { 330145d9abdbSWeongyo Jeong bwn_key_dowrite(mac, i + 4, BWN_SEC_ALGO_NONE, 330245d9abdbSWeongyo Jeong NULL, BWN_SEC_KEYSIZE, NULL); 330345d9abdbSWeongyo Jeong } 330445d9abdbSWeongyo Jeong mac->mac_key[i].keyconf = NULL; 330545d9abdbSWeongyo Jeong } 330645d9abdbSWeongyo Jeong } 330745d9abdbSWeongyo Jeong 330845d9abdbSWeongyo Jeong static void 330945d9abdbSWeongyo Jeong bwn_crypt_init(struct bwn_mac *mac) 331045d9abdbSWeongyo Jeong { 3311b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 331245d9abdbSWeongyo Jeong 3313b9b64aa5SWeongyo Jeong mac->mac_max_nr_keys = (siba_get_revid(sc->sc_dev) >= 5) ? 58 : 20; 331445d9abdbSWeongyo Jeong KASSERT(mac->mac_max_nr_keys <= N(mac->mac_key), 331545d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 331645d9abdbSWeongyo Jeong mac->mac_ktp = bwn_shm_read_2(mac, BWN_SHARED, BWN_SHARED_KEY_TABLEP); 331745d9abdbSWeongyo Jeong mac->mac_ktp *= 2; 3318b9b64aa5SWeongyo Jeong if (siba_get_revid(sc->sc_dev) >= 5) 3319b9b64aa5SWeongyo Jeong BWN_WRITE_2(mac, BWN_RCMTA_COUNT, mac->mac_max_nr_keys - 8); 332045d9abdbSWeongyo Jeong bwn_clear_keys(mac); 332145d9abdbSWeongyo Jeong } 332245d9abdbSWeongyo Jeong 332345d9abdbSWeongyo Jeong static void 332445d9abdbSWeongyo Jeong bwn_chip_exit(struct bwn_mac *mac) 332545d9abdbSWeongyo Jeong { 3326b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 332745d9abdbSWeongyo Jeong 332845d9abdbSWeongyo Jeong bwn_phy_exit(mac); 3329b9b64aa5SWeongyo Jeong siba_gpio_set(sc->sc_dev, 0); 333045d9abdbSWeongyo Jeong } 333145d9abdbSWeongyo Jeong 333245d9abdbSWeongyo Jeong static int 333345d9abdbSWeongyo Jeong bwn_fw_fillinfo(struct bwn_mac *mac) 333445d9abdbSWeongyo Jeong { 333545d9abdbSWeongyo Jeong int error; 333645d9abdbSWeongyo Jeong 333745d9abdbSWeongyo Jeong error = bwn_fw_gets(mac, BWN_FWTYPE_DEFAULT); 333845d9abdbSWeongyo Jeong if (error == 0) 333945d9abdbSWeongyo Jeong return (0); 334045d9abdbSWeongyo Jeong error = bwn_fw_gets(mac, BWN_FWTYPE_OPENSOURCE); 334145d9abdbSWeongyo Jeong if (error == 0) 334245d9abdbSWeongyo Jeong return (0); 334345d9abdbSWeongyo Jeong return (error); 334445d9abdbSWeongyo Jeong } 334545d9abdbSWeongyo Jeong 334645d9abdbSWeongyo Jeong static int 334745d9abdbSWeongyo Jeong bwn_gpio_init(struct bwn_mac *mac) 334845d9abdbSWeongyo Jeong { 3349b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 3350b9b64aa5SWeongyo Jeong uint32_t mask = 0x1f, set = 0xf, value; 335145d9abdbSWeongyo Jeong 335245d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, 335345d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_MACCTL) & ~BWN_MACCTL_GPOUT_MASK); 335445d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_GPIO_MASK, 335545d9abdbSWeongyo Jeong BWN_READ_2(mac, BWN_GPIO_MASK) | 0x000f); 335645d9abdbSWeongyo Jeong 3357b9b64aa5SWeongyo Jeong if (siba_get_chipid(sc->sc_dev) == 0x4301) { 335845d9abdbSWeongyo Jeong mask |= 0x0060; 335945d9abdbSWeongyo Jeong set |= 0x0060; 336045d9abdbSWeongyo Jeong } 3361b9b64aa5SWeongyo Jeong if (siba_sprom_get_bf_lo(sc->sc_dev) & BWN_BFL_PACTRL) { 336245d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_GPIO_MASK, 336345d9abdbSWeongyo Jeong BWN_READ_2(mac, BWN_GPIO_MASK) | 0x0200); 336445d9abdbSWeongyo Jeong mask |= 0x0200; 336545d9abdbSWeongyo Jeong set |= 0x0200; 336645d9abdbSWeongyo Jeong } 3367b9b64aa5SWeongyo Jeong if (siba_get_revid(sc->sc_dev) >= 2) 336845d9abdbSWeongyo Jeong mask |= 0x0010; 3369b9b64aa5SWeongyo Jeong 3370b9b64aa5SWeongyo Jeong value = siba_gpio_get(sc->sc_dev); 3371b9b64aa5SWeongyo Jeong if (value == -1) 337245d9abdbSWeongyo Jeong return (0); 3373b9b64aa5SWeongyo Jeong siba_gpio_set(sc->sc_dev, (value & mask) | set); 337445d9abdbSWeongyo Jeong 337545d9abdbSWeongyo Jeong return (0); 337645d9abdbSWeongyo Jeong } 337745d9abdbSWeongyo Jeong 337845d9abdbSWeongyo Jeong static int 337945d9abdbSWeongyo Jeong bwn_fw_loadinitvals(struct bwn_mac *mac) 338045d9abdbSWeongyo Jeong { 338145d9abdbSWeongyo Jeong #define GETFWOFFSET(fwp, offset) \ 338245d9abdbSWeongyo Jeong ((const struct bwn_fwinitvals *)((const char *)fwp.fw->data + offset)) 338345d9abdbSWeongyo Jeong const size_t hdr_len = sizeof(struct bwn_fwhdr); 338445d9abdbSWeongyo Jeong const struct bwn_fwhdr *hdr; 338545d9abdbSWeongyo Jeong struct bwn_fw *fw = &mac->mac_fw; 338645d9abdbSWeongyo Jeong int error; 338745d9abdbSWeongyo Jeong 338845d9abdbSWeongyo Jeong hdr = (const struct bwn_fwhdr *)(fw->initvals.fw->data); 338945d9abdbSWeongyo Jeong error = bwn_fwinitvals_write(mac, GETFWOFFSET(fw->initvals, hdr_len), 339045d9abdbSWeongyo Jeong be32toh(hdr->size), fw->initvals.fw->datasize - hdr_len); 339145d9abdbSWeongyo Jeong if (error) 339245d9abdbSWeongyo Jeong return (error); 339345d9abdbSWeongyo Jeong if (fw->initvals_band.fw) { 339445d9abdbSWeongyo Jeong hdr = (const struct bwn_fwhdr *)(fw->initvals_band.fw->data); 339545d9abdbSWeongyo Jeong error = bwn_fwinitvals_write(mac, 339645d9abdbSWeongyo Jeong GETFWOFFSET(fw->initvals_band, hdr_len), 339745d9abdbSWeongyo Jeong be32toh(hdr->size), 339845d9abdbSWeongyo Jeong fw->initvals_band.fw->datasize - hdr_len); 339945d9abdbSWeongyo Jeong } 340045d9abdbSWeongyo Jeong return (error); 340145d9abdbSWeongyo Jeong #undef GETFWOFFSET 340245d9abdbSWeongyo Jeong } 340345d9abdbSWeongyo Jeong 340445d9abdbSWeongyo Jeong static int 340545d9abdbSWeongyo Jeong bwn_phy_init(struct bwn_mac *mac) 340645d9abdbSWeongyo Jeong { 340745d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 340845d9abdbSWeongyo Jeong int error; 340945d9abdbSWeongyo Jeong 341045d9abdbSWeongyo Jeong mac->mac_phy.chan = mac->mac_phy.get_default_chan(mac); 341145d9abdbSWeongyo Jeong mac->mac_phy.rf_onoff(mac, 1); 341245d9abdbSWeongyo Jeong error = mac->mac_phy.init(mac); 341345d9abdbSWeongyo Jeong if (error) { 341445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "PHY init failed\n"); 341545d9abdbSWeongyo Jeong goto fail0; 341645d9abdbSWeongyo Jeong } 341745d9abdbSWeongyo Jeong error = bwn_switch_channel(mac, 341845d9abdbSWeongyo Jeong mac->mac_phy.get_default_chan(mac)); 341945d9abdbSWeongyo Jeong if (error) { 342045d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 342145d9abdbSWeongyo Jeong "failed to switch default channel\n"); 342245d9abdbSWeongyo Jeong goto fail1; 342345d9abdbSWeongyo Jeong } 342445d9abdbSWeongyo Jeong return (0); 342545d9abdbSWeongyo Jeong fail1: 342645d9abdbSWeongyo Jeong if (mac->mac_phy.exit) 342745d9abdbSWeongyo Jeong mac->mac_phy.exit(mac); 342845d9abdbSWeongyo Jeong fail0: 342945d9abdbSWeongyo Jeong mac->mac_phy.rf_onoff(mac, 0); 343045d9abdbSWeongyo Jeong 343145d9abdbSWeongyo Jeong return (error); 343245d9abdbSWeongyo Jeong } 343345d9abdbSWeongyo Jeong 343445d9abdbSWeongyo Jeong static void 343545d9abdbSWeongyo Jeong bwn_set_txantenna(struct bwn_mac *mac, int antenna) 343645d9abdbSWeongyo Jeong { 343745d9abdbSWeongyo Jeong uint16_t ant; 343845d9abdbSWeongyo Jeong uint16_t tmp; 343945d9abdbSWeongyo Jeong 344045d9abdbSWeongyo Jeong ant = bwn_ant2phy(antenna); 344145d9abdbSWeongyo Jeong 344245d9abdbSWeongyo Jeong /* For ACK/CTS */ 344345d9abdbSWeongyo Jeong tmp = bwn_shm_read_2(mac, BWN_SHARED, BWN_SHARED_ACKCTS_PHYCTL); 344445d9abdbSWeongyo Jeong tmp = (tmp & ~BWN_TX_PHY_ANT) | ant; 344545d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_ACKCTS_PHYCTL, tmp); 344645d9abdbSWeongyo Jeong /* For Probe Resposes */ 344745d9abdbSWeongyo Jeong tmp = bwn_shm_read_2(mac, BWN_SHARED, BWN_SHARED_PROBE_RESP_PHYCTL); 344845d9abdbSWeongyo Jeong tmp = (tmp & ~BWN_TX_PHY_ANT) | ant; 344945d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_PROBE_RESP_PHYCTL, tmp); 345045d9abdbSWeongyo Jeong } 345145d9abdbSWeongyo Jeong 345245d9abdbSWeongyo Jeong static void 345345d9abdbSWeongyo Jeong bwn_set_opmode(struct bwn_mac *mac) 345445d9abdbSWeongyo Jeong { 345545d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 34567a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 345745d9abdbSWeongyo Jeong uint32_t ctl; 345845d9abdbSWeongyo Jeong uint16_t cfp_pretbtt; 345945d9abdbSWeongyo Jeong 346045d9abdbSWeongyo Jeong ctl = BWN_READ_4(mac, BWN_MACCTL); 346145d9abdbSWeongyo Jeong ctl &= ~(BWN_MACCTL_HOSTAP | BWN_MACCTL_PASS_CTL | 346245d9abdbSWeongyo Jeong BWN_MACCTL_PASS_BADPLCP | BWN_MACCTL_PASS_BADFCS | 346345d9abdbSWeongyo Jeong BWN_MACCTL_PROMISC | BWN_MACCTL_BEACON_PROMISC); 346445d9abdbSWeongyo Jeong ctl |= BWN_MACCTL_STA; 346545d9abdbSWeongyo Jeong 346645d9abdbSWeongyo Jeong if (ic->ic_opmode == IEEE80211_M_HOSTAP || 346745d9abdbSWeongyo Jeong ic->ic_opmode == IEEE80211_M_MBSS) 346845d9abdbSWeongyo Jeong ctl |= BWN_MACCTL_HOSTAP; 346945d9abdbSWeongyo Jeong else if (ic->ic_opmode == IEEE80211_M_IBSS) 347045d9abdbSWeongyo Jeong ctl &= ~BWN_MACCTL_STA; 347145d9abdbSWeongyo Jeong ctl |= sc->sc_filters; 347245d9abdbSWeongyo Jeong 3473b9b64aa5SWeongyo Jeong if (siba_get_revid(sc->sc_dev) <= 4) 347445d9abdbSWeongyo Jeong ctl |= BWN_MACCTL_PROMISC; 347545d9abdbSWeongyo Jeong 347645d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, ctl); 347745d9abdbSWeongyo Jeong 347845d9abdbSWeongyo Jeong cfp_pretbtt = 2; 347945d9abdbSWeongyo Jeong if ((ctl & BWN_MACCTL_STA) && !(ctl & BWN_MACCTL_HOSTAP)) { 3480b9b64aa5SWeongyo Jeong if (siba_get_chipid(sc->sc_dev) == 0x4306 && 3481b9b64aa5SWeongyo Jeong siba_get_chiprev(sc->sc_dev) == 3) 348245d9abdbSWeongyo Jeong cfp_pretbtt = 100; 348345d9abdbSWeongyo Jeong else 348445d9abdbSWeongyo Jeong cfp_pretbtt = 50; 348545d9abdbSWeongyo Jeong } 348645d9abdbSWeongyo Jeong BWN_WRITE_2(mac, 0x612, cfp_pretbtt); 348745d9abdbSWeongyo Jeong } 348845d9abdbSWeongyo Jeong 348945d9abdbSWeongyo Jeong static int 349045d9abdbSWeongyo Jeong bwn_dma_gettype(struct bwn_mac *mac) 349145d9abdbSWeongyo Jeong { 349245d9abdbSWeongyo Jeong uint32_t tmp; 349345d9abdbSWeongyo Jeong uint16_t base; 349445d9abdbSWeongyo Jeong 349545d9abdbSWeongyo Jeong tmp = BWN_READ_4(mac, SIBA_TGSHIGH); 349645d9abdbSWeongyo Jeong if (tmp & SIBA_TGSHIGH_DMA64) 349745d9abdbSWeongyo Jeong return (BWN_DMA_64BIT); 349845d9abdbSWeongyo Jeong base = bwn_dma_base(0, 0); 349945d9abdbSWeongyo Jeong BWN_WRITE_4(mac, base + BWN_DMA32_TXCTL, BWN_DMA32_TXADDREXT_MASK); 350045d9abdbSWeongyo Jeong tmp = BWN_READ_4(mac, base + BWN_DMA32_TXCTL); 350145d9abdbSWeongyo Jeong if (tmp & BWN_DMA32_TXADDREXT_MASK) 350245d9abdbSWeongyo Jeong return (BWN_DMA_32BIT); 350345d9abdbSWeongyo Jeong 350445d9abdbSWeongyo Jeong return (BWN_DMA_30BIT); 350545d9abdbSWeongyo Jeong } 350645d9abdbSWeongyo Jeong 350745d9abdbSWeongyo Jeong static void 350845d9abdbSWeongyo Jeong bwn_dma_ring_addr(void *arg, bus_dma_segment_t *seg, int nseg, int error) 350945d9abdbSWeongyo Jeong { 351045d9abdbSWeongyo Jeong if (!error) { 351145d9abdbSWeongyo Jeong KASSERT(nseg == 1, ("too many segments(%d)\n", nseg)); 351245d9abdbSWeongyo Jeong *((bus_addr_t *)arg) = seg->ds_addr; 351345d9abdbSWeongyo Jeong } 351445d9abdbSWeongyo Jeong } 351545d9abdbSWeongyo Jeong 3516*d546e47aSAdrian Chadd void 351745d9abdbSWeongyo Jeong bwn_ram_write(struct bwn_mac *mac, uint16_t offset, uint32_t val) 351845d9abdbSWeongyo Jeong { 351945d9abdbSWeongyo Jeong uint32_t macctl; 352045d9abdbSWeongyo Jeong 352145d9abdbSWeongyo Jeong KASSERT(offset % 4 == 0, ("%s:%d: fail", __func__, __LINE__)); 352245d9abdbSWeongyo Jeong 352345d9abdbSWeongyo Jeong macctl = BWN_READ_4(mac, BWN_MACCTL); 352445d9abdbSWeongyo Jeong if (macctl & BWN_MACCTL_BIGENDIAN) 352545d9abdbSWeongyo Jeong printf("TODO: need swap\n"); 352645d9abdbSWeongyo Jeong 352745d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_RAM_CONTROL, offset); 352845d9abdbSWeongyo Jeong BWN_BARRIER(mac, BUS_SPACE_BARRIER_WRITE); 352945d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_RAM_DATA, val); 353045d9abdbSWeongyo Jeong } 353145d9abdbSWeongyo Jeong 3532b9768303SAdrian Chadd void 353345d9abdbSWeongyo Jeong bwn_mac_suspend(struct bwn_mac *mac) 353445d9abdbSWeongyo Jeong { 353545d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 353645d9abdbSWeongyo Jeong int i; 353745d9abdbSWeongyo Jeong uint32_t tmp; 353845d9abdbSWeongyo Jeong 353945d9abdbSWeongyo Jeong KASSERT(mac->mac_suspended >= 0, 354045d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 354145d9abdbSWeongyo Jeong 354245d9abdbSWeongyo Jeong if (mac->mac_suspended == 0) { 354345d9abdbSWeongyo Jeong bwn_psctl(mac, BWN_PS_AWAKE); 354445d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, 354545d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_MACCTL) 354645d9abdbSWeongyo Jeong & ~BWN_MACCTL_ON); 354745d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_MACCTL); 354845d9abdbSWeongyo Jeong for (i = 35; i; i--) { 354945d9abdbSWeongyo Jeong tmp = BWN_READ_4(mac, BWN_INTR_REASON); 355045d9abdbSWeongyo Jeong if (tmp & BWN_INTR_MAC_SUSPENDED) 355145d9abdbSWeongyo Jeong goto out; 355245d9abdbSWeongyo Jeong DELAY(10); 355345d9abdbSWeongyo Jeong } 355445d9abdbSWeongyo Jeong for (i = 40; i; i--) { 355545d9abdbSWeongyo Jeong tmp = BWN_READ_4(mac, BWN_INTR_REASON); 355645d9abdbSWeongyo Jeong if (tmp & BWN_INTR_MAC_SUSPENDED) 355745d9abdbSWeongyo Jeong goto out; 355845d9abdbSWeongyo Jeong DELAY(1000); 355945d9abdbSWeongyo Jeong } 356045d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "MAC suspend failed\n"); 356145d9abdbSWeongyo Jeong } 356245d9abdbSWeongyo Jeong out: 356345d9abdbSWeongyo Jeong mac->mac_suspended++; 356445d9abdbSWeongyo Jeong } 356545d9abdbSWeongyo Jeong 3566b9768303SAdrian Chadd void 356745d9abdbSWeongyo Jeong bwn_mac_enable(struct bwn_mac *mac) 356845d9abdbSWeongyo Jeong { 356945d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 357045d9abdbSWeongyo Jeong uint16_t state; 357145d9abdbSWeongyo Jeong 357245d9abdbSWeongyo Jeong state = bwn_shm_read_2(mac, BWN_SHARED, 357345d9abdbSWeongyo Jeong BWN_SHARED_UCODESTAT); 357445d9abdbSWeongyo Jeong if (state != BWN_SHARED_UCODESTAT_SUSPEND && 357545d9abdbSWeongyo Jeong state != BWN_SHARED_UCODESTAT_SLEEP) 357645d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "warn: firmware state (%d)\n", state); 357745d9abdbSWeongyo Jeong 357845d9abdbSWeongyo Jeong mac->mac_suspended--; 357945d9abdbSWeongyo Jeong KASSERT(mac->mac_suspended >= 0, 358045d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 358145d9abdbSWeongyo Jeong if (mac->mac_suspended == 0) { 358245d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, 358345d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_MACCTL) | BWN_MACCTL_ON); 358445d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_INTR_REASON, BWN_INTR_MAC_SUSPENDED); 358545d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_MACCTL); 358645d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_INTR_REASON); 358745d9abdbSWeongyo Jeong bwn_psctl(mac, 0); 358845d9abdbSWeongyo Jeong } 358945d9abdbSWeongyo Jeong } 359045d9abdbSWeongyo Jeong 3591*d546e47aSAdrian Chadd void 359245d9abdbSWeongyo Jeong bwn_psctl(struct bwn_mac *mac, uint32_t flags) 359345d9abdbSWeongyo Jeong { 3594b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 359545d9abdbSWeongyo Jeong int i; 359645d9abdbSWeongyo Jeong uint16_t ucstat; 359745d9abdbSWeongyo Jeong 359845d9abdbSWeongyo Jeong KASSERT(!((flags & BWN_PS_ON) && (flags & BWN_PS_OFF)), 359945d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 360045d9abdbSWeongyo Jeong KASSERT(!((flags & BWN_PS_AWAKE) && (flags & BWN_PS_ASLEEP)), 360145d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 360245d9abdbSWeongyo Jeong 360345d9abdbSWeongyo Jeong /* XXX forcibly awake and hwps-off */ 360445d9abdbSWeongyo Jeong 360545d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, 360645d9abdbSWeongyo Jeong (BWN_READ_4(mac, BWN_MACCTL) | BWN_MACCTL_AWAKE) & 360745d9abdbSWeongyo Jeong ~BWN_MACCTL_HWPS); 360845d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_MACCTL); 3609b9b64aa5SWeongyo Jeong if (siba_get_revid(sc->sc_dev) >= 5) { 361045d9abdbSWeongyo Jeong for (i = 0; i < 100; i++) { 361145d9abdbSWeongyo Jeong ucstat = bwn_shm_read_2(mac, BWN_SHARED, 361245d9abdbSWeongyo Jeong BWN_SHARED_UCODESTAT); 361345d9abdbSWeongyo Jeong if (ucstat != BWN_SHARED_UCODESTAT_SLEEP) 361445d9abdbSWeongyo Jeong break; 361545d9abdbSWeongyo Jeong DELAY(10); 361645d9abdbSWeongyo Jeong } 361745d9abdbSWeongyo Jeong } 361845d9abdbSWeongyo Jeong } 361945d9abdbSWeongyo Jeong 362045d9abdbSWeongyo Jeong static int 362145d9abdbSWeongyo Jeong bwn_fw_gets(struct bwn_mac *mac, enum bwn_fwtype type) 362245d9abdbSWeongyo Jeong { 362345d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 362445d9abdbSWeongyo Jeong struct bwn_fw *fw = &mac->mac_fw; 3625b9b64aa5SWeongyo Jeong const uint8_t rev = siba_get_revid(sc->sc_dev); 362645d9abdbSWeongyo Jeong const char *filename; 362745d9abdbSWeongyo Jeong uint32_t high; 362845d9abdbSWeongyo Jeong int error; 362945d9abdbSWeongyo Jeong 363045d9abdbSWeongyo Jeong /* microcode */ 363145d9abdbSWeongyo Jeong if (rev >= 5 && rev <= 10) 363245d9abdbSWeongyo Jeong filename = "ucode5"; 363345d9abdbSWeongyo Jeong else if (rev >= 11 && rev <= 12) 363445d9abdbSWeongyo Jeong filename = "ucode11"; 363545d9abdbSWeongyo Jeong else if (rev == 13) 363645d9abdbSWeongyo Jeong filename = "ucode13"; 363745d9abdbSWeongyo Jeong else if (rev == 14) 363845d9abdbSWeongyo Jeong filename = "ucode14"; 363945d9abdbSWeongyo Jeong else if (rev >= 15) 364045d9abdbSWeongyo Jeong filename = "ucode15"; 364145d9abdbSWeongyo Jeong else { 364245d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "no ucode for rev %d\n", rev); 364345d9abdbSWeongyo Jeong bwn_release_firmware(mac); 364445d9abdbSWeongyo Jeong return (EOPNOTSUPP); 364545d9abdbSWeongyo Jeong } 364645d9abdbSWeongyo Jeong error = bwn_fw_get(mac, type, filename, &fw->ucode); 364745d9abdbSWeongyo Jeong if (error) { 364845d9abdbSWeongyo Jeong bwn_release_firmware(mac); 364945d9abdbSWeongyo Jeong return (error); 365045d9abdbSWeongyo Jeong } 365145d9abdbSWeongyo Jeong 365245d9abdbSWeongyo Jeong /* PCM */ 365345d9abdbSWeongyo Jeong KASSERT(fw->no_pcmfile == 0, ("%s:%d fail", __func__, __LINE__)); 365445d9abdbSWeongyo Jeong if (rev >= 5 && rev <= 10) { 365545d9abdbSWeongyo Jeong error = bwn_fw_get(mac, type, "pcm5", &fw->pcm); 365645d9abdbSWeongyo Jeong if (error == ENOENT) 365745d9abdbSWeongyo Jeong fw->no_pcmfile = 1; 365845d9abdbSWeongyo Jeong else if (error) { 365945d9abdbSWeongyo Jeong bwn_release_firmware(mac); 366045d9abdbSWeongyo Jeong return (error); 366145d9abdbSWeongyo Jeong } 366245d9abdbSWeongyo Jeong } else if (rev < 11) { 366345d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "no PCM for rev %d\n", rev); 366445d9abdbSWeongyo Jeong return (EOPNOTSUPP); 366545d9abdbSWeongyo Jeong } 366645d9abdbSWeongyo Jeong 366745d9abdbSWeongyo Jeong /* initvals */ 3668b9b64aa5SWeongyo Jeong high = siba_read_4(sc->sc_dev, SIBA_TGSHIGH); 366945d9abdbSWeongyo Jeong switch (mac->mac_phy.type) { 367045d9abdbSWeongyo Jeong case BWN_PHYTYPE_A: 367145d9abdbSWeongyo Jeong if (rev < 5 || rev > 10) 367245d9abdbSWeongyo Jeong goto fail1; 367345d9abdbSWeongyo Jeong if (high & BWN_TGSHIGH_HAVE_2GHZ) 367445d9abdbSWeongyo Jeong filename = "a0g1initvals5"; 367545d9abdbSWeongyo Jeong else 367645d9abdbSWeongyo Jeong filename = "a0g0initvals5"; 367745d9abdbSWeongyo Jeong break; 367845d9abdbSWeongyo Jeong case BWN_PHYTYPE_G: 367945d9abdbSWeongyo Jeong if (rev >= 5 && rev <= 10) 368045d9abdbSWeongyo Jeong filename = "b0g0initvals5"; 368145d9abdbSWeongyo Jeong else if (rev >= 13) 368245d9abdbSWeongyo Jeong filename = "b0g0initvals13"; 368345d9abdbSWeongyo Jeong else 368445d9abdbSWeongyo Jeong goto fail1; 368545d9abdbSWeongyo Jeong break; 368645d9abdbSWeongyo Jeong case BWN_PHYTYPE_LP: 368745d9abdbSWeongyo Jeong if (rev == 13) 368845d9abdbSWeongyo Jeong filename = "lp0initvals13"; 368945d9abdbSWeongyo Jeong else if (rev == 14) 369045d9abdbSWeongyo Jeong filename = "lp0initvals14"; 369145d9abdbSWeongyo Jeong else if (rev >= 15) 369245d9abdbSWeongyo Jeong filename = "lp0initvals15"; 369345d9abdbSWeongyo Jeong else 369445d9abdbSWeongyo Jeong goto fail1; 369545d9abdbSWeongyo Jeong break; 369645d9abdbSWeongyo Jeong case BWN_PHYTYPE_N: 369745d9abdbSWeongyo Jeong if (rev >= 11 && rev <= 12) 369845d9abdbSWeongyo Jeong filename = "n0initvals11"; 369945d9abdbSWeongyo Jeong else 370045d9abdbSWeongyo Jeong goto fail1; 370145d9abdbSWeongyo Jeong break; 370245d9abdbSWeongyo Jeong default: 370345d9abdbSWeongyo Jeong goto fail1; 370445d9abdbSWeongyo Jeong } 370545d9abdbSWeongyo Jeong error = bwn_fw_get(mac, type, filename, &fw->initvals); 370645d9abdbSWeongyo Jeong if (error) { 370745d9abdbSWeongyo Jeong bwn_release_firmware(mac); 370845d9abdbSWeongyo Jeong return (error); 370945d9abdbSWeongyo Jeong } 371045d9abdbSWeongyo Jeong 371145d9abdbSWeongyo Jeong /* bandswitch initvals */ 371245d9abdbSWeongyo Jeong switch (mac->mac_phy.type) { 371345d9abdbSWeongyo Jeong case BWN_PHYTYPE_A: 371445d9abdbSWeongyo Jeong if (rev >= 5 && rev <= 10) { 371545d9abdbSWeongyo Jeong if (high & BWN_TGSHIGH_HAVE_2GHZ) 371645d9abdbSWeongyo Jeong filename = "a0g1bsinitvals5"; 371745d9abdbSWeongyo Jeong else 371845d9abdbSWeongyo Jeong filename = "a0g0bsinitvals5"; 371945d9abdbSWeongyo Jeong } else if (rev >= 11) 372045d9abdbSWeongyo Jeong filename = NULL; 372145d9abdbSWeongyo Jeong else 372245d9abdbSWeongyo Jeong goto fail1; 372345d9abdbSWeongyo Jeong break; 372445d9abdbSWeongyo Jeong case BWN_PHYTYPE_G: 372545d9abdbSWeongyo Jeong if (rev >= 5 && rev <= 10) 372645d9abdbSWeongyo Jeong filename = "b0g0bsinitvals5"; 372745d9abdbSWeongyo Jeong else if (rev >= 11) 372845d9abdbSWeongyo Jeong filename = NULL; 372945d9abdbSWeongyo Jeong else 373045d9abdbSWeongyo Jeong goto fail1; 373145d9abdbSWeongyo Jeong break; 373245d9abdbSWeongyo Jeong case BWN_PHYTYPE_LP: 373345d9abdbSWeongyo Jeong if (rev == 13) 373445d9abdbSWeongyo Jeong filename = "lp0bsinitvals13"; 373545d9abdbSWeongyo Jeong else if (rev == 14) 373645d9abdbSWeongyo Jeong filename = "lp0bsinitvals14"; 373745d9abdbSWeongyo Jeong else if (rev >= 15) 373845d9abdbSWeongyo Jeong filename = "lp0bsinitvals15"; 373945d9abdbSWeongyo Jeong else 374045d9abdbSWeongyo Jeong goto fail1; 374145d9abdbSWeongyo Jeong break; 374245d9abdbSWeongyo Jeong case BWN_PHYTYPE_N: 374345d9abdbSWeongyo Jeong if (rev >= 11 && rev <= 12) 374445d9abdbSWeongyo Jeong filename = "n0bsinitvals11"; 374545d9abdbSWeongyo Jeong else 374645d9abdbSWeongyo Jeong goto fail1; 374745d9abdbSWeongyo Jeong break; 374845d9abdbSWeongyo Jeong default: 374945d9abdbSWeongyo Jeong goto fail1; 375045d9abdbSWeongyo Jeong } 375145d9abdbSWeongyo Jeong error = bwn_fw_get(mac, type, filename, &fw->initvals_band); 375245d9abdbSWeongyo Jeong if (error) { 375345d9abdbSWeongyo Jeong bwn_release_firmware(mac); 375445d9abdbSWeongyo Jeong return (error); 375545d9abdbSWeongyo Jeong } 375645d9abdbSWeongyo Jeong return (0); 375745d9abdbSWeongyo Jeong fail1: 375845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "no INITVALS for rev %d\n", rev); 375945d9abdbSWeongyo Jeong bwn_release_firmware(mac); 376045d9abdbSWeongyo Jeong return (EOPNOTSUPP); 376145d9abdbSWeongyo Jeong } 376245d9abdbSWeongyo Jeong 376345d9abdbSWeongyo Jeong static int 376445d9abdbSWeongyo Jeong bwn_fw_get(struct bwn_mac *mac, enum bwn_fwtype type, 376545d9abdbSWeongyo Jeong const char *name, struct bwn_fwfile *bfw) 376645d9abdbSWeongyo Jeong { 376745d9abdbSWeongyo Jeong const struct bwn_fwhdr *hdr; 376845d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 376945d9abdbSWeongyo Jeong const struct firmware *fw; 377045d9abdbSWeongyo Jeong char namebuf[64]; 377145d9abdbSWeongyo Jeong 377245d9abdbSWeongyo Jeong if (name == NULL) { 377345d9abdbSWeongyo Jeong bwn_do_release_fw(bfw); 377445d9abdbSWeongyo Jeong return (0); 377545d9abdbSWeongyo Jeong } 377645d9abdbSWeongyo Jeong if (bfw->filename != NULL) { 377745d9abdbSWeongyo Jeong if (bfw->type == type && (strcmp(bfw->filename, name) == 0)) 377845d9abdbSWeongyo Jeong return (0); 377945d9abdbSWeongyo Jeong bwn_do_release_fw(bfw); 378045d9abdbSWeongyo Jeong } 378145d9abdbSWeongyo Jeong 37828600d132SWeongyo Jeong snprintf(namebuf, sizeof(namebuf), "bwn%s_v4_%s%s", 37838600d132SWeongyo Jeong (type == BWN_FWTYPE_OPENSOURCE) ? "-open" : "", 37848600d132SWeongyo Jeong (mac->mac_phy.type == BWN_PHYTYPE_LP) ? "lp_" : "", name); 378545d9abdbSWeongyo Jeong /* XXX Sleeping on "fwload" with the non-sleepable locks held */ 378645d9abdbSWeongyo Jeong fw = firmware_get(namebuf); 378745d9abdbSWeongyo Jeong if (fw == NULL) { 378845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "the fw file(%s) not found\n", 378945d9abdbSWeongyo Jeong namebuf); 379045d9abdbSWeongyo Jeong return (ENOENT); 379145d9abdbSWeongyo Jeong } 379245d9abdbSWeongyo Jeong if (fw->datasize < sizeof(struct bwn_fwhdr)) 379345d9abdbSWeongyo Jeong goto fail; 379445d9abdbSWeongyo Jeong hdr = (const struct bwn_fwhdr *)(fw->data); 379545d9abdbSWeongyo Jeong switch (hdr->type) { 379645d9abdbSWeongyo Jeong case BWN_FWTYPE_UCODE: 379745d9abdbSWeongyo Jeong case BWN_FWTYPE_PCM: 379845d9abdbSWeongyo Jeong if (be32toh(hdr->size) != 379945d9abdbSWeongyo Jeong (fw->datasize - sizeof(struct bwn_fwhdr))) 380045d9abdbSWeongyo Jeong goto fail; 380145d9abdbSWeongyo Jeong /* FALLTHROUGH */ 380245d9abdbSWeongyo Jeong case BWN_FWTYPE_IV: 380345d9abdbSWeongyo Jeong if (hdr->ver != 1) 380445d9abdbSWeongyo Jeong goto fail; 380545d9abdbSWeongyo Jeong break; 380645d9abdbSWeongyo Jeong default: 380745d9abdbSWeongyo Jeong goto fail; 380845d9abdbSWeongyo Jeong } 380945d9abdbSWeongyo Jeong bfw->filename = name; 381045d9abdbSWeongyo Jeong bfw->fw = fw; 381145d9abdbSWeongyo Jeong bfw->type = type; 381245d9abdbSWeongyo Jeong return (0); 381345d9abdbSWeongyo Jeong fail: 381445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "the fw file(%s) format error\n", namebuf); 381545d9abdbSWeongyo Jeong if (fw != NULL) 381645d9abdbSWeongyo Jeong firmware_put(fw, FIRMWARE_UNLOAD); 381745d9abdbSWeongyo Jeong return (EPROTO); 381845d9abdbSWeongyo Jeong } 381945d9abdbSWeongyo Jeong 382045d9abdbSWeongyo Jeong static void 382145d9abdbSWeongyo Jeong bwn_release_firmware(struct bwn_mac *mac) 382245d9abdbSWeongyo Jeong { 382345d9abdbSWeongyo Jeong 382445d9abdbSWeongyo Jeong bwn_do_release_fw(&mac->mac_fw.ucode); 382545d9abdbSWeongyo Jeong bwn_do_release_fw(&mac->mac_fw.pcm); 382645d9abdbSWeongyo Jeong bwn_do_release_fw(&mac->mac_fw.initvals); 382745d9abdbSWeongyo Jeong bwn_do_release_fw(&mac->mac_fw.initvals_band); 382845d9abdbSWeongyo Jeong } 382945d9abdbSWeongyo Jeong 383045d9abdbSWeongyo Jeong static void 383145d9abdbSWeongyo Jeong bwn_do_release_fw(struct bwn_fwfile *bfw) 383245d9abdbSWeongyo Jeong { 383345d9abdbSWeongyo Jeong 383445d9abdbSWeongyo Jeong if (bfw->fw != NULL) 383545d9abdbSWeongyo Jeong firmware_put(bfw->fw, FIRMWARE_UNLOAD); 383645d9abdbSWeongyo Jeong bfw->fw = NULL; 383745d9abdbSWeongyo Jeong bfw->filename = NULL; 383845d9abdbSWeongyo Jeong } 383945d9abdbSWeongyo Jeong 384045d9abdbSWeongyo Jeong static int 384145d9abdbSWeongyo Jeong bwn_fw_loaducode(struct bwn_mac *mac) 384245d9abdbSWeongyo Jeong { 384345d9abdbSWeongyo Jeong #define GETFWOFFSET(fwp, offset) \ 384445d9abdbSWeongyo Jeong ((const uint32_t *)((const char *)fwp.fw->data + offset)) 384545d9abdbSWeongyo Jeong #define GETFWSIZE(fwp, offset) \ 384645d9abdbSWeongyo Jeong ((fwp.fw->datasize - offset) / sizeof(uint32_t)) 384745d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 384845d9abdbSWeongyo Jeong const uint32_t *data; 384945d9abdbSWeongyo Jeong unsigned int i; 385045d9abdbSWeongyo Jeong uint32_t ctl; 385145d9abdbSWeongyo Jeong uint16_t date, fwcaps, time; 385245d9abdbSWeongyo Jeong int error = 0; 385345d9abdbSWeongyo Jeong 385445d9abdbSWeongyo Jeong ctl = BWN_READ_4(mac, BWN_MACCTL); 385545d9abdbSWeongyo Jeong ctl |= BWN_MACCTL_MCODE_JMP0; 385645d9abdbSWeongyo Jeong KASSERT(!(ctl & BWN_MACCTL_MCODE_RUN), ("%s:%d: fail", __func__, 385745d9abdbSWeongyo Jeong __LINE__)); 385845d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, ctl); 385945d9abdbSWeongyo Jeong for (i = 0; i < 64; i++) 386045d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SCRATCH, i, 0); 386145d9abdbSWeongyo Jeong for (i = 0; i < 4096; i += 2) 386245d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, i, 0); 386345d9abdbSWeongyo Jeong 386445d9abdbSWeongyo Jeong data = GETFWOFFSET(mac->mac_fw.ucode, sizeof(struct bwn_fwhdr)); 386545d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, BWN_UCODE | BWN_SHARED_AUTOINC, 0x0000); 386645d9abdbSWeongyo Jeong for (i = 0; i < GETFWSIZE(mac->mac_fw.ucode, sizeof(struct bwn_fwhdr)); 386745d9abdbSWeongyo Jeong i++) { 386845d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_SHM_DATA, be32toh(data[i])); 386945d9abdbSWeongyo Jeong DELAY(10); 387045d9abdbSWeongyo Jeong } 387145d9abdbSWeongyo Jeong 387245d9abdbSWeongyo Jeong if (mac->mac_fw.pcm.fw) { 387345d9abdbSWeongyo Jeong data = GETFWOFFSET(mac->mac_fw.pcm, sizeof(struct bwn_fwhdr)); 387445d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, BWN_HW, 0x01ea); 387545d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_SHM_DATA, 0x00004000); 387645d9abdbSWeongyo Jeong bwn_shm_ctlword(mac, BWN_HW, 0x01eb); 387745d9abdbSWeongyo Jeong for (i = 0; i < GETFWSIZE(mac->mac_fw.pcm, 387845d9abdbSWeongyo Jeong sizeof(struct bwn_fwhdr)); i++) { 387945d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_SHM_DATA, be32toh(data[i])); 388045d9abdbSWeongyo Jeong DELAY(10); 388145d9abdbSWeongyo Jeong } 388245d9abdbSWeongyo Jeong } 388345d9abdbSWeongyo Jeong 388445d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_INTR_REASON, BWN_INTR_ALL); 388545d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, 388645d9abdbSWeongyo Jeong (BWN_READ_4(mac, BWN_MACCTL) & ~BWN_MACCTL_MCODE_JMP0) | 388745d9abdbSWeongyo Jeong BWN_MACCTL_MCODE_RUN); 388845d9abdbSWeongyo Jeong 388945d9abdbSWeongyo Jeong for (i = 0; i < 21; i++) { 389045d9abdbSWeongyo Jeong if (BWN_READ_4(mac, BWN_INTR_REASON) == BWN_INTR_MAC_SUSPENDED) 389145d9abdbSWeongyo Jeong break; 389245d9abdbSWeongyo Jeong if (i >= 20) { 389345d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "ucode timeout\n"); 389445d9abdbSWeongyo Jeong error = ENXIO; 389545d9abdbSWeongyo Jeong goto error; 389645d9abdbSWeongyo Jeong } 389745d9abdbSWeongyo Jeong DELAY(50000); 389845d9abdbSWeongyo Jeong } 389945d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_INTR_REASON); 390045d9abdbSWeongyo Jeong 390145d9abdbSWeongyo Jeong mac->mac_fw.rev = bwn_shm_read_2(mac, BWN_SHARED, BWN_SHARED_UCODE_REV); 390245d9abdbSWeongyo Jeong if (mac->mac_fw.rev <= 0x128) { 390345d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "the firmware is too old\n"); 390445d9abdbSWeongyo Jeong error = EOPNOTSUPP; 390545d9abdbSWeongyo Jeong goto error; 390645d9abdbSWeongyo Jeong } 390745d9abdbSWeongyo Jeong mac->mac_fw.patch = bwn_shm_read_2(mac, BWN_SHARED, 390845d9abdbSWeongyo Jeong BWN_SHARED_UCODE_PATCH); 390945d9abdbSWeongyo Jeong date = bwn_shm_read_2(mac, BWN_SHARED, BWN_SHARED_UCODE_DATE); 391045d9abdbSWeongyo Jeong mac->mac_fw.opensource = (date == 0xffff); 391145d9abdbSWeongyo Jeong if (bwn_wme != 0) 391245d9abdbSWeongyo Jeong mac->mac_flags |= BWN_MAC_FLAG_WME; 391345d9abdbSWeongyo Jeong mac->mac_flags |= BWN_MAC_FLAG_HWCRYPTO; 391445d9abdbSWeongyo Jeong 391545d9abdbSWeongyo Jeong time = bwn_shm_read_2(mac, BWN_SHARED, BWN_SHARED_UCODE_TIME); 391645d9abdbSWeongyo Jeong if (mac->mac_fw.opensource == 0) { 391745d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 391845d9abdbSWeongyo Jeong "firmware version (rev %u patch %u date %#x time %#x)\n", 391945d9abdbSWeongyo Jeong mac->mac_fw.rev, mac->mac_fw.patch, date, time); 392045d9abdbSWeongyo Jeong if (mac->mac_fw.no_pcmfile) 392145d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 392245d9abdbSWeongyo Jeong "no HW crypto acceleration due to pcm5\n"); 392345d9abdbSWeongyo Jeong } else { 392445d9abdbSWeongyo Jeong mac->mac_fw.patch = time; 392545d9abdbSWeongyo Jeong fwcaps = bwn_fwcaps_read(mac); 392645d9abdbSWeongyo Jeong if (!(fwcaps & BWN_FWCAPS_HWCRYPTO) || mac->mac_fw.no_pcmfile) { 392745d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 392845d9abdbSWeongyo Jeong "disabling HW crypto acceleration\n"); 392945d9abdbSWeongyo Jeong mac->mac_flags &= ~BWN_MAC_FLAG_HWCRYPTO; 393045d9abdbSWeongyo Jeong } 393145d9abdbSWeongyo Jeong if (!(fwcaps & BWN_FWCAPS_WME)) { 393245d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "disabling WME support\n"); 393345d9abdbSWeongyo Jeong mac->mac_flags &= ~BWN_MAC_FLAG_WME; 393445d9abdbSWeongyo Jeong } 393545d9abdbSWeongyo Jeong } 393645d9abdbSWeongyo Jeong 393745d9abdbSWeongyo Jeong if (BWN_ISOLDFMT(mac)) 393845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "using old firmware image\n"); 393945d9abdbSWeongyo Jeong 394045d9abdbSWeongyo Jeong return (0); 394145d9abdbSWeongyo Jeong 394245d9abdbSWeongyo Jeong error: 394345d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCTL, 394445d9abdbSWeongyo Jeong (BWN_READ_4(mac, BWN_MACCTL) & ~BWN_MACCTL_MCODE_RUN) | 394545d9abdbSWeongyo Jeong BWN_MACCTL_MCODE_JMP0); 394645d9abdbSWeongyo Jeong 394745d9abdbSWeongyo Jeong return (error); 394845d9abdbSWeongyo Jeong #undef GETFWSIZE 394945d9abdbSWeongyo Jeong #undef GETFWOFFSET 395045d9abdbSWeongyo Jeong } 395145d9abdbSWeongyo Jeong 395245d9abdbSWeongyo Jeong /* OpenFirmware only */ 395345d9abdbSWeongyo Jeong static uint16_t 395445d9abdbSWeongyo Jeong bwn_fwcaps_read(struct bwn_mac *mac) 395545d9abdbSWeongyo Jeong { 395645d9abdbSWeongyo Jeong 395745d9abdbSWeongyo Jeong KASSERT(mac->mac_fw.opensource == 1, 395845d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 395945d9abdbSWeongyo Jeong return (bwn_shm_read_2(mac, BWN_SHARED, BWN_SHARED_FWCAPS)); 396045d9abdbSWeongyo Jeong } 396145d9abdbSWeongyo Jeong 396245d9abdbSWeongyo Jeong static int 396345d9abdbSWeongyo Jeong bwn_fwinitvals_write(struct bwn_mac *mac, const struct bwn_fwinitvals *ivals, 396445d9abdbSWeongyo Jeong size_t count, size_t array_size) 396545d9abdbSWeongyo Jeong { 396645d9abdbSWeongyo Jeong #define GET_NEXTIV16(iv) \ 396745d9abdbSWeongyo Jeong ((const struct bwn_fwinitvals *)((const uint8_t *)(iv) + \ 396845d9abdbSWeongyo Jeong sizeof(uint16_t) + sizeof(uint16_t))) 396945d9abdbSWeongyo Jeong #define GET_NEXTIV32(iv) \ 397045d9abdbSWeongyo Jeong ((const struct bwn_fwinitvals *)((const uint8_t *)(iv) + \ 397145d9abdbSWeongyo Jeong sizeof(uint16_t) + sizeof(uint32_t))) 397245d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 397345d9abdbSWeongyo Jeong const struct bwn_fwinitvals *iv; 397445d9abdbSWeongyo Jeong uint16_t offset; 397545d9abdbSWeongyo Jeong size_t i; 397645d9abdbSWeongyo Jeong uint8_t bit32; 397745d9abdbSWeongyo Jeong 397845d9abdbSWeongyo Jeong KASSERT(sizeof(struct bwn_fwinitvals) == 6, 397945d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 398045d9abdbSWeongyo Jeong iv = ivals; 398145d9abdbSWeongyo Jeong for (i = 0; i < count; i++) { 398245d9abdbSWeongyo Jeong if (array_size < sizeof(iv->offset_size)) 398345d9abdbSWeongyo Jeong goto fail; 398445d9abdbSWeongyo Jeong array_size -= sizeof(iv->offset_size); 398545d9abdbSWeongyo Jeong offset = be16toh(iv->offset_size); 398645d9abdbSWeongyo Jeong bit32 = (offset & BWN_FWINITVALS_32BIT) ? 1 : 0; 398745d9abdbSWeongyo Jeong offset &= BWN_FWINITVALS_OFFSET_MASK; 398845d9abdbSWeongyo Jeong if (offset >= 0x1000) 398945d9abdbSWeongyo Jeong goto fail; 399045d9abdbSWeongyo Jeong if (bit32) { 399145d9abdbSWeongyo Jeong if (array_size < sizeof(iv->data.d32)) 399245d9abdbSWeongyo Jeong goto fail; 399345d9abdbSWeongyo Jeong array_size -= sizeof(iv->data.d32); 399445d9abdbSWeongyo Jeong BWN_WRITE_4(mac, offset, be32toh(iv->data.d32)); 399545d9abdbSWeongyo Jeong iv = GET_NEXTIV32(iv); 399645d9abdbSWeongyo Jeong } else { 399745d9abdbSWeongyo Jeong 399845d9abdbSWeongyo Jeong if (array_size < sizeof(iv->data.d16)) 399945d9abdbSWeongyo Jeong goto fail; 400045d9abdbSWeongyo Jeong array_size -= sizeof(iv->data.d16); 400145d9abdbSWeongyo Jeong BWN_WRITE_2(mac, offset, be16toh(iv->data.d16)); 400245d9abdbSWeongyo Jeong 400345d9abdbSWeongyo Jeong iv = GET_NEXTIV16(iv); 400445d9abdbSWeongyo Jeong } 400545d9abdbSWeongyo Jeong } 400645d9abdbSWeongyo Jeong if (array_size != 0) 400745d9abdbSWeongyo Jeong goto fail; 400845d9abdbSWeongyo Jeong return (0); 400945d9abdbSWeongyo Jeong fail: 401045d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "initvals: invalid format\n"); 401145d9abdbSWeongyo Jeong return (EPROTO); 401245d9abdbSWeongyo Jeong #undef GET_NEXTIV16 401345d9abdbSWeongyo Jeong #undef GET_NEXTIV32 401445d9abdbSWeongyo Jeong } 401545d9abdbSWeongyo Jeong 4016*d546e47aSAdrian Chadd int 401745d9abdbSWeongyo Jeong bwn_switch_channel(struct bwn_mac *mac, int chan) 401845d9abdbSWeongyo Jeong { 401945d9abdbSWeongyo Jeong struct bwn_phy *phy = &(mac->mac_phy); 402045d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 40217a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 402245d9abdbSWeongyo Jeong uint16_t channelcookie, savedcookie; 402345d9abdbSWeongyo Jeong int error; 402445d9abdbSWeongyo Jeong 402545d9abdbSWeongyo Jeong if (chan == 0xffff) 402645d9abdbSWeongyo Jeong chan = phy->get_default_chan(mac); 402745d9abdbSWeongyo Jeong 402845d9abdbSWeongyo Jeong channelcookie = chan; 402945d9abdbSWeongyo Jeong if (IEEE80211_IS_CHAN_5GHZ(ic->ic_curchan)) 403045d9abdbSWeongyo Jeong channelcookie |= 0x100; 403145d9abdbSWeongyo Jeong savedcookie = bwn_shm_read_2(mac, BWN_SHARED, BWN_SHARED_CHAN); 403245d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_CHAN, channelcookie); 403345d9abdbSWeongyo Jeong error = phy->switch_channel(mac, chan); 403445d9abdbSWeongyo Jeong if (error) 403545d9abdbSWeongyo Jeong goto fail; 403645d9abdbSWeongyo Jeong 403745d9abdbSWeongyo Jeong mac->mac_phy.chan = chan; 403845d9abdbSWeongyo Jeong DELAY(8000); 403945d9abdbSWeongyo Jeong return (0); 404045d9abdbSWeongyo Jeong fail: 404145d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "failed to switch channel\n"); 404245d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_CHAN, savedcookie); 404345d9abdbSWeongyo Jeong return (error); 404445d9abdbSWeongyo Jeong } 404545d9abdbSWeongyo Jeong 404645d9abdbSWeongyo Jeong static uint16_t 404745d9abdbSWeongyo Jeong bwn_ant2phy(int antenna) 404845d9abdbSWeongyo Jeong { 404945d9abdbSWeongyo Jeong 405045d9abdbSWeongyo Jeong switch (antenna) { 405145d9abdbSWeongyo Jeong case BWN_ANT0: 405245d9abdbSWeongyo Jeong return (BWN_TX_PHY_ANT0); 405345d9abdbSWeongyo Jeong case BWN_ANT1: 405445d9abdbSWeongyo Jeong return (BWN_TX_PHY_ANT1); 405545d9abdbSWeongyo Jeong case BWN_ANT2: 405645d9abdbSWeongyo Jeong return (BWN_TX_PHY_ANT2); 405745d9abdbSWeongyo Jeong case BWN_ANT3: 405845d9abdbSWeongyo Jeong return (BWN_TX_PHY_ANT3); 405945d9abdbSWeongyo Jeong case BWN_ANTAUTO: 406045d9abdbSWeongyo Jeong return (BWN_TX_PHY_ANT01AUTO); 406145d9abdbSWeongyo Jeong } 406245d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 406345d9abdbSWeongyo Jeong return (0); 406445d9abdbSWeongyo Jeong } 406545d9abdbSWeongyo Jeong 406645d9abdbSWeongyo Jeong static void 406745d9abdbSWeongyo Jeong bwn_wme_load(struct bwn_mac *mac) 406845d9abdbSWeongyo Jeong { 406945d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 407045d9abdbSWeongyo Jeong int i; 407145d9abdbSWeongyo Jeong 407245d9abdbSWeongyo Jeong KASSERT(N(bwn_wme_shm_offsets) == N(sc->sc_wmeParams), 407345d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 407445d9abdbSWeongyo Jeong 407545d9abdbSWeongyo Jeong bwn_mac_suspend(mac); 407645d9abdbSWeongyo Jeong for (i = 0; i < N(sc->sc_wmeParams); i++) 407745d9abdbSWeongyo Jeong bwn_wme_loadparams(mac, &(sc->sc_wmeParams[i]), 407845d9abdbSWeongyo Jeong bwn_wme_shm_offsets[i]); 407945d9abdbSWeongyo Jeong bwn_mac_enable(mac); 408045d9abdbSWeongyo Jeong } 408145d9abdbSWeongyo Jeong 408245d9abdbSWeongyo Jeong static void 408345d9abdbSWeongyo Jeong bwn_wme_loadparams(struct bwn_mac *mac, 408445d9abdbSWeongyo Jeong const struct wmeParams *p, uint16_t shm_offset) 408545d9abdbSWeongyo Jeong { 408645d9abdbSWeongyo Jeong #define SM(_v, _f) (((_v) << _f##_S) & _f) 408745d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 408845d9abdbSWeongyo Jeong uint16_t params[BWN_NR_WMEPARAMS]; 408945d9abdbSWeongyo Jeong int slot, tmp; 409045d9abdbSWeongyo Jeong unsigned int i; 409145d9abdbSWeongyo Jeong 409245d9abdbSWeongyo Jeong slot = BWN_READ_2(mac, BWN_RNG) & 409345d9abdbSWeongyo Jeong SM(p->wmep_logcwmin, WME_PARAM_LOGCWMIN); 409445d9abdbSWeongyo Jeong 409545d9abdbSWeongyo Jeong memset(¶ms, 0, sizeof(params)); 409645d9abdbSWeongyo Jeong 409745d9abdbSWeongyo Jeong DPRINTF(sc, BWN_DEBUG_WME, "wmep_txopLimit %d wmep_logcwmin %d " 409845d9abdbSWeongyo Jeong "wmep_logcwmax %d wmep_aifsn %d\n", p->wmep_txopLimit, 409945d9abdbSWeongyo Jeong p->wmep_logcwmin, p->wmep_logcwmax, p->wmep_aifsn); 410045d9abdbSWeongyo Jeong 410145d9abdbSWeongyo Jeong params[BWN_WMEPARAM_TXOP] = p->wmep_txopLimit * 32; 410245d9abdbSWeongyo Jeong params[BWN_WMEPARAM_CWMIN] = SM(p->wmep_logcwmin, WME_PARAM_LOGCWMIN); 410345d9abdbSWeongyo Jeong params[BWN_WMEPARAM_CWMAX] = SM(p->wmep_logcwmax, WME_PARAM_LOGCWMAX); 410445d9abdbSWeongyo Jeong params[BWN_WMEPARAM_CWCUR] = SM(p->wmep_logcwmin, WME_PARAM_LOGCWMIN); 410545d9abdbSWeongyo Jeong params[BWN_WMEPARAM_AIFS] = p->wmep_aifsn; 410645d9abdbSWeongyo Jeong params[BWN_WMEPARAM_BSLOTS] = slot; 410745d9abdbSWeongyo Jeong params[BWN_WMEPARAM_REGGAP] = slot + p->wmep_aifsn; 410845d9abdbSWeongyo Jeong 410945d9abdbSWeongyo Jeong for (i = 0; i < N(params); i++) { 411045d9abdbSWeongyo Jeong if (i == BWN_WMEPARAM_STATUS) { 411145d9abdbSWeongyo Jeong tmp = bwn_shm_read_2(mac, BWN_SHARED, 411245d9abdbSWeongyo Jeong shm_offset + (i * 2)); 411345d9abdbSWeongyo Jeong tmp |= 0x100; 411445d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, shm_offset + (i * 2), 411545d9abdbSWeongyo Jeong tmp); 411645d9abdbSWeongyo Jeong } else { 411745d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, shm_offset + (i * 2), 411845d9abdbSWeongyo Jeong params[i]); 411945d9abdbSWeongyo Jeong } 412045d9abdbSWeongyo Jeong } 412145d9abdbSWeongyo Jeong } 412245d9abdbSWeongyo Jeong 412345d9abdbSWeongyo Jeong static void 412445d9abdbSWeongyo Jeong bwn_mac_write_bssid(struct bwn_mac *mac) 412545d9abdbSWeongyo Jeong { 412645d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 412745d9abdbSWeongyo Jeong uint32_t tmp; 412845d9abdbSWeongyo Jeong int i; 412945d9abdbSWeongyo Jeong uint8_t mac_bssid[IEEE80211_ADDR_LEN * 2]; 413045d9abdbSWeongyo Jeong 413145d9abdbSWeongyo Jeong bwn_mac_setfilter(mac, BWN_MACFILTER_BSSID, sc->sc_bssid); 41327a79cebfSGleb Smirnoff memcpy(mac_bssid, sc->sc_ic.ic_macaddr, IEEE80211_ADDR_LEN); 413345d9abdbSWeongyo Jeong memcpy(mac_bssid + IEEE80211_ADDR_LEN, sc->sc_bssid, 413445d9abdbSWeongyo Jeong IEEE80211_ADDR_LEN); 413545d9abdbSWeongyo Jeong 413645d9abdbSWeongyo Jeong for (i = 0; i < N(mac_bssid); i += sizeof(uint32_t)) { 413745d9abdbSWeongyo Jeong tmp = (uint32_t) (mac_bssid[i + 0]); 413845d9abdbSWeongyo Jeong tmp |= (uint32_t) (mac_bssid[i + 1]) << 8; 413945d9abdbSWeongyo Jeong tmp |= (uint32_t) (mac_bssid[i + 2]) << 16; 414045d9abdbSWeongyo Jeong tmp |= (uint32_t) (mac_bssid[i + 3]) << 24; 414145d9abdbSWeongyo Jeong bwn_ram_write(mac, 0x20 + i, tmp); 414245d9abdbSWeongyo Jeong } 414345d9abdbSWeongyo Jeong } 414445d9abdbSWeongyo Jeong 414545d9abdbSWeongyo Jeong static void 414645d9abdbSWeongyo Jeong bwn_mac_setfilter(struct bwn_mac *mac, uint16_t offset, 414745d9abdbSWeongyo Jeong const uint8_t *macaddr) 414845d9abdbSWeongyo Jeong { 414945d9abdbSWeongyo Jeong static const uint8_t zero[IEEE80211_ADDR_LEN] = { 0 }; 415045d9abdbSWeongyo Jeong uint16_t data; 415145d9abdbSWeongyo Jeong 415245d9abdbSWeongyo Jeong if (!mac) 415345d9abdbSWeongyo Jeong macaddr = zero; 415445d9abdbSWeongyo Jeong 415545d9abdbSWeongyo Jeong offset |= 0x0020; 415645d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_MACFILTER_CONTROL, offset); 415745d9abdbSWeongyo Jeong 415845d9abdbSWeongyo Jeong data = macaddr[0]; 415945d9abdbSWeongyo Jeong data |= macaddr[1] << 8; 416045d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_MACFILTER_DATA, data); 416145d9abdbSWeongyo Jeong data = macaddr[2]; 416245d9abdbSWeongyo Jeong data |= macaddr[3] << 8; 416345d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_MACFILTER_DATA, data); 416445d9abdbSWeongyo Jeong data = macaddr[4]; 416545d9abdbSWeongyo Jeong data |= macaddr[5] << 8; 416645d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_MACFILTER_DATA, data); 416745d9abdbSWeongyo Jeong } 416845d9abdbSWeongyo Jeong 416945d9abdbSWeongyo Jeong static void 417045d9abdbSWeongyo Jeong bwn_key_dowrite(struct bwn_mac *mac, uint8_t index, uint8_t algorithm, 417145d9abdbSWeongyo Jeong const uint8_t *key, size_t key_len, const uint8_t *mac_addr) 417245d9abdbSWeongyo Jeong { 417345d9abdbSWeongyo Jeong uint8_t buf[BWN_SEC_KEYSIZE] = { 0, }; 417445d9abdbSWeongyo Jeong uint8_t per_sta_keys_start = 8; 417545d9abdbSWeongyo Jeong 417645d9abdbSWeongyo Jeong if (BWN_SEC_NEWAPI(mac)) 417745d9abdbSWeongyo Jeong per_sta_keys_start = 4; 417845d9abdbSWeongyo Jeong 417945d9abdbSWeongyo Jeong KASSERT(index < mac->mac_max_nr_keys, 418045d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 418145d9abdbSWeongyo Jeong KASSERT(key_len <= BWN_SEC_KEYSIZE, 418245d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 418345d9abdbSWeongyo Jeong 418445d9abdbSWeongyo Jeong if (index >= per_sta_keys_start) 418545d9abdbSWeongyo Jeong bwn_key_macwrite(mac, index, NULL); 418645d9abdbSWeongyo Jeong if (key) 418745d9abdbSWeongyo Jeong memcpy(buf, key, key_len); 418845d9abdbSWeongyo Jeong bwn_key_write(mac, index, algorithm, buf); 418945d9abdbSWeongyo Jeong if (index >= per_sta_keys_start) 419045d9abdbSWeongyo Jeong bwn_key_macwrite(mac, index, mac_addr); 419145d9abdbSWeongyo Jeong 419245d9abdbSWeongyo Jeong mac->mac_key[index].algorithm = algorithm; 419345d9abdbSWeongyo Jeong } 419445d9abdbSWeongyo Jeong 419545d9abdbSWeongyo Jeong static void 419645d9abdbSWeongyo Jeong bwn_key_macwrite(struct bwn_mac *mac, uint8_t index, const uint8_t *addr) 419745d9abdbSWeongyo Jeong { 4198b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 419945d9abdbSWeongyo Jeong uint32_t addrtmp[2] = { 0, 0 }; 420045d9abdbSWeongyo Jeong uint8_t start = 8; 420145d9abdbSWeongyo Jeong 420245d9abdbSWeongyo Jeong if (BWN_SEC_NEWAPI(mac)) 420345d9abdbSWeongyo Jeong start = 4; 420445d9abdbSWeongyo Jeong 420545d9abdbSWeongyo Jeong KASSERT(index >= start, 420645d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 420745d9abdbSWeongyo Jeong index -= start; 420845d9abdbSWeongyo Jeong 420945d9abdbSWeongyo Jeong if (addr) { 421045d9abdbSWeongyo Jeong addrtmp[0] = addr[0]; 421145d9abdbSWeongyo Jeong addrtmp[0] |= ((uint32_t) (addr[1]) << 8); 421245d9abdbSWeongyo Jeong addrtmp[0] |= ((uint32_t) (addr[2]) << 16); 421345d9abdbSWeongyo Jeong addrtmp[0] |= ((uint32_t) (addr[3]) << 24); 421445d9abdbSWeongyo Jeong addrtmp[1] = addr[4]; 421545d9abdbSWeongyo Jeong addrtmp[1] |= ((uint32_t) (addr[5]) << 8); 421645d9abdbSWeongyo Jeong } 421745d9abdbSWeongyo Jeong 4218b9b64aa5SWeongyo Jeong if (siba_get_revid(sc->sc_dev) >= 5) { 421945d9abdbSWeongyo Jeong bwn_shm_write_4(mac, BWN_RCMTA, (index * 2) + 0, addrtmp[0]); 422045d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_RCMTA, (index * 2) + 1, addrtmp[1]); 422145d9abdbSWeongyo Jeong } else { 422245d9abdbSWeongyo Jeong if (index >= 8) { 422345d9abdbSWeongyo Jeong bwn_shm_write_4(mac, BWN_SHARED, 422445d9abdbSWeongyo Jeong BWN_SHARED_PSM + (index * 6) + 0, addrtmp[0]); 422545d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, 422645d9abdbSWeongyo Jeong BWN_SHARED_PSM + (index * 6) + 4, addrtmp[1]); 422745d9abdbSWeongyo Jeong } 422845d9abdbSWeongyo Jeong } 422945d9abdbSWeongyo Jeong } 423045d9abdbSWeongyo Jeong 423145d9abdbSWeongyo Jeong static void 423245d9abdbSWeongyo Jeong bwn_key_write(struct bwn_mac *mac, uint8_t index, uint8_t algorithm, 423345d9abdbSWeongyo Jeong const uint8_t *key) 423445d9abdbSWeongyo Jeong { 423545d9abdbSWeongyo Jeong unsigned int i; 423645d9abdbSWeongyo Jeong uint32_t offset; 423745d9abdbSWeongyo Jeong uint16_t kidx, value; 423845d9abdbSWeongyo Jeong 423945d9abdbSWeongyo Jeong kidx = BWN_SEC_KEY2FW(mac, index); 424045d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, 424145d9abdbSWeongyo Jeong BWN_SHARED_KEYIDX_BLOCK + (kidx * 2), (kidx << 4) | algorithm); 424245d9abdbSWeongyo Jeong 424345d9abdbSWeongyo Jeong offset = mac->mac_ktp + (index * BWN_SEC_KEYSIZE); 424445d9abdbSWeongyo Jeong for (i = 0; i < BWN_SEC_KEYSIZE; i += 2) { 424545d9abdbSWeongyo Jeong value = key[i]; 424645d9abdbSWeongyo Jeong value |= (uint16_t)(key[i + 1]) << 8; 424745d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, offset + i, value); 424845d9abdbSWeongyo Jeong } 424945d9abdbSWeongyo Jeong } 425045d9abdbSWeongyo Jeong 425145d9abdbSWeongyo Jeong static void 425245d9abdbSWeongyo Jeong bwn_phy_exit(struct bwn_mac *mac) 425345d9abdbSWeongyo Jeong { 425445d9abdbSWeongyo Jeong 425545d9abdbSWeongyo Jeong mac->mac_phy.rf_onoff(mac, 0); 425645d9abdbSWeongyo Jeong if (mac->mac_phy.exit != NULL) 425745d9abdbSWeongyo Jeong mac->mac_phy.exit(mac); 425845d9abdbSWeongyo Jeong } 425945d9abdbSWeongyo Jeong 426045d9abdbSWeongyo Jeong static void 426145d9abdbSWeongyo Jeong bwn_dma_free(struct bwn_mac *mac) 426245d9abdbSWeongyo Jeong { 426345d9abdbSWeongyo Jeong struct bwn_dma *dma; 426445d9abdbSWeongyo Jeong 426545d9abdbSWeongyo Jeong if ((mac->mac_flags & BWN_MAC_FLAG_DMA) == 0) 426645d9abdbSWeongyo Jeong return; 426745d9abdbSWeongyo Jeong dma = &mac->mac_method.dma; 426845d9abdbSWeongyo Jeong 426945d9abdbSWeongyo Jeong bwn_dma_ringfree(&dma->rx); 427045d9abdbSWeongyo Jeong bwn_dma_ringfree(&dma->wme[WME_AC_BK]); 427145d9abdbSWeongyo Jeong bwn_dma_ringfree(&dma->wme[WME_AC_BE]); 427245d9abdbSWeongyo Jeong bwn_dma_ringfree(&dma->wme[WME_AC_VI]); 427345d9abdbSWeongyo Jeong bwn_dma_ringfree(&dma->wme[WME_AC_VO]); 427445d9abdbSWeongyo Jeong bwn_dma_ringfree(&dma->mcast); 427545d9abdbSWeongyo Jeong } 427645d9abdbSWeongyo Jeong 427745d9abdbSWeongyo Jeong static void 427845d9abdbSWeongyo Jeong bwn_core_stop(struct bwn_mac *mac) 427945d9abdbSWeongyo Jeong { 428045d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 428145d9abdbSWeongyo Jeong 428245d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 428345d9abdbSWeongyo Jeong 428445d9abdbSWeongyo Jeong if (mac->mac_status < BWN_MAC_STATUS_STARTED) 428545d9abdbSWeongyo Jeong return; 428645d9abdbSWeongyo Jeong 428745d9abdbSWeongyo Jeong callout_stop(&sc->sc_rfswitch_ch); 428845d9abdbSWeongyo Jeong callout_stop(&sc->sc_task_ch); 428945d9abdbSWeongyo Jeong callout_stop(&sc->sc_watchdog_ch); 429045d9abdbSWeongyo Jeong sc->sc_watchdog_timer = 0; 429145d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_INTR_MASK, 0); 429245d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_INTR_MASK); 429345d9abdbSWeongyo Jeong bwn_mac_suspend(mac); 429445d9abdbSWeongyo Jeong 429545d9abdbSWeongyo Jeong mac->mac_status = BWN_MAC_STATUS_INITED; 429645d9abdbSWeongyo Jeong } 429745d9abdbSWeongyo Jeong 429845d9abdbSWeongyo Jeong static int 429945d9abdbSWeongyo Jeong bwn_switch_band(struct bwn_softc *sc, struct ieee80211_channel *chan) 430045d9abdbSWeongyo Jeong { 430145d9abdbSWeongyo Jeong struct bwn_mac *up_dev = NULL; 430245d9abdbSWeongyo Jeong struct bwn_mac *down_dev; 430345d9abdbSWeongyo Jeong struct bwn_mac *mac; 430445d9abdbSWeongyo Jeong int err, status; 430545d9abdbSWeongyo Jeong uint8_t gmode; 430645d9abdbSWeongyo Jeong 430745d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 430845d9abdbSWeongyo Jeong 430945d9abdbSWeongyo Jeong TAILQ_FOREACH(mac, &sc->sc_maclist, mac_list) { 431045d9abdbSWeongyo Jeong if (IEEE80211_IS_CHAN_2GHZ(chan) && 431145d9abdbSWeongyo Jeong mac->mac_phy.supports_2ghz) { 431245d9abdbSWeongyo Jeong up_dev = mac; 431345d9abdbSWeongyo Jeong gmode = 1; 431445d9abdbSWeongyo Jeong } else if (IEEE80211_IS_CHAN_5GHZ(chan) && 431545d9abdbSWeongyo Jeong mac->mac_phy.supports_5ghz) { 431645d9abdbSWeongyo Jeong up_dev = mac; 431745d9abdbSWeongyo Jeong gmode = 0; 431845d9abdbSWeongyo Jeong } else { 431945d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 432045d9abdbSWeongyo Jeong return (EINVAL); 432145d9abdbSWeongyo Jeong } 432245d9abdbSWeongyo Jeong if (up_dev != NULL) 432345d9abdbSWeongyo Jeong break; 432445d9abdbSWeongyo Jeong } 432545d9abdbSWeongyo Jeong if (up_dev == NULL) { 432645d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "Could not find a device\n"); 432745d9abdbSWeongyo Jeong return (ENODEV); 432845d9abdbSWeongyo Jeong } 432945d9abdbSWeongyo Jeong if (up_dev == sc->sc_curmac && sc->sc_curmac->mac_phy.gmode == gmode) 433045d9abdbSWeongyo Jeong return (0); 433145d9abdbSWeongyo Jeong 433245d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "switching to %s-GHz band\n", 433345d9abdbSWeongyo Jeong IEEE80211_IS_CHAN_2GHZ(chan) ? "2" : "5"); 433445d9abdbSWeongyo Jeong 43357df9d5acSKevin Lo down_dev = sc->sc_curmac; 433645d9abdbSWeongyo Jeong status = down_dev->mac_status; 433745d9abdbSWeongyo Jeong if (status >= BWN_MAC_STATUS_STARTED) 433845d9abdbSWeongyo Jeong bwn_core_stop(down_dev); 433945d9abdbSWeongyo Jeong if (status >= BWN_MAC_STATUS_INITED) 434045d9abdbSWeongyo Jeong bwn_core_exit(down_dev); 434145d9abdbSWeongyo Jeong 434245d9abdbSWeongyo Jeong if (down_dev != up_dev) 434345d9abdbSWeongyo Jeong bwn_phy_reset(down_dev); 434445d9abdbSWeongyo Jeong 434545d9abdbSWeongyo Jeong up_dev->mac_phy.gmode = gmode; 434645d9abdbSWeongyo Jeong if (status >= BWN_MAC_STATUS_INITED) { 434745d9abdbSWeongyo Jeong err = bwn_core_init(up_dev); 434845d9abdbSWeongyo Jeong if (err) { 434945d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 435045d9abdbSWeongyo Jeong "fatal: failed to initialize for %s-GHz\n", 435145d9abdbSWeongyo Jeong IEEE80211_IS_CHAN_2GHZ(chan) ? "2" : "5"); 435245d9abdbSWeongyo Jeong goto fail; 435345d9abdbSWeongyo Jeong } 435445d9abdbSWeongyo Jeong } 435545d9abdbSWeongyo Jeong if (status >= BWN_MAC_STATUS_STARTED) 435645d9abdbSWeongyo Jeong bwn_core_start(up_dev); 435745d9abdbSWeongyo Jeong KASSERT(up_dev->mac_status == status, ("%s: fail", __func__)); 435845d9abdbSWeongyo Jeong sc->sc_curmac = up_dev; 435945d9abdbSWeongyo Jeong 436045d9abdbSWeongyo Jeong return (0); 436145d9abdbSWeongyo Jeong fail: 436245d9abdbSWeongyo Jeong sc->sc_curmac = NULL; 436345d9abdbSWeongyo Jeong return (err); 436445d9abdbSWeongyo Jeong } 436545d9abdbSWeongyo Jeong 436645d9abdbSWeongyo Jeong static void 436745d9abdbSWeongyo Jeong bwn_rf_turnon(struct bwn_mac *mac) 436845d9abdbSWeongyo Jeong { 436945d9abdbSWeongyo Jeong 437045d9abdbSWeongyo Jeong bwn_mac_suspend(mac); 437145d9abdbSWeongyo Jeong mac->mac_phy.rf_onoff(mac, 1); 437245d9abdbSWeongyo Jeong mac->mac_phy.rf_on = 1; 437345d9abdbSWeongyo Jeong bwn_mac_enable(mac); 437445d9abdbSWeongyo Jeong } 437545d9abdbSWeongyo Jeong 437645d9abdbSWeongyo Jeong static void 437745d9abdbSWeongyo Jeong bwn_rf_turnoff(struct bwn_mac *mac) 437845d9abdbSWeongyo Jeong { 437945d9abdbSWeongyo Jeong 438045d9abdbSWeongyo Jeong bwn_mac_suspend(mac); 438145d9abdbSWeongyo Jeong mac->mac_phy.rf_onoff(mac, 0); 438245d9abdbSWeongyo Jeong mac->mac_phy.rf_on = 0; 438345d9abdbSWeongyo Jeong bwn_mac_enable(mac); 438445d9abdbSWeongyo Jeong } 438545d9abdbSWeongyo Jeong 438645d9abdbSWeongyo Jeong static void 438745d9abdbSWeongyo Jeong bwn_phy_reset(struct bwn_mac *mac) 438845d9abdbSWeongyo Jeong { 4389b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 439045d9abdbSWeongyo Jeong 4391b9b64aa5SWeongyo Jeong siba_write_4(sc->sc_dev, SIBA_TGSLOW, 4392b9b64aa5SWeongyo Jeong ((siba_read_4(sc->sc_dev, SIBA_TGSLOW) & ~BWN_TGSLOW_SUPPORT_G) | 439345d9abdbSWeongyo Jeong BWN_TGSLOW_PHYRESET) | SIBA_TGSLOW_FGC); 439445d9abdbSWeongyo Jeong DELAY(1000); 4395b9b64aa5SWeongyo Jeong siba_write_4(sc->sc_dev, SIBA_TGSLOW, 4396b9b64aa5SWeongyo Jeong (siba_read_4(sc->sc_dev, SIBA_TGSLOW) & ~SIBA_TGSLOW_FGC) | 439745d9abdbSWeongyo Jeong BWN_TGSLOW_PHYRESET); 439845d9abdbSWeongyo Jeong DELAY(1000); 439945d9abdbSWeongyo Jeong } 440045d9abdbSWeongyo Jeong 440145d9abdbSWeongyo Jeong static int 440245d9abdbSWeongyo Jeong bwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 440345d9abdbSWeongyo Jeong { 440445d9abdbSWeongyo Jeong struct bwn_vap *bvp = BWN_VAP(vap); 440545d9abdbSWeongyo Jeong struct ieee80211com *ic= vap->iv_ic; 440645d9abdbSWeongyo Jeong enum ieee80211_state ostate = vap->iv_state; 44072cb71df1SAdrian Chadd struct bwn_softc *sc = ic->ic_softc; 440845d9abdbSWeongyo Jeong struct bwn_mac *mac = sc->sc_curmac; 440945d9abdbSWeongyo Jeong int error; 441045d9abdbSWeongyo Jeong 441145d9abdbSWeongyo Jeong DPRINTF(sc, BWN_DEBUG_STATE, "%s: %s -> %s\n", __func__, 441245d9abdbSWeongyo Jeong ieee80211_state_name[vap->iv_state], 441345d9abdbSWeongyo Jeong ieee80211_state_name[nstate]); 441445d9abdbSWeongyo Jeong 441545d9abdbSWeongyo Jeong error = bvp->bv_newstate(vap, nstate, arg); 441645d9abdbSWeongyo Jeong if (error != 0) 441745d9abdbSWeongyo Jeong return (error); 441845d9abdbSWeongyo Jeong 441945d9abdbSWeongyo Jeong BWN_LOCK(sc); 442045d9abdbSWeongyo Jeong 442145d9abdbSWeongyo Jeong bwn_led_newstate(mac, nstate); 442245d9abdbSWeongyo Jeong 442345d9abdbSWeongyo Jeong /* 442445d9abdbSWeongyo Jeong * Clear the BSSID when we stop a STA 442545d9abdbSWeongyo Jeong */ 442645d9abdbSWeongyo Jeong if (vap->iv_opmode == IEEE80211_M_STA) { 442745d9abdbSWeongyo Jeong if (ostate == IEEE80211_S_RUN && nstate != IEEE80211_S_RUN) { 442845d9abdbSWeongyo Jeong /* 442945d9abdbSWeongyo Jeong * Clear out the BSSID. If we reassociate to 443045d9abdbSWeongyo Jeong * the same AP, this will reinialize things 443145d9abdbSWeongyo Jeong * correctly... 443245d9abdbSWeongyo Jeong */ 443345d9abdbSWeongyo Jeong if (ic->ic_opmode == IEEE80211_M_STA && 443445d9abdbSWeongyo Jeong (sc->sc_flags & BWN_FLAG_INVALID) == 0) { 443545d9abdbSWeongyo Jeong memset(sc->sc_bssid, 0, IEEE80211_ADDR_LEN); 443645d9abdbSWeongyo Jeong bwn_set_macaddr(mac); 443745d9abdbSWeongyo Jeong } 443845d9abdbSWeongyo Jeong } 443945d9abdbSWeongyo Jeong } 444045d9abdbSWeongyo Jeong 44417478ae97SWeongyo Jeong if (vap->iv_opmode == IEEE80211_M_MONITOR || 44427478ae97SWeongyo Jeong vap->iv_opmode == IEEE80211_M_AHDEMO) { 444345d9abdbSWeongyo Jeong /* XXX nothing to do? */ 444445d9abdbSWeongyo Jeong } else if (nstate == IEEE80211_S_RUN) { 444545d9abdbSWeongyo Jeong memcpy(sc->sc_bssid, vap->iv_bss->ni_bssid, IEEE80211_ADDR_LEN); 444645d9abdbSWeongyo Jeong bwn_set_opmode(mac); 444745d9abdbSWeongyo Jeong bwn_set_pretbtt(mac); 444845d9abdbSWeongyo Jeong bwn_spu_setdelay(mac, 0); 444945d9abdbSWeongyo Jeong bwn_set_macaddr(mac); 445045d9abdbSWeongyo Jeong } 445145d9abdbSWeongyo Jeong 445245d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 445345d9abdbSWeongyo Jeong 445445d9abdbSWeongyo Jeong return (error); 445545d9abdbSWeongyo Jeong } 445645d9abdbSWeongyo Jeong 445745d9abdbSWeongyo Jeong static void 445845d9abdbSWeongyo Jeong bwn_set_pretbtt(struct bwn_mac *mac) 445945d9abdbSWeongyo Jeong { 446045d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 44617a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 446245d9abdbSWeongyo Jeong uint16_t pretbtt; 446345d9abdbSWeongyo Jeong 446445d9abdbSWeongyo Jeong if (ic->ic_opmode == IEEE80211_M_IBSS) 446545d9abdbSWeongyo Jeong pretbtt = 2; 446645d9abdbSWeongyo Jeong else 446745d9abdbSWeongyo Jeong pretbtt = (mac->mac_phy.type == BWN_PHYTYPE_A) ? 120 : 250; 446845d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, BWN_SHARED_PRETBTT, pretbtt); 446945d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_TSF_CFP_PRETBTT, pretbtt); 447045d9abdbSWeongyo Jeong } 447145d9abdbSWeongyo Jeong 447245d9abdbSWeongyo Jeong static int 447345d9abdbSWeongyo Jeong bwn_intr(void *arg) 447445d9abdbSWeongyo Jeong { 447545d9abdbSWeongyo Jeong struct bwn_mac *mac = arg; 447645d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 447745d9abdbSWeongyo Jeong uint32_t reason; 447845d9abdbSWeongyo Jeong 4479b9b64aa5SWeongyo Jeong if (mac->mac_status < BWN_MAC_STATUS_STARTED || 4480b9b64aa5SWeongyo Jeong (sc->sc_flags & BWN_FLAG_INVALID)) 448145d9abdbSWeongyo Jeong return (FILTER_STRAY); 448245d9abdbSWeongyo Jeong 448345d9abdbSWeongyo Jeong reason = BWN_READ_4(mac, BWN_INTR_REASON); 448445d9abdbSWeongyo Jeong if (reason == 0xffffffff) /* shared IRQ */ 448545d9abdbSWeongyo Jeong return (FILTER_STRAY); 448645d9abdbSWeongyo Jeong reason &= mac->mac_intr_mask; 448745d9abdbSWeongyo Jeong if (reason == 0) 448845d9abdbSWeongyo Jeong return (FILTER_HANDLED); 448945d9abdbSWeongyo Jeong 449045d9abdbSWeongyo Jeong mac->mac_reason[0] = BWN_READ_4(mac, BWN_DMA0_REASON) & 0x0001dc00; 449145d9abdbSWeongyo Jeong mac->mac_reason[1] = BWN_READ_4(mac, BWN_DMA1_REASON) & 0x0000dc00; 449245d9abdbSWeongyo Jeong mac->mac_reason[2] = BWN_READ_4(mac, BWN_DMA2_REASON) & 0x0000dc00; 449345d9abdbSWeongyo Jeong mac->mac_reason[3] = BWN_READ_4(mac, BWN_DMA3_REASON) & 0x0001dc00; 449445d9abdbSWeongyo Jeong mac->mac_reason[4] = BWN_READ_4(mac, BWN_DMA4_REASON) & 0x0000dc00; 449545d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_INTR_REASON, reason); 449645d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_DMA0_REASON, mac->mac_reason[0]); 449745d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_DMA1_REASON, mac->mac_reason[1]); 449845d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_DMA2_REASON, mac->mac_reason[2]); 449945d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_DMA3_REASON, mac->mac_reason[3]); 450045d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_DMA4_REASON, mac->mac_reason[4]); 450145d9abdbSWeongyo Jeong 450245d9abdbSWeongyo Jeong /* Disable interrupts. */ 450345d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_INTR_MASK, 0); 450445d9abdbSWeongyo Jeong 450545d9abdbSWeongyo Jeong mac->mac_reason_intr = reason; 450645d9abdbSWeongyo Jeong 450745d9abdbSWeongyo Jeong BWN_BARRIER(mac, BUS_SPACE_BARRIER_READ); 450845d9abdbSWeongyo Jeong BWN_BARRIER(mac, BUS_SPACE_BARRIER_WRITE); 450945d9abdbSWeongyo Jeong 4510cbc4d2dbSJohn Baldwin taskqueue_enqueue(sc->sc_tq, &mac->mac_intrtask); 451145d9abdbSWeongyo Jeong return (FILTER_HANDLED); 451245d9abdbSWeongyo Jeong } 451345d9abdbSWeongyo Jeong 451445d9abdbSWeongyo Jeong static void 451545d9abdbSWeongyo Jeong bwn_intrtask(void *arg, int npending) 451645d9abdbSWeongyo Jeong { 451745d9abdbSWeongyo Jeong struct bwn_mac *mac = arg; 451845d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 451945d9abdbSWeongyo Jeong uint32_t merged = 0; 452045d9abdbSWeongyo Jeong int i, tx = 0, rx = 0; 452145d9abdbSWeongyo Jeong 452245d9abdbSWeongyo Jeong BWN_LOCK(sc); 4523b9b64aa5SWeongyo Jeong if (mac->mac_status < BWN_MAC_STATUS_STARTED || 4524b9b64aa5SWeongyo Jeong (sc->sc_flags & BWN_FLAG_INVALID)) { 452545d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 452645d9abdbSWeongyo Jeong return; 452745d9abdbSWeongyo Jeong } 452845d9abdbSWeongyo Jeong 452945d9abdbSWeongyo Jeong for (i = 0; i < N(mac->mac_reason); i++) 453045d9abdbSWeongyo Jeong merged |= mac->mac_reason[i]; 453145d9abdbSWeongyo Jeong 453245d9abdbSWeongyo Jeong if (mac->mac_reason_intr & BWN_INTR_MAC_TXERR) 453345d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "MAC trans error\n"); 453445d9abdbSWeongyo Jeong 453545d9abdbSWeongyo Jeong if (mac->mac_reason_intr & BWN_INTR_PHY_TXERR) { 453645d9abdbSWeongyo Jeong DPRINTF(sc, BWN_DEBUG_INTR, "%s: PHY trans error\n", __func__); 453745d9abdbSWeongyo Jeong mac->mac_phy.txerrors--; 453845d9abdbSWeongyo Jeong if (mac->mac_phy.txerrors == 0) { 453945d9abdbSWeongyo Jeong mac->mac_phy.txerrors = BWN_TXERROR_MAX; 454045d9abdbSWeongyo Jeong bwn_restart(mac, "PHY TX errors"); 454145d9abdbSWeongyo Jeong } 454245d9abdbSWeongyo Jeong } 454345d9abdbSWeongyo Jeong 454445d9abdbSWeongyo Jeong if (merged & (BWN_DMAINTR_FATALMASK | BWN_DMAINTR_NONFATALMASK)) { 454545d9abdbSWeongyo Jeong if (merged & BWN_DMAINTR_FATALMASK) { 454645d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 454745d9abdbSWeongyo Jeong "Fatal DMA error: %#x %#x %#x %#x %#x %#x\n", 454845d9abdbSWeongyo Jeong mac->mac_reason[0], mac->mac_reason[1], 454945d9abdbSWeongyo Jeong mac->mac_reason[2], mac->mac_reason[3], 455045d9abdbSWeongyo Jeong mac->mac_reason[4], mac->mac_reason[5]); 455145d9abdbSWeongyo Jeong bwn_restart(mac, "DMA error"); 455245d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 455345d9abdbSWeongyo Jeong return; 455445d9abdbSWeongyo Jeong } 455545d9abdbSWeongyo Jeong if (merged & BWN_DMAINTR_NONFATALMASK) { 455645d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 455745d9abdbSWeongyo Jeong "DMA error: %#x %#x %#x %#x %#x %#x\n", 455845d9abdbSWeongyo Jeong mac->mac_reason[0], mac->mac_reason[1], 455945d9abdbSWeongyo Jeong mac->mac_reason[2], mac->mac_reason[3], 456045d9abdbSWeongyo Jeong mac->mac_reason[4], mac->mac_reason[5]); 456145d9abdbSWeongyo Jeong } 456245d9abdbSWeongyo Jeong } 456345d9abdbSWeongyo Jeong 456445d9abdbSWeongyo Jeong if (mac->mac_reason_intr & BWN_INTR_UCODE_DEBUG) 456545d9abdbSWeongyo Jeong bwn_intr_ucode_debug(mac); 456645d9abdbSWeongyo Jeong if (mac->mac_reason_intr & BWN_INTR_TBTT_INDI) 456745d9abdbSWeongyo Jeong bwn_intr_tbtt_indication(mac); 456845d9abdbSWeongyo Jeong if (mac->mac_reason_intr & BWN_INTR_ATIM_END) 456945d9abdbSWeongyo Jeong bwn_intr_atim_end(mac); 457045d9abdbSWeongyo Jeong if (mac->mac_reason_intr & BWN_INTR_BEACON) 457145d9abdbSWeongyo Jeong bwn_intr_beacon(mac); 457245d9abdbSWeongyo Jeong if (mac->mac_reason_intr & BWN_INTR_PMQ) 457345d9abdbSWeongyo Jeong bwn_intr_pmq(mac); 457445d9abdbSWeongyo Jeong if (mac->mac_reason_intr & BWN_INTR_NOISESAMPLE_OK) 457545d9abdbSWeongyo Jeong bwn_intr_noise(mac); 457645d9abdbSWeongyo Jeong 457745d9abdbSWeongyo Jeong if (mac->mac_flags & BWN_MAC_FLAG_DMA) { 457845d9abdbSWeongyo Jeong if (mac->mac_reason[0] & BWN_DMAINTR_RX_DONE) { 457945d9abdbSWeongyo Jeong bwn_dma_rx(mac->mac_method.dma.rx); 458045d9abdbSWeongyo Jeong rx = 1; 458145d9abdbSWeongyo Jeong } 458245d9abdbSWeongyo Jeong } else 458345d9abdbSWeongyo Jeong rx = bwn_pio_rx(&mac->mac_method.pio.rx); 458445d9abdbSWeongyo Jeong 458545d9abdbSWeongyo Jeong KASSERT(!(mac->mac_reason[1] & BWN_DMAINTR_RX_DONE), ("%s", __func__)); 458645d9abdbSWeongyo Jeong KASSERT(!(mac->mac_reason[2] & BWN_DMAINTR_RX_DONE), ("%s", __func__)); 458745d9abdbSWeongyo Jeong KASSERT(!(mac->mac_reason[3] & BWN_DMAINTR_RX_DONE), ("%s", __func__)); 458845d9abdbSWeongyo Jeong KASSERT(!(mac->mac_reason[4] & BWN_DMAINTR_RX_DONE), ("%s", __func__)); 458945d9abdbSWeongyo Jeong KASSERT(!(mac->mac_reason[5] & BWN_DMAINTR_RX_DONE), ("%s", __func__)); 459045d9abdbSWeongyo Jeong 459145d9abdbSWeongyo Jeong if (mac->mac_reason_intr & BWN_INTR_TX_OK) { 459245d9abdbSWeongyo Jeong bwn_intr_txeof(mac); 459345d9abdbSWeongyo Jeong tx = 1; 459445d9abdbSWeongyo Jeong } 459545d9abdbSWeongyo Jeong 459645d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_INTR_MASK, mac->mac_intr_mask); 459745d9abdbSWeongyo Jeong 459845d9abdbSWeongyo Jeong if (sc->sc_blink_led != NULL && sc->sc_led_blink) { 459945d9abdbSWeongyo Jeong int evt = BWN_LED_EVENT_NONE; 460045d9abdbSWeongyo Jeong 460145d9abdbSWeongyo Jeong if (tx && rx) { 460245d9abdbSWeongyo Jeong if (sc->sc_rx_rate > sc->sc_tx_rate) 460345d9abdbSWeongyo Jeong evt = BWN_LED_EVENT_RX; 460445d9abdbSWeongyo Jeong else 460545d9abdbSWeongyo Jeong evt = BWN_LED_EVENT_TX; 460645d9abdbSWeongyo Jeong } else if (tx) { 460745d9abdbSWeongyo Jeong evt = BWN_LED_EVENT_TX; 460845d9abdbSWeongyo Jeong } else if (rx) { 460945d9abdbSWeongyo Jeong evt = BWN_LED_EVENT_RX; 461045d9abdbSWeongyo Jeong } else if (rx == 0) { 461145d9abdbSWeongyo Jeong evt = BWN_LED_EVENT_POLL; 461245d9abdbSWeongyo Jeong } 461345d9abdbSWeongyo Jeong 461445d9abdbSWeongyo Jeong if (evt != BWN_LED_EVENT_NONE) 461545d9abdbSWeongyo Jeong bwn_led_event(mac, evt); 461645d9abdbSWeongyo Jeong } 461745d9abdbSWeongyo Jeong 46187a79cebfSGleb Smirnoff if (mbufq_first(&sc->sc_snd) != NULL) 46197a79cebfSGleb Smirnoff bwn_start(sc); 462045d9abdbSWeongyo Jeong 462145d9abdbSWeongyo Jeong BWN_BARRIER(mac, BUS_SPACE_BARRIER_READ); 462245d9abdbSWeongyo Jeong BWN_BARRIER(mac, BUS_SPACE_BARRIER_WRITE); 462345d9abdbSWeongyo Jeong 462445d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 462545d9abdbSWeongyo Jeong } 462645d9abdbSWeongyo Jeong 462745d9abdbSWeongyo Jeong static void 462845d9abdbSWeongyo Jeong bwn_restart(struct bwn_mac *mac, const char *msg) 462945d9abdbSWeongyo Jeong { 463045d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 46317a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 463245d9abdbSWeongyo Jeong 463345d9abdbSWeongyo Jeong if (mac->mac_status < BWN_MAC_STATUS_INITED) 463445d9abdbSWeongyo Jeong return; 463545d9abdbSWeongyo Jeong 463645d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "HW reset: %s\n", msg); 463745d9abdbSWeongyo Jeong ieee80211_runtask(ic, &mac->mac_hwreset); 463845d9abdbSWeongyo Jeong } 463945d9abdbSWeongyo Jeong 464045d9abdbSWeongyo Jeong static void 464145d9abdbSWeongyo Jeong bwn_intr_ucode_debug(struct bwn_mac *mac) 464245d9abdbSWeongyo Jeong { 464345d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 464445d9abdbSWeongyo Jeong uint16_t reason; 464545d9abdbSWeongyo Jeong 464645d9abdbSWeongyo Jeong if (mac->mac_fw.opensource == 0) 464745d9abdbSWeongyo Jeong return; 464845d9abdbSWeongyo Jeong 464945d9abdbSWeongyo Jeong reason = bwn_shm_read_2(mac, BWN_SCRATCH, BWN_DEBUGINTR_REASON_REG); 465045d9abdbSWeongyo Jeong switch (reason) { 465145d9abdbSWeongyo Jeong case BWN_DEBUGINTR_PANIC: 465245d9abdbSWeongyo Jeong bwn_handle_fwpanic(mac); 465345d9abdbSWeongyo Jeong break; 465445d9abdbSWeongyo Jeong case BWN_DEBUGINTR_DUMP_SHM: 465545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "BWN_DEBUGINTR_DUMP_SHM\n"); 465645d9abdbSWeongyo Jeong break; 465745d9abdbSWeongyo Jeong case BWN_DEBUGINTR_DUMP_REGS: 465845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "BWN_DEBUGINTR_DUMP_REGS\n"); 465945d9abdbSWeongyo Jeong break; 466045d9abdbSWeongyo Jeong case BWN_DEBUGINTR_MARKER: 466145d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "BWN_DEBUGINTR_MARKER\n"); 466245d9abdbSWeongyo Jeong break; 466345d9abdbSWeongyo Jeong default: 466445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 466545d9abdbSWeongyo Jeong "ucode debug unknown reason: %#x\n", reason); 466645d9abdbSWeongyo Jeong } 466745d9abdbSWeongyo Jeong 466845d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SCRATCH, BWN_DEBUGINTR_REASON_REG, 466945d9abdbSWeongyo Jeong BWN_DEBUGINTR_ACK); 467045d9abdbSWeongyo Jeong } 467145d9abdbSWeongyo Jeong 467245d9abdbSWeongyo Jeong static void 467345d9abdbSWeongyo Jeong bwn_intr_tbtt_indication(struct bwn_mac *mac) 467445d9abdbSWeongyo Jeong { 467545d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 46767a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 467745d9abdbSWeongyo Jeong 467845d9abdbSWeongyo Jeong if (ic->ic_opmode != IEEE80211_M_HOSTAP) 467945d9abdbSWeongyo Jeong bwn_psctl(mac, 0); 468045d9abdbSWeongyo Jeong if (ic->ic_opmode == IEEE80211_M_IBSS) 468145d9abdbSWeongyo Jeong mac->mac_flags |= BWN_MAC_FLAG_DFQVALID; 468245d9abdbSWeongyo Jeong } 468345d9abdbSWeongyo Jeong 468445d9abdbSWeongyo Jeong static void 468545d9abdbSWeongyo Jeong bwn_intr_atim_end(struct bwn_mac *mac) 468645d9abdbSWeongyo Jeong { 468745d9abdbSWeongyo Jeong 468845d9abdbSWeongyo Jeong if (mac->mac_flags & BWN_MAC_FLAG_DFQVALID) { 468945d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCMD, 469045d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_MACCMD) | BWN_MACCMD_DFQ_VALID); 469145d9abdbSWeongyo Jeong mac->mac_flags &= ~BWN_MAC_FLAG_DFQVALID; 469245d9abdbSWeongyo Jeong } 469345d9abdbSWeongyo Jeong } 469445d9abdbSWeongyo Jeong 469545d9abdbSWeongyo Jeong static void 469645d9abdbSWeongyo Jeong bwn_intr_beacon(struct bwn_mac *mac) 469745d9abdbSWeongyo Jeong { 469845d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 46997a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 470045d9abdbSWeongyo Jeong uint32_t cmd, beacon0, beacon1; 470145d9abdbSWeongyo Jeong 470245d9abdbSWeongyo Jeong if (ic->ic_opmode == IEEE80211_M_HOSTAP || 470345d9abdbSWeongyo Jeong ic->ic_opmode == IEEE80211_M_MBSS) 470445d9abdbSWeongyo Jeong return; 470545d9abdbSWeongyo Jeong 470645d9abdbSWeongyo Jeong mac->mac_intr_mask &= ~BWN_INTR_BEACON; 470745d9abdbSWeongyo Jeong 470845d9abdbSWeongyo Jeong cmd = BWN_READ_4(mac, BWN_MACCMD); 470945d9abdbSWeongyo Jeong beacon0 = (cmd & BWN_MACCMD_BEACON0_VALID); 471045d9abdbSWeongyo Jeong beacon1 = (cmd & BWN_MACCMD_BEACON1_VALID); 471145d9abdbSWeongyo Jeong 471245d9abdbSWeongyo Jeong if (beacon0 && beacon1) { 471345d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_INTR_REASON, BWN_INTR_BEACON); 471445d9abdbSWeongyo Jeong mac->mac_intr_mask |= BWN_INTR_BEACON; 471545d9abdbSWeongyo Jeong return; 471645d9abdbSWeongyo Jeong } 471745d9abdbSWeongyo Jeong 471845d9abdbSWeongyo Jeong if (sc->sc_flags & BWN_FLAG_NEED_BEACON_TP) { 471945d9abdbSWeongyo Jeong sc->sc_flags &= ~BWN_FLAG_NEED_BEACON_TP; 472045d9abdbSWeongyo Jeong bwn_load_beacon0(mac); 472145d9abdbSWeongyo Jeong bwn_load_beacon1(mac); 472245d9abdbSWeongyo Jeong cmd = BWN_READ_4(mac, BWN_MACCMD); 472345d9abdbSWeongyo Jeong cmd |= BWN_MACCMD_BEACON0_VALID; 472445d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCMD, cmd); 472545d9abdbSWeongyo Jeong } else { 472645d9abdbSWeongyo Jeong if (!beacon0) { 472745d9abdbSWeongyo Jeong bwn_load_beacon0(mac); 472845d9abdbSWeongyo Jeong cmd = BWN_READ_4(mac, BWN_MACCMD); 472945d9abdbSWeongyo Jeong cmd |= BWN_MACCMD_BEACON0_VALID; 473045d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCMD, cmd); 473145d9abdbSWeongyo Jeong } else if (!beacon1) { 473245d9abdbSWeongyo Jeong bwn_load_beacon1(mac); 473345d9abdbSWeongyo Jeong cmd = BWN_READ_4(mac, BWN_MACCMD); 473445d9abdbSWeongyo Jeong cmd |= BWN_MACCMD_BEACON1_VALID; 473545d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCMD, cmd); 473645d9abdbSWeongyo Jeong } 473745d9abdbSWeongyo Jeong } 473845d9abdbSWeongyo Jeong } 473945d9abdbSWeongyo Jeong 474045d9abdbSWeongyo Jeong static void 474145d9abdbSWeongyo Jeong bwn_intr_pmq(struct bwn_mac *mac) 474245d9abdbSWeongyo Jeong { 474345d9abdbSWeongyo Jeong uint32_t tmp; 474445d9abdbSWeongyo Jeong 474545d9abdbSWeongyo Jeong while (1) { 474645d9abdbSWeongyo Jeong tmp = BWN_READ_4(mac, BWN_PS_STATUS); 474745d9abdbSWeongyo Jeong if (!(tmp & 0x00000008)) 474845d9abdbSWeongyo Jeong break; 474945d9abdbSWeongyo Jeong } 475045d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_PS_STATUS, 0x0002); 475145d9abdbSWeongyo Jeong } 475245d9abdbSWeongyo Jeong 475345d9abdbSWeongyo Jeong static void 475445d9abdbSWeongyo Jeong bwn_intr_noise(struct bwn_mac *mac) 475545d9abdbSWeongyo Jeong { 475645d9abdbSWeongyo Jeong struct bwn_phy_g *pg = &mac->mac_phy.phy_g; 475745d9abdbSWeongyo Jeong uint16_t tmp; 475845d9abdbSWeongyo Jeong uint8_t noise[4]; 475945d9abdbSWeongyo Jeong uint8_t i, j; 476045d9abdbSWeongyo Jeong int32_t average; 476145d9abdbSWeongyo Jeong 476245d9abdbSWeongyo Jeong if (mac->mac_phy.type != BWN_PHYTYPE_G) 476345d9abdbSWeongyo Jeong return; 476445d9abdbSWeongyo Jeong 476545d9abdbSWeongyo Jeong KASSERT(mac->mac_noise.noi_running, ("%s: fail", __func__)); 476645d9abdbSWeongyo Jeong *((uint32_t *)noise) = htole32(bwn_jssi_read(mac)); 476745d9abdbSWeongyo Jeong if (noise[0] == 0x7f || noise[1] == 0x7f || noise[2] == 0x7f || 476845d9abdbSWeongyo Jeong noise[3] == 0x7f) 476945d9abdbSWeongyo Jeong goto new; 477045d9abdbSWeongyo Jeong 477145d9abdbSWeongyo Jeong KASSERT(mac->mac_noise.noi_nsamples < 8, 477245d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 477345d9abdbSWeongyo Jeong i = mac->mac_noise.noi_nsamples; 477445d9abdbSWeongyo Jeong noise[0] = MIN(MAX(noise[0], 0), N(pg->pg_nrssi_lt) - 1); 477545d9abdbSWeongyo Jeong noise[1] = MIN(MAX(noise[1], 0), N(pg->pg_nrssi_lt) - 1); 477645d9abdbSWeongyo Jeong noise[2] = MIN(MAX(noise[2], 0), N(pg->pg_nrssi_lt) - 1); 477745d9abdbSWeongyo Jeong noise[3] = MIN(MAX(noise[3], 0), N(pg->pg_nrssi_lt) - 1); 477845d9abdbSWeongyo Jeong mac->mac_noise.noi_samples[i][0] = pg->pg_nrssi_lt[noise[0]]; 477945d9abdbSWeongyo Jeong mac->mac_noise.noi_samples[i][1] = pg->pg_nrssi_lt[noise[1]]; 478045d9abdbSWeongyo Jeong mac->mac_noise.noi_samples[i][2] = pg->pg_nrssi_lt[noise[2]]; 478145d9abdbSWeongyo Jeong mac->mac_noise.noi_samples[i][3] = pg->pg_nrssi_lt[noise[3]]; 478245d9abdbSWeongyo Jeong mac->mac_noise.noi_nsamples++; 478345d9abdbSWeongyo Jeong if (mac->mac_noise.noi_nsamples == 8) { 478445d9abdbSWeongyo Jeong average = 0; 478545d9abdbSWeongyo Jeong for (i = 0; i < 8; i++) { 478645d9abdbSWeongyo Jeong for (j = 0; j < 4; j++) 478745d9abdbSWeongyo Jeong average += mac->mac_noise.noi_samples[i][j]; 478845d9abdbSWeongyo Jeong } 478945d9abdbSWeongyo Jeong average = (((average / 32) * 125) + 64) / 128; 479045d9abdbSWeongyo Jeong tmp = (bwn_shm_read_2(mac, BWN_SHARED, 0x40c) / 128) & 0x1f; 479145d9abdbSWeongyo Jeong if (tmp >= 8) 479245d9abdbSWeongyo Jeong average += 2; 479345d9abdbSWeongyo Jeong else 479445d9abdbSWeongyo Jeong average -= 25; 479545d9abdbSWeongyo Jeong average -= (tmp == 8) ? 72 : 48; 479645d9abdbSWeongyo Jeong 479745d9abdbSWeongyo Jeong mac->mac_stats.link_noise = average; 479845d9abdbSWeongyo Jeong mac->mac_noise.noi_running = 0; 479945d9abdbSWeongyo Jeong return; 480045d9abdbSWeongyo Jeong } 480145d9abdbSWeongyo Jeong new: 480245d9abdbSWeongyo Jeong bwn_noise_gensample(mac); 480345d9abdbSWeongyo Jeong } 480445d9abdbSWeongyo Jeong 480545d9abdbSWeongyo Jeong static int 480645d9abdbSWeongyo Jeong bwn_pio_rx(struct bwn_pio_rxqueue *prq) 480745d9abdbSWeongyo Jeong { 480845d9abdbSWeongyo Jeong struct bwn_mac *mac = prq->prq_mac; 480945d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 481045d9abdbSWeongyo Jeong unsigned int i; 481145d9abdbSWeongyo Jeong 481245d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 481345d9abdbSWeongyo Jeong 481445d9abdbSWeongyo Jeong if (mac->mac_status < BWN_MAC_STATUS_STARTED) 481545d9abdbSWeongyo Jeong return (0); 481645d9abdbSWeongyo Jeong 481745d9abdbSWeongyo Jeong for (i = 0; i < 5000; i++) { 481845d9abdbSWeongyo Jeong if (bwn_pio_rxeof(prq) == 0) 481945d9abdbSWeongyo Jeong break; 482045d9abdbSWeongyo Jeong } 482145d9abdbSWeongyo Jeong if (i >= 5000) 482245d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "too many RX frames in PIO mode\n"); 482345d9abdbSWeongyo Jeong return ((i > 0) ? 1 : 0); 482445d9abdbSWeongyo Jeong } 482545d9abdbSWeongyo Jeong 482645d9abdbSWeongyo Jeong static void 482745d9abdbSWeongyo Jeong bwn_dma_rx(struct bwn_dma_ring *dr) 482845d9abdbSWeongyo Jeong { 482945d9abdbSWeongyo Jeong int slot, curslot; 483045d9abdbSWeongyo Jeong 483145d9abdbSWeongyo Jeong KASSERT(!dr->dr_tx, ("%s:%d: fail", __func__, __LINE__)); 483245d9abdbSWeongyo Jeong curslot = dr->get_curslot(dr); 483345d9abdbSWeongyo Jeong KASSERT(curslot >= 0 && curslot < dr->dr_numslots, 483445d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 483545d9abdbSWeongyo Jeong 483645d9abdbSWeongyo Jeong slot = dr->dr_curslot; 483745d9abdbSWeongyo Jeong for (; slot != curslot; slot = bwn_dma_nextslot(dr, slot)) 483845d9abdbSWeongyo Jeong bwn_dma_rxeof(dr, &slot); 483945d9abdbSWeongyo Jeong 484045d9abdbSWeongyo Jeong bus_dmamap_sync(dr->dr_ring_dtag, dr->dr_ring_dmap, 484145d9abdbSWeongyo Jeong BUS_DMASYNC_PREWRITE); 484245d9abdbSWeongyo Jeong 484345d9abdbSWeongyo Jeong dr->set_curslot(dr, slot); 484445d9abdbSWeongyo Jeong dr->dr_curslot = slot; 484545d9abdbSWeongyo Jeong } 484645d9abdbSWeongyo Jeong 484745d9abdbSWeongyo Jeong static void 484845d9abdbSWeongyo Jeong bwn_intr_txeof(struct bwn_mac *mac) 484945d9abdbSWeongyo Jeong { 485045d9abdbSWeongyo Jeong struct bwn_txstatus stat; 485145d9abdbSWeongyo Jeong uint32_t stat0, stat1; 485245d9abdbSWeongyo Jeong uint16_t tmp; 485345d9abdbSWeongyo Jeong 485445d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(mac->mac_sc); 485545d9abdbSWeongyo Jeong 485645d9abdbSWeongyo Jeong while (1) { 485745d9abdbSWeongyo Jeong stat0 = BWN_READ_4(mac, BWN_XMITSTAT_0); 485845d9abdbSWeongyo Jeong if (!(stat0 & 0x00000001)) 485945d9abdbSWeongyo Jeong break; 486045d9abdbSWeongyo Jeong stat1 = BWN_READ_4(mac, BWN_XMITSTAT_1); 486145d9abdbSWeongyo Jeong 486245d9abdbSWeongyo Jeong stat.cookie = (stat0 >> 16); 486345d9abdbSWeongyo Jeong stat.seq = (stat1 & 0x0000ffff); 486445d9abdbSWeongyo Jeong stat.phy_stat = ((stat1 & 0x00ff0000) >> 16); 486545d9abdbSWeongyo Jeong tmp = (stat0 & 0x0000ffff); 486645d9abdbSWeongyo Jeong stat.framecnt = ((tmp & 0xf000) >> 12); 486745d9abdbSWeongyo Jeong stat.rtscnt = ((tmp & 0x0f00) >> 8); 486845d9abdbSWeongyo Jeong stat.sreason = ((tmp & 0x001c) >> 2); 486945d9abdbSWeongyo Jeong stat.pm = (tmp & 0x0080) ? 1 : 0; 487045d9abdbSWeongyo Jeong stat.im = (tmp & 0x0040) ? 1 : 0; 487145d9abdbSWeongyo Jeong stat.ampdu = (tmp & 0x0020) ? 1 : 0; 487245d9abdbSWeongyo Jeong stat.ack = (tmp & 0x0002) ? 1 : 0; 487345d9abdbSWeongyo Jeong 487445d9abdbSWeongyo Jeong bwn_handle_txeof(mac, &stat); 487545d9abdbSWeongyo Jeong } 487645d9abdbSWeongyo Jeong } 487745d9abdbSWeongyo Jeong 487845d9abdbSWeongyo Jeong static void 487945d9abdbSWeongyo Jeong bwn_hwreset(void *arg, int npending) 488045d9abdbSWeongyo Jeong { 488145d9abdbSWeongyo Jeong struct bwn_mac *mac = arg; 488245d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 488345d9abdbSWeongyo Jeong int error = 0; 488445d9abdbSWeongyo Jeong int prev_status; 488545d9abdbSWeongyo Jeong 488645d9abdbSWeongyo Jeong BWN_LOCK(sc); 488745d9abdbSWeongyo Jeong 488845d9abdbSWeongyo Jeong prev_status = mac->mac_status; 488945d9abdbSWeongyo Jeong if (prev_status >= BWN_MAC_STATUS_STARTED) 489045d9abdbSWeongyo Jeong bwn_core_stop(mac); 489145d9abdbSWeongyo Jeong if (prev_status >= BWN_MAC_STATUS_INITED) 489245d9abdbSWeongyo Jeong bwn_core_exit(mac); 489345d9abdbSWeongyo Jeong 489445d9abdbSWeongyo Jeong if (prev_status >= BWN_MAC_STATUS_INITED) { 489545d9abdbSWeongyo Jeong error = bwn_core_init(mac); 489645d9abdbSWeongyo Jeong if (error) 489745d9abdbSWeongyo Jeong goto out; 489845d9abdbSWeongyo Jeong } 489945d9abdbSWeongyo Jeong if (prev_status >= BWN_MAC_STATUS_STARTED) 490045d9abdbSWeongyo Jeong bwn_core_start(mac); 490145d9abdbSWeongyo Jeong out: 490245d9abdbSWeongyo Jeong if (error) { 490345d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: failed (%d)\n", __func__, error); 490445d9abdbSWeongyo Jeong sc->sc_curmac = NULL; 490545d9abdbSWeongyo Jeong } 490645d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 490745d9abdbSWeongyo Jeong } 490845d9abdbSWeongyo Jeong 490945d9abdbSWeongyo Jeong static void 491045d9abdbSWeongyo Jeong bwn_handle_fwpanic(struct bwn_mac *mac) 491145d9abdbSWeongyo Jeong { 491245d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 491345d9abdbSWeongyo Jeong uint16_t reason; 491445d9abdbSWeongyo Jeong 491545d9abdbSWeongyo Jeong reason = bwn_shm_read_2(mac, BWN_SCRATCH, BWN_FWPANIC_REASON_REG); 491645d9abdbSWeongyo Jeong device_printf(sc->sc_dev,"fw panic (%u)\n", reason); 491745d9abdbSWeongyo Jeong 491845d9abdbSWeongyo Jeong if (reason == BWN_FWPANIC_RESTART) 491945d9abdbSWeongyo Jeong bwn_restart(mac, "ucode panic"); 492045d9abdbSWeongyo Jeong } 492145d9abdbSWeongyo Jeong 492245d9abdbSWeongyo Jeong static void 492345d9abdbSWeongyo Jeong bwn_load_beacon0(struct bwn_mac *mac) 492445d9abdbSWeongyo Jeong { 492545d9abdbSWeongyo Jeong 492645d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 492745d9abdbSWeongyo Jeong } 492845d9abdbSWeongyo Jeong 492945d9abdbSWeongyo Jeong static void 493045d9abdbSWeongyo Jeong bwn_load_beacon1(struct bwn_mac *mac) 493145d9abdbSWeongyo Jeong { 493245d9abdbSWeongyo Jeong 493345d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 493445d9abdbSWeongyo Jeong } 493545d9abdbSWeongyo Jeong 493645d9abdbSWeongyo Jeong static uint32_t 493745d9abdbSWeongyo Jeong bwn_jssi_read(struct bwn_mac *mac) 493845d9abdbSWeongyo Jeong { 493945d9abdbSWeongyo Jeong uint32_t val = 0; 494045d9abdbSWeongyo Jeong 494145d9abdbSWeongyo Jeong val = bwn_shm_read_2(mac, BWN_SHARED, 0x08a); 494245d9abdbSWeongyo Jeong val <<= 16; 494345d9abdbSWeongyo Jeong val |= bwn_shm_read_2(mac, BWN_SHARED, 0x088); 494445d9abdbSWeongyo Jeong 494545d9abdbSWeongyo Jeong return (val); 494645d9abdbSWeongyo Jeong } 494745d9abdbSWeongyo Jeong 494845d9abdbSWeongyo Jeong static void 494945d9abdbSWeongyo Jeong bwn_noise_gensample(struct bwn_mac *mac) 495045d9abdbSWeongyo Jeong { 495145d9abdbSWeongyo Jeong uint32_t jssi = 0x7f7f7f7f; 495245d9abdbSWeongyo Jeong 495345d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, 0x088, (jssi & 0x0000ffff)); 495445d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, 0x08a, (jssi & 0xffff0000) >> 16); 495545d9abdbSWeongyo Jeong BWN_WRITE_4(mac, BWN_MACCMD, 495645d9abdbSWeongyo Jeong BWN_READ_4(mac, BWN_MACCMD) | BWN_MACCMD_BGNOISE); 495745d9abdbSWeongyo Jeong } 495845d9abdbSWeongyo Jeong 495945d9abdbSWeongyo Jeong static int 496045d9abdbSWeongyo Jeong bwn_dma_freeslot(struct bwn_dma_ring *dr) 496145d9abdbSWeongyo Jeong { 49620d05eee2SWarner Losh BWN_ASSERT_LOCKED(dr->dr_mac->mac_sc); 496345d9abdbSWeongyo Jeong 496445d9abdbSWeongyo Jeong return (dr->dr_numslots - dr->dr_usedslot); 496545d9abdbSWeongyo Jeong } 496645d9abdbSWeongyo Jeong 496745d9abdbSWeongyo Jeong static int 496845d9abdbSWeongyo Jeong bwn_dma_nextslot(struct bwn_dma_ring *dr, int slot) 496945d9abdbSWeongyo Jeong { 49700d05eee2SWarner Losh BWN_ASSERT_LOCKED(dr->dr_mac->mac_sc); 497145d9abdbSWeongyo Jeong 497245d9abdbSWeongyo Jeong KASSERT(slot >= -1 && slot <= dr->dr_numslots - 1, 497345d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 497445d9abdbSWeongyo Jeong if (slot == dr->dr_numslots - 1) 497545d9abdbSWeongyo Jeong return (0); 497645d9abdbSWeongyo Jeong return (slot + 1); 497745d9abdbSWeongyo Jeong } 497845d9abdbSWeongyo Jeong 497945d9abdbSWeongyo Jeong static void 498045d9abdbSWeongyo Jeong bwn_dma_rxeof(struct bwn_dma_ring *dr, int *slot) 498145d9abdbSWeongyo Jeong { 498245d9abdbSWeongyo Jeong struct bwn_mac *mac = dr->dr_mac; 498345d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 498445d9abdbSWeongyo Jeong struct bwn_dma *dma = &mac->mac_method.dma; 498545d9abdbSWeongyo Jeong struct bwn_dmadesc_generic *desc; 498645d9abdbSWeongyo Jeong struct bwn_dmadesc_meta *meta; 498745d9abdbSWeongyo Jeong struct bwn_rxhdr4 *rxhdr; 498845d9abdbSWeongyo Jeong struct mbuf *m; 498945d9abdbSWeongyo Jeong uint32_t macstat; 499045d9abdbSWeongyo Jeong int32_t tmp; 499145d9abdbSWeongyo Jeong int cnt = 0; 499245d9abdbSWeongyo Jeong uint16_t len; 499345d9abdbSWeongyo Jeong 499445d9abdbSWeongyo Jeong dr->getdesc(dr, *slot, &desc, &meta); 499545d9abdbSWeongyo Jeong 499645d9abdbSWeongyo Jeong bus_dmamap_sync(dma->rxbuf_dtag, meta->mt_dmap, BUS_DMASYNC_POSTREAD); 499745d9abdbSWeongyo Jeong m = meta->mt_m; 499845d9abdbSWeongyo Jeong 499945d9abdbSWeongyo Jeong if (bwn_dma_newbuf(dr, desc, meta, 0)) { 50007a79cebfSGleb Smirnoff counter_u64_add(sc->sc_ic.ic_ierrors, 1); 500145d9abdbSWeongyo Jeong return; 500245d9abdbSWeongyo Jeong } 500345d9abdbSWeongyo Jeong 500445d9abdbSWeongyo Jeong rxhdr = mtod(m, struct bwn_rxhdr4 *); 500545d9abdbSWeongyo Jeong len = le16toh(rxhdr->frame_len); 500645d9abdbSWeongyo Jeong if (len <= 0) { 50077a79cebfSGleb Smirnoff counter_u64_add(sc->sc_ic.ic_ierrors, 1); 500845d9abdbSWeongyo Jeong return; 500945d9abdbSWeongyo Jeong } 501045d9abdbSWeongyo Jeong if (bwn_dma_check_redzone(dr, m)) { 501145d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "redzone error.\n"); 501245d9abdbSWeongyo Jeong bwn_dma_set_redzone(dr, m); 501345d9abdbSWeongyo Jeong bus_dmamap_sync(dma->rxbuf_dtag, meta->mt_dmap, 501445d9abdbSWeongyo Jeong BUS_DMASYNC_PREWRITE); 501545d9abdbSWeongyo Jeong return; 501645d9abdbSWeongyo Jeong } 501745d9abdbSWeongyo Jeong if (len > dr->dr_rx_bufsize) { 501845d9abdbSWeongyo Jeong tmp = len; 501945d9abdbSWeongyo Jeong while (1) { 502045d9abdbSWeongyo Jeong dr->getdesc(dr, *slot, &desc, &meta); 502145d9abdbSWeongyo Jeong bwn_dma_set_redzone(dr, meta->mt_m); 502245d9abdbSWeongyo Jeong bus_dmamap_sync(dma->rxbuf_dtag, meta->mt_dmap, 502345d9abdbSWeongyo Jeong BUS_DMASYNC_PREWRITE); 502445d9abdbSWeongyo Jeong *slot = bwn_dma_nextslot(dr, *slot); 502545d9abdbSWeongyo Jeong cnt++; 502645d9abdbSWeongyo Jeong tmp -= dr->dr_rx_bufsize; 502745d9abdbSWeongyo Jeong if (tmp <= 0) 502845d9abdbSWeongyo Jeong break; 502945d9abdbSWeongyo Jeong } 503045d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "too small buffer " 503145d9abdbSWeongyo Jeong "(len %u buffer %u dropped %d)\n", 503245d9abdbSWeongyo Jeong len, dr->dr_rx_bufsize, cnt); 503345d9abdbSWeongyo Jeong return; 503445d9abdbSWeongyo Jeong } 503545d9abdbSWeongyo Jeong macstat = le32toh(rxhdr->mac_status); 503645d9abdbSWeongyo Jeong if (macstat & BWN_RX_MAC_FCSERR) { 503745d9abdbSWeongyo Jeong if (!(mac->mac_sc->sc_filters & BWN_MACCTL_PASS_BADFCS)) { 503845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "RX drop\n"); 503945d9abdbSWeongyo Jeong return; 504045d9abdbSWeongyo Jeong } 504145d9abdbSWeongyo Jeong } 504245d9abdbSWeongyo Jeong 504345d9abdbSWeongyo Jeong m->m_len = m->m_pkthdr.len = len + dr->dr_frameoffset; 504445d9abdbSWeongyo Jeong m_adj(m, dr->dr_frameoffset); 504545d9abdbSWeongyo Jeong 504645d9abdbSWeongyo Jeong bwn_rxeof(dr->dr_mac, m, rxhdr); 504745d9abdbSWeongyo Jeong } 504845d9abdbSWeongyo Jeong 504945d9abdbSWeongyo Jeong static void 505045d9abdbSWeongyo Jeong bwn_handle_txeof(struct bwn_mac *mac, const struct bwn_txstatus *status) 505145d9abdbSWeongyo Jeong { 505245d9abdbSWeongyo Jeong struct bwn_dma_ring *dr; 505345d9abdbSWeongyo Jeong struct bwn_dmadesc_generic *desc; 505445d9abdbSWeongyo Jeong struct bwn_dmadesc_meta *meta; 505545d9abdbSWeongyo Jeong struct bwn_pio_txqueue *tq; 505645d9abdbSWeongyo Jeong struct bwn_pio_txpkt *tp = NULL; 505745d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 5058d2ee7771SWeongyo Jeong struct bwn_stats *stats = &mac->mac_stats; 505945d9abdbSWeongyo Jeong struct ieee80211_node *ni; 5060b6108616SRui Paulo struct ieee80211vap *vap; 5061f5101b53SWeongyo Jeong int retrycnt = 0, slot; 506245d9abdbSWeongyo Jeong 506345d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(mac->mac_sc); 506445d9abdbSWeongyo Jeong 506545d9abdbSWeongyo Jeong if (status->im) 506645d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "TODO: STATUS IM\n"); 506745d9abdbSWeongyo Jeong if (status->ampdu) 506845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "TODO: STATUS AMPDU\n"); 506945d9abdbSWeongyo Jeong if (status->rtscnt) { 507045d9abdbSWeongyo Jeong if (status->rtscnt == 0xf) 5071d2ee7771SWeongyo Jeong stats->rtsfail++; 507245d9abdbSWeongyo Jeong else 5073d2ee7771SWeongyo Jeong stats->rts++; 507445d9abdbSWeongyo Jeong } 507545d9abdbSWeongyo Jeong 507645d9abdbSWeongyo Jeong if (mac->mac_flags & BWN_MAC_FLAG_DMA) { 507745d9abdbSWeongyo Jeong if (status->ack) { 507845d9abdbSWeongyo Jeong dr = bwn_dma_parse_cookie(mac, status, 507945d9abdbSWeongyo Jeong status->cookie, &slot); 508045d9abdbSWeongyo Jeong if (dr == NULL) { 508145d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 508245d9abdbSWeongyo Jeong "failed to parse cookie\n"); 508345d9abdbSWeongyo Jeong return; 508445d9abdbSWeongyo Jeong } 508545d9abdbSWeongyo Jeong while (1) { 508645d9abdbSWeongyo Jeong dr->getdesc(dr, slot, &desc, &meta); 508745d9abdbSWeongyo Jeong if (meta->mt_islast) { 508845d9abdbSWeongyo Jeong ni = meta->mt_ni; 5089b6108616SRui Paulo vap = ni->ni_vap; 5090b6108616SRui Paulo ieee80211_ratectl_tx_complete(vap, ni, 5091b6108616SRui Paulo status->ack ? 5092b6108616SRui Paulo IEEE80211_RATECTL_TX_SUCCESS : 5093b6108616SRui Paulo IEEE80211_RATECTL_TX_FAILURE, 5094f5101b53SWeongyo Jeong &retrycnt, 0); 509545d9abdbSWeongyo Jeong break; 509645d9abdbSWeongyo Jeong } 509745d9abdbSWeongyo Jeong slot = bwn_dma_nextslot(dr, slot); 509845d9abdbSWeongyo Jeong } 509945d9abdbSWeongyo Jeong } 510045d9abdbSWeongyo Jeong bwn_dma_handle_txeof(mac, status); 510145d9abdbSWeongyo Jeong } else { 510245d9abdbSWeongyo Jeong if (status->ack) { 510345d9abdbSWeongyo Jeong tq = bwn_pio_parse_cookie(mac, status->cookie, &tp); 510445d9abdbSWeongyo Jeong if (tq == NULL) { 510545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 510645d9abdbSWeongyo Jeong "failed to parse cookie\n"); 510745d9abdbSWeongyo Jeong return; 510845d9abdbSWeongyo Jeong } 510945d9abdbSWeongyo Jeong ni = tp->tp_ni; 5110b6108616SRui Paulo vap = ni->ni_vap; 5111b6108616SRui Paulo ieee80211_ratectl_tx_complete(vap, ni, 5112b6108616SRui Paulo status->ack ? 5113b6108616SRui Paulo IEEE80211_RATECTL_TX_SUCCESS : 5114b6108616SRui Paulo IEEE80211_RATECTL_TX_FAILURE, 5115f5101b53SWeongyo Jeong &retrycnt, 0); 511645d9abdbSWeongyo Jeong } 511745d9abdbSWeongyo Jeong bwn_pio_handle_txeof(mac, status); 511845d9abdbSWeongyo Jeong } 511945d9abdbSWeongyo Jeong 512045d9abdbSWeongyo Jeong bwn_phy_txpower_check(mac, 0); 512145d9abdbSWeongyo Jeong } 512245d9abdbSWeongyo Jeong 512345d9abdbSWeongyo Jeong static uint8_t 512445d9abdbSWeongyo Jeong bwn_pio_rxeof(struct bwn_pio_rxqueue *prq) 512545d9abdbSWeongyo Jeong { 512645d9abdbSWeongyo Jeong struct bwn_mac *mac = prq->prq_mac; 512745d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 512845d9abdbSWeongyo Jeong struct bwn_rxhdr4 rxhdr; 512945d9abdbSWeongyo Jeong struct mbuf *m; 513045d9abdbSWeongyo Jeong uint32_t ctl32, macstat, v32; 513145d9abdbSWeongyo Jeong unsigned int i, padding; 51326dcc706bSWeongyo Jeong uint16_t ctl16, len, totlen, v16; 513345d9abdbSWeongyo Jeong unsigned char *mp; 513445d9abdbSWeongyo Jeong char *data; 513545d9abdbSWeongyo Jeong 513645d9abdbSWeongyo Jeong memset(&rxhdr, 0, sizeof(rxhdr)); 513745d9abdbSWeongyo Jeong 513845d9abdbSWeongyo Jeong if (prq->prq_rev >= 8) { 513945d9abdbSWeongyo Jeong ctl32 = bwn_pio_rx_read_4(prq, BWN_PIO8_RXCTL); 514045d9abdbSWeongyo Jeong if (!(ctl32 & BWN_PIO8_RXCTL_FRAMEREADY)) 514145d9abdbSWeongyo Jeong return (0); 514245d9abdbSWeongyo Jeong bwn_pio_rx_write_4(prq, BWN_PIO8_RXCTL, 514345d9abdbSWeongyo Jeong BWN_PIO8_RXCTL_FRAMEREADY); 514445d9abdbSWeongyo Jeong for (i = 0; i < 10; i++) { 514545d9abdbSWeongyo Jeong ctl32 = bwn_pio_rx_read_4(prq, BWN_PIO8_RXCTL); 514645d9abdbSWeongyo Jeong if (ctl32 & BWN_PIO8_RXCTL_DATAREADY) 514745d9abdbSWeongyo Jeong goto ready; 514845d9abdbSWeongyo Jeong DELAY(10); 514945d9abdbSWeongyo Jeong } 515045d9abdbSWeongyo Jeong } else { 515145d9abdbSWeongyo Jeong ctl16 = bwn_pio_rx_read_2(prq, BWN_PIO_RXCTL); 515245d9abdbSWeongyo Jeong if (!(ctl16 & BWN_PIO_RXCTL_FRAMEREADY)) 515345d9abdbSWeongyo Jeong return (0); 515445d9abdbSWeongyo Jeong bwn_pio_rx_write_2(prq, BWN_PIO_RXCTL, 515545d9abdbSWeongyo Jeong BWN_PIO_RXCTL_FRAMEREADY); 515645d9abdbSWeongyo Jeong for (i = 0; i < 10; i++) { 515745d9abdbSWeongyo Jeong ctl16 = bwn_pio_rx_read_2(prq, BWN_PIO_RXCTL); 515845d9abdbSWeongyo Jeong if (ctl16 & BWN_PIO_RXCTL_DATAREADY) 515945d9abdbSWeongyo Jeong goto ready; 516045d9abdbSWeongyo Jeong DELAY(10); 516145d9abdbSWeongyo Jeong } 516245d9abdbSWeongyo Jeong } 516345d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: timed out\n", __func__); 516445d9abdbSWeongyo Jeong return (1); 516545d9abdbSWeongyo Jeong ready: 516645d9abdbSWeongyo Jeong if (prq->prq_rev >= 8) 5167b9b64aa5SWeongyo Jeong siba_read_multi_4(sc->sc_dev, &rxhdr, sizeof(rxhdr), 516845d9abdbSWeongyo Jeong prq->prq_base + BWN_PIO8_RXDATA); 516945d9abdbSWeongyo Jeong else 5170b9b64aa5SWeongyo Jeong siba_read_multi_2(sc->sc_dev, &rxhdr, sizeof(rxhdr), 517145d9abdbSWeongyo Jeong prq->prq_base + BWN_PIO_RXDATA); 517245d9abdbSWeongyo Jeong len = le16toh(rxhdr.frame_len); 517345d9abdbSWeongyo Jeong if (len > 0x700) { 517445d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: len is too big\n", __func__); 517545d9abdbSWeongyo Jeong goto error; 517645d9abdbSWeongyo Jeong } 517745d9abdbSWeongyo Jeong if (len == 0) { 517845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: len is 0\n", __func__); 517945d9abdbSWeongyo Jeong goto error; 518045d9abdbSWeongyo Jeong } 518145d9abdbSWeongyo Jeong 518245d9abdbSWeongyo Jeong macstat = le32toh(rxhdr.mac_status); 518345d9abdbSWeongyo Jeong if (macstat & BWN_RX_MAC_FCSERR) { 518445d9abdbSWeongyo Jeong if (!(mac->mac_sc->sc_filters & BWN_MACCTL_PASS_BADFCS)) { 518545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: FCS error", __func__); 518645d9abdbSWeongyo Jeong goto error; 518745d9abdbSWeongyo Jeong } 518845d9abdbSWeongyo Jeong } 518945d9abdbSWeongyo Jeong 519045d9abdbSWeongyo Jeong padding = (macstat & BWN_RX_MAC_PADDING) ? 2 : 0; 51916dcc706bSWeongyo Jeong totlen = len + padding; 51926dcc706bSWeongyo Jeong KASSERT(totlen <= MCLBYTES, ("too big..\n")); 5193c6499eccSGleb Smirnoff m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 519445d9abdbSWeongyo Jeong if (m == NULL) { 519545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: out of memory", __func__); 519645d9abdbSWeongyo Jeong goto error; 519745d9abdbSWeongyo Jeong } 519845d9abdbSWeongyo Jeong mp = mtod(m, unsigned char *); 519945d9abdbSWeongyo Jeong if (prq->prq_rev >= 8) { 52006dcc706bSWeongyo Jeong siba_read_multi_4(sc->sc_dev, mp, (totlen & ~3), 520145d9abdbSWeongyo Jeong prq->prq_base + BWN_PIO8_RXDATA); 52026dcc706bSWeongyo Jeong if (totlen & 3) { 520345d9abdbSWeongyo Jeong v32 = bwn_pio_rx_read_4(prq, BWN_PIO8_RXDATA); 52046dcc706bSWeongyo Jeong data = &(mp[totlen - 1]); 52056dcc706bSWeongyo Jeong switch (totlen & 3) { 520645d9abdbSWeongyo Jeong case 3: 520745d9abdbSWeongyo Jeong *data = (v32 >> 16); 520845d9abdbSWeongyo Jeong data--; 520945d9abdbSWeongyo Jeong case 2: 521045d9abdbSWeongyo Jeong *data = (v32 >> 8); 521145d9abdbSWeongyo Jeong data--; 521245d9abdbSWeongyo Jeong case 1: 521345d9abdbSWeongyo Jeong *data = v32; 521445d9abdbSWeongyo Jeong } 521545d9abdbSWeongyo Jeong } 521645d9abdbSWeongyo Jeong } else { 52176dcc706bSWeongyo Jeong siba_read_multi_2(sc->sc_dev, mp, (totlen & ~1), 521845d9abdbSWeongyo Jeong prq->prq_base + BWN_PIO_RXDATA); 52196dcc706bSWeongyo Jeong if (totlen & 1) { 522045d9abdbSWeongyo Jeong v16 = bwn_pio_rx_read_2(prq, BWN_PIO_RXDATA); 52216dcc706bSWeongyo Jeong mp[totlen - 1] = v16; 522245d9abdbSWeongyo Jeong } 522345d9abdbSWeongyo Jeong } 522445d9abdbSWeongyo Jeong 52256dcc706bSWeongyo Jeong m->m_len = m->m_pkthdr.len = totlen; 522645d9abdbSWeongyo Jeong 522745d9abdbSWeongyo Jeong bwn_rxeof(prq->prq_mac, m, &rxhdr); 522845d9abdbSWeongyo Jeong 522945d9abdbSWeongyo Jeong return (1); 523045d9abdbSWeongyo Jeong error: 523145d9abdbSWeongyo Jeong if (prq->prq_rev >= 8) 523245d9abdbSWeongyo Jeong bwn_pio_rx_write_4(prq, BWN_PIO8_RXCTL, 523345d9abdbSWeongyo Jeong BWN_PIO8_RXCTL_DATAREADY); 523445d9abdbSWeongyo Jeong else 523545d9abdbSWeongyo Jeong bwn_pio_rx_write_2(prq, BWN_PIO_RXCTL, BWN_PIO_RXCTL_DATAREADY); 523645d9abdbSWeongyo Jeong return (1); 523745d9abdbSWeongyo Jeong } 523845d9abdbSWeongyo Jeong 523945d9abdbSWeongyo Jeong static int 524045d9abdbSWeongyo Jeong bwn_dma_newbuf(struct bwn_dma_ring *dr, struct bwn_dmadesc_generic *desc, 524145d9abdbSWeongyo Jeong struct bwn_dmadesc_meta *meta, int init) 524245d9abdbSWeongyo Jeong { 524345d9abdbSWeongyo Jeong struct bwn_mac *mac = dr->dr_mac; 524445d9abdbSWeongyo Jeong struct bwn_dma *dma = &mac->mac_method.dma; 524545d9abdbSWeongyo Jeong struct bwn_rxhdr4 *hdr; 524645d9abdbSWeongyo Jeong bus_dmamap_t map; 524745d9abdbSWeongyo Jeong bus_addr_t paddr; 524845d9abdbSWeongyo Jeong struct mbuf *m; 524945d9abdbSWeongyo Jeong int error; 525045d9abdbSWeongyo Jeong 5251c6499eccSGleb Smirnoff m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 525245d9abdbSWeongyo Jeong if (m == NULL) { 525345d9abdbSWeongyo Jeong error = ENOBUFS; 525445d9abdbSWeongyo Jeong 525545d9abdbSWeongyo Jeong /* 525645d9abdbSWeongyo Jeong * If the NIC is up and running, we need to: 525745d9abdbSWeongyo Jeong * - Clear RX buffer's header. 525845d9abdbSWeongyo Jeong * - Restore RX descriptor settings. 525945d9abdbSWeongyo Jeong */ 526045d9abdbSWeongyo Jeong if (init) 526145d9abdbSWeongyo Jeong return (error); 526245d9abdbSWeongyo Jeong else 526345d9abdbSWeongyo Jeong goto back; 526445d9abdbSWeongyo Jeong } 526545d9abdbSWeongyo Jeong m->m_len = m->m_pkthdr.len = MCLBYTES; 526645d9abdbSWeongyo Jeong 526745d9abdbSWeongyo Jeong bwn_dma_set_redzone(dr, m); 526845d9abdbSWeongyo Jeong 526945d9abdbSWeongyo Jeong /* 527045d9abdbSWeongyo Jeong * Try to load RX buf into temporary DMA map 527145d9abdbSWeongyo Jeong */ 527245d9abdbSWeongyo Jeong error = bus_dmamap_load_mbuf(dma->rxbuf_dtag, dr->dr_spare_dmap, m, 527345d9abdbSWeongyo Jeong bwn_dma_buf_addr, &paddr, BUS_DMA_NOWAIT); 527445d9abdbSWeongyo Jeong if (error) { 527545d9abdbSWeongyo Jeong m_freem(m); 527645d9abdbSWeongyo Jeong 527745d9abdbSWeongyo Jeong /* 527845d9abdbSWeongyo Jeong * See the comment above 527945d9abdbSWeongyo Jeong */ 528045d9abdbSWeongyo Jeong if (init) 528145d9abdbSWeongyo Jeong return (error); 528245d9abdbSWeongyo Jeong else 528345d9abdbSWeongyo Jeong goto back; 528445d9abdbSWeongyo Jeong } 528545d9abdbSWeongyo Jeong 528645d9abdbSWeongyo Jeong if (!init) 528745d9abdbSWeongyo Jeong bus_dmamap_unload(dma->rxbuf_dtag, meta->mt_dmap); 528845d9abdbSWeongyo Jeong meta->mt_m = m; 528945d9abdbSWeongyo Jeong meta->mt_paddr = paddr; 529045d9abdbSWeongyo Jeong 529145d9abdbSWeongyo Jeong /* 529245d9abdbSWeongyo Jeong * Swap RX buf's DMA map with the loaded temporary one 529345d9abdbSWeongyo Jeong */ 529445d9abdbSWeongyo Jeong map = meta->mt_dmap; 529545d9abdbSWeongyo Jeong meta->mt_dmap = dr->dr_spare_dmap; 529645d9abdbSWeongyo Jeong dr->dr_spare_dmap = map; 529745d9abdbSWeongyo Jeong 529845d9abdbSWeongyo Jeong back: 529945d9abdbSWeongyo Jeong /* 530045d9abdbSWeongyo Jeong * Clear RX buf header 530145d9abdbSWeongyo Jeong */ 530245d9abdbSWeongyo Jeong hdr = mtod(meta->mt_m, struct bwn_rxhdr4 *); 530345d9abdbSWeongyo Jeong bzero(hdr, sizeof(*hdr)); 530445d9abdbSWeongyo Jeong bus_dmamap_sync(dma->rxbuf_dtag, meta->mt_dmap, 530545d9abdbSWeongyo Jeong BUS_DMASYNC_PREWRITE); 530645d9abdbSWeongyo Jeong 530745d9abdbSWeongyo Jeong /* 530845d9abdbSWeongyo Jeong * Setup RX buf descriptor 530945d9abdbSWeongyo Jeong */ 5310c2553fb9SHiren Panchasara dr->setdesc(dr, desc, meta->mt_paddr, meta->mt_m->m_len - 531145d9abdbSWeongyo Jeong sizeof(*hdr), 0, 0, 0); 531245d9abdbSWeongyo Jeong return (error); 531345d9abdbSWeongyo Jeong } 531445d9abdbSWeongyo Jeong 531545d9abdbSWeongyo Jeong static void 531645d9abdbSWeongyo Jeong bwn_dma_buf_addr(void *arg, bus_dma_segment_t *seg, int nseg, 531745d9abdbSWeongyo Jeong bus_size_t mapsz __unused, int error) 531845d9abdbSWeongyo Jeong { 531945d9abdbSWeongyo Jeong 532045d9abdbSWeongyo Jeong if (!error) { 532145d9abdbSWeongyo Jeong KASSERT(nseg == 1, ("too many segments(%d)\n", nseg)); 532245d9abdbSWeongyo Jeong *((bus_addr_t *)arg) = seg->ds_addr; 532345d9abdbSWeongyo Jeong } 532445d9abdbSWeongyo Jeong } 532545d9abdbSWeongyo Jeong 532645d9abdbSWeongyo Jeong static int 532745d9abdbSWeongyo Jeong bwn_hwrate2ieeerate(int rate) 532845d9abdbSWeongyo Jeong { 532945d9abdbSWeongyo Jeong 533045d9abdbSWeongyo Jeong switch (rate) { 533145d9abdbSWeongyo Jeong case BWN_CCK_RATE_1MB: 533245d9abdbSWeongyo Jeong return (2); 533345d9abdbSWeongyo Jeong case BWN_CCK_RATE_2MB: 533445d9abdbSWeongyo Jeong return (4); 533545d9abdbSWeongyo Jeong case BWN_CCK_RATE_5MB: 533645d9abdbSWeongyo Jeong return (11); 533745d9abdbSWeongyo Jeong case BWN_CCK_RATE_11MB: 533845d9abdbSWeongyo Jeong return (22); 533945d9abdbSWeongyo Jeong case BWN_OFDM_RATE_6MB: 534045d9abdbSWeongyo Jeong return (12); 534145d9abdbSWeongyo Jeong case BWN_OFDM_RATE_9MB: 534245d9abdbSWeongyo Jeong return (18); 534345d9abdbSWeongyo Jeong case BWN_OFDM_RATE_12MB: 534445d9abdbSWeongyo Jeong return (24); 534545d9abdbSWeongyo Jeong case BWN_OFDM_RATE_18MB: 534645d9abdbSWeongyo Jeong return (36); 534745d9abdbSWeongyo Jeong case BWN_OFDM_RATE_24MB: 534845d9abdbSWeongyo Jeong return (48); 534945d9abdbSWeongyo Jeong case BWN_OFDM_RATE_36MB: 535045d9abdbSWeongyo Jeong return (72); 535145d9abdbSWeongyo Jeong case BWN_OFDM_RATE_48MB: 535245d9abdbSWeongyo Jeong return (96); 535345d9abdbSWeongyo Jeong case BWN_OFDM_RATE_54MB: 535445d9abdbSWeongyo Jeong return (108); 535545d9abdbSWeongyo Jeong default: 535645d9abdbSWeongyo Jeong printf("Ooops\n"); 535745d9abdbSWeongyo Jeong return (0); 535845d9abdbSWeongyo Jeong } 535945d9abdbSWeongyo Jeong } 536045d9abdbSWeongyo Jeong 536145d9abdbSWeongyo Jeong static void 536245d9abdbSWeongyo Jeong bwn_rxeof(struct bwn_mac *mac, struct mbuf *m, const void *_rxhdr) 536345d9abdbSWeongyo Jeong { 536445d9abdbSWeongyo Jeong const struct bwn_rxhdr4 *rxhdr = _rxhdr; 536545d9abdbSWeongyo Jeong struct bwn_plcp6 *plcp; 536645d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 536745d9abdbSWeongyo Jeong struct ieee80211_frame_min *wh; 536845d9abdbSWeongyo Jeong struct ieee80211_node *ni; 53697a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 537045d9abdbSWeongyo Jeong uint32_t macstat; 53710d05eee2SWarner Losh int padding, rate, rssi = 0, noise = 0, type; 537245d9abdbSWeongyo Jeong uint16_t phytype, phystat0, phystat3, chanstat; 537345d9abdbSWeongyo Jeong unsigned char *mp = mtod(m, unsigned char *); 53740d05eee2SWarner Losh static int rx_mac_dec_rpt = 0; 537545d9abdbSWeongyo Jeong 537645d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 537745d9abdbSWeongyo Jeong 537845d9abdbSWeongyo Jeong phystat0 = le16toh(rxhdr->phy_status0); 537945d9abdbSWeongyo Jeong phystat3 = le16toh(rxhdr->phy_status3); 538045d9abdbSWeongyo Jeong macstat = le32toh(rxhdr->mac_status); 538145d9abdbSWeongyo Jeong chanstat = le16toh(rxhdr->channel); 538245d9abdbSWeongyo Jeong phytype = chanstat & BWN_RX_CHAN_PHYTYPE; 538345d9abdbSWeongyo Jeong 538445d9abdbSWeongyo Jeong if (macstat & BWN_RX_MAC_FCSERR) 538545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "TODO RX: RX_FLAG_FAILED_FCS_CRC\n"); 538645d9abdbSWeongyo Jeong if (phystat0 & (BWN_RX_PHYST0_PLCPHCF | BWN_RX_PHYST0_PLCPFV)) 538745d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "TODO RX: RX_FLAG_FAILED_PLCP_CRC\n"); 538845d9abdbSWeongyo Jeong if (macstat & BWN_RX_MAC_DECERR) 538945d9abdbSWeongyo Jeong goto drop; 539045d9abdbSWeongyo Jeong 539145d9abdbSWeongyo Jeong padding = (macstat & BWN_RX_MAC_PADDING) ? 2 : 0; 539245d9abdbSWeongyo Jeong if (m->m_pkthdr.len < (sizeof(struct bwn_plcp6) + padding)) { 5393ef0894bfSWeongyo Jeong device_printf(sc->sc_dev, "frame too short (length=%d)\n", 5394ef0894bfSWeongyo Jeong m->m_pkthdr.len); 539545d9abdbSWeongyo Jeong goto drop; 539645d9abdbSWeongyo Jeong } 539745d9abdbSWeongyo Jeong plcp = (struct bwn_plcp6 *)(mp + padding); 539845d9abdbSWeongyo Jeong m_adj(m, sizeof(struct bwn_plcp6) + padding); 539945d9abdbSWeongyo Jeong if (m->m_pkthdr.len < IEEE80211_MIN_LEN) { 5400ef0894bfSWeongyo Jeong device_printf(sc->sc_dev, "frame too short (length=%d)\n", 5401ef0894bfSWeongyo Jeong m->m_pkthdr.len); 540245d9abdbSWeongyo Jeong goto drop; 540345d9abdbSWeongyo Jeong } 540445d9abdbSWeongyo Jeong wh = mtod(m, struct ieee80211_frame_min *); 540545d9abdbSWeongyo Jeong 54060d05eee2SWarner Losh if (macstat & BWN_RX_MAC_DEC && rx_mac_dec_rpt++ < 50) 5407ef0894bfSWeongyo Jeong device_printf(sc->sc_dev, 5408ef0894bfSWeongyo Jeong "RX decryption attempted (old %d keyidx %#x)\n", 5409ef0894bfSWeongyo Jeong BWN_ISOLDFMT(mac), 5410ef0894bfSWeongyo Jeong (macstat & BWN_RX_MAC_KEYIDX) >> BWN_RX_MAC_KEYIDX_SHIFT); 541145d9abdbSWeongyo Jeong 541245d9abdbSWeongyo Jeong /* XXX calculating RSSI & noise & antenna */ 541345d9abdbSWeongyo Jeong 541445d9abdbSWeongyo Jeong if (phystat0 & BWN_RX_PHYST0_OFDM) 541545d9abdbSWeongyo Jeong rate = bwn_plcp_get_ofdmrate(mac, plcp, 541645d9abdbSWeongyo Jeong phytype == BWN_PHYTYPE_A); 541745d9abdbSWeongyo Jeong else 541845d9abdbSWeongyo Jeong rate = bwn_plcp_get_cckrate(mac, plcp); 541945d9abdbSWeongyo Jeong if (rate == -1) { 542045d9abdbSWeongyo Jeong if (!(mac->mac_sc->sc_filters & BWN_MACCTL_PASS_BADPLCP)) 542145d9abdbSWeongyo Jeong goto drop; 542245d9abdbSWeongyo Jeong } 542345d9abdbSWeongyo Jeong sc->sc_rx_rate = bwn_hwrate2ieeerate(rate); 542445d9abdbSWeongyo Jeong 542545d9abdbSWeongyo Jeong /* RX radio tap */ 542645d9abdbSWeongyo Jeong if (ieee80211_radiotap_active(ic)) 542745d9abdbSWeongyo Jeong bwn_rx_radiotap(mac, m, rxhdr, plcp, rate, rssi, noise); 542845d9abdbSWeongyo Jeong m_adj(m, -IEEE80211_CRC_LEN); 542945d9abdbSWeongyo Jeong 543045d9abdbSWeongyo Jeong rssi = rxhdr->phy.abg.rssi; /* XXX incorrect RSSI calculation? */ 543145d9abdbSWeongyo Jeong noise = mac->mac_stats.link_noise; 543245d9abdbSWeongyo Jeong 543345d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 543445d9abdbSWeongyo Jeong 543545d9abdbSWeongyo Jeong ni = ieee80211_find_rxnode(ic, wh); 543645d9abdbSWeongyo Jeong if (ni != NULL) { 543745d9abdbSWeongyo Jeong type = ieee80211_input(ni, m, rssi, noise); 543845d9abdbSWeongyo Jeong ieee80211_free_node(ni); 543945d9abdbSWeongyo Jeong } else 544045d9abdbSWeongyo Jeong type = ieee80211_input_all(ic, m, rssi, noise); 544145d9abdbSWeongyo Jeong 544245d9abdbSWeongyo Jeong BWN_LOCK(sc); 544345d9abdbSWeongyo Jeong return; 544445d9abdbSWeongyo Jeong drop: 544545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "%s: dropped\n", __func__); 544645d9abdbSWeongyo Jeong } 544745d9abdbSWeongyo Jeong 544845d9abdbSWeongyo Jeong static void 544945d9abdbSWeongyo Jeong bwn_dma_handle_txeof(struct bwn_mac *mac, 545045d9abdbSWeongyo Jeong const struct bwn_txstatus *status) 545145d9abdbSWeongyo Jeong { 545245d9abdbSWeongyo Jeong struct bwn_dma *dma = &mac->mac_method.dma; 545345d9abdbSWeongyo Jeong struct bwn_dma_ring *dr; 545445d9abdbSWeongyo Jeong struct bwn_dmadesc_generic *desc; 545545d9abdbSWeongyo Jeong struct bwn_dmadesc_meta *meta; 545645d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 545745d9abdbSWeongyo Jeong int slot; 545845d9abdbSWeongyo Jeong 545945d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 546045d9abdbSWeongyo Jeong 546145d9abdbSWeongyo Jeong dr = bwn_dma_parse_cookie(mac, status, status->cookie, &slot); 546245d9abdbSWeongyo Jeong if (dr == NULL) { 546345d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "failed to parse cookie\n"); 546445d9abdbSWeongyo Jeong return; 546545d9abdbSWeongyo Jeong } 546645d9abdbSWeongyo Jeong KASSERT(dr->dr_tx, ("%s:%d: fail", __func__, __LINE__)); 546745d9abdbSWeongyo Jeong 546845d9abdbSWeongyo Jeong while (1) { 546945d9abdbSWeongyo Jeong KASSERT(slot >= 0 && slot < dr->dr_numslots, 547045d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 547145d9abdbSWeongyo Jeong dr->getdesc(dr, slot, &desc, &meta); 547245d9abdbSWeongyo Jeong 547345d9abdbSWeongyo Jeong if (meta->mt_txtype == BWN_DMADESC_METATYPE_HEADER) 547445d9abdbSWeongyo Jeong bus_dmamap_unload(dr->dr_txring_dtag, meta->mt_dmap); 547545d9abdbSWeongyo Jeong else if (meta->mt_txtype == BWN_DMADESC_METATYPE_BODY) 547645d9abdbSWeongyo Jeong bus_dmamap_unload(dma->txbuf_dtag, meta->mt_dmap); 547745d9abdbSWeongyo Jeong 547845d9abdbSWeongyo Jeong if (meta->mt_islast) { 547945d9abdbSWeongyo Jeong KASSERT(meta->mt_m != NULL, 548045d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 548145d9abdbSWeongyo Jeong 54827a79cebfSGleb Smirnoff ieee80211_tx_complete(meta->mt_ni, meta->mt_m, 0); 548345d9abdbSWeongyo Jeong meta->mt_ni = NULL; 548445d9abdbSWeongyo Jeong meta->mt_m = NULL; 54857a79cebfSGleb Smirnoff } else 548645d9abdbSWeongyo Jeong KASSERT(meta->mt_m == NULL, 548745d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 548845d9abdbSWeongyo Jeong 548945d9abdbSWeongyo Jeong dr->dr_usedslot--; 54907a79cebfSGleb Smirnoff if (meta->mt_islast) 549145d9abdbSWeongyo Jeong break; 549245d9abdbSWeongyo Jeong slot = bwn_dma_nextslot(dr, slot); 549345d9abdbSWeongyo Jeong } 549445d9abdbSWeongyo Jeong sc->sc_watchdog_timer = 0; 549545d9abdbSWeongyo Jeong if (dr->dr_stop) { 549645d9abdbSWeongyo Jeong KASSERT(bwn_dma_freeslot(dr) >= BWN_TX_SLOTS_PER_FRAME, 549745d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 549845d9abdbSWeongyo Jeong dr->dr_stop = 0; 549945d9abdbSWeongyo Jeong } 550045d9abdbSWeongyo Jeong } 550145d9abdbSWeongyo Jeong 550245d9abdbSWeongyo Jeong static void 550345d9abdbSWeongyo Jeong bwn_pio_handle_txeof(struct bwn_mac *mac, 550445d9abdbSWeongyo Jeong const struct bwn_txstatus *status) 550545d9abdbSWeongyo Jeong { 550645d9abdbSWeongyo Jeong struct bwn_pio_txqueue *tq; 550745d9abdbSWeongyo Jeong struct bwn_pio_txpkt *tp = NULL; 550845d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 550945d9abdbSWeongyo Jeong 551045d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 551145d9abdbSWeongyo Jeong 551245d9abdbSWeongyo Jeong tq = bwn_pio_parse_cookie(mac, status->cookie, &tp); 551345d9abdbSWeongyo Jeong if (tq == NULL) 551445d9abdbSWeongyo Jeong return; 551545d9abdbSWeongyo Jeong 551645d9abdbSWeongyo Jeong tq->tq_used -= roundup(tp->tp_m->m_pkthdr.len + BWN_HDRSIZE(mac), 4); 551745d9abdbSWeongyo Jeong tq->tq_free++; 551845d9abdbSWeongyo Jeong 551945d9abdbSWeongyo Jeong if (tp->tp_ni != NULL) { 552045d9abdbSWeongyo Jeong /* 552145d9abdbSWeongyo Jeong * Do any tx complete callback. Note this must 552245d9abdbSWeongyo Jeong * be done before releasing the node reference. 552345d9abdbSWeongyo Jeong */ 552445d9abdbSWeongyo Jeong if (tp->tp_m->m_flags & M_TXCB) 552545d9abdbSWeongyo Jeong ieee80211_process_callback(tp->tp_ni, tp->tp_m, 0); 552645d9abdbSWeongyo Jeong ieee80211_free_node(tp->tp_ni); 552745d9abdbSWeongyo Jeong tp->tp_ni = NULL; 552845d9abdbSWeongyo Jeong } 552945d9abdbSWeongyo Jeong m_freem(tp->tp_m); 553045d9abdbSWeongyo Jeong tp->tp_m = NULL; 553145d9abdbSWeongyo Jeong TAILQ_INSERT_TAIL(&tq->tq_pktlist, tp, tp_list); 553245d9abdbSWeongyo Jeong 553345d9abdbSWeongyo Jeong sc->sc_watchdog_timer = 0; 553445d9abdbSWeongyo Jeong } 553545d9abdbSWeongyo Jeong 553645d9abdbSWeongyo Jeong static void 553745d9abdbSWeongyo Jeong bwn_phy_txpower_check(struct bwn_mac *mac, uint32_t flags) 553845d9abdbSWeongyo Jeong { 553945d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 554045d9abdbSWeongyo Jeong struct bwn_phy *phy = &mac->mac_phy; 55417a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 554245d9abdbSWeongyo Jeong unsigned long now; 554345d9abdbSWeongyo Jeong int result; 554445d9abdbSWeongyo Jeong 554545d9abdbSWeongyo Jeong BWN_GETTIME(now); 554645d9abdbSWeongyo Jeong 5547d475bf23SAdrian Chadd if (!(flags & BWN_TXPWR_IGNORE_TIME) && ieee80211_time_before(now, phy->nexttime)) 554845d9abdbSWeongyo Jeong return; 554945d9abdbSWeongyo Jeong phy->nexttime = now + 2 * 1000; 555045d9abdbSWeongyo Jeong 5551b9b64aa5SWeongyo Jeong if (siba_get_pci_subvendor(sc->sc_dev) == SIBA_BOARDVENDOR_BCM && 5552b9b64aa5SWeongyo Jeong siba_get_pci_subdevice(sc->sc_dev) == SIBA_BOARD_BU4306) 555345d9abdbSWeongyo Jeong return; 555445d9abdbSWeongyo Jeong 555545d9abdbSWeongyo Jeong if (phy->recalc_txpwr != NULL) { 555645d9abdbSWeongyo Jeong result = phy->recalc_txpwr(mac, 555745d9abdbSWeongyo Jeong (flags & BWN_TXPWR_IGNORE_TSSI) ? 1 : 0); 555845d9abdbSWeongyo Jeong if (result == BWN_TXPWR_RES_DONE) 555945d9abdbSWeongyo Jeong return; 556045d9abdbSWeongyo Jeong KASSERT(result == BWN_TXPWR_RES_NEED_ADJUST, 556145d9abdbSWeongyo Jeong ("%s: fail", __func__)); 556245d9abdbSWeongyo Jeong KASSERT(phy->set_txpwr != NULL, ("%s: fail", __func__)); 556345d9abdbSWeongyo Jeong 556445d9abdbSWeongyo Jeong ieee80211_runtask(ic, &mac->mac_txpower); 556545d9abdbSWeongyo Jeong } 556645d9abdbSWeongyo Jeong } 556745d9abdbSWeongyo Jeong 556845d9abdbSWeongyo Jeong static uint16_t 556945d9abdbSWeongyo Jeong bwn_pio_rx_read_2(struct bwn_pio_rxqueue *prq, uint16_t offset) 557045d9abdbSWeongyo Jeong { 557145d9abdbSWeongyo Jeong 557245d9abdbSWeongyo Jeong return (BWN_READ_2(prq->prq_mac, prq->prq_base + offset)); 557345d9abdbSWeongyo Jeong } 557445d9abdbSWeongyo Jeong 557545d9abdbSWeongyo Jeong static uint32_t 557645d9abdbSWeongyo Jeong bwn_pio_rx_read_4(struct bwn_pio_rxqueue *prq, uint16_t offset) 557745d9abdbSWeongyo Jeong { 557845d9abdbSWeongyo Jeong 557945d9abdbSWeongyo Jeong return (BWN_READ_4(prq->prq_mac, prq->prq_base + offset)); 558045d9abdbSWeongyo Jeong } 558145d9abdbSWeongyo Jeong 558245d9abdbSWeongyo Jeong static void 558345d9abdbSWeongyo Jeong bwn_pio_rx_write_2(struct bwn_pio_rxqueue *prq, uint16_t offset, uint16_t value) 558445d9abdbSWeongyo Jeong { 558545d9abdbSWeongyo Jeong 558645d9abdbSWeongyo Jeong BWN_WRITE_2(prq->prq_mac, prq->prq_base + offset, value); 558745d9abdbSWeongyo Jeong } 558845d9abdbSWeongyo Jeong 558945d9abdbSWeongyo Jeong static void 559045d9abdbSWeongyo Jeong bwn_pio_rx_write_4(struct bwn_pio_rxqueue *prq, uint16_t offset, uint32_t value) 559145d9abdbSWeongyo Jeong { 559245d9abdbSWeongyo Jeong 559345d9abdbSWeongyo Jeong BWN_WRITE_4(prq->prq_mac, prq->prq_base + offset, value); 559445d9abdbSWeongyo Jeong } 559545d9abdbSWeongyo Jeong 559645d9abdbSWeongyo Jeong static int 559745d9abdbSWeongyo Jeong bwn_ieeerate2hwrate(struct bwn_softc *sc, int rate) 559845d9abdbSWeongyo Jeong { 559945d9abdbSWeongyo Jeong 560045d9abdbSWeongyo Jeong switch (rate) { 560145d9abdbSWeongyo Jeong /* OFDM rates (cf IEEE Std 802.11a-1999, pp. 14 Table 80) */ 560245d9abdbSWeongyo Jeong case 12: 560345d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_6MB); 560445d9abdbSWeongyo Jeong case 18: 560545d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_9MB); 560645d9abdbSWeongyo Jeong case 24: 560745d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_12MB); 560845d9abdbSWeongyo Jeong case 36: 560945d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_18MB); 561045d9abdbSWeongyo Jeong case 48: 561145d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_24MB); 561245d9abdbSWeongyo Jeong case 72: 561345d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_36MB); 561445d9abdbSWeongyo Jeong case 96: 561545d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_48MB); 561645d9abdbSWeongyo Jeong case 108: 561745d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_54MB); 561845d9abdbSWeongyo Jeong /* CCK rates (NB: not IEEE std, device-specific) */ 561945d9abdbSWeongyo Jeong case 2: 562045d9abdbSWeongyo Jeong return (BWN_CCK_RATE_1MB); 562145d9abdbSWeongyo Jeong case 4: 562245d9abdbSWeongyo Jeong return (BWN_CCK_RATE_2MB); 562345d9abdbSWeongyo Jeong case 11: 562445d9abdbSWeongyo Jeong return (BWN_CCK_RATE_5MB); 562545d9abdbSWeongyo Jeong case 22: 562645d9abdbSWeongyo Jeong return (BWN_CCK_RATE_11MB); 562745d9abdbSWeongyo Jeong } 562845d9abdbSWeongyo Jeong 562945d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "unsupported rate %d\n", rate); 563045d9abdbSWeongyo Jeong return (BWN_CCK_RATE_1MB); 563145d9abdbSWeongyo Jeong } 563245d9abdbSWeongyo Jeong 563345d9abdbSWeongyo Jeong static int 563445d9abdbSWeongyo Jeong bwn_set_txhdr(struct bwn_mac *mac, struct ieee80211_node *ni, 563545d9abdbSWeongyo Jeong struct mbuf *m, struct bwn_txhdr *txhdr, uint16_t cookie) 563645d9abdbSWeongyo Jeong { 563745d9abdbSWeongyo Jeong const struct bwn_phy *phy = &mac->mac_phy; 563845d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 563945d9abdbSWeongyo Jeong struct ieee80211_frame *wh; 564045d9abdbSWeongyo Jeong struct ieee80211_frame *protwh; 564145d9abdbSWeongyo Jeong struct ieee80211_frame_cts *cts; 564245d9abdbSWeongyo Jeong struct ieee80211_frame_rts *rts; 564345d9abdbSWeongyo Jeong const struct ieee80211_txparam *tp; 564445d9abdbSWeongyo Jeong struct ieee80211vap *vap = ni->ni_vap; 56457a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 564645d9abdbSWeongyo Jeong struct mbuf *mprot; 564745d9abdbSWeongyo Jeong unsigned int len; 564845d9abdbSWeongyo Jeong uint32_t macctl = 0; 564945d9abdbSWeongyo Jeong int protdur, rts_rate, rts_rate_fb, ismcast, isshort, rix, type; 565045d9abdbSWeongyo Jeong uint16_t phyctl = 0; 565145d9abdbSWeongyo Jeong uint8_t rate, rate_fb; 565245d9abdbSWeongyo Jeong 565345d9abdbSWeongyo Jeong wh = mtod(m, struct ieee80211_frame *); 565445d9abdbSWeongyo Jeong memset(txhdr, 0, sizeof(*txhdr)); 565545d9abdbSWeongyo Jeong 565645d9abdbSWeongyo Jeong type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 565745d9abdbSWeongyo Jeong ismcast = IEEE80211_IS_MULTICAST(wh->i_addr1); 565845d9abdbSWeongyo Jeong isshort = (ic->ic_flags & IEEE80211_F_SHPREAMBLE) != 0; 565945d9abdbSWeongyo Jeong 566045d9abdbSWeongyo Jeong /* 566145d9abdbSWeongyo Jeong * Find TX rate 566245d9abdbSWeongyo Jeong */ 566345d9abdbSWeongyo Jeong tp = &vap->iv_txparms[ieee80211_chan2mode(ic->ic_curchan)]; 566445d9abdbSWeongyo Jeong if (type != IEEE80211_FC0_TYPE_DATA || (m->m_flags & M_EAPOL)) 566545d9abdbSWeongyo Jeong rate = rate_fb = tp->mgmtrate; 566645d9abdbSWeongyo Jeong else if (ismcast) 566745d9abdbSWeongyo Jeong rate = rate_fb = tp->mcastrate; 566845d9abdbSWeongyo Jeong else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) 566945d9abdbSWeongyo Jeong rate = rate_fb = tp->ucastrate; 567045d9abdbSWeongyo Jeong else { 5671b6108616SRui Paulo rix = ieee80211_ratectl_rate(ni, NULL, 0); 567245d9abdbSWeongyo Jeong rate = ni->ni_txrate; 567345d9abdbSWeongyo Jeong 567445d9abdbSWeongyo Jeong if (rix > 0) 567545d9abdbSWeongyo Jeong rate_fb = ni->ni_rates.rs_rates[rix - 1] & 567645d9abdbSWeongyo Jeong IEEE80211_RATE_VAL; 567745d9abdbSWeongyo Jeong else 567845d9abdbSWeongyo Jeong rate_fb = rate; 567945d9abdbSWeongyo Jeong } 568045d9abdbSWeongyo Jeong 568145d9abdbSWeongyo Jeong sc->sc_tx_rate = rate; 568245d9abdbSWeongyo Jeong 568345d9abdbSWeongyo Jeong rate = bwn_ieeerate2hwrate(sc, rate); 568445d9abdbSWeongyo Jeong rate_fb = bwn_ieeerate2hwrate(sc, rate_fb); 568545d9abdbSWeongyo Jeong 568645d9abdbSWeongyo Jeong txhdr->phyrate = (BWN_ISOFDMRATE(rate)) ? bwn_plcp_getofdm(rate) : 568745d9abdbSWeongyo Jeong bwn_plcp_getcck(rate); 568845d9abdbSWeongyo Jeong bcopy(wh->i_fc, txhdr->macfc, sizeof(txhdr->macfc)); 568945d9abdbSWeongyo Jeong bcopy(wh->i_addr1, txhdr->addr1, IEEE80211_ADDR_LEN); 569045d9abdbSWeongyo Jeong 569145d9abdbSWeongyo Jeong if ((rate_fb == rate) || 569245d9abdbSWeongyo Jeong (*(u_int16_t *)wh->i_dur & htole16(0x8000)) || 569345d9abdbSWeongyo Jeong (*(u_int16_t *)wh->i_dur == htole16(0))) 569445d9abdbSWeongyo Jeong txhdr->dur_fb = *(u_int16_t *)wh->i_dur; 569545d9abdbSWeongyo Jeong else 569645d9abdbSWeongyo Jeong txhdr->dur_fb = ieee80211_compute_duration(ic->ic_rt, 569745d9abdbSWeongyo Jeong m->m_pkthdr.len, rate, isshort); 569845d9abdbSWeongyo Jeong 569945d9abdbSWeongyo Jeong /* XXX TX encryption */ 570045d9abdbSWeongyo Jeong bwn_plcp_genhdr(BWN_ISOLDFMT(mac) ? 570145d9abdbSWeongyo Jeong (struct bwn_plcp4 *)(&txhdr->body.old.plcp) : 570245d9abdbSWeongyo Jeong (struct bwn_plcp4 *)(&txhdr->body.new.plcp), 570345d9abdbSWeongyo Jeong m->m_pkthdr.len + IEEE80211_CRC_LEN, rate); 570445d9abdbSWeongyo Jeong bwn_plcp_genhdr((struct bwn_plcp4 *)(&txhdr->plcp_fb), 570545d9abdbSWeongyo Jeong m->m_pkthdr.len + IEEE80211_CRC_LEN, rate_fb); 570645d9abdbSWeongyo Jeong 570745d9abdbSWeongyo Jeong txhdr->eftypes |= (BWN_ISOFDMRATE(rate_fb)) ? BWN_TX_EFT_FB_OFDM : 570845d9abdbSWeongyo Jeong BWN_TX_EFT_FB_CCK; 570945d9abdbSWeongyo Jeong txhdr->chan = phy->chan; 571045d9abdbSWeongyo Jeong phyctl |= (BWN_ISOFDMRATE(rate)) ? BWN_TX_PHY_ENC_OFDM : 571145d9abdbSWeongyo Jeong BWN_TX_PHY_ENC_CCK; 571245d9abdbSWeongyo Jeong if (isshort && (rate == BWN_CCK_RATE_2MB || rate == BWN_CCK_RATE_5MB || 571345d9abdbSWeongyo Jeong rate == BWN_CCK_RATE_11MB)) 571445d9abdbSWeongyo Jeong phyctl |= BWN_TX_PHY_SHORTPRMBL; 571545d9abdbSWeongyo Jeong 571645d9abdbSWeongyo Jeong /* XXX TX antenna selection */ 571745d9abdbSWeongyo Jeong 571845d9abdbSWeongyo Jeong switch (bwn_antenna_sanitize(mac, 0)) { 571945d9abdbSWeongyo Jeong case 0: 572045d9abdbSWeongyo Jeong phyctl |= BWN_TX_PHY_ANT01AUTO; 572145d9abdbSWeongyo Jeong break; 572245d9abdbSWeongyo Jeong case 1: 572345d9abdbSWeongyo Jeong phyctl |= BWN_TX_PHY_ANT0; 572445d9abdbSWeongyo Jeong break; 572545d9abdbSWeongyo Jeong case 2: 572645d9abdbSWeongyo Jeong phyctl |= BWN_TX_PHY_ANT1; 572745d9abdbSWeongyo Jeong break; 572845d9abdbSWeongyo Jeong case 3: 572945d9abdbSWeongyo Jeong phyctl |= BWN_TX_PHY_ANT2; 573045d9abdbSWeongyo Jeong break; 573145d9abdbSWeongyo Jeong case 4: 573245d9abdbSWeongyo Jeong phyctl |= BWN_TX_PHY_ANT3; 573345d9abdbSWeongyo Jeong break; 573445d9abdbSWeongyo Jeong default: 573545d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 573645d9abdbSWeongyo Jeong } 573745d9abdbSWeongyo Jeong 573845d9abdbSWeongyo Jeong if (!ismcast) 573945d9abdbSWeongyo Jeong macctl |= BWN_TX_MAC_ACK; 574045d9abdbSWeongyo Jeong 574145d9abdbSWeongyo Jeong macctl |= (BWN_TX_MAC_HWSEQ | BWN_TX_MAC_START_MSDU); 574245d9abdbSWeongyo Jeong if (!IEEE80211_IS_MULTICAST(wh->i_addr1) && 574345d9abdbSWeongyo Jeong m->m_pkthdr.len + IEEE80211_CRC_LEN > vap->iv_rtsthreshold) 574445d9abdbSWeongyo Jeong macctl |= BWN_TX_MAC_LONGFRAME; 574545d9abdbSWeongyo Jeong 574645d9abdbSWeongyo Jeong if (ic->ic_flags & IEEE80211_F_USEPROT) { 574745d9abdbSWeongyo Jeong /* XXX RTS rate is always 1MB??? */ 574845d9abdbSWeongyo Jeong rts_rate = BWN_CCK_RATE_1MB; 574945d9abdbSWeongyo Jeong rts_rate_fb = bwn_get_fbrate(rts_rate); 575045d9abdbSWeongyo Jeong 575145d9abdbSWeongyo Jeong protdur = ieee80211_compute_duration(ic->ic_rt, 575245d9abdbSWeongyo Jeong m->m_pkthdr.len, rate, isshort) + 575345d9abdbSWeongyo Jeong + ieee80211_ack_duration(ic->ic_rt, rate, isshort); 575445d9abdbSWeongyo Jeong 575545d9abdbSWeongyo Jeong if (ic->ic_protmode == IEEE80211_PROT_CTSONLY) { 575645d9abdbSWeongyo Jeong cts = (struct ieee80211_frame_cts *)(BWN_ISOLDFMT(mac) ? 575745d9abdbSWeongyo Jeong (txhdr->body.old.rts_frame) : 575845d9abdbSWeongyo Jeong (txhdr->body.new.rts_frame)); 575945d9abdbSWeongyo Jeong mprot = ieee80211_alloc_cts(ic, ni->ni_vap->iv_myaddr, 576045d9abdbSWeongyo Jeong protdur); 576145d9abdbSWeongyo Jeong KASSERT(mprot != NULL, ("failed to alloc mbuf\n")); 576245d9abdbSWeongyo Jeong bcopy(mtod(mprot, uint8_t *), (uint8_t *)cts, 576345d9abdbSWeongyo Jeong mprot->m_pkthdr.len); 576445d9abdbSWeongyo Jeong m_freem(mprot); 576545d9abdbSWeongyo Jeong macctl |= BWN_TX_MAC_SEND_CTSTOSELF; 576645d9abdbSWeongyo Jeong len = sizeof(struct ieee80211_frame_cts); 576745d9abdbSWeongyo Jeong } else { 576845d9abdbSWeongyo Jeong rts = (struct ieee80211_frame_rts *)(BWN_ISOLDFMT(mac) ? 576945d9abdbSWeongyo Jeong (txhdr->body.old.rts_frame) : 577045d9abdbSWeongyo Jeong (txhdr->body.new.rts_frame)); 577145d9abdbSWeongyo Jeong protdur += ieee80211_ack_duration(ic->ic_rt, rate, 577245d9abdbSWeongyo Jeong isshort); 577345d9abdbSWeongyo Jeong mprot = ieee80211_alloc_rts(ic, wh->i_addr1, 577445d9abdbSWeongyo Jeong wh->i_addr2, protdur); 577545d9abdbSWeongyo Jeong KASSERT(mprot != NULL, ("failed to alloc mbuf\n")); 577645d9abdbSWeongyo Jeong bcopy(mtod(mprot, uint8_t *), (uint8_t *)rts, 577745d9abdbSWeongyo Jeong mprot->m_pkthdr.len); 577845d9abdbSWeongyo Jeong m_freem(mprot); 577945d9abdbSWeongyo Jeong macctl |= BWN_TX_MAC_SEND_RTSCTS; 578045d9abdbSWeongyo Jeong len = sizeof(struct ieee80211_frame_rts); 578145d9abdbSWeongyo Jeong } 578245d9abdbSWeongyo Jeong len += IEEE80211_CRC_LEN; 578345d9abdbSWeongyo Jeong bwn_plcp_genhdr((struct bwn_plcp4 *)((BWN_ISOLDFMT(mac)) ? 578445d9abdbSWeongyo Jeong &txhdr->body.old.rts_plcp : 578545d9abdbSWeongyo Jeong &txhdr->body.new.rts_plcp), len, rts_rate); 578645d9abdbSWeongyo Jeong bwn_plcp_genhdr((struct bwn_plcp4 *)&txhdr->rts_plcp_fb, len, 578745d9abdbSWeongyo Jeong rts_rate_fb); 578845d9abdbSWeongyo Jeong 578945d9abdbSWeongyo Jeong protwh = (struct ieee80211_frame *)(BWN_ISOLDFMT(mac) ? 579045d9abdbSWeongyo Jeong (&txhdr->body.old.rts_frame) : 579145d9abdbSWeongyo Jeong (&txhdr->body.new.rts_frame)); 579245d9abdbSWeongyo Jeong txhdr->rts_dur_fb = *(u_int16_t *)protwh->i_dur; 579345d9abdbSWeongyo Jeong 579445d9abdbSWeongyo Jeong if (BWN_ISOFDMRATE(rts_rate)) { 579545d9abdbSWeongyo Jeong txhdr->eftypes |= BWN_TX_EFT_RTS_OFDM; 579645d9abdbSWeongyo Jeong txhdr->phyrate_rts = bwn_plcp_getofdm(rts_rate); 579745d9abdbSWeongyo Jeong } else { 579845d9abdbSWeongyo Jeong txhdr->eftypes |= BWN_TX_EFT_RTS_CCK; 579945d9abdbSWeongyo Jeong txhdr->phyrate_rts = bwn_plcp_getcck(rts_rate); 580045d9abdbSWeongyo Jeong } 580145d9abdbSWeongyo Jeong txhdr->eftypes |= (BWN_ISOFDMRATE(rts_rate_fb)) ? 580245d9abdbSWeongyo Jeong BWN_TX_EFT_RTS_FBOFDM : BWN_TX_EFT_RTS_FBCCK; 580345d9abdbSWeongyo Jeong } 580445d9abdbSWeongyo Jeong 580545d9abdbSWeongyo Jeong if (BWN_ISOLDFMT(mac)) 580645d9abdbSWeongyo Jeong txhdr->body.old.cookie = htole16(cookie); 580745d9abdbSWeongyo Jeong else 580845d9abdbSWeongyo Jeong txhdr->body.new.cookie = htole16(cookie); 580945d9abdbSWeongyo Jeong 581045d9abdbSWeongyo Jeong txhdr->macctl = htole32(macctl); 581145d9abdbSWeongyo Jeong txhdr->phyctl = htole16(phyctl); 581245d9abdbSWeongyo Jeong 581345d9abdbSWeongyo Jeong /* 581445d9abdbSWeongyo Jeong * TX radio tap 581545d9abdbSWeongyo Jeong */ 581645d9abdbSWeongyo Jeong if (ieee80211_radiotap_active_vap(vap)) { 581745d9abdbSWeongyo Jeong sc->sc_tx_th.wt_flags = 0; 58185945b5f5SKevin Lo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) 581945d9abdbSWeongyo Jeong sc->sc_tx_th.wt_flags |= IEEE80211_RADIOTAP_F_WEP; 582045d9abdbSWeongyo Jeong if (isshort && 582145d9abdbSWeongyo Jeong (rate == BWN_CCK_RATE_2MB || rate == BWN_CCK_RATE_5MB || 582245d9abdbSWeongyo Jeong rate == BWN_CCK_RATE_11MB)) 582345d9abdbSWeongyo Jeong sc->sc_tx_th.wt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE; 582445d9abdbSWeongyo Jeong sc->sc_tx_th.wt_rate = rate; 582545d9abdbSWeongyo Jeong 582645d9abdbSWeongyo Jeong ieee80211_radiotap_tx(vap, m); 582745d9abdbSWeongyo Jeong } 582845d9abdbSWeongyo Jeong 582945d9abdbSWeongyo Jeong return (0); 583045d9abdbSWeongyo Jeong } 583145d9abdbSWeongyo Jeong 583245d9abdbSWeongyo Jeong static void 583345d9abdbSWeongyo Jeong bwn_plcp_genhdr(struct bwn_plcp4 *plcp, const uint16_t octets, 583445d9abdbSWeongyo Jeong const uint8_t rate) 583545d9abdbSWeongyo Jeong { 583645d9abdbSWeongyo Jeong uint32_t d, plen; 583745d9abdbSWeongyo Jeong uint8_t *raw = plcp->o.raw; 583845d9abdbSWeongyo Jeong 583945d9abdbSWeongyo Jeong if (BWN_ISOFDMRATE(rate)) { 584045d9abdbSWeongyo Jeong d = bwn_plcp_getofdm(rate); 584145d9abdbSWeongyo Jeong KASSERT(!(octets & 0xf000), 584245d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 584345d9abdbSWeongyo Jeong d |= (octets << 5); 584445d9abdbSWeongyo Jeong plcp->o.data = htole32(d); 584545d9abdbSWeongyo Jeong } else { 584645d9abdbSWeongyo Jeong plen = octets * 16 / rate; 584745d9abdbSWeongyo Jeong if ((octets * 16 % rate) > 0) { 584845d9abdbSWeongyo Jeong plen++; 584945d9abdbSWeongyo Jeong if ((rate == BWN_CCK_RATE_11MB) 585045d9abdbSWeongyo Jeong && ((octets * 8 % 11) < 4)) { 585145d9abdbSWeongyo Jeong raw[1] = 0x84; 585245d9abdbSWeongyo Jeong } else 585345d9abdbSWeongyo Jeong raw[1] = 0x04; 585445d9abdbSWeongyo Jeong } else 585545d9abdbSWeongyo Jeong raw[1] = 0x04; 585645d9abdbSWeongyo Jeong plcp->o.data |= htole32(plen << 16); 585745d9abdbSWeongyo Jeong raw[0] = bwn_plcp_getcck(rate); 585845d9abdbSWeongyo Jeong } 585945d9abdbSWeongyo Jeong } 586045d9abdbSWeongyo Jeong 586145d9abdbSWeongyo Jeong static uint8_t 586245d9abdbSWeongyo Jeong bwn_antenna_sanitize(struct bwn_mac *mac, uint8_t n) 586345d9abdbSWeongyo Jeong { 5864b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 586545d9abdbSWeongyo Jeong uint8_t mask; 586645d9abdbSWeongyo Jeong 586745d9abdbSWeongyo Jeong if (n == 0) 586845d9abdbSWeongyo Jeong return (0); 586945d9abdbSWeongyo Jeong if (mac->mac_phy.gmode) 5870b9b64aa5SWeongyo Jeong mask = siba_sprom_get_ant_bg(sc->sc_dev); 587145d9abdbSWeongyo Jeong else 5872b9b64aa5SWeongyo Jeong mask = siba_sprom_get_ant_a(sc->sc_dev); 587345d9abdbSWeongyo Jeong if (!(mask & (1 << (n - 1)))) 587445d9abdbSWeongyo Jeong return (0); 587545d9abdbSWeongyo Jeong return (n); 587645d9abdbSWeongyo Jeong } 587745d9abdbSWeongyo Jeong 587845d9abdbSWeongyo Jeong static uint8_t 587945d9abdbSWeongyo Jeong bwn_get_fbrate(uint8_t bitrate) 588045d9abdbSWeongyo Jeong { 588145d9abdbSWeongyo Jeong switch (bitrate) { 588245d9abdbSWeongyo Jeong case BWN_CCK_RATE_1MB: 588345d9abdbSWeongyo Jeong return (BWN_CCK_RATE_1MB); 588445d9abdbSWeongyo Jeong case BWN_CCK_RATE_2MB: 588545d9abdbSWeongyo Jeong return (BWN_CCK_RATE_1MB); 588645d9abdbSWeongyo Jeong case BWN_CCK_RATE_5MB: 588745d9abdbSWeongyo Jeong return (BWN_CCK_RATE_2MB); 588845d9abdbSWeongyo Jeong case BWN_CCK_RATE_11MB: 588945d9abdbSWeongyo Jeong return (BWN_CCK_RATE_5MB); 589045d9abdbSWeongyo Jeong case BWN_OFDM_RATE_6MB: 589145d9abdbSWeongyo Jeong return (BWN_CCK_RATE_5MB); 589245d9abdbSWeongyo Jeong case BWN_OFDM_RATE_9MB: 589345d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_6MB); 589445d9abdbSWeongyo Jeong case BWN_OFDM_RATE_12MB: 589545d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_9MB); 589645d9abdbSWeongyo Jeong case BWN_OFDM_RATE_18MB: 589745d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_12MB); 589845d9abdbSWeongyo Jeong case BWN_OFDM_RATE_24MB: 589945d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_18MB); 590045d9abdbSWeongyo Jeong case BWN_OFDM_RATE_36MB: 590145d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_24MB); 590245d9abdbSWeongyo Jeong case BWN_OFDM_RATE_48MB: 590345d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_36MB); 590445d9abdbSWeongyo Jeong case BWN_OFDM_RATE_54MB: 590545d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_48MB); 590645d9abdbSWeongyo Jeong } 590745d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 590845d9abdbSWeongyo Jeong return (0); 590945d9abdbSWeongyo Jeong } 591045d9abdbSWeongyo Jeong 591145d9abdbSWeongyo Jeong static uint32_t 591245d9abdbSWeongyo Jeong bwn_pio_write_multi_4(struct bwn_mac *mac, struct bwn_pio_txqueue *tq, 591345d9abdbSWeongyo Jeong uint32_t ctl, const void *_data, int len) 591445d9abdbSWeongyo Jeong { 5915b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 591645d9abdbSWeongyo Jeong uint32_t value = 0; 591745d9abdbSWeongyo Jeong const uint8_t *data = _data; 591845d9abdbSWeongyo Jeong 591945d9abdbSWeongyo Jeong ctl |= BWN_PIO8_TXCTL_0_7 | BWN_PIO8_TXCTL_8_15 | 592045d9abdbSWeongyo Jeong BWN_PIO8_TXCTL_16_23 | BWN_PIO8_TXCTL_24_31; 592145d9abdbSWeongyo Jeong bwn_pio_write_4(mac, tq, BWN_PIO8_TXCTL, ctl); 592245d9abdbSWeongyo Jeong 5923b9b64aa5SWeongyo Jeong siba_write_multi_4(sc->sc_dev, data, (len & ~3), 592445d9abdbSWeongyo Jeong tq->tq_base + BWN_PIO8_TXDATA); 592545d9abdbSWeongyo Jeong if (len & 3) { 592645d9abdbSWeongyo Jeong ctl &= ~(BWN_PIO8_TXCTL_8_15 | BWN_PIO8_TXCTL_16_23 | 592745d9abdbSWeongyo Jeong BWN_PIO8_TXCTL_24_31); 592845d9abdbSWeongyo Jeong data = &(data[len - 1]); 592945d9abdbSWeongyo Jeong switch (len & 3) { 593045d9abdbSWeongyo Jeong case 3: 593145d9abdbSWeongyo Jeong ctl |= BWN_PIO8_TXCTL_16_23; 593245d9abdbSWeongyo Jeong value |= (uint32_t)(*data) << 16; 593345d9abdbSWeongyo Jeong data--; 593445d9abdbSWeongyo Jeong case 2: 593545d9abdbSWeongyo Jeong ctl |= BWN_PIO8_TXCTL_8_15; 593645d9abdbSWeongyo Jeong value |= (uint32_t)(*data) << 8; 593745d9abdbSWeongyo Jeong data--; 593845d9abdbSWeongyo Jeong case 1: 593945d9abdbSWeongyo Jeong value |= (uint32_t)(*data); 594045d9abdbSWeongyo Jeong } 594145d9abdbSWeongyo Jeong bwn_pio_write_4(mac, tq, BWN_PIO8_TXCTL, ctl); 594245d9abdbSWeongyo Jeong bwn_pio_write_4(mac, tq, BWN_PIO8_TXDATA, value); 594345d9abdbSWeongyo Jeong } 594445d9abdbSWeongyo Jeong 594545d9abdbSWeongyo Jeong return (ctl); 594645d9abdbSWeongyo Jeong } 594745d9abdbSWeongyo Jeong 594845d9abdbSWeongyo Jeong static void 594945d9abdbSWeongyo Jeong bwn_pio_write_4(struct bwn_mac *mac, struct bwn_pio_txqueue *tq, 595045d9abdbSWeongyo Jeong uint16_t offset, uint32_t value) 595145d9abdbSWeongyo Jeong { 595245d9abdbSWeongyo Jeong 595345d9abdbSWeongyo Jeong BWN_WRITE_4(mac, tq->tq_base + offset, value); 595445d9abdbSWeongyo Jeong } 595545d9abdbSWeongyo Jeong 595645d9abdbSWeongyo Jeong static uint16_t 595745d9abdbSWeongyo Jeong bwn_pio_write_multi_2(struct bwn_mac *mac, struct bwn_pio_txqueue *tq, 595845d9abdbSWeongyo Jeong uint16_t ctl, const void *_data, int len) 595945d9abdbSWeongyo Jeong { 5960b9b64aa5SWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 596145d9abdbSWeongyo Jeong const uint8_t *data = _data; 596245d9abdbSWeongyo Jeong 596345d9abdbSWeongyo Jeong ctl |= BWN_PIO_TXCTL_WRITELO | BWN_PIO_TXCTL_WRITEHI; 596445d9abdbSWeongyo Jeong BWN_PIO_WRITE_2(mac, tq, BWN_PIO_TXCTL, ctl); 596545d9abdbSWeongyo Jeong 5966b9b64aa5SWeongyo Jeong siba_write_multi_2(sc->sc_dev, data, (len & ~1), 596745d9abdbSWeongyo Jeong tq->tq_base + BWN_PIO_TXDATA); 596845d9abdbSWeongyo Jeong if (len & 1) { 596945d9abdbSWeongyo Jeong ctl &= ~BWN_PIO_TXCTL_WRITEHI; 597045d9abdbSWeongyo Jeong BWN_PIO_WRITE_2(mac, tq, BWN_PIO_TXCTL, ctl); 597145d9abdbSWeongyo Jeong BWN_PIO_WRITE_2(mac, tq, BWN_PIO_TXDATA, data[len - 1]); 597245d9abdbSWeongyo Jeong } 597345d9abdbSWeongyo Jeong 597445d9abdbSWeongyo Jeong return (ctl); 597545d9abdbSWeongyo Jeong } 597645d9abdbSWeongyo Jeong 597745d9abdbSWeongyo Jeong static uint16_t 597845d9abdbSWeongyo Jeong bwn_pio_write_mbuf_2(struct bwn_mac *mac, struct bwn_pio_txqueue *tq, 597945d9abdbSWeongyo Jeong uint16_t ctl, struct mbuf *m0) 598045d9abdbSWeongyo Jeong { 598145d9abdbSWeongyo Jeong int i, j = 0; 598245d9abdbSWeongyo Jeong uint16_t data = 0; 598345d9abdbSWeongyo Jeong const uint8_t *buf; 598445d9abdbSWeongyo Jeong struct mbuf *m = m0; 598545d9abdbSWeongyo Jeong 598645d9abdbSWeongyo Jeong ctl |= BWN_PIO_TXCTL_WRITELO | BWN_PIO_TXCTL_WRITEHI; 598745d9abdbSWeongyo Jeong BWN_PIO_WRITE_2(mac, tq, BWN_PIO_TXCTL, ctl); 598845d9abdbSWeongyo Jeong 598945d9abdbSWeongyo Jeong for (; m != NULL; m = m->m_next) { 599045d9abdbSWeongyo Jeong buf = mtod(m, const uint8_t *); 599145d9abdbSWeongyo Jeong for (i = 0; i < m->m_len; i++) { 599245d9abdbSWeongyo Jeong if (!((j++) % 2)) 599345d9abdbSWeongyo Jeong data |= buf[i]; 599445d9abdbSWeongyo Jeong else { 599545d9abdbSWeongyo Jeong data |= (buf[i] << 8); 599645d9abdbSWeongyo Jeong BWN_PIO_WRITE_2(mac, tq, BWN_PIO_TXDATA, data); 599745d9abdbSWeongyo Jeong data = 0; 599845d9abdbSWeongyo Jeong } 599945d9abdbSWeongyo Jeong } 600045d9abdbSWeongyo Jeong } 600145d9abdbSWeongyo Jeong if (m0->m_pkthdr.len % 2) { 600245d9abdbSWeongyo Jeong ctl &= ~BWN_PIO_TXCTL_WRITEHI; 600345d9abdbSWeongyo Jeong BWN_PIO_WRITE_2(mac, tq, BWN_PIO_TXCTL, ctl); 600445d9abdbSWeongyo Jeong BWN_PIO_WRITE_2(mac, tq, BWN_PIO_TXDATA, data); 600545d9abdbSWeongyo Jeong } 600645d9abdbSWeongyo Jeong 600745d9abdbSWeongyo Jeong return (ctl); 600845d9abdbSWeongyo Jeong } 600945d9abdbSWeongyo Jeong 601045d9abdbSWeongyo Jeong static void 601145d9abdbSWeongyo Jeong bwn_set_slot_time(struct bwn_mac *mac, uint16_t time) 601245d9abdbSWeongyo Jeong { 601345d9abdbSWeongyo Jeong 601445d9abdbSWeongyo Jeong if (mac->mac_phy.type != BWN_PHYTYPE_G) 601545d9abdbSWeongyo Jeong return; 601645d9abdbSWeongyo Jeong BWN_WRITE_2(mac, 0x684, 510 + time); 601745d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SHARED, 0x0010, time); 601845d9abdbSWeongyo Jeong } 601945d9abdbSWeongyo Jeong 602045d9abdbSWeongyo Jeong static struct bwn_dma_ring * 602145d9abdbSWeongyo Jeong bwn_dma_select(struct bwn_mac *mac, uint8_t prio) 602245d9abdbSWeongyo Jeong { 602345d9abdbSWeongyo Jeong 602445d9abdbSWeongyo Jeong if ((mac->mac_flags & BWN_MAC_FLAG_WME) == 0) 602545d9abdbSWeongyo Jeong return (mac->mac_method.dma.wme[WME_AC_BE]); 602645d9abdbSWeongyo Jeong 602745d9abdbSWeongyo Jeong switch (prio) { 602845d9abdbSWeongyo Jeong case 3: 602945d9abdbSWeongyo Jeong return (mac->mac_method.dma.wme[WME_AC_VO]); 603045d9abdbSWeongyo Jeong case 2: 603145d9abdbSWeongyo Jeong return (mac->mac_method.dma.wme[WME_AC_VI]); 603245d9abdbSWeongyo Jeong case 0: 603345d9abdbSWeongyo Jeong return (mac->mac_method.dma.wme[WME_AC_BE]); 603445d9abdbSWeongyo Jeong case 1: 603545d9abdbSWeongyo Jeong return (mac->mac_method.dma.wme[WME_AC_BK]); 603645d9abdbSWeongyo Jeong } 603745d9abdbSWeongyo Jeong KASSERT(0 == 1, ("%s:%d: fail", __func__, __LINE__)); 60380d05eee2SWarner Losh return (NULL); 603945d9abdbSWeongyo Jeong } 604045d9abdbSWeongyo Jeong 604145d9abdbSWeongyo Jeong static int 604245d9abdbSWeongyo Jeong bwn_dma_getslot(struct bwn_dma_ring *dr) 604345d9abdbSWeongyo Jeong { 604445d9abdbSWeongyo Jeong int slot; 604545d9abdbSWeongyo Jeong 60460d05eee2SWarner Losh BWN_ASSERT_LOCKED(dr->dr_mac->mac_sc); 604745d9abdbSWeongyo Jeong 604845d9abdbSWeongyo Jeong KASSERT(dr->dr_tx, ("%s:%d: fail", __func__, __LINE__)); 604945d9abdbSWeongyo Jeong KASSERT(!(dr->dr_stop), ("%s:%d: fail", __func__, __LINE__)); 605045d9abdbSWeongyo Jeong KASSERT(bwn_dma_freeslot(dr) != 0, ("%s:%d: fail", __func__, __LINE__)); 605145d9abdbSWeongyo Jeong 605245d9abdbSWeongyo Jeong slot = bwn_dma_nextslot(dr, dr->dr_curslot); 605345d9abdbSWeongyo Jeong KASSERT(!(slot & ~0x0fff), ("%s:%d: fail", __func__, __LINE__)); 605445d9abdbSWeongyo Jeong dr->dr_curslot = slot; 605545d9abdbSWeongyo Jeong dr->dr_usedslot++; 605645d9abdbSWeongyo Jeong 605745d9abdbSWeongyo Jeong return (slot); 605845d9abdbSWeongyo Jeong } 605945d9abdbSWeongyo Jeong 606045d9abdbSWeongyo Jeong static struct bwn_pio_txqueue * 606145d9abdbSWeongyo Jeong bwn_pio_parse_cookie(struct bwn_mac *mac, uint16_t cookie, 606245d9abdbSWeongyo Jeong struct bwn_pio_txpkt **pack) 606345d9abdbSWeongyo Jeong { 606445d9abdbSWeongyo Jeong struct bwn_pio *pio = &mac->mac_method.pio; 606545d9abdbSWeongyo Jeong struct bwn_pio_txqueue *tq = NULL; 606645d9abdbSWeongyo Jeong unsigned int index; 606745d9abdbSWeongyo Jeong 606845d9abdbSWeongyo Jeong switch (cookie & 0xf000) { 606945d9abdbSWeongyo Jeong case 0x1000: 607045d9abdbSWeongyo Jeong tq = &pio->wme[WME_AC_BK]; 607145d9abdbSWeongyo Jeong break; 607245d9abdbSWeongyo Jeong case 0x2000: 607345d9abdbSWeongyo Jeong tq = &pio->wme[WME_AC_BE]; 607445d9abdbSWeongyo Jeong break; 607545d9abdbSWeongyo Jeong case 0x3000: 607645d9abdbSWeongyo Jeong tq = &pio->wme[WME_AC_VI]; 607745d9abdbSWeongyo Jeong break; 607845d9abdbSWeongyo Jeong case 0x4000: 607945d9abdbSWeongyo Jeong tq = &pio->wme[WME_AC_VO]; 608045d9abdbSWeongyo Jeong break; 608145d9abdbSWeongyo Jeong case 0x5000: 608245d9abdbSWeongyo Jeong tq = &pio->mcast; 608345d9abdbSWeongyo Jeong break; 608445d9abdbSWeongyo Jeong } 608545d9abdbSWeongyo Jeong KASSERT(tq != NULL, ("%s:%d: fail", __func__, __LINE__)); 608645d9abdbSWeongyo Jeong if (tq == NULL) 608745d9abdbSWeongyo Jeong return (NULL); 608845d9abdbSWeongyo Jeong index = (cookie & 0x0fff); 608945d9abdbSWeongyo Jeong KASSERT(index < N(tq->tq_pkts), ("%s:%d: fail", __func__, __LINE__)); 609045d9abdbSWeongyo Jeong if (index >= N(tq->tq_pkts)) 609145d9abdbSWeongyo Jeong return (NULL); 609245d9abdbSWeongyo Jeong *pack = &tq->tq_pkts[index]; 609345d9abdbSWeongyo Jeong KASSERT(*pack != NULL, ("%s:%d: fail", __func__, __LINE__)); 609445d9abdbSWeongyo Jeong return (tq); 609545d9abdbSWeongyo Jeong } 609645d9abdbSWeongyo Jeong 609745d9abdbSWeongyo Jeong static void 609845d9abdbSWeongyo Jeong bwn_txpwr(void *arg, int npending) 609945d9abdbSWeongyo Jeong { 610045d9abdbSWeongyo Jeong struct bwn_mac *mac = arg; 610145d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 610245d9abdbSWeongyo Jeong 610345d9abdbSWeongyo Jeong BWN_LOCK(sc); 610445d9abdbSWeongyo Jeong if (mac && mac->mac_status >= BWN_MAC_STATUS_STARTED && 610545d9abdbSWeongyo Jeong mac->mac_phy.set_txpwr != NULL) 610645d9abdbSWeongyo Jeong mac->mac_phy.set_txpwr(mac); 610745d9abdbSWeongyo Jeong BWN_UNLOCK(sc); 610845d9abdbSWeongyo Jeong } 610945d9abdbSWeongyo Jeong 611045d9abdbSWeongyo Jeong static void 611145d9abdbSWeongyo Jeong bwn_task_15s(struct bwn_mac *mac) 611245d9abdbSWeongyo Jeong { 611345d9abdbSWeongyo Jeong uint16_t reg; 611445d9abdbSWeongyo Jeong 611545d9abdbSWeongyo Jeong if (mac->mac_fw.opensource) { 611645d9abdbSWeongyo Jeong reg = bwn_shm_read_2(mac, BWN_SCRATCH, BWN_WATCHDOG_REG); 611745d9abdbSWeongyo Jeong if (reg) { 611845d9abdbSWeongyo Jeong bwn_restart(mac, "fw watchdog"); 611945d9abdbSWeongyo Jeong return; 612045d9abdbSWeongyo Jeong } 612145d9abdbSWeongyo Jeong bwn_shm_write_2(mac, BWN_SCRATCH, BWN_WATCHDOG_REG, 1); 612245d9abdbSWeongyo Jeong } 612345d9abdbSWeongyo Jeong if (mac->mac_phy.task_15s) 612445d9abdbSWeongyo Jeong mac->mac_phy.task_15s(mac); 612545d9abdbSWeongyo Jeong 612645d9abdbSWeongyo Jeong mac->mac_phy.txerrors = BWN_TXERROR_MAX; 612745d9abdbSWeongyo Jeong } 612845d9abdbSWeongyo Jeong 612945d9abdbSWeongyo Jeong static void 613045d9abdbSWeongyo Jeong bwn_task_30s(struct bwn_mac *mac) 613145d9abdbSWeongyo Jeong { 613245d9abdbSWeongyo Jeong 613345d9abdbSWeongyo Jeong if (mac->mac_phy.type != BWN_PHYTYPE_G || mac->mac_noise.noi_running) 613445d9abdbSWeongyo Jeong return; 613545d9abdbSWeongyo Jeong mac->mac_noise.noi_running = 1; 613645d9abdbSWeongyo Jeong mac->mac_noise.noi_nsamples = 0; 613745d9abdbSWeongyo Jeong 613845d9abdbSWeongyo Jeong bwn_noise_gensample(mac); 613945d9abdbSWeongyo Jeong } 614045d9abdbSWeongyo Jeong 614145d9abdbSWeongyo Jeong static void 614245d9abdbSWeongyo Jeong bwn_task_60s(struct bwn_mac *mac) 614345d9abdbSWeongyo Jeong { 614445d9abdbSWeongyo Jeong 614545d9abdbSWeongyo Jeong if (mac->mac_phy.task_60s) 614645d9abdbSWeongyo Jeong mac->mac_phy.task_60s(mac); 614745d9abdbSWeongyo Jeong bwn_phy_txpower_check(mac, BWN_TXPWR_IGNORE_TIME); 614845d9abdbSWeongyo Jeong } 614945d9abdbSWeongyo Jeong 615045d9abdbSWeongyo Jeong static void 615145d9abdbSWeongyo Jeong bwn_tasks(void *arg) 615245d9abdbSWeongyo Jeong { 615345d9abdbSWeongyo Jeong struct bwn_mac *mac = arg; 615445d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 615545d9abdbSWeongyo Jeong 615645d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(sc); 615745d9abdbSWeongyo Jeong if (mac->mac_status != BWN_MAC_STATUS_STARTED) 615845d9abdbSWeongyo Jeong return; 615945d9abdbSWeongyo Jeong 616045d9abdbSWeongyo Jeong if (mac->mac_task_state % 4 == 0) 616145d9abdbSWeongyo Jeong bwn_task_60s(mac); 616245d9abdbSWeongyo Jeong if (mac->mac_task_state % 2 == 0) 616345d9abdbSWeongyo Jeong bwn_task_30s(mac); 616445d9abdbSWeongyo Jeong bwn_task_15s(mac); 616545d9abdbSWeongyo Jeong 616645d9abdbSWeongyo Jeong mac->mac_task_state++; 616745d9abdbSWeongyo Jeong callout_reset(&sc->sc_task_ch, hz * 15, bwn_tasks, mac); 616845d9abdbSWeongyo Jeong } 616945d9abdbSWeongyo Jeong 617045d9abdbSWeongyo Jeong static int 617145d9abdbSWeongyo Jeong bwn_plcp_get_ofdmrate(struct bwn_mac *mac, struct bwn_plcp6 *plcp, uint8_t a) 617245d9abdbSWeongyo Jeong { 617345d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 617445d9abdbSWeongyo Jeong 617545d9abdbSWeongyo Jeong KASSERT(a == 0, ("not support APHY\n")); 617645d9abdbSWeongyo Jeong 617745d9abdbSWeongyo Jeong switch (plcp->o.raw[0] & 0xf) { 617845d9abdbSWeongyo Jeong case 0xb: 617945d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_6MB); 618045d9abdbSWeongyo Jeong case 0xf: 618145d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_9MB); 618245d9abdbSWeongyo Jeong case 0xa: 618345d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_12MB); 618445d9abdbSWeongyo Jeong case 0xe: 618545d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_18MB); 618645d9abdbSWeongyo Jeong case 0x9: 618745d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_24MB); 618845d9abdbSWeongyo Jeong case 0xd: 618945d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_36MB); 619045d9abdbSWeongyo Jeong case 0x8: 619145d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_48MB); 619245d9abdbSWeongyo Jeong case 0xc: 619345d9abdbSWeongyo Jeong return (BWN_OFDM_RATE_54MB); 619445d9abdbSWeongyo Jeong } 619545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "incorrect OFDM rate %d\n", 619645d9abdbSWeongyo Jeong plcp->o.raw[0] & 0xf); 619745d9abdbSWeongyo Jeong return (-1); 619845d9abdbSWeongyo Jeong } 619945d9abdbSWeongyo Jeong 620045d9abdbSWeongyo Jeong static int 620145d9abdbSWeongyo Jeong bwn_plcp_get_cckrate(struct bwn_mac *mac, struct bwn_plcp6 *plcp) 620245d9abdbSWeongyo Jeong { 620345d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 620445d9abdbSWeongyo Jeong 620545d9abdbSWeongyo Jeong switch (plcp->o.raw[0]) { 620645d9abdbSWeongyo Jeong case 0x0a: 620745d9abdbSWeongyo Jeong return (BWN_CCK_RATE_1MB); 620845d9abdbSWeongyo Jeong case 0x14: 620945d9abdbSWeongyo Jeong return (BWN_CCK_RATE_2MB); 621045d9abdbSWeongyo Jeong case 0x37: 621145d9abdbSWeongyo Jeong return (BWN_CCK_RATE_5MB); 621245d9abdbSWeongyo Jeong case 0x6e: 621345d9abdbSWeongyo Jeong return (BWN_CCK_RATE_11MB); 621445d9abdbSWeongyo Jeong } 621545d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "incorrect CCK rate %d\n", plcp->o.raw[0]); 621645d9abdbSWeongyo Jeong return (-1); 621745d9abdbSWeongyo Jeong } 621845d9abdbSWeongyo Jeong 621945d9abdbSWeongyo Jeong static void 622045d9abdbSWeongyo Jeong bwn_rx_radiotap(struct bwn_mac *mac, struct mbuf *m, 622145d9abdbSWeongyo Jeong const struct bwn_rxhdr4 *rxhdr, struct bwn_plcp6 *plcp, int rate, 622245d9abdbSWeongyo Jeong int rssi, int noise) 622345d9abdbSWeongyo Jeong { 622445d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 622545d9abdbSWeongyo Jeong const struct ieee80211_frame_min *wh; 622645d9abdbSWeongyo Jeong uint64_t tsf; 622745d9abdbSWeongyo Jeong uint16_t low_mactime_now; 622845d9abdbSWeongyo Jeong 622945d9abdbSWeongyo Jeong if (htole16(rxhdr->phy_status0) & BWN_RX_PHYST0_SHORTPRMBL) 623045d9abdbSWeongyo Jeong sc->sc_rx_th.wr_flags |= IEEE80211_RADIOTAP_F_SHORTPRE; 623145d9abdbSWeongyo Jeong 623245d9abdbSWeongyo Jeong wh = mtod(m, const struct ieee80211_frame_min *); 62335945b5f5SKevin Lo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) 623445d9abdbSWeongyo Jeong sc->sc_rx_th.wr_flags |= IEEE80211_RADIOTAP_F_WEP; 623545d9abdbSWeongyo Jeong 623645d9abdbSWeongyo Jeong bwn_tsf_read(mac, &tsf); 623745d9abdbSWeongyo Jeong low_mactime_now = tsf; 623845d9abdbSWeongyo Jeong tsf = tsf & ~0xffffULL; 623945d9abdbSWeongyo Jeong tsf += le16toh(rxhdr->mac_time); 624045d9abdbSWeongyo Jeong if (low_mactime_now < le16toh(rxhdr->mac_time)) 624145d9abdbSWeongyo Jeong tsf -= 0x10000; 624245d9abdbSWeongyo Jeong 624345d9abdbSWeongyo Jeong sc->sc_rx_th.wr_tsf = tsf; 624445d9abdbSWeongyo Jeong sc->sc_rx_th.wr_rate = rate; 624545d9abdbSWeongyo Jeong sc->sc_rx_th.wr_antsignal = rssi; 624645d9abdbSWeongyo Jeong sc->sc_rx_th.wr_antnoise = noise; 624745d9abdbSWeongyo Jeong } 624845d9abdbSWeongyo Jeong 624945d9abdbSWeongyo Jeong static void 625045d9abdbSWeongyo Jeong bwn_tsf_read(struct bwn_mac *mac, uint64_t *tsf) 625145d9abdbSWeongyo Jeong { 625245d9abdbSWeongyo Jeong uint32_t low, high; 625345d9abdbSWeongyo Jeong 62543c7703eaSPyun YongHyeon KASSERT(siba_get_revid(mac->mac_sc->sc_dev) >= 3, 625545d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 625645d9abdbSWeongyo Jeong 625745d9abdbSWeongyo Jeong low = BWN_READ_4(mac, BWN_REV3PLUS_TSF_LOW); 625845d9abdbSWeongyo Jeong high = BWN_READ_4(mac, BWN_REV3PLUS_TSF_HIGH); 625945d9abdbSWeongyo Jeong *tsf = high; 626045d9abdbSWeongyo Jeong *tsf <<= 32; 626145d9abdbSWeongyo Jeong *tsf |= low; 626245d9abdbSWeongyo Jeong } 626345d9abdbSWeongyo Jeong 626445d9abdbSWeongyo Jeong static int 626545d9abdbSWeongyo Jeong bwn_dma_attach(struct bwn_mac *mac) 626645d9abdbSWeongyo Jeong { 626745d9abdbSWeongyo Jeong struct bwn_dma *dma = &mac->mac_method.dma; 626845d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 626945d9abdbSWeongyo Jeong bus_addr_t lowaddr = 0; 627045d9abdbSWeongyo Jeong int error; 627145d9abdbSWeongyo Jeong 6272b9b64aa5SWeongyo Jeong if (siba_get_type(sc->sc_dev) == SIBA_TYPE_PCMCIA || bwn_usedma == 0) 627345d9abdbSWeongyo Jeong return (0); 627445d9abdbSWeongyo Jeong 6275b9b64aa5SWeongyo Jeong KASSERT(siba_get_revid(sc->sc_dev) >= 5, ("%s: fail", __func__)); 627645d9abdbSWeongyo Jeong 627745d9abdbSWeongyo Jeong mac->mac_flags |= BWN_MAC_FLAG_DMA; 627845d9abdbSWeongyo Jeong 627945d9abdbSWeongyo Jeong dma->dmatype = bwn_dma_gettype(mac); 628045d9abdbSWeongyo Jeong if (dma->dmatype == BWN_DMA_30BIT) 628145d9abdbSWeongyo Jeong lowaddr = BWN_BUS_SPACE_MAXADDR_30BIT; 628245d9abdbSWeongyo Jeong else if (dma->dmatype == BWN_DMA_32BIT) 628345d9abdbSWeongyo Jeong lowaddr = BUS_SPACE_MAXADDR_32BIT; 628445d9abdbSWeongyo Jeong else 628545d9abdbSWeongyo Jeong lowaddr = BUS_SPACE_MAXADDR; 628645d9abdbSWeongyo Jeong 628745d9abdbSWeongyo Jeong /* 628845d9abdbSWeongyo Jeong * Create top level DMA tag 628945d9abdbSWeongyo Jeong */ 629045d9abdbSWeongyo Jeong error = bus_dma_tag_create(bus_get_dma_tag(sc->sc_dev), /* parent */ 629145d9abdbSWeongyo Jeong BWN_ALIGN, 0, /* alignment, bounds */ 629245d9abdbSWeongyo Jeong lowaddr, /* lowaddr */ 629345d9abdbSWeongyo Jeong BUS_SPACE_MAXADDR, /* highaddr */ 629445d9abdbSWeongyo Jeong NULL, NULL, /* filter, filterarg */ 62956f954fb3SAlexander Motin BUS_SPACE_MAXSIZE, /* maxsize */ 629645d9abdbSWeongyo Jeong BUS_SPACE_UNRESTRICTED, /* nsegments */ 629745d9abdbSWeongyo Jeong BUS_SPACE_MAXSIZE, /* maxsegsize */ 629845d9abdbSWeongyo Jeong 0, /* flags */ 629945d9abdbSWeongyo Jeong NULL, NULL, /* lockfunc, lockarg */ 630045d9abdbSWeongyo Jeong &dma->parent_dtag); 630145d9abdbSWeongyo Jeong if (error) { 630245d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "can't create parent DMA tag\n"); 630345d9abdbSWeongyo Jeong return (error); 630445d9abdbSWeongyo Jeong } 630545d9abdbSWeongyo Jeong 630645d9abdbSWeongyo Jeong /* 630745d9abdbSWeongyo Jeong * Create TX/RX mbuf DMA tag 630845d9abdbSWeongyo Jeong */ 630945d9abdbSWeongyo Jeong error = bus_dma_tag_create(dma->parent_dtag, 631045d9abdbSWeongyo Jeong 1, 631145d9abdbSWeongyo Jeong 0, 631245d9abdbSWeongyo Jeong BUS_SPACE_MAXADDR, 631345d9abdbSWeongyo Jeong BUS_SPACE_MAXADDR, 631445d9abdbSWeongyo Jeong NULL, NULL, 631545d9abdbSWeongyo Jeong MCLBYTES, 631645d9abdbSWeongyo Jeong 1, 631745d9abdbSWeongyo Jeong BUS_SPACE_MAXSIZE_32BIT, 631845d9abdbSWeongyo Jeong 0, 631945d9abdbSWeongyo Jeong NULL, NULL, 632045d9abdbSWeongyo Jeong &dma->rxbuf_dtag); 632145d9abdbSWeongyo Jeong if (error) { 632245d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "can't create mbuf DMA tag\n"); 632345d9abdbSWeongyo Jeong goto fail0; 632445d9abdbSWeongyo Jeong } 632545d9abdbSWeongyo Jeong error = bus_dma_tag_create(dma->parent_dtag, 632645d9abdbSWeongyo Jeong 1, 632745d9abdbSWeongyo Jeong 0, 632845d9abdbSWeongyo Jeong BUS_SPACE_MAXADDR, 632945d9abdbSWeongyo Jeong BUS_SPACE_MAXADDR, 633045d9abdbSWeongyo Jeong NULL, NULL, 633145d9abdbSWeongyo Jeong MCLBYTES, 633245d9abdbSWeongyo Jeong 1, 633345d9abdbSWeongyo Jeong BUS_SPACE_MAXSIZE_32BIT, 633445d9abdbSWeongyo Jeong 0, 633545d9abdbSWeongyo Jeong NULL, NULL, 633645d9abdbSWeongyo Jeong &dma->txbuf_dtag); 633745d9abdbSWeongyo Jeong if (error) { 633845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, "can't create mbuf DMA tag\n"); 633945d9abdbSWeongyo Jeong goto fail1; 634045d9abdbSWeongyo Jeong } 634145d9abdbSWeongyo Jeong 634245d9abdbSWeongyo Jeong dma->wme[WME_AC_BK] = bwn_dma_ringsetup(mac, 0, 1, dma->dmatype); 634345d9abdbSWeongyo Jeong if (!dma->wme[WME_AC_BK]) 634445d9abdbSWeongyo Jeong goto fail2; 634545d9abdbSWeongyo Jeong 634645d9abdbSWeongyo Jeong dma->wme[WME_AC_BE] = bwn_dma_ringsetup(mac, 1, 1, dma->dmatype); 634745d9abdbSWeongyo Jeong if (!dma->wme[WME_AC_BE]) 634845d9abdbSWeongyo Jeong goto fail3; 634945d9abdbSWeongyo Jeong 635045d9abdbSWeongyo Jeong dma->wme[WME_AC_VI] = bwn_dma_ringsetup(mac, 2, 1, dma->dmatype); 635145d9abdbSWeongyo Jeong if (!dma->wme[WME_AC_VI]) 635245d9abdbSWeongyo Jeong goto fail4; 635345d9abdbSWeongyo Jeong 635445d9abdbSWeongyo Jeong dma->wme[WME_AC_VO] = bwn_dma_ringsetup(mac, 3, 1, dma->dmatype); 635545d9abdbSWeongyo Jeong if (!dma->wme[WME_AC_VO]) 635645d9abdbSWeongyo Jeong goto fail5; 635745d9abdbSWeongyo Jeong 635845d9abdbSWeongyo Jeong dma->mcast = bwn_dma_ringsetup(mac, 4, 1, dma->dmatype); 635945d9abdbSWeongyo Jeong if (!dma->mcast) 636045d9abdbSWeongyo Jeong goto fail6; 636145d9abdbSWeongyo Jeong dma->rx = bwn_dma_ringsetup(mac, 0, 0, dma->dmatype); 636245d9abdbSWeongyo Jeong if (!dma->rx) 636345d9abdbSWeongyo Jeong goto fail7; 636445d9abdbSWeongyo Jeong 636545d9abdbSWeongyo Jeong return (error); 636645d9abdbSWeongyo Jeong 636745d9abdbSWeongyo Jeong fail7: bwn_dma_ringfree(&dma->mcast); 636845d9abdbSWeongyo Jeong fail6: bwn_dma_ringfree(&dma->wme[WME_AC_VO]); 636945d9abdbSWeongyo Jeong fail5: bwn_dma_ringfree(&dma->wme[WME_AC_VI]); 637045d9abdbSWeongyo Jeong fail4: bwn_dma_ringfree(&dma->wme[WME_AC_BE]); 637145d9abdbSWeongyo Jeong fail3: bwn_dma_ringfree(&dma->wme[WME_AC_BK]); 637245d9abdbSWeongyo Jeong fail2: bus_dma_tag_destroy(dma->txbuf_dtag); 637345d9abdbSWeongyo Jeong fail1: bus_dma_tag_destroy(dma->rxbuf_dtag); 637445d9abdbSWeongyo Jeong fail0: bus_dma_tag_destroy(dma->parent_dtag); 637545d9abdbSWeongyo Jeong return (error); 637645d9abdbSWeongyo Jeong } 637745d9abdbSWeongyo Jeong 637845d9abdbSWeongyo Jeong static struct bwn_dma_ring * 637945d9abdbSWeongyo Jeong bwn_dma_parse_cookie(struct bwn_mac *mac, const struct bwn_txstatus *status, 638045d9abdbSWeongyo Jeong uint16_t cookie, int *slot) 638145d9abdbSWeongyo Jeong { 638245d9abdbSWeongyo Jeong struct bwn_dma *dma = &mac->mac_method.dma; 638345d9abdbSWeongyo Jeong struct bwn_dma_ring *dr; 638445d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 638545d9abdbSWeongyo Jeong 638645d9abdbSWeongyo Jeong BWN_ASSERT_LOCKED(mac->mac_sc); 638745d9abdbSWeongyo Jeong 638845d9abdbSWeongyo Jeong switch (cookie & 0xf000) { 638945d9abdbSWeongyo Jeong case 0x1000: 639045d9abdbSWeongyo Jeong dr = dma->wme[WME_AC_BK]; 639145d9abdbSWeongyo Jeong break; 639245d9abdbSWeongyo Jeong case 0x2000: 639345d9abdbSWeongyo Jeong dr = dma->wme[WME_AC_BE]; 639445d9abdbSWeongyo Jeong break; 639545d9abdbSWeongyo Jeong case 0x3000: 639645d9abdbSWeongyo Jeong dr = dma->wme[WME_AC_VI]; 639745d9abdbSWeongyo Jeong break; 639845d9abdbSWeongyo Jeong case 0x4000: 639945d9abdbSWeongyo Jeong dr = dma->wme[WME_AC_VO]; 640045d9abdbSWeongyo Jeong break; 640145d9abdbSWeongyo Jeong case 0x5000: 640245d9abdbSWeongyo Jeong dr = dma->mcast; 640345d9abdbSWeongyo Jeong break; 640445d9abdbSWeongyo Jeong default: 64050d05eee2SWarner Losh dr = NULL; 640645d9abdbSWeongyo Jeong KASSERT(0 == 1, 640745d9abdbSWeongyo Jeong ("invalid cookie value %d", cookie & 0xf000)); 640845d9abdbSWeongyo Jeong } 640945d9abdbSWeongyo Jeong *slot = (cookie & 0x0fff); 641045d9abdbSWeongyo Jeong if (*slot < 0 || *slot >= dr->dr_numslots) { 641145d9abdbSWeongyo Jeong /* 641245d9abdbSWeongyo Jeong * XXX FIXME: sometimes H/W returns TX DONE events duplicately 641345d9abdbSWeongyo Jeong * that it occurs events which have same H/W sequence numbers. 641445d9abdbSWeongyo Jeong * When it's occurred just prints a WARNING msgs and ignores. 641545d9abdbSWeongyo Jeong */ 641645d9abdbSWeongyo Jeong KASSERT(status->seq == dma->lastseq, 641745d9abdbSWeongyo Jeong ("%s:%d: fail", __func__, __LINE__)); 641845d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 641945d9abdbSWeongyo Jeong "out of slot ranges (0 < %d < %d)\n", *slot, 642045d9abdbSWeongyo Jeong dr->dr_numslots); 642145d9abdbSWeongyo Jeong return (NULL); 642245d9abdbSWeongyo Jeong } 642345d9abdbSWeongyo Jeong dma->lastseq = status->seq; 642445d9abdbSWeongyo Jeong return (dr); 642545d9abdbSWeongyo Jeong } 642645d9abdbSWeongyo Jeong 642745d9abdbSWeongyo Jeong static void 642845d9abdbSWeongyo Jeong bwn_dma_stop(struct bwn_mac *mac) 642945d9abdbSWeongyo Jeong { 643045d9abdbSWeongyo Jeong struct bwn_dma *dma; 643145d9abdbSWeongyo Jeong 643245d9abdbSWeongyo Jeong if ((mac->mac_flags & BWN_MAC_FLAG_DMA) == 0) 643345d9abdbSWeongyo Jeong return; 643445d9abdbSWeongyo Jeong dma = &mac->mac_method.dma; 643545d9abdbSWeongyo Jeong 643645d9abdbSWeongyo Jeong bwn_dma_ringstop(&dma->rx); 643745d9abdbSWeongyo Jeong bwn_dma_ringstop(&dma->wme[WME_AC_BK]); 643845d9abdbSWeongyo Jeong bwn_dma_ringstop(&dma->wme[WME_AC_BE]); 643945d9abdbSWeongyo Jeong bwn_dma_ringstop(&dma->wme[WME_AC_VI]); 644045d9abdbSWeongyo Jeong bwn_dma_ringstop(&dma->wme[WME_AC_VO]); 644145d9abdbSWeongyo Jeong bwn_dma_ringstop(&dma->mcast); 644245d9abdbSWeongyo Jeong } 644345d9abdbSWeongyo Jeong 644445d9abdbSWeongyo Jeong static void 644545d9abdbSWeongyo Jeong bwn_dma_ringstop(struct bwn_dma_ring **dr) 644645d9abdbSWeongyo Jeong { 644745d9abdbSWeongyo Jeong 644845d9abdbSWeongyo Jeong if (dr == NULL) 644945d9abdbSWeongyo Jeong return; 645045d9abdbSWeongyo Jeong 645145d9abdbSWeongyo Jeong bwn_dma_cleanup(*dr); 645245d9abdbSWeongyo Jeong } 645345d9abdbSWeongyo Jeong 645445d9abdbSWeongyo Jeong static void 645545d9abdbSWeongyo Jeong bwn_pio_stop(struct bwn_mac *mac) 645645d9abdbSWeongyo Jeong { 645745d9abdbSWeongyo Jeong struct bwn_pio *pio; 645845d9abdbSWeongyo Jeong 645945d9abdbSWeongyo Jeong if (mac->mac_flags & BWN_MAC_FLAG_DMA) 646045d9abdbSWeongyo Jeong return; 646145d9abdbSWeongyo Jeong pio = &mac->mac_method.pio; 646245d9abdbSWeongyo Jeong 646345d9abdbSWeongyo Jeong bwn_destroy_queue_tx(&pio->mcast); 646445d9abdbSWeongyo Jeong bwn_destroy_queue_tx(&pio->wme[WME_AC_VO]); 646545d9abdbSWeongyo Jeong bwn_destroy_queue_tx(&pio->wme[WME_AC_VI]); 646645d9abdbSWeongyo Jeong bwn_destroy_queue_tx(&pio->wme[WME_AC_BE]); 646745d9abdbSWeongyo Jeong bwn_destroy_queue_tx(&pio->wme[WME_AC_BK]); 646845d9abdbSWeongyo Jeong } 646945d9abdbSWeongyo Jeong 647045d9abdbSWeongyo Jeong static void 647145d9abdbSWeongyo Jeong bwn_led_attach(struct bwn_mac *mac) 647245d9abdbSWeongyo Jeong { 647345d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 647445d9abdbSWeongyo Jeong const uint8_t *led_act = NULL; 647545d9abdbSWeongyo Jeong uint16_t val[BWN_LED_MAX]; 647645d9abdbSWeongyo Jeong int i; 647745d9abdbSWeongyo Jeong 647845d9abdbSWeongyo Jeong sc->sc_led_idle = (2350 * hz) / 1000; 647945d9abdbSWeongyo Jeong sc->sc_led_blink = 1; 648045d9abdbSWeongyo Jeong 648145d9abdbSWeongyo Jeong for (i = 0; i < N(bwn_vendor_led_act); ++i) { 6482b9b64aa5SWeongyo Jeong if (siba_get_pci_subvendor(sc->sc_dev) == 6483b9b64aa5SWeongyo Jeong bwn_vendor_led_act[i].vid) { 648445d9abdbSWeongyo Jeong led_act = bwn_vendor_led_act[i].led_act; 648545d9abdbSWeongyo Jeong break; 648645d9abdbSWeongyo Jeong } 648745d9abdbSWeongyo Jeong } 648845d9abdbSWeongyo Jeong if (led_act == NULL) 648945d9abdbSWeongyo Jeong led_act = bwn_default_led_act; 649045d9abdbSWeongyo Jeong 6491b9b64aa5SWeongyo Jeong val[0] = siba_sprom_get_gpio0(sc->sc_dev); 6492b9b64aa5SWeongyo Jeong val[1] = siba_sprom_get_gpio1(sc->sc_dev); 6493b9b64aa5SWeongyo Jeong val[2] = siba_sprom_get_gpio2(sc->sc_dev); 6494b9b64aa5SWeongyo Jeong val[3] = siba_sprom_get_gpio3(sc->sc_dev); 649545d9abdbSWeongyo Jeong 649645d9abdbSWeongyo Jeong for (i = 0; i < BWN_LED_MAX; ++i) { 649745d9abdbSWeongyo Jeong struct bwn_led *led = &sc->sc_leds[i]; 649845d9abdbSWeongyo Jeong 649945d9abdbSWeongyo Jeong if (val[i] == 0xff) { 650045d9abdbSWeongyo Jeong led->led_act = led_act[i]; 650145d9abdbSWeongyo Jeong } else { 650245d9abdbSWeongyo Jeong if (val[i] & BWN_LED_ACT_LOW) 650345d9abdbSWeongyo Jeong led->led_flags |= BWN_LED_F_ACTLOW; 650445d9abdbSWeongyo Jeong led->led_act = val[i] & BWN_LED_ACT_MASK; 650545d9abdbSWeongyo Jeong } 650645d9abdbSWeongyo Jeong led->led_mask = (1 << i); 650745d9abdbSWeongyo Jeong 650845d9abdbSWeongyo Jeong if (led->led_act == BWN_LED_ACT_BLINK_SLOW || 650945d9abdbSWeongyo Jeong led->led_act == BWN_LED_ACT_BLINK_POLL || 651045d9abdbSWeongyo Jeong led->led_act == BWN_LED_ACT_BLINK) { 651145d9abdbSWeongyo Jeong led->led_flags |= BWN_LED_F_BLINK; 651245d9abdbSWeongyo Jeong if (led->led_act == BWN_LED_ACT_BLINK_POLL) 651345d9abdbSWeongyo Jeong led->led_flags |= BWN_LED_F_POLLABLE; 651445d9abdbSWeongyo Jeong else if (led->led_act == BWN_LED_ACT_BLINK_SLOW) 651545d9abdbSWeongyo Jeong led->led_flags |= BWN_LED_F_SLOW; 651645d9abdbSWeongyo Jeong 651745d9abdbSWeongyo Jeong if (sc->sc_blink_led == NULL) { 651845d9abdbSWeongyo Jeong sc->sc_blink_led = led; 651945d9abdbSWeongyo Jeong if (led->led_flags & BWN_LED_F_SLOW) 652045d9abdbSWeongyo Jeong BWN_LED_SLOWDOWN(sc->sc_led_idle); 652145d9abdbSWeongyo Jeong } 652245d9abdbSWeongyo Jeong } 652345d9abdbSWeongyo Jeong 652445d9abdbSWeongyo Jeong DPRINTF(sc, BWN_DEBUG_LED, 652545d9abdbSWeongyo Jeong "%dth led, act %d, lowact %d\n", i, 652645d9abdbSWeongyo Jeong led->led_act, led->led_flags & BWN_LED_F_ACTLOW); 652745d9abdbSWeongyo Jeong } 652845d9abdbSWeongyo Jeong callout_init_mtx(&sc->sc_led_blink_ch, &sc->sc_mtx, 0); 652945d9abdbSWeongyo Jeong } 653045d9abdbSWeongyo Jeong 653145d9abdbSWeongyo Jeong static __inline uint16_t 653245d9abdbSWeongyo Jeong bwn_led_onoff(const struct bwn_led *led, uint16_t val, int on) 653345d9abdbSWeongyo Jeong { 653445d9abdbSWeongyo Jeong 653545d9abdbSWeongyo Jeong if (led->led_flags & BWN_LED_F_ACTLOW) 653645d9abdbSWeongyo Jeong on = !on; 653745d9abdbSWeongyo Jeong if (on) 653845d9abdbSWeongyo Jeong val |= led->led_mask; 653945d9abdbSWeongyo Jeong else 654045d9abdbSWeongyo Jeong val &= ~led->led_mask; 654145d9abdbSWeongyo Jeong return val; 654245d9abdbSWeongyo Jeong } 654345d9abdbSWeongyo Jeong 654445d9abdbSWeongyo Jeong static void 654545d9abdbSWeongyo Jeong bwn_led_newstate(struct bwn_mac *mac, enum ieee80211_state nstate) 654645d9abdbSWeongyo Jeong { 654745d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 65487a79cebfSGleb Smirnoff struct ieee80211com *ic = &sc->sc_ic; 654945d9abdbSWeongyo Jeong uint16_t val; 655045d9abdbSWeongyo Jeong int i; 655145d9abdbSWeongyo Jeong 655245d9abdbSWeongyo Jeong if (nstate == IEEE80211_S_INIT) { 655345d9abdbSWeongyo Jeong callout_stop(&sc->sc_led_blink_ch); 655445d9abdbSWeongyo Jeong sc->sc_led_blinking = 0; 655545d9abdbSWeongyo Jeong } 655645d9abdbSWeongyo Jeong 65577a79cebfSGleb Smirnoff if ((sc->sc_flags & BWN_FLAG_RUNNING) == 0) 655845d9abdbSWeongyo Jeong return; 655945d9abdbSWeongyo Jeong 656045d9abdbSWeongyo Jeong val = BWN_READ_2(mac, BWN_GPIO_CONTROL); 656145d9abdbSWeongyo Jeong for (i = 0; i < BWN_LED_MAX; ++i) { 656245d9abdbSWeongyo Jeong struct bwn_led *led = &sc->sc_leds[i]; 656345d9abdbSWeongyo Jeong int on; 656445d9abdbSWeongyo Jeong 656545d9abdbSWeongyo Jeong if (led->led_act == BWN_LED_ACT_UNKN || 656645d9abdbSWeongyo Jeong led->led_act == BWN_LED_ACT_NULL) 656745d9abdbSWeongyo Jeong continue; 656845d9abdbSWeongyo Jeong 656945d9abdbSWeongyo Jeong if ((led->led_flags & BWN_LED_F_BLINK) && 657045d9abdbSWeongyo Jeong nstate != IEEE80211_S_INIT) 657145d9abdbSWeongyo Jeong continue; 657245d9abdbSWeongyo Jeong 657345d9abdbSWeongyo Jeong switch (led->led_act) { 657445d9abdbSWeongyo Jeong case BWN_LED_ACT_ON: /* Always on */ 657545d9abdbSWeongyo Jeong on = 1; 657645d9abdbSWeongyo Jeong break; 657745d9abdbSWeongyo Jeong case BWN_LED_ACT_OFF: /* Always off */ 657845d9abdbSWeongyo Jeong case BWN_LED_ACT_5GHZ: /* TODO: 11A */ 657945d9abdbSWeongyo Jeong on = 0; 658045d9abdbSWeongyo Jeong break; 658145d9abdbSWeongyo Jeong default: 658245d9abdbSWeongyo Jeong on = 1; 658345d9abdbSWeongyo Jeong switch (nstate) { 658445d9abdbSWeongyo Jeong case IEEE80211_S_INIT: 658545d9abdbSWeongyo Jeong on = 0; 658645d9abdbSWeongyo Jeong break; 658745d9abdbSWeongyo Jeong case IEEE80211_S_RUN: 658845d9abdbSWeongyo Jeong if (led->led_act == BWN_LED_ACT_11G && 658945d9abdbSWeongyo Jeong ic->ic_curmode != IEEE80211_MODE_11G) 659045d9abdbSWeongyo Jeong on = 0; 659145d9abdbSWeongyo Jeong break; 659245d9abdbSWeongyo Jeong default: 659345d9abdbSWeongyo Jeong if (led->led_act == BWN_LED_ACT_ASSOC) 659445d9abdbSWeongyo Jeong on = 0; 659545d9abdbSWeongyo Jeong break; 659645d9abdbSWeongyo Jeong } 659745d9abdbSWeongyo Jeong break; 659845d9abdbSWeongyo Jeong } 659945d9abdbSWeongyo Jeong 660045d9abdbSWeongyo Jeong val = bwn_led_onoff(led, val, on); 660145d9abdbSWeongyo Jeong } 660245d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_GPIO_CONTROL, val); 660345d9abdbSWeongyo Jeong } 660445d9abdbSWeongyo Jeong 660545d9abdbSWeongyo Jeong static void 660645d9abdbSWeongyo Jeong bwn_led_event(struct bwn_mac *mac, int event) 660745d9abdbSWeongyo Jeong { 660845d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 660945d9abdbSWeongyo Jeong struct bwn_led *led = sc->sc_blink_led; 661045d9abdbSWeongyo Jeong int rate; 661145d9abdbSWeongyo Jeong 661245d9abdbSWeongyo Jeong if (event == BWN_LED_EVENT_POLL) { 661345d9abdbSWeongyo Jeong if ((led->led_flags & BWN_LED_F_POLLABLE) == 0) 661445d9abdbSWeongyo Jeong return; 661545d9abdbSWeongyo Jeong if (ticks - sc->sc_led_ticks < sc->sc_led_idle) 661645d9abdbSWeongyo Jeong return; 661745d9abdbSWeongyo Jeong } 661845d9abdbSWeongyo Jeong 661945d9abdbSWeongyo Jeong sc->sc_led_ticks = ticks; 662045d9abdbSWeongyo Jeong if (sc->sc_led_blinking) 662145d9abdbSWeongyo Jeong return; 662245d9abdbSWeongyo Jeong 662345d9abdbSWeongyo Jeong switch (event) { 662445d9abdbSWeongyo Jeong case BWN_LED_EVENT_RX: 662545d9abdbSWeongyo Jeong rate = sc->sc_rx_rate; 662645d9abdbSWeongyo Jeong break; 662745d9abdbSWeongyo Jeong case BWN_LED_EVENT_TX: 662845d9abdbSWeongyo Jeong rate = sc->sc_tx_rate; 662945d9abdbSWeongyo Jeong break; 663045d9abdbSWeongyo Jeong case BWN_LED_EVENT_POLL: 663145d9abdbSWeongyo Jeong rate = 0; 663245d9abdbSWeongyo Jeong break; 663345d9abdbSWeongyo Jeong default: 663445d9abdbSWeongyo Jeong panic("unknown LED event %d\n", event); 663545d9abdbSWeongyo Jeong break; 663645d9abdbSWeongyo Jeong } 663745d9abdbSWeongyo Jeong bwn_led_blink_start(mac, bwn_led_duration[rate].on_dur, 663845d9abdbSWeongyo Jeong bwn_led_duration[rate].off_dur); 663945d9abdbSWeongyo Jeong } 664045d9abdbSWeongyo Jeong 664145d9abdbSWeongyo Jeong static void 664245d9abdbSWeongyo Jeong bwn_led_blink_start(struct bwn_mac *mac, int on_dur, int off_dur) 664345d9abdbSWeongyo Jeong { 664445d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 664545d9abdbSWeongyo Jeong struct bwn_led *led = sc->sc_blink_led; 664645d9abdbSWeongyo Jeong uint16_t val; 664745d9abdbSWeongyo Jeong 664845d9abdbSWeongyo Jeong val = BWN_READ_2(mac, BWN_GPIO_CONTROL); 664945d9abdbSWeongyo Jeong val = bwn_led_onoff(led, val, 1); 665045d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_GPIO_CONTROL, val); 665145d9abdbSWeongyo Jeong 665245d9abdbSWeongyo Jeong if (led->led_flags & BWN_LED_F_SLOW) { 665345d9abdbSWeongyo Jeong BWN_LED_SLOWDOWN(on_dur); 665445d9abdbSWeongyo Jeong BWN_LED_SLOWDOWN(off_dur); 665545d9abdbSWeongyo Jeong } 665645d9abdbSWeongyo Jeong 665745d9abdbSWeongyo Jeong sc->sc_led_blinking = 1; 665845d9abdbSWeongyo Jeong sc->sc_led_blink_offdur = off_dur; 665945d9abdbSWeongyo Jeong 666045d9abdbSWeongyo Jeong callout_reset(&sc->sc_led_blink_ch, on_dur, bwn_led_blink_next, mac); 666145d9abdbSWeongyo Jeong } 666245d9abdbSWeongyo Jeong 666345d9abdbSWeongyo Jeong static void 666445d9abdbSWeongyo Jeong bwn_led_blink_next(void *arg) 666545d9abdbSWeongyo Jeong { 666645d9abdbSWeongyo Jeong struct bwn_mac *mac = arg; 666745d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 666845d9abdbSWeongyo Jeong uint16_t val; 666945d9abdbSWeongyo Jeong 667045d9abdbSWeongyo Jeong val = BWN_READ_2(mac, BWN_GPIO_CONTROL); 667145d9abdbSWeongyo Jeong val = bwn_led_onoff(sc->sc_blink_led, val, 0); 667245d9abdbSWeongyo Jeong BWN_WRITE_2(mac, BWN_GPIO_CONTROL, val); 667345d9abdbSWeongyo Jeong 667445d9abdbSWeongyo Jeong callout_reset(&sc->sc_led_blink_ch, sc->sc_led_blink_offdur, 667545d9abdbSWeongyo Jeong bwn_led_blink_end, mac); 667645d9abdbSWeongyo Jeong } 667745d9abdbSWeongyo Jeong 667845d9abdbSWeongyo Jeong static void 667945d9abdbSWeongyo Jeong bwn_led_blink_end(void *arg) 668045d9abdbSWeongyo Jeong { 668145d9abdbSWeongyo Jeong struct bwn_mac *mac = arg; 668245d9abdbSWeongyo Jeong struct bwn_softc *sc = mac->mac_sc; 668345d9abdbSWeongyo Jeong 668445d9abdbSWeongyo Jeong sc->sc_led_blinking = 0; 668545d9abdbSWeongyo Jeong } 668645d9abdbSWeongyo Jeong 668745d9abdbSWeongyo Jeong static int 668845d9abdbSWeongyo Jeong bwn_suspend(device_t dev) 668945d9abdbSWeongyo Jeong { 669045d9abdbSWeongyo Jeong struct bwn_softc *sc = device_get_softc(dev); 669145d9abdbSWeongyo Jeong 66927a79cebfSGleb Smirnoff BWN_LOCK(sc); 66937a79cebfSGleb Smirnoff bwn_stop(sc); 66947a79cebfSGleb Smirnoff BWN_UNLOCK(sc); 669545d9abdbSWeongyo Jeong return (0); 669645d9abdbSWeongyo Jeong } 669745d9abdbSWeongyo Jeong 669845d9abdbSWeongyo Jeong static int 669945d9abdbSWeongyo Jeong bwn_resume(device_t dev) 670045d9abdbSWeongyo Jeong { 670145d9abdbSWeongyo Jeong struct bwn_softc *sc = device_get_softc(dev); 67027a79cebfSGleb Smirnoff int error = EDOOFUS; 670345d9abdbSWeongyo Jeong 67047a79cebfSGleb Smirnoff BWN_LOCK(sc); 67057a79cebfSGleb Smirnoff if (sc->sc_ic.ic_nrunning > 0) 67067a79cebfSGleb Smirnoff error = bwn_init(sc); 67077a79cebfSGleb Smirnoff BWN_UNLOCK(sc); 67087a79cebfSGleb Smirnoff if (error == 0) 67097a79cebfSGleb Smirnoff ieee80211_start_all(&sc->sc_ic); 671045d9abdbSWeongyo Jeong return (0); 671145d9abdbSWeongyo Jeong } 671245d9abdbSWeongyo Jeong 671345d9abdbSWeongyo Jeong static void 671445d9abdbSWeongyo Jeong bwn_rfswitch(void *arg) 671545d9abdbSWeongyo Jeong { 671645d9abdbSWeongyo Jeong struct bwn_softc *sc = arg; 671745d9abdbSWeongyo Jeong struct bwn_mac *mac = sc->sc_curmac; 671845d9abdbSWeongyo Jeong int cur = 0, prev = 0; 671945d9abdbSWeongyo Jeong 672045d9abdbSWeongyo Jeong KASSERT(mac->mac_status >= BWN_MAC_STATUS_STARTED, 672145d9abdbSWeongyo Jeong ("%s: invalid MAC status %d", __func__, mac->mac_status)); 672245d9abdbSWeongyo Jeong 6723d3f9e6a7SAdrian Chadd if (mac->mac_phy.rev >= 3 || mac->mac_phy.type == BWN_PHYTYPE_LP) { 672445d9abdbSWeongyo Jeong if (!(BWN_READ_4(mac, BWN_RF_HWENABLED_HI) 672545d9abdbSWeongyo Jeong & BWN_RF_HWENABLED_HI_MASK)) 672645d9abdbSWeongyo Jeong cur = 1; 672745d9abdbSWeongyo Jeong } else { 672845d9abdbSWeongyo Jeong if (BWN_READ_2(mac, BWN_RF_HWENABLED_LO) 672945d9abdbSWeongyo Jeong & BWN_RF_HWENABLED_LO_MASK) 673045d9abdbSWeongyo Jeong cur = 1; 673145d9abdbSWeongyo Jeong } 673245d9abdbSWeongyo Jeong 673345d9abdbSWeongyo Jeong if (mac->mac_flags & BWN_MAC_FLAG_RADIO_ON) 673445d9abdbSWeongyo Jeong prev = 1; 673545d9abdbSWeongyo Jeong 673645d9abdbSWeongyo Jeong if (cur != prev) { 673745d9abdbSWeongyo Jeong if (cur) 673845d9abdbSWeongyo Jeong mac->mac_flags |= BWN_MAC_FLAG_RADIO_ON; 673945d9abdbSWeongyo Jeong else 674045d9abdbSWeongyo Jeong mac->mac_flags &= ~BWN_MAC_FLAG_RADIO_ON; 674145d9abdbSWeongyo Jeong 674245d9abdbSWeongyo Jeong device_printf(sc->sc_dev, 674345d9abdbSWeongyo Jeong "status of RF switch is changed to %s\n", 674445d9abdbSWeongyo Jeong cur ? "ON" : "OFF"); 674545d9abdbSWeongyo Jeong if (cur != mac->mac_phy.rf_on) { 674645d9abdbSWeongyo Jeong if (cur) 674745d9abdbSWeongyo Jeong bwn_rf_turnon(mac); 674845d9abdbSWeongyo Jeong else 674945d9abdbSWeongyo Jeong bwn_rf_turnoff(mac); 675045d9abdbSWeongyo Jeong } 675145d9abdbSWeongyo Jeong } 675245d9abdbSWeongyo Jeong 675345d9abdbSWeongyo Jeong callout_schedule(&sc->sc_rfswitch_ch, hz); 675445d9abdbSWeongyo Jeong } 675545d9abdbSWeongyo Jeong 675645d9abdbSWeongyo Jeong static void 6757d2ee7771SWeongyo Jeong bwn_sysctl_node(struct bwn_softc *sc) 6758d2ee7771SWeongyo Jeong { 6759d2ee7771SWeongyo Jeong device_t dev = sc->sc_dev; 6760d2ee7771SWeongyo Jeong struct bwn_mac *mac; 6761d2ee7771SWeongyo Jeong struct bwn_stats *stats; 6762d2ee7771SWeongyo Jeong 6763d2ee7771SWeongyo Jeong /* XXX assume that count of MAC is only 1. */ 6764d2ee7771SWeongyo Jeong 6765d2ee7771SWeongyo Jeong if ((mac = sc->sc_curmac) == NULL) 6766d2ee7771SWeongyo Jeong return; 6767d2ee7771SWeongyo Jeong stats = &mac->mac_stats; 6768d2ee7771SWeongyo Jeong 67696dc7dc9aSMatthew D Fleming SYSCTL_ADD_INT(device_get_sysctl_ctx(dev), 6770d2ee7771SWeongyo Jeong SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, 6771d2ee7771SWeongyo Jeong "linknoise", CTLFLAG_RW, &stats->rts, 0, "Noise level"); 67726dc7dc9aSMatthew D Fleming SYSCTL_ADD_INT(device_get_sysctl_ctx(dev), 6773d2ee7771SWeongyo Jeong SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, 6774d2ee7771SWeongyo Jeong "rts", CTLFLAG_RW, &stats->rts, 0, "RTS"); 67756dc7dc9aSMatthew D Fleming SYSCTL_ADD_INT(device_get_sysctl_ctx(dev), 6776d2ee7771SWeongyo Jeong SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, 6777d2ee7771SWeongyo Jeong "rtsfail", CTLFLAG_RW, &stats->rtsfail, 0, "RTS failed to send"); 6778d2ee7771SWeongyo Jeong 6779d2ee7771SWeongyo Jeong #ifdef BWN_DEBUG 6780d2ee7771SWeongyo Jeong SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev), 6781d2ee7771SWeongyo Jeong SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, 6782d2ee7771SWeongyo Jeong "debug", CTLFLAG_RW, &sc->sc_debug, 0, "Debug flags"); 6783d2ee7771SWeongyo Jeong #endif 6784d2ee7771SWeongyo Jeong } 6785d2ee7771SWeongyo Jeong 678645d9abdbSWeongyo Jeong static device_method_t bwn_methods[] = { 678745d9abdbSWeongyo Jeong /* Device interface */ 678845d9abdbSWeongyo Jeong DEVMETHOD(device_probe, bwn_probe), 678945d9abdbSWeongyo Jeong DEVMETHOD(device_attach, bwn_attach), 679045d9abdbSWeongyo Jeong DEVMETHOD(device_detach, bwn_detach), 679145d9abdbSWeongyo Jeong DEVMETHOD(device_suspend, bwn_suspend), 679245d9abdbSWeongyo Jeong DEVMETHOD(device_resume, bwn_resume), 6793848e30ffSMarius Strobl DEVMETHOD_END 679445d9abdbSWeongyo Jeong }; 679545d9abdbSWeongyo Jeong static driver_t bwn_driver = { 679645d9abdbSWeongyo Jeong "bwn", 679745d9abdbSWeongyo Jeong bwn_methods, 679845d9abdbSWeongyo Jeong sizeof(struct bwn_softc) 679945d9abdbSWeongyo Jeong }; 680045d9abdbSWeongyo Jeong static devclass_t bwn_devclass; 680145d9abdbSWeongyo Jeong DRIVER_MODULE(bwn, siba_bwn, bwn_driver, bwn_devclass, 0, 0); 680245d9abdbSWeongyo Jeong MODULE_DEPEND(bwn, siba_bwn, 1, 1, 1); 680345d9abdbSWeongyo Jeong MODULE_DEPEND(bwn, wlan, 1, 1, 1); /* 802.11 media layer */ 680445d9abdbSWeongyo Jeong MODULE_DEPEND(bwn, firmware, 1, 1, 1); /* firmware support */ 680545d9abdbSWeongyo Jeong MODULE_DEPEND(bwn, wlan_amrr, 1, 1, 1); 6806