xref: /freebsd/sys/dev/bwn/if_bwn.c (revision d546e47aa0b57d0fe2370217df91aa5a921e6932)
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, &reg) == 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(&params, 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