Home | History | Annotate | Line # | Download | only in usb
if_urtwn.c revision 1.5.4.3
      1  1.5.4.2     tls /*	$NetBSD: if_urtwn.c,v 1.5.4.3 2014/08/20 00:03:51 tls Exp $	*/
      2      1.1  nonaka /*	$OpenBSD: if_urtwn.c,v 1.20 2011/11/26 06:39:33 ckuethe Exp $	*/
      3      1.1  nonaka 
      4      1.1  nonaka /*-
      5      1.1  nonaka  * Copyright (c) 2010 Damien Bergamini <damien.bergamini (at) free.fr>
      6  1.5.4.3     tls  * Copyright (c) 2014 Kevin Lo <kevlo (at) FreeBSD.org>
      7      1.1  nonaka  *
      8      1.1  nonaka  * Permission to use, copy, modify, and distribute this software for any
      9      1.1  nonaka  * purpose with or without fee is hereby granted, provided that the above
     10      1.1  nonaka  * copyright notice and this permission notice appear in all copies.
     11      1.1  nonaka  *
     12      1.1  nonaka  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     13      1.1  nonaka  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     14      1.1  nonaka  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     15      1.1  nonaka  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     16      1.1  nonaka  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     17      1.1  nonaka  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     18      1.1  nonaka  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     19      1.1  nonaka  */
     20      1.1  nonaka 
     21  1.5.4.1     tls /*-
     22  1.5.4.3     tls  * Driver for Realtek RTL8188CE-VAU/RTL8188CUS/RTL8188EU/RTL8188RU/RTL8192CU.
     23      1.1  nonaka  */
     24      1.1  nonaka 
     25      1.1  nonaka #include <sys/cdefs.h>
     26  1.5.4.2     tls __KERNEL_RCSID(0, "$NetBSD: if_urtwn.c,v 1.5.4.3 2014/08/20 00:03:51 tls Exp $");
     27  1.5.4.1     tls 
     28  1.5.4.1     tls #ifdef _KERNEL_OPT
     29  1.5.4.1     tls #include "opt_inet.h"
     30  1.5.4.1     tls #endif
     31      1.1  nonaka 
     32      1.1  nonaka #include <sys/param.h>
     33      1.1  nonaka #include <sys/sockio.h>
     34      1.1  nonaka #include <sys/sysctl.h>
     35      1.1  nonaka #include <sys/mbuf.h>
     36      1.1  nonaka #include <sys/kernel.h>
     37      1.1  nonaka #include <sys/socket.h>
     38      1.1  nonaka #include <sys/systm.h>
     39      1.1  nonaka #include <sys/malloc.h>
     40      1.1  nonaka #include <sys/module.h>
     41      1.1  nonaka #include <sys/conf.h>
     42      1.1  nonaka #include <sys/device.h>
     43      1.1  nonaka 
     44      1.1  nonaka #include <sys/bus.h>
     45      1.1  nonaka #include <machine/endian.h>
     46      1.1  nonaka #include <sys/intr.h>
     47      1.1  nonaka 
     48      1.1  nonaka #include <net/bpf.h>
     49      1.1  nonaka #include <net/if.h>
     50      1.1  nonaka #include <net/if_arp.h>
     51      1.1  nonaka #include <net/if_dl.h>
     52      1.1  nonaka #include <net/if_ether.h>
     53      1.1  nonaka #include <net/if_media.h>
     54      1.1  nonaka #include <net/if_types.h>
     55      1.1  nonaka 
     56      1.1  nonaka #include <netinet/in.h>
     57      1.1  nonaka #include <netinet/in_systm.h>
     58      1.1  nonaka #include <netinet/in_var.h>
     59      1.1  nonaka #include <netinet/ip.h>
     60  1.5.4.1     tls #include <netinet/if_inarp.h>
     61      1.1  nonaka 
     62      1.1  nonaka #include <net80211/ieee80211_netbsd.h>
     63      1.1  nonaka #include <net80211/ieee80211_var.h>
     64      1.1  nonaka #include <net80211/ieee80211_radiotap.h>
     65      1.1  nonaka 
     66      1.1  nonaka #include <dev/firmload.h>
     67      1.1  nonaka 
     68      1.1  nonaka #include <dev/usb/usb.h>
     69      1.1  nonaka #include <dev/usb/usbdi.h>
     70      1.1  nonaka #include <dev/usb/usbdivar.h>
     71      1.1  nonaka #include <dev/usb/usbdi_util.h>
     72      1.1  nonaka #include <dev/usb/usbdevs.h>
     73      1.1  nonaka 
     74      1.1  nonaka #include <dev/usb/if_urtwnreg.h>
     75      1.1  nonaka #include <dev/usb/if_urtwnvar.h>
     76      1.1  nonaka #include <dev/usb/if_urtwn_data.h>
     77      1.1  nonaka 
     78  1.5.4.1     tls /*
     79  1.5.4.1     tls  * The sc_write_mtx locking is to prevent sequences of writes from
     80  1.5.4.1     tls  * being intermingled with each other.  I don't know if this is really
     81  1.5.4.1     tls  * needed.  I have added it just to be on the safe side.
     82  1.5.4.1     tls  */
     83      1.1  nonaka 
     84      1.1  nonaka #ifdef URTWN_DEBUG
     85      1.1  nonaka #define	DBG_INIT	__BIT(0)
     86      1.1  nonaka #define	DBG_FN		__BIT(1)
     87      1.1  nonaka #define	DBG_TX		__BIT(2)
     88      1.1  nonaka #define	DBG_RX		__BIT(3)
     89      1.1  nonaka #define	DBG_STM		__BIT(4)
     90      1.1  nonaka #define	DBG_RF		__BIT(5)
     91      1.1  nonaka #define	DBG_REG		__BIT(6)
     92      1.1  nonaka #define	DBG_ALL		0xffffffffU
     93  1.5.4.1     tls u_int urtwn_debug = 0;
     94      1.1  nonaka #define DPRINTFN(n, s)	\
     95      1.1  nonaka 	do { if (urtwn_debug & (n)) printf s; } while (/*CONSTCOND*/0)
     96      1.1  nonaka #else
     97      1.1  nonaka #define DPRINTFN(n, s)
     98      1.1  nonaka #endif
     99      1.1  nonaka 
    100  1.5.4.3     tls #define URTWN_DEV(v,p)	{ { USB_VENDOR_##v, USB_PRODUCT_##v##_##p }, 0 }
    101  1.5.4.3     tls #define URTWN_RTL8188E_DEV(v,p) \
    102  1.5.4.3     tls 	{ { USB_VENDOR_##v, USB_PRODUCT_##v##_##p }, FLAG_RTL8188E }
    103  1.5.4.3     tls static const struct urtwn_dev {
    104  1.5.4.3     tls 	struct usb_devno	dev;
    105  1.5.4.3     tls 	uint32_t		flags;
    106  1.5.4.3     tls #define	FLAG_RTL8188E	__BIT(0)
    107  1.5.4.3     tls } urtwn_devs[] = {
    108  1.5.4.3     tls 	URTWN_DEV(ABOCOM,	RTL8188CU_1),
    109  1.5.4.3     tls 	URTWN_DEV(ABOCOM,	RTL8188CU_2),
    110  1.5.4.3     tls 	URTWN_DEV(ABOCOM,	RTL8192CU),
    111  1.5.4.3     tls 	URTWN_DEV(ASUSTEK,	RTL8192CU),
    112  1.5.4.3     tls 	URTWN_DEV(ASUSTEK,	USBN10NANO),
    113  1.5.4.3     tls 	URTWN_DEV(AZUREWAVE,	RTL8188CE_1),
    114  1.5.4.3     tls 	URTWN_DEV(AZUREWAVE,	RTL8188CE_2),
    115  1.5.4.3     tls 	URTWN_DEV(AZUREWAVE,	RTL8188CU),
    116  1.5.4.3     tls 	URTWN_DEV(BELKIN,	RTL8188CU),
    117  1.5.4.3     tls 	URTWN_DEV(BELKIN,	RTL8192CU),
    118  1.5.4.3     tls 	URTWN_DEV(CHICONY,	RTL8188CUS_1),
    119  1.5.4.3     tls 	URTWN_DEV(CHICONY,	RTL8188CUS_2),
    120  1.5.4.3     tls 	URTWN_DEV(CHICONY,	RTL8188CUS_3),
    121  1.5.4.3     tls 	URTWN_DEV(CHICONY,	RTL8188CUS_4),
    122  1.5.4.3     tls 	URTWN_DEV(CHICONY,	RTL8188CUS_5),
    123  1.5.4.3     tls 	URTWN_DEV(COREGA,	RTL8192CU),
    124  1.5.4.3     tls 	URTWN_DEV(DLINK,	RTL8188CU),
    125  1.5.4.3     tls 	URTWN_DEV(DLINK,	RTL8192CU_1),
    126  1.5.4.3     tls 	URTWN_DEV(DLINK,	RTL8192CU_2),
    127  1.5.4.3     tls 	URTWN_DEV(DLINK,	RTL8192CU_3),
    128  1.5.4.3     tls 	URTWN_DEV(EDIMAX,	RTL8188CU),
    129  1.5.4.3     tls 	URTWN_DEV(EDIMAX,	RTL8192CU),
    130  1.5.4.3     tls 	URTWN_DEV(FEIXUN,	RTL8188CU),
    131  1.5.4.3     tls 	URTWN_DEV(FEIXUN,	RTL8192CU),
    132  1.5.4.3     tls 	URTWN_DEV(GUILLEMOT,	HWNUP150),
    133  1.5.4.3     tls 	URTWN_DEV(HAWKING,	RTL8192CU),
    134  1.5.4.3     tls 	URTWN_DEV(HP3,		RTL8188CU),
    135  1.5.4.3     tls 	URTWN_DEV(NETGEAR,	WNA1000M),
    136  1.5.4.3     tls 	URTWN_DEV(NETGEAR,	RTL8192CU),
    137  1.5.4.3     tls 	URTWN_DEV(NETGEAR4,	RTL8188CU),
    138  1.5.4.3     tls 	URTWN_DEV(NOVATECH,	RTL8188CU),
    139  1.5.4.3     tls 	URTWN_DEV(PLANEX2,	RTL8188CU_1),
    140  1.5.4.3     tls 	URTWN_DEV(PLANEX2,	RTL8188CU_2),
    141  1.5.4.3     tls 	URTWN_DEV(PLANEX2,	RTL8192CU),
    142  1.5.4.3     tls 	URTWN_DEV(PLANEX2,	RTL8188CU_3),
    143  1.5.4.3     tls 	URTWN_DEV(PLANEX2,	RTL8188CU_4),
    144  1.5.4.3     tls 	URTWN_DEV(PLANEX2,	RTL8188CUS),
    145  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8188CE_0),
    146  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8188CE_1),
    147  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8188CTV),
    148  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8188CU_0),
    149  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8188CU_1),
    150  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8188CU_2),
    151  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8188CU_COMBO),
    152  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8188CUS),
    153  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8188RU),
    154  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8188RU_2),
    155  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8191CU),
    156  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8192CE),
    157  1.5.4.3     tls 	URTWN_DEV(REALTEK,	RTL8192CU),
    158  1.5.4.3     tls 	URTWN_DEV(SITECOMEU,	RTL8188CU),
    159  1.5.4.3     tls 	URTWN_DEV(SITECOMEU,	RTL8188CU_2),
    160  1.5.4.3     tls 	URTWN_DEV(SITECOMEU,	RTL8192CU),
    161  1.5.4.3     tls 	URTWN_DEV(SITECOMEU,	RTL8192CUR2),
    162  1.5.4.3     tls 	URTWN_DEV(TRENDNET,	RTL8188CU),
    163  1.5.4.3     tls 	URTWN_DEV(TRENDNET,	RTL8192CU),
    164  1.5.4.3     tls 	URTWN_DEV(ZYXEL,	RTL8192CU),
    165  1.5.4.3     tls 
    166  1.5.4.3     tls 	/* URTWN_RTL8188E */
    167  1.5.4.3     tls 	URTWN_RTL8188E_DEV(ELECOM, WDC150SU2M),
    168  1.5.4.3     tls 	URTWN_RTL8188E_DEV(REALTEK, RTL8188ETV),
    169  1.5.4.3     tls 	URTWN_RTL8188E_DEV(REALTEK, RTL8188EU),
    170      1.1  nonaka };
    171  1.5.4.3     tls #undef URTWN_DEV
    172  1.5.4.3     tls #undef URTWN_RTL8188E_DEV
    173      1.1  nonaka 
    174      1.1  nonaka static int	urtwn_match(device_t, cfdata_t, void *);
    175      1.1  nonaka static void	urtwn_attach(device_t, device_t, void *);
    176      1.1  nonaka static int	urtwn_detach(device_t, int);
    177      1.1  nonaka static int	urtwn_activate(device_t, enum devact);
    178      1.1  nonaka 
    179      1.1  nonaka CFATTACH_DECL_NEW(urtwn, sizeof(struct urtwn_softc), urtwn_match,
    180      1.1  nonaka     urtwn_attach, urtwn_detach, urtwn_activate);
    181      1.1  nonaka 
    182      1.1  nonaka static int	urtwn_open_pipes(struct urtwn_softc *);
    183      1.1  nonaka static void	urtwn_close_pipes(struct urtwn_softc *);
    184      1.1  nonaka static int	urtwn_alloc_rx_list(struct urtwn_softc *);
    185      1.1  nonaka static void	urtwn_free_rx_list(struct urtwn_softc *);
    186      1.1  nonaka static int	urtwn_alloc_tx_list(struct urtwn_softc *);
    187      1.1  nonaka static void	urtwn_free_tx_list(struct urtwn_softc *);
    188      1.1  nonaka static void	urtwn_task(void *);
    189      1.1  nonaka static void	urtwn_do_async(struct urtwn_softc *,
    190      1.1  nonaka 		    void (*)(struct urtwn_softc *, void *), void *, int);
    191      1.1  nonaka static void	urtwn_wait_async(struct urtwn_softc *);
    192      1.1  nonaka static int	urtwn_write_region_1(struct urtwn_softc *, uint16_t, uint8_t *,
    193      1.1  nonaka 		    int);
    194  1.5.4.1     tls static void	urtwn_write_1(struct urtwn_softc *, uint16_t, uint8_t);
    195  1.5.4.1     tls static void	urtwn_write_2(struct urtwn_softc *, uint16_t, uint16_t);
    196  1.5.4.1     tls static void	urtwn_write_4(struct urtwn_softc *, uint16_t, uint32_t);
    197  1.5.4.1     tls static int	urtwn_write_region(struct urtwn_softc *, uint16_t, uint8_t *,
    198  1.5.4.1     tls 		    int);
    199      1.1  nonaka static int	urtwn_read_region_1(struct urtwn_softc *, uint16_t, uint8_t *,
    200      1.1  nonaka 		    int);
    201  1.5.4.1     tls static uint8_t	urtwn_read_1(struct urtwn_softc *, uint16_t);
    202  1.5.4.1     tls static uint16_t	urtwn_read_2(struct urtwn_softc *, uint16_t);
    203  1.5.4.1     tls static uint32_t	urtwn_read_4(struct urtwn_softc *, uint16_t);
    204      1.1  nonaka static int	urtwn_fw_cmd(struct urtwn_softc *, uint8_t, const void *, int);
    205  1.5.4.3     tls static void	urtwn_r92c_rf_write(struct urtwn_softc *, int, uint8_t,
    206  1.5.4.3     tls 		    uint32_t);
    207  1.5.4.3     tls static void	urtwn_r88e_rf_write(struct urtwn_softc *, int, uint8_t,
    208  1.5.4.3     tls 		    uint32_t);
    209      1.1  nonaka static uint32_t	urtwn_rf_read(struct urtwn_softc *, int, uint8_t);
    210      1.1  nonaka static int	urtwn_llt_write(struct urtwn_softc *, uint32_t, uint32_t);
    211      1.1  nonaka static uint8_t	urtwn_efuse_read_1(struct urtwn_softc *, uint16_t);
    212      1.1  nonaka static void	urtwn_efuse_read(struct urtwn_softc *);
    213  1.5.4.3     tls static void	urtwn_efuse_switch_power(struct urtwn_softc *);
    214      1.1  nonaka static int	urtwn_read_chipid(struct urtwn_softc *);
    215  1.5.4.1     tls #ifdef URTWN_DEBUG
    216  1.5.4.1     tls static void	urtwn_dump_rom(struct urtwn_softc *, struct r92c_rom *);
    217  1.5.4.1     tls #endif
    218      1.1  nonaka static void	urtwn_read_rom(struct urtwn_softc *);
    219  1.5.4.3     tls static void	urtwn_r88e_read_rom(struct urtwn_softc *);
    220      1.1  nonaka static int	urtwn_media_change(struct ifnet *);
    221      1.1  nonaka static int	urtwn_ra_init(struct urtwn_softc *);
    222  1.5.4.1     tls static int	urtwn_get_nettype(struct urtwn_softc *);
    223  1.5.4.1     tls static void	urtwn_set_nettype0_msr(struct urtwn_softc *, uint8_t);
    224      1.1  nonaka static void	urtwn_tsf_sync_enable(struct urtwn_softc *);
    225      1.1  nonaka static void	urtwn_set_led(struct urtwn_softc *, int, int);
    226      1.1  nonaka static void	urtwn_calib_to(void *);
    227      1.1  nonaka static void	urtwn_calib_to_cb(struct urtwn_softc *, void *);
    228      1.1  nonaka static void	urtwn_next_scan(void *);
    229      1.1  nonaka static int	urtwn_newstate(struct ieee80211com *, enum ieee80211_state,
    230      1.1  nonaka 		    int);
    231      1.1  nonaka static void	urtwn_newstate_cb(struct urtwn_softc *, void *);
    232      1.1  nonaka static int	urtwn_wme_update(struct ieee80211com *);
    233      1.1  nonaka static void	urtwn_wme_update_cb(struct urtwn_softc *, void *);
    234      1.1  nonaka static void	urtwn_update_avgrssi(struct urtwn_softc *, int, int8_t);
    235      1.1  nonaka static int8_t	urtwn_get_rssi(struct urtwn_softc *, int, void *);
    236  1.5.4.3     tls static int8_t	urtwn_r88e_get_rssi(struct urtwn_softc *, int, void *);
    237      1.1  nonaka static void	urtwn_rx_frame(struct urtwn_softc *, uint8_t *, int);
    238      1.1  nonaka static void	urtwn_rxeof(usbd_xfer_handle, usbd_private_handle, usbd_status);
    239      1.1  nonaka static void	urtwn_txeof(usbd_xfer_handle, usbd_private_handle, usbd_status);
    240      1.1  nonaka static int	urtwn_tx(struct urtwn_softc *, struct mbuf *,
    241  1.5.4.1     tls 		    struct ieee80211_node *, struct urtwn_tx_data *);
    242      1.1  nonaka static void	urtwn_start(struct ifnet *);
    243      1.1  nonaka static void	urtwn_watchdog(struct ifnet *);
    244      1.1  nonaka static int	urtwn_ioctl(struct ifnet *, u_long, void *);
    245  1.5.4.3     tls static int	urtwn_r92c_power_on(struct urtwn_softc *);
    246  1.5.4.3     tls static int	urtwn_r88e_power_on(struct urtwn_softc *);
    247      1.1  nonaka static int	urtwn_llt_init(struct urtwn_softc *);
    248      1.1  nonaka static void	urtwn_fw_reset(struct urtwn_softc *);
    249  1.5.4.3     tls static void	urtwn_r88e_fw_reset(struct urtwn_softc *);
    250      1.1  nonaka static int	urtwn_fw_loadpage(struct urtwn_softc *, int, uint8_t *, int);
    251      1.1  nonaka static int	urtwn_load_firmware(struct urtwn_softc *);
    252  1.5.4.3     tls static int	urtwn_r92c_dma_init(struct urtwn_softc *);
    253  1.5.4.3     tls static int	urtwn_r88e_dma_init(struct urtwn_softc *);
    254      1.1  nonaka static void	urtwn_mac_init(struct urtwn_softc *);
    255      1.1  nonaka static void	urtwn_bb_init(struct urtwn_softc *);
    256      1.1  nonaka static void	urtwn_rf_init(struct urtwn_softc *);
    257      1.1  nonaka static void	urtwn_cam_init(struct urtwn_softc *);
    258      1.1  nonaka static void	urtwn_pa_bias_init(struct urtwn_softc *);
    259      1.1  nonaka static void	urtwn_rxfilter_init(struct urtwn_softc *);
    260      1.1  nonaka static void	urtwn_edca_init(struct urtwn_softc *);
    261      1.1  nonaka static void	urtwn_write_txpower(struct urtwn_softc *, int, uint16_t[]);
    262  1.5.4.2     tls static void	urtwn_get_txpower(struct urtwn_softc *, size_t, u_int, u_int,
    263      1.1  nonaka 		    uint16_t[]);
    264  1.5.4.3     tls static void	urtwn_r88e_get_txpower(struct urtwn_softc *, size_t, u_int,
    265  1.5.4.3     tls 		    u_int, uint16_t[]);
    266      1.1  nonaka static void	urtwn_set_txpower(struct urtwn_softc *, u_int, u_int);
    267      1.1  nonaka static void	urtwn_set_chan(struct urtwn_softc *, struct ieee80211_channel *,
    268      1.1  nonaka 		    u_int);
    269      1.1  nonaka static void	urtwn_iq_calib(struct urtwn_softc *, bool);
    270      1.1  nonaka static void	urtwn_lc_calib(struct urtwn_softc *);
    271      1.1  nonaka static void	urtwn_temp_calib(struct urtwn_softc *);
    272      1.1  nonaka static int	urtwn_init(struct ifnet *);
    273      1.1  nonaka static void	urtwn_stop(struct ifnet *, int);
    274  1.5.4.1     tls static int	urtwn_reset(struct ifnet *);
    275      1.1  nonaka static void	urtwn_chip_stop(struct urtwn_softc *);
    276  1.5.4.3     tls static void	urtwn_newassoc(struct ieee80211_node *, int);
    277      1.1  nonaka 
    278      1.1  nonaka /* Aliases. */
    279      1.1  nonaka #define	urtwn_bb_write	urtwn_write_4
    280      1.1  nonaka #define	urtwn_bb_read	urtwn_read_4
    281      1.1  nonaka 
    282  1.5.4.3     tls #define	urtwn_lookup(d,v,p)	((const struct urtwn_dev *)usb_lookup(d,v,p))
    283  1.5.4.3     tls 
    284      1.1  nonaka static int
    285      1.1  nonaka urtwn_match(device_t parent, cfdata_t match, void *aux)
    286      1.1  nonaka {
    287      1.1  nonaka 	struct usb_attach_arg *uaa = aux;
    288      1.1  nonaka 
    289  1.5.4.3     tls 	return ((urtwn_lookup(urtwn_devs, uaa->vendor, uaa->product) != NULL) ?
    290      1.1  nonaka 	    UMATCH_VENDOR_PRODUCT : UMATCH_NONE);
    291      1.1  nonaka }
    292      1.1  nonaka 
    293      1.1  nonaka static void
    294      1.1  nonaka urtwn_attach(device_t parent, device_t self, void *aux)
    295      1.1  nonaka {
    296      1.1  nonaka 	struct urtwn_softc *sc = device_private(self);
    297      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
    298      1.1  nonaka 	struct ifnet *ifp = &sc->sc_if;
    299      1.1  nonaka 	struct usb_attach_arg *uaa = aux;
    300      1.1  nonaka 	char *devinfop;
    301  1.5.4.3     tls 	const struct urtwn_dev *dev;
    302  1.5.4.2     tls 	size_t i;
    303  1.5.4.2     tls 	int error;
    304      1.1  nonaka 
    305      1.1  nonaka 	sc->sc_dev = self;
    306      1.1  nonaka 	sc->sc_udev = uaa->device;
    307      1.1  nonaka 
    308  1.5.4.3     tls 	sc->chip = 0;
    309  1.5.4.3     tls 	dev = urtwn_lookup(urtwn_devs, uaa->vendor, uaa->product);
    310  1.5.4.3     tls 	if (dev != NULL && ISSET(dev->flags, FLAG_RTL8188E))
    311  1.5.4.3     tls 		SET(sc->chip, URTWN_CHIP_88E);
    312  1.5.4.3     tls 
    313      1.1  nonaka 	aprint_naive("\n");
    314      1.1  nonaka 	aprint_normal("\n");
    315      1.1  nonaka 
    316  1.5.4.1     tls 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
    317  1.5.4.1     tls 
    318      1.1  nonaka 	devinfop = usbd_devinfo_alloc(sc->sc_udev, 0);
    319      1.1  nonaka 	aprint_normal_dev(self, "%s\n", devinfop);
    320      1.1  nonaka 	usbd_devinfo_free(devinfop);
    321      1.1  nonaka 
    322      1.1  nonaka 	mutex_init(&sc->sc_task_mtx, MUTEX_DEFAULT, IPL_NET);
    323  1.5.4.1     tls 	mutex_init(&sc->sc_tx_mtx, MUTEX_DEFAULT, IPL_NONE);
    324      1.1  nonaka 	mutex_init(&sc->sc_fwcmd_mtx, MUTEX_DEFAULT, IPL_NONE);
    325  1.5.4.1     tls 	mutex_init(&sc->sc_write_mtx, MUTEX_DEFAULT, IPL_NONE);
    326      1.1  nonaka 
    327  1.5.4.1     tls 	usb_init_task(&sc->sc_task, urtwn_task, sc, 0);
    328      1.1  nonaka 
    329      1.1  nonaka 	callout_init(&sc->sc_scan_to, 0);
    330      1.1  nonaka 	callout_setfunc(&sc->sc_scan_to, urtwn_next_scan, sc);
    331      1.1  nonaka 	callout_init(&sc->sc_calib_to, 0);
    332      1.1  nonaka 	callout_setfunc(&sc->sc_calib_to, urtwn_calib_to, sc);
    333      1.1  nonaka 
    334  1.5.4.1     tls 	error = usbd_set_config_no(sc->sc_udev, 1, 0);
    335  1.5.4.1     tls 	if (error != 0) {
    336  1.5.4.1     tls 		aprint_error_dev(self, "failed to set configuration"
    337  1.5.4.1     tls 		    ", err=%s\n", usbd_errstr(error));
    338      1.1  nonaka 		goto fail;
    339      1.1  nonaka 	}
    340      1.1  nonaka 
    341      1.1  nonaka 	/* Get the first interface handle. */
    342      1.1  nonaka 	error = usbd_device2interface_handle(sc->sc_udev, 0, &sc->sc_iface);
    343      1.1  nonaka 	if (error != 0) {
    344      1.1  nonaka 		aprint_error_dev(self, "could not get interface handle\n");
    345      1.1  nonaka 		goto fail;
    346      1.1  nonaka 	}
    347      1.1  nonaka 
    348      1.1  nonaka 	error = urtwn_read_chipid(sc);
    349      1.1  nonaka 	if (error != 0) {
    350      1.1  nonaka 		aprint_error_dev(self, "unsupported test chip\n");
    351      1.1  nonaka 		goto fail;
    352      1.1  nonaka 	}
    353      1.1  nonaka 
    354      1.1  nonaka 	/* Determine number of Tx/Rx chains. */
    355      1.1  nonaka 	if (sc->chip & URTWN_CHIP_92C) {
    356      1.1  nonaka 		sc->ntxchains = (sc->chip & URTWN_CHIP_92C_1T2R) ? 1 : 2;
    357      1.1  nonaka 		sc->nrxchains = 2;
    358      1.1  nonaka 	} else {
    359      1.1  nonaka 		sc->ntxchains = 1;
    360      1.1  nonaka 		sc->nrxchains = 1;
    361      1.1  nonaka 	}
    362  1.5.4.3     tls 
    363  1.5.4.3     tls 	if (ISSET(sc->chip, URTWN_CHIP_88E))
    364  1.5.4.3     tls 		urtwn_r88e_read_rom(sc);
    365  1.5.4.3     tls 	else
    366  1.5.4.3     tls 		urtwn_read_rom(sc);
    367      1.1  nonaka 
    368  1.5.4.2     tls 	aprint_normal_dev(self, "MAC/BB RTL%s, RF 6052 %zdT%zdR, address %s\n",
    369      1.1  nonaka 	    (sc->chip & URTWN_CHIP_92C) ? "8192CU" :
    370  1.5.4.3     tls 	    (sc->chip & URTWN_CHIP_88E) ? "8188EU" :
    371      1.1  nonaka 	    (sc->board_type == R92C_BOARD_TYPE_HIGHPA) ? "8188RU" :
    372      1.1  nonaka 	    (sc->board_type == R92C_BOARD_TYPE_MINICARD) ? "8188CE-VAU" :
    373      1.1  nonaka 	    "8188CUS", sc->ntxchains, sc->nrxchains,
    374      1.1  nonaka 	    ether_sprintf(ic->ic_myaddr));
    375      1.1  nonaka 
    376      1.1  nonaka 	error = urtwn_open_pipes(sc);
    377      1.1  nonaka 	if (error != 0) {
    378      1.1  nonaka 		aprint_error_dev(sc->sc_dev, "could not open pipes\n");
    379      1.1  nonaka 		goto fail;
    380      1.1  nonaka 	}
    381      1.1  nonaka 	aprint_normal_dev(self, "%d rx pipe%s, %d tx pipe%s\n",
    382      1.1  nonaka 	    sc->rx_npipe, sc->rx_npipe > 1 ? "s" : "",
    383      1.1  nonaka 	    sc->tx_npipe, sc->tx_npipe > 1 ? "s" : "");
    384      1.1  nonaka 
    385      1.1  nonaka 	/*
    386      1.1  nonaka 	 * Setup the 802.11 device.
    387      1.1  nonaka 	 */
    388      1.1  nonaka 	ic->ic_ifp = ifp;
    389      1.1  nonaka 	ic->ic_phytype = IEEE80211_T_OFDM;	/* Not only, but not used. */
    390      1.1  nonaka 	ic->ic_opmode = IEEE80211_M_STA;	/* Default to BSS mode. */
    391      1.1  nonaka 	ic->ic_state = IEEE80211_S_INIT;
    392      1.1  nonaka 
    393      1.1  nonaka 	/* Set device capabilities. */
    394      1.1  nonaka 	ic->ic_caps =
    395      1.1  nonaka 	    IEEE80211_C_MONITOR |	/* Monitor mode supported. */
    396  1.5.4.3     tls 	    IEEE80211_C_IBSS |		/* IBSS mode supported */
    397  1.5.4.3     tls 	    IEEE80211_C_HOSTAP |	/* HostAp mode supported */
    398      1.1  nonaka 	    IEEE80211_C_SHPREAMBLE |	/* Short preamble supported. */
    399      1.1  nonaka 	    IEEE80211_C_SHSLOT |	/* Short slot time supported. */
    400      1.1  nonaka 	    IEEE80211_C_WME |		/* 802.11e */
    401      1.1  nonaka 	    IEEE80211_C_WPA;		/* 802.11i */
    402      1.1  nonaka 
    403      1.1  nonaka 	/* Set supported .11b and .11g rates. */
    404      1.1  nonaka 	ic->ic_sup_rates[IEEE80211_MODE_11B] = ieee80211_std_rateset_11b;
    405      1.1  nonaka 	ic->ic_sup_rates[IEEE80211_MODE_11G] = ieee80211_std_rateset_11g;
    406      1.1  nonaka 
    407      1.1  nonaka 	/* Set supported .11b and .11g channels (1 through 14). */
    408      1.1  nonaka 	for (i = 1; i <= 14; i++) {
    409      1.1  nonaka 		ic->ic_channels[i].ic_freq =
    410      1.1  nonaka 		    ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ);
    411      1.1  nonaka 		ic->ic_channels[i].ic_flags =
    412      1.1  nonaka 		    IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM |
    413      1.1  nonaka 		    IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ;
    414      1.1  nonaka 	}
    415      1.1  nonaka 
    416      1.1  nonaka 	ifp->if_softc = sc;
    417      1.1  nonaka 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    418      1.1  nonaka 	ifp->if_init = urtwn_init;
    419      1.1  nonaka 	ifp->if_ioctl = urtwn_ioctl;
    420      1.1  nonaka 	ifp->if_start = urtwn_start;
    421      1.1  nonaka 	ifp->if_watchdog = urtwn_watchdog;
    422      1.1  nonaka 	IFQ_SET_READY(&ifp->if_snd);
    423      1.1  nonaka 	memcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
    424      1.1  nonaka 
    425      1.1  nonaka 	if_attach(ifp);
    426      1.1  nonaka 	ieee80211_ifattach(ic);
    427  1.5.4.1     tls 
    428      1.1  nonaka 	/* override default methods */
    429  1.5.4.3     tls 	ic->ic_newassoc = urtwn_newassoc;
    430  1.5.4.1     tls 	ic->ic_reset = urtwn_reset;
    431      1.1  nonaka 	ic->ic_wme.wme_update = urtwn_wme_update;
    432      1.1  nonaka 
    433      1.1  nonaka 	/* Override state transition machine. */
    434      1.1  nonaka 	sc->sc_newstate = ic->ic_newstate;
    435      1.1  nonaka 	ic->ic_newstate = urtwn_newstate;
    436      1.1  nonaka 	ieee80211_media_init(ic, urtwn_media_change, ieee80211_media_status);
    437      1.1  nonaka 
    438      1.1  nonaka 	bpf_attach2(ifp, DLT_IEEE802_11_RADIO,
    439      1.1  nonaka 	    sizeof(struct ieee80211_frame) + IEEE80211_RADIOTAP_HDRLEN,
    440      1.1  nonaka 	    &sc->sc_drvbpf);
    441      1.1  nonaka 
    442      1.1  nonaka 	sc->sc_rxtap_len = sizeof(sc->sc_rxtapu);
    443      1.1  nonaka 	sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len);
    444      1.1  nonaka 	sc->sc_rxtap.wr_ihdr.it_present = htole32(URTWN_RX_RADIOTAP_PRESENT);
    445      1.1  nonaka 
    446      1.1  nonaka 	sc->sc_txtap_len = sizeof(sc->sc_txtapu);
    447      1.1  nonaka 	sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len);
    448      1.1  nonaka 	sc->sc_txtap.wt_ihdr.it_present = htole32(URTWN_TX_RADIOTAP_PRESENT);
    449      1.1  nonaka 
    450      1.1  nonaka 	ieee80211_announce(ic);
    451      1.1  nonaka 
    452      1.1  nonaka 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, sc->sc_dev);
    453      1.1  nonaka 
    454  1.5.4.3     tls 	if (!pmf_device_register(self, NULL, NULL))
    455  1.5.4.3     tls 		aprint_error_dev(self, "couldn't establish power handler\n");
    456  1.5.4.3     tls 
    457      1.1  nonaka 	SET(sc->sc_flags, URTWN_FLAG_ATTACHED);
    458      1.1  nonaka 	return;
    459      1.1  nonaka 
    460      1.1  nonaka  fail:
    461      1.1  nonaka 	sc->sc_dying = 1;
    462      1.1  nonaka 	aprint_error_dev(self, "attach failed\n");
    463      1.1  nonaka }
    464      1.1  nonaka 
    465      1.1  nonaka static int
    466      1.1  nonaka urtwn_detach(device_t self, int flags)
    467      1.1  nonaka {
    468      1.1  nonaka 	struct urtwn_softc *sc = device_private(self);
    469      1.1  nonaka 	struct ifnet *ifp = &sc->sc_if;
    470      1.1  nonaka 	int s;
    471      1.1  nonaka 
    472      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
    473      1.1  nonaka 
    474  1.5.4.3     tls 	pmf_device_deregister(self);
    475  1.5.4.3     tls 
    476      1.1  nonaka 	s = splusb();
    477      1.1  nonaka 
    478      1.1  nonaka 	sc->sc_dying = 1;
    479      1.1  nonaka 
    480      1.1  nonaka 	callout_stop(&sc->sc_scan_to);
    481      1.1  nonaka 	callout_stop(&sc->sc_calib_to);
    482      1.1  nonaka 
    483      1.1  nonaka 	if (ISSET(sc->sc_flags, URTWN_FLAG_ATTACHED)) {
    484      1.1  nonaka 		usb_rem_task(sc->sc_udev, &sc->sc_task);
    485      1.1  nonaka 		urtwn_stop(ifp, 0);
    486      1.1  nonaka 
    487      1.1  nonaka 		ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
    488      1.1  nonaka 		bpf_detach(ifp);
    489      1.1  nonaka 		ieee80211_ifdetach(&sc->sc_ic);
    490      1.1  nonaka 		if_detach(ifp);
    491      1.1  nonaka 
    492      1.1  nonaka 		/* Abort and close Tx/Rx pipes. */
    493      1.1  nonaka 		urtwn_close_pipes(sc);
    494      1.1  nonaka 	}
    495      1.1  nonaka 
    496      1.1  nonaka 	splx(s);
    497      1.1  nonaka 
    498      1.1  nonaka 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev);
    499      1.1  nonaka 
    500      1.1  nonaka 	callout_destroy(&sc->sc_scan_to);
    501      1.1  nonaka 	callout_destroy(&sc->sc_calib_to);
    502  1.5.4.1     tls 
    503  1.5.4.1     tls 	mutex_destroy(&sc->sc_write_mtx);
    504      1.1  nonaka 	mutex_destroy(&sc->sc_fwcmd_mtx);
    505      1.1  nonaka 	mutex_destroy(&sc->sc_tx_mtx);
    506      1.1  nonaka 	mutex_destroy(&sc->sc_task_mtx);
    507      1.1  nonaka 
    508      1.1  nonaka 	return (0);
    509      1.1  nonaka }
    510      1.1  nonaka 
    511      1.1  nonaka static int
    512      1.1  nonaka urtwn_activate(device_t self, enum devact act)
    513      1.1  nonaka {
    514      1.1  nonaka 	struct urtwn_softc *sc = device_private(self);
    515      1.1  nonaka 
    516      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
    517      1.1  nonaka 
    518      1.1  nonaka 	switch (act) {
    519      1.1  nonaka 	case DVACT_DEACTIVATE:
    520      1.1  nonaka 		if_deactivate(sc->sc_ic.ic_ifp);
    521      1.1  nonaka 		return (0);
    522      1.1  nonaka 	default:
    523      1.1  nonaka 		return (EOPNOTSUPP);
    524      1.1  nonaka 	}
    525      1.1  nonaka }
    526      1.1  nonaka 
    527      1.1  nonaka static int
    528      1.1  nonaka urtwn_open_pipes(struct urtwn_softc *sc)
    529      1.1  nonaka {
    530      1.1  nonaka 	/* Bulk-out endpoints addresses (from highest to lowest prio). */
    531      1.1  nonaka 	static const uint8_t epaddr[] = { 0x02, 0x03, 0x05 };
    532      1.1  nonaka 	usb_interface_descriptor_t *id;
    533      1.1  nonaka 	usb_endpoint_descriptor_t *ed;
    534  1.5.4.2     tls 	size_t i, ntx = 0;
    535  1.5.4.2     tls 	int error;
    536      1.1  nonaka 
    537      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
    538      1.1  nonaka 
    539      1.1  nonaka 	/* Determine the number of bulk-out pipes. */
    540      1.1  nonaka 	id = usbd_get_interface_descriptor(sc->sc_iface);
    541      1.1  nonaka 	for (i = 0; i < id->bNumEndpoints; i++) {
    542      1.1  nonaka 		ed = usbd_interface2endpoint_descriptor(sc->sc_iface, i);
    543      1.1  nonaka 		if (ed != NULL &&
    544      1.1  nonaka 		    UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK &&
    545      1.1  nonaka 		    UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT)
    546      1.1  nonaka 			ntx++;
    547      1.1  nonaka 	}
    548  1.5.4.2     tls 	DPRINTFN(DBG_INIT, ("%s: %s: found %zd bulk-out pipes\n",
    549      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, ntx));
    550      1.1  nonaka 	if (ntx == 0 || ntx > R92C_MAX_EPOUT) {
    551      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
    552  1.5.4.2     tls 		    "%zd: invalid number of Tx bulk pipes\n", ntx);
    553      1.1  nonaka 		return (EIO);
    554      1.1  nonaka 	}
    555      1.1  nonaka 	sc->rx_npipe = 1;
    556      1.1  nonaka 	sc->tx_npipe = ntx;
    557      1.1  nonaka 
    558      1.1  nonaka 	/* Open bulk-in pipe at address 0x81. */
    559      1.1  nonaka 	error = usbd_open_pipe(sc->sc_iface, 0x81, USBD_EXCLUSIVE_USE,
    560      1.1  nonaka 	    &sc->rx_pipe);
    561      1.1  nonaka 	if (error != 0) {
    562  1.5.4.1     tls 		aprint_error_dev(sc->sc_dev, "could not open Rx bulk pipe"
    563  1.5.4.1     tls 		    ": %d\n", error);
    564      1.1  nonaka 		goto fail;
    565      1.1  nonaka 	}
    566      1.1  nonaka 
    567      1.1  nonaka 	/* Open bulk-out pipes (up to 3). */
    568      1.1  nonaka 	for (i = 0; i < ntx; i++) {
    569      1.1  nonaka 		error = usbd_open_pipe(sc->sc_iface, epaddr[i],
    570      1.1  nonaka 		    USBD_EXCLUSIVE_USE, &sc->tx_pipe[i]);
    571      1.1  nonaka 		if (error != 0) {
    572      1.1  nonaka 			aprint_error_dev(sc->sc_dev,
    573  1.5.4.1     tls 			    "could not open Tx bulk pipe 0x%02x: %d\n",
    574  1.5.4.1     tls 			    epaddr[i], error);
    575      1.1  nonaka 			goto fail;
    576      1.1  nonaka 		}
    577      1.1  nonaka 	}
    578      1.1  nonaka 
    579      1.1  nonaka 	/* Map 802.11 access categories to USB pipes. */
    580      1.1  nonaka 	sc->ac2idx[WME_AC_BK] =
    581      1.1  nonaka 	sc->ac2idx[WME_AC_BE] = (ntx == 3) ? 2 : ((ntx == 2) ? 1 : 0);
    582      1.1  nonaka 	sc->ac2idx[WME_AC_VI] = (ntx == 3) ? 1 : 0;
    583      1.1  nonaka 	sc->ac2idx[WME_AC_VO] = 0;	/* Always use highest prio. */
    584      1.1  nonaka 
    585      1.1  nonaka  fail:
    586      1.1  nonaka 	if (error != 0)
    587      1.1  nonaka 		urtwn_close_pipes(sc);
    588      1.1  nonaka 	return (error);
    589      1.1  nonaka }
    590      1.1  nonaka 
    591      1.1  nonaka static void
    592      1.1  nonaka urtwn_close_pipes(struct urtwn_softc *sc)
    593      1.1  nonaka {
    594  1.5.4.2     tls 	usbd_pipe_handle pipe;
    595  1.5.4.2     tls 	size_t i;
    596      1.1  nonaka 
    597      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
    598      1.1  nonaka 
    599      1.1  nonaka 	/* Close Rx pipe. */
    600  1.5.4.2     tls 	CTASSERT(sizeof(pipe) == sizeof(void *));
    601  1.5.4.2     tls 	pipe = atomic_swap_ptr(&sc->rx_pipe, NULL);
    602  1.5.4.2     tls 	if (pipe != NULL) {
    603  1.5.4.2     tls 		usbd_abort_pipe(pipe);
    604  1.5.4.2     tls 		usbd_close_pipe(pipe);
    605      1.1  nonaka 	}
    606      1.1  nonaka 	/* Close Tx pipes. */
    607      1.1  nonaka 	for (i = 0; i < R92C_MAX_EPOUT; i++) {
    608  1.5.4.2     tls 		pipe = atomic_swap_ptr(&sc->tx_pipe[i], NULL);
    609  1.5.4.2     tls 		if (pipe != NULL) {
    610  1.5.4.2     tls 			usbd_abort_pipe(pipe);
    611  1.5.4.2     tls 			usbd_close_pipe(pipe);
    612  1.5.4.2     tls 		}
    613      1.1  nonaka 	}
    614      1.1  nonaka }
    615      1.1  nonaka 
    616      1.1  nonaka static int
    617      1.1  nonaka urtwn_alloc_rx_list(struct urtwn_softc *sc)
    618      1.1  nonaka {
    619      1.1  nonaka 	struct urtwn_rx_data *data;
    620  1.5.4.2     tls 	size_t i;
    621  1.5.4.2     tls 	int error = 0;
    622      1.1  nonaka 
    623      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
    624      1.1  nonaka 
    625      1.1  nonaka 	for (i = 0; i < URTWN_RX_LIST_COUNT; i++) {
    626      1.1  nonaka 		data = &sc->rx_data[i];
    627      1.1  nonaka 
    628      1.1  nonaka 		data->sc = sc;	/* Backpointer for callbacks. */
    629      1.1  nonaka 
    630      1.1  nonaka 		data->xfer = usbd_alloc_xfer(sc->sc_udev);
    631      1.1  nonaka 		if (data->xfer == NULL) {
    632      1.1  nonaka 			aprint_error_dev(sc->sc_dev,
    633      1.1  nonaka 			    "could not allocate xfer\n");
    634      1.1  nonaka 			error = ENOMEM;
    635      1.1  nonaka 			break;
    636      1.1  nonaka 		}
    637      1.1  nonaka 
    638      1.1  nonaka 		data->buf = usbd_alloc_buffer(data->xfer, URTWN_RXBUFSZ);
    639      1.1  nonaka 		if (data->buf == NULL) {
    640      1.1  nonaka 			aprint_error_dev(sc->sc_dev,
    641      1.1  nonaka 			    "could not allocate xfer buffer\n");
    642      1.1  nonaka 			error = ENOMEM;
    643      1.1  nonaka 			break;
    644      1.1  nonaka 		}
    645      1.1  nonaka 	}
    646      1.1  nonaka 	if (error != 0)
    647      1.1  nonaka 		urtwn_free_rx_list(sc);
    648      1.1  nonaka 	return (error);
    649      1.1  nonaka }
    650      1.1  nonaka 
    651      1.1  nonaka static void
    652      1.1  nonaka urtwn_free_rx_list(struct urtwn_softc *sc)
    653      1.1  nonaka {
    654  1.5.4.2     tls 	usbd_xfer_handle xfer;
    655  1.5.4.2     tls 	size_t i;
    656      1.1  nonaka 
    657      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
    658      1.1  nonaka 
    659      1.1  nonaka 	/* NB: Caller must abort pipe first. */
    660      1.1  nonaka 	for (i = 0; i < URTWN_RX_LIST_COUNT; i++) {
    661  1.5.4.2     tls 		CTASSERT(sizeof(xfer) == sizeof(void *));
    662  1.5.4.2     tls 		xfer = atomic_swap_ptr(&sc->rx_data[i].xfer, NULL);
    663  1.5.4.2     tls 		if (xfer != NULL)
    664  1.5.4.2     tls 			usbd_free_xfer(xfer);
    665      1.1  nonaka 	}
    666      1.1  nonaka }
    667      1.1  nonaka 
    668      1.1  nonaka static int
    669      1.1  nonaka urtwn_alloc_tx_list(struct urtwn_softc *sc)
    670      1.1  nonaka {
    671      1.1  nonaka 	struct urtwn_tx_data *data;
    672  1.5.4.2     tls 	size_t i;
    673  1.5.4.2     tls 	int error = 0;
    674      1.1  nonaka 
    675      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
    676      1.1  nonaka 
    677      1.1  nonaka 	mutex_enter(&sc->sc_tx_mtx);
    678      1.1  nonaka 	TAILQ_INIT(&sc->tx_free_list);
    679      1.1  nonaka 	for (i = 0; i < URTWN_TX_LIST_COUNT; i++) {
    680      1.1  nonaka 		data = &sc->tx_data[i];
    681      1.1  nonaka 
    682      1.1  nonaka 		data->sc = sc;	/* Backpointer for callbacks. */
    683      1.1  nonaka 
    684      1.1  nonaka 		data->xfer = usbd_alloc_xfer(sc->sc_udev);
    685      1.1  nonaka 		if (data->xfer == NULL) {
    686      1.1  nonaka 			aprint_error_dev(sc->sc_dev,
    687      1.1  nonaka 			    "could not allocate xfer\n");
    688      1.1  nonaka 			error = ENOMEM;
    689      1.1  nonaka 			goto fail;
    690      1.1  nonaka 		}
    691      1.1  nonaka 
    692      1.1  nonaka 		data->buf = usbd_alloc_buffer(data->xfer, URTWN_TXBUFSZ);
    693      1.1  nonaka 		if (data->buf == NULL) {
    694      1.1  nonaka 			aprint_error_dev(sc->sc_dev,
    695      1.1  nonaka 			    "could not allocate xfer buffer\n");
    696      1.1  nonaka 			error = ENOMEM;
    697      1.1  nonaka 			goto fail;
    698      1.1  nonaka 		}
    699      1.1  nonaka 
    700      1.1  nonaka 		/* Append this Tx buffer to our free list. */
    701      1.1  nonaka 		TAILQ_INSERT_TAIL(&sc->tx_free_list, data, next);
    702      1.1  nonaka 	}
    703      1.1  nonaka 	mutex_exit(&sc->sc_tx_mtx);
    704      1.1  nonaka 	return (0);
    705      1.1  nonaka 
    706      1.1  nonaka  fail:
    707      1.1  nonaka 	urtwn_free_tx_list(sc);
    708      1.2   skrll 	mutex_exit(&sc->sc_tx_mtx);
    709      1.1  nonaka 	return (error);
    710      1.1  nonaka }
    711      1.1  nonaka 
    712      1.1  nonaka static void
    713      1.1  nonaka urtwn_free_tx_list(struct urtwn_softc *sc)
    714      1.1  nonaka {
    715  1.5.4.2     tls 	usbd_xfer_handle xfer;
    716  1.5.4.2     tls 	size_t i;
    717      1.1  nonaka 
    718      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
    719      1.1  nonaka 
    720      1.1  nonaka 	/* NB: Caller must abort pipe first. */
    721      1.1  nonaka 	for (i = 0; i < URTWN_TX_LIST_COUNT; i++) {
    722  1.5.4.2     tls 		CTASSERT(sizeof(xfer) == sizeof(void *));
    723  1.5.4.2     tls 		xfer = atomic_swap_ptr(&sc->tx_data[i].xfer, NULL);
    724  1.5.4.2     tls 		if (xfer != NULL)
    725  1.5.4.2     tls 			usbd_free_xfer(xfer);
    726      1.1  nonaka 	}
    727      1.1  nonaka }
    728      1.1  nonaka 
    729      1.1  nonaka static void
    730      1.1  nonaka urtwn_task(void *arg)
    731      1.1  nonaka {
    732      1.1  nonaka 	struct urtwn_softc *sc = arg;
    733      1.1  nonaka 	struct urtwn_host_cmd_ring *ring = &sc->cmdq;
    734      1.1  nonaka 	struct urtwn_host_cmd *cmd;
    735      1.1  nonaka 	int s;
    736      1.1  nonaka 
    737      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
    738      1.1  nonaka 
    739      1.1  nonaka 	/* Process host commands. */
    740      1.1  nonaka 	s = splusb();
    741      1.1  nonaka 	mutex_spin_enter(&sc->sc_task_mtx);
    742      1.1  nonaka 	while (ring->next != ring->cur) {
    743      1.1  nonaka 		cmd = &ring->cmd[ring->next];
    744      1.1  nonaka 		mutex_spin_exit(&sc->sc_task_mtx);
    745      1.1  nonaka 		splx(s);
    746  1.5.4.1     tls 		/* Invoke callback with kernel lock held. */
    747      1.1  nonaka 		cmd->cb(sc, cmd->data);
    748      1.1  nonaka 		s = splusb();
    749      1.1  nonaka 		mutex_spin_enter(&sc->sc_task_mtx);
    750      1.1  nonaka 		ring->queued--;
    751      1.1  nonaka 		ring->next = (ring->next + 1) % URTWN_HOST_CMD_RING_COUNT;
    752      1.1  nonaka 	}
    753      1.1  nonaka 	mutex_spin_exit(&sc->sc_task_mtx);
    754      1.1  nonaka 	wakeup(&sc->cmdq);
    755      1.1  nonaka 	splx(s);
    756      1.1  nonaka }
    757      1.1  nonaka 
    758      1.1  nonaka static void
    759      1.1  nonaka urtwn_do_async(struct urtwn_softc *sc, void (*cb)(struct urtwn_softc *, void *),
    760      1.1  nonaka     void *arg, int len)
    761      1.1  nonaka {
    762      1.1  nonaka 	struct urtwn_host_cmd_ring *ring = &sc->cmdq;
    763      1.1  nonaka 	struct urtwn_host_cmd *cmd;
    764      1.1  nonaka 	int s;
    765      1.1  nonaka 
    766      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: cb=%p, arg=%p, len=%d\n",
    767      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, cb, arg, len));
    768      1.1  nonaka 
    769      1.1  nonaka 	s = splusb();
    770      1.1  nonaka 	mutex_spin_enter(&sc->sc_task_mtx);
    771      1.1  nonaka 	cmd = &ring->cmd[ring->cur];
    772      1.1  nonaka 	cmd->cb = cb;
    773      1.1  nonaka 	KASSERT(len <= sizeof(cmd->data));
    774      1.1  nonaka 	memcpy(cmd->data, arg, len);
    775      1.1  nonaka 	ring->cur = (ring->cur + 1) % URTWN_HOST_CMD_RING_COUNT;
    776      1.1  nonaka 
    777      1.1  nonaka 	/* If there is no pending command already, schedule a task. */
    778      1.1  nonaka 	if (!sc->sc_dying && ++ring->queued == 1) {
    779      1.1  nonaka 		mutex_spin_exit(&sc->sc_task_mtx);
    780      1.1  nonaka 		usb_add_task(sc->sc_udev, &sc->sc_task, USB_TASKQ_DRIVER);
    781      1.1  nonaka 	} else
    782      1.1  nonaka 		mutex_spin_exit(&sc->sc_task_mtx);
    783      1.1  nonaka 	splx(s);
    784      1.1  nonaka }
    785      1.1  nonaka 
    786      1.1  nonaka static void
    787      1.1  nonaka urtwn_wait_async(struct urtwn_softc *sc)
    788      1.1  nonaka {
    789      1.1  nonaka 
    790      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
    791      1.1  nonaka 
    792      1.1  nonaka 	/* Wait for all queued asynchronous commands to complete. */
    793      1.1  nonaka 	while (sc->cmdq.queued > 0)
    794      1.1  nonaka 		tsleep(&sc->cmdq, 0, "endtask", 0);
    795      1.1  nonaka }
    796      1.1  nonaka 
    797      1.1  nonaka static int
    798      1.1  nonaka urtwn_write_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf,
    799      1.1  nonaka     int len)
    800      1.1  nonaka {
    801      1.1  nonaka 	usb_device_request_t req;
    802      1.1  nonaka 	usbd_status error;
    803      1.1  nonaka 
    804  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
    805  1.5.4.1     tls 
    806      1.1  nonaka 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    807      1.1  nonaka 	req.bRequest = R92C_REQ_REGS;
    808      1.1  nonaka 	USETW(req.wValue, addr);
    809      1.1  nonaka 	USETW(req.wIndex, 0);
    810      1.1  nonaka 	USETW(req.wLength, len);
    811      1.1  nonaka 	error = usbd_do_request(sc->sc_udev, &req, buf);
    812      1.1  nonaka 	if (error != USBD_NORMAL_COMPLETION) {
    813      1.1  nonaka 		DPRINTFN(DBG_REG, ("%s: %s: error=%d: addr=0x%x, len=%d\n",
    814      1.1  nonaka 		    device_xname(sc->sc_dev), __func__, error, addr, len));
    815      1.1  nonaka 	}
    816      1.1  nonaka 	return (error);
    817      1.1  nonaka }
    818      1.1  nonaka 
    819      1.1  nonaka static void
    820      1.1  nonaka urtwn_write_1(struct urtwn_softc *sc, uint16_t addr, uint8_t val)
    821      1.1  nonaka {
    822      1.1  nonaka 
    823      1.1  nonaka 	DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
    824      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, addr, val));
    825      1.1  nonaka 
    826      1.1  nonaka 	urtwn_write_region_1(sc, addr, &val, 1);
    827      1.1  nonaka }
    828      1.1  nonaka 
    829      1.1  nonaka static void
    830      1.1  nonaka urtwn_write_2(struct urtwn_softc *sc, uint16_t addr, uint16_t val)
    831      1.1  nonaka {
    832      1.1  nonaka 	uint8_t buf[2];
    833      1.1  nonaka 
    834      1.1  nonaka 	DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
    835      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, addr, val));
    836      1.1  nonaka 
    837      1.1  nonaka 	buf[0] = (uint8_t)val;
    838      1.1  nonaka 	buf[1] = (uint8_t)(val >> 8);
    839      1.1  nonaka 	urtwn_write_region_1(sc, addr, buf, 2);
    840      1.1  nonaka }
    841      1.1  nonaka 
    842      1.1  nonaka static void
    843      1.1  nonaka urtwn_write_4(struct urtwn_softc *sc, uint16_t addr, uint32_t val)
    844      1.1  nonaka {
    845      1.1  nonaka 	uint8_t buf[4];
    846      1.1  nonaka 
    847      1.1  nonaka 	DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
    848      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, addr, val));
    849      1.1  nonaka 
    850      1.1  nonaka 	buf[0] = (uint8_t)val;
    851      1.1  nonaka 	buf[1] = (uint8_t)(val >> 8);
    852      1.1  nonaka 	buf[2] = (uint8_t)(val >> 16);
    853      1.1  nonaka 	buf[3] = (uint8_t)(val >> 24);
    854      1.1  nonaka 	urtwn_write_region_1(sc, addr, buf, 4);
    855      1.1  nonaka }
    856      1.1  nonaka 
    857      1.1  nonaka static int
    858      1.1  nonaka urtwn_write_region(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, int len)
    859      1.1  nonaka {
    860      1.1  nonaka 
    861      1.1  nonaka 	DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, len=0x%x\n",
    862      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, addr, len));
    863      1.1  nonaka 
    864      1.1  nonaka 	return urtwn_write_region_1(sc, addr, buf, len);
    865      1.1  nonaka }
    866      1.1  nonaka 
    867      1.1  nonaka static int
    868      1.1  nonaka urtwn_read_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf,
    869      1.1  nonaka     int len)
    870      1.1  nonaka {
    871      1.1  nonaka 	usb_device_request_t req;
    872      1.1  nonaka 	usbd_status error;
    873      1.1  nonaka 
    874      1.1  nonaka 	req.bmRequestType = UT_READ_VENDOR_DEVICE;
    875      1.1  nonaka 	req.bRequest = R92C_REQ_REGS;
    876      1.1  nonaka 	USETW(req.wValue, addr);
    877      1.1  nonaka 	USETW(req.wIndex, 0);
    878      1.1  nonaka 	USETW(req.wLength, len);
    879      1.1  nonaka 	error = usbd_do_request(sc->sc_udev, &req, buf);
    880      1.1  nonaka 	if (error != USBD_NORMAL_COMPLETION) {
    881      1.1  nonaka 		DPRINTFN(DBG_REG, ("%s: %s: error=%d: addr=0x%x, len=%d\n",
    882      1.1  nonaka 		    device_xname(sc->sc_dev), __func__, error, addr, len));
    883      1.1  nonaka 	}
    884      1.1  nonaka 	return (error);
    885      1.1  nonaka }
    886      1.1  nonaka 
    887      1.1  nonaka static uint8_t
    888      1.1  nonaka urtwn_read_1(struct urtwn_softc *sc, uint16_t addr)
    889      1.1  nonaka {
    890      1.1  nonaka 	uint8_t val;
    891      1.1  nonaka 
    892      1.1  nonaka 	if (urtwn_read_region_1(sc, addr, &val, 1) != USBD_NORMAL_COMPLETION)
    893      1.1  nonaka 		return (0xff);
    894      1.1  nonaka 
    895      1.1  nonaka 	DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
    896      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, addr, val));
    897      1.1  nonaka 	return (val);
    898      1.1  nonaka }
    899      1.1  nonaka 
    900      1.1  nonaka static uint16_t
    901      1.1  nonaka urtwn_read_2(struct urtwn_softc *sc, uint16_t addr)
    902      1.1  nonaka {
    903      1.1  nonaka 	uint8_t buf[2];
    904      1.1  nonaka 	uint16_t val;
    905      1.1  nonaka 
    906      1.1  nonaka 	if (urtwn_read_region_1(sc, addr, buf, 2) != USBD_NORMAL_COMPLETION)
    907      1.1  nonaka 		return (0xffff);
    908      1.1  nonaka 
    909      1.1  nonaka 	val = LE_READ_2(&buf[0]);
    910      1.1  nonaka 	DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
    911      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, addr, val));
    912      1.1  nonaka 	return (val);
    913      1.1  nonaka }
    914      1.1  nonaka 
    915      1.1  nonaka static uint32_t
    916      1.1  nonaka urtwn_read_4(struct urtwn_softc *sc, uint16_t addr)
    917      1.1  nonaka {
    918      1.1  nonaka 	uint8_t buf[4];
    919      1.1  nonaka 	uint32_t val;
    920      1.1  nonaka 
    921      1.1  nonaka 	if (urtwn_read_region_1(sc, addr, buf, 4) != USBD_NORMAL_COMPLETION)
    922      1.1  nonaka 		return (0xffffffff);
    923      1.1  nonaka 
    924      1.1  nonaka 	val = LE_READ_4(&buf[0]);
    925      1.1  nonaka 	DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
    926      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, addr, val));
    927      1.1  nonaka 	return (val);
    928      1.1  nonaka }
    929      1.1  nonaka 
    930      1.1  nonaka static int
    931      1.1  nonaka urtwn_fw_cmd(struct urtwn_softc *sc, uint8_t id, const void *buf, int len)
    932      1.1  nonaka {
    933      1.1  nonaka 	struct r92c_fw_cmd cmd;
    934      1.1  nonaka 	uint8_t *cp;
    935      1.1  nonaka 	int fwcur;
    936      1.1  nonaka 	int ntries;
    937      1.1  nonaka 
    938      1.1  nonaka 	DPRINTFN(DBG_REG, ("%s: %s: id=%d, buf=%p, len=%d\n",
    939      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, id, buf, len));
    940      1.1  nonaka 
    941  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
    942  1.5.4.1     tls 
    943      1.1  nonaka 	mutex_enter(&sc->sc_fwcmd_mtx);
    944      1.1  nonaka 	fwcur = sc->fwcur;
    945      1.1  nonaka 	sc->fwcur = (sc->fwcur + 1) % R92C_H2C_NBOX;
    946      1.1  nonaka 	mutex_exit(&sc->sc_fwcmd_mtx);
    947      1.1  nonaka 
    948      1.1  nonaka 	/* Wait for current FW box to be empty. */
    949      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
    950      1.1  nonaka 		if (!(urtwn_read_1(sc, R92C_HMETFR) & (1 << fwcur)))
    951      1.1  nonaka 			break;
    952      1.1  nonaka 		DELAY(1);
    953      1.1  nonaka 	}
    954      1.1  nonaka 	if (ntries == 100) {
    955      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
    956      1.1  nonaka 		    "could not send firmware command %d\n", id);
    957      1.1  nonaka 		return (ETIMEDOUT);
    958      1.1  nonaka 	}
    959      1.1  nonaka 
    960      1.1  nonaka 	memset(&cmd, 0, sizeof(cmd));
    961      1.1  nonaka 	KASSERT(len <= sizeof(cmd.msg));
    962      1.1  nonaka 	memcpy(cmd.msg, buf, len);
    963      1.1  nonaka 
    964      1.1  nonaka 	/* Write the first word last since that will trigger the FW. */
    965      1.1  nonaka 	cp = (uint8_t *)&cmd;
    966      1.1  nonaka 	if (len >= 4) {
    967      1.1  nonaka 		cmd.id = id | R92C_CMD_FLAG_EXT;
    968      1.1  nonaka 		urtwn_write_region(sc, R92C_HMEBOX_EXT(fwcur), &cp[1], 2);
    969      1.1  nonaka 		urtwn_write_4(sc, R92C_HMEBOX(fwcur),
    970      1.1  nonaka 		    cp[0] + (cp[3] << 8) + (cp[4] << 16) + (cp[5] << 24));
    971      1.1  nonaka 	} else {
    972      1.1  nonaka 		cmd.id = id;
    973      1.1  nonaka 		urtwn_write_region(sc, R92C_HMEBOX(fwcur), cp, len);
    974      1.1  nonaka 	}
    975      1.1  nonaka 
    976      1.1  nonaka 	return (0);
    977      1.1  nonaka }
    978      1.1  nonaka 
    979  1.5.4.3     tls static __inline void
    980      1.1  nonaka urtwn_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, uint32_t val)
    981      1.1  nonaka {
    982      1.1  nonaka 
    983  1.5.4.3     tls 	sc->sc_rf_write(sc, chain, addr, val);
    984  1.5.4.3     tls }
    985  1.5.4.3     tls 
    986  1.5.4.3     tls static void
    987  1.5.4.3     tls urtwn_r92c_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr,
    988  1.5.4.3     tls     uint32_t val)
    989  1.5.4.3     tls {
    990  1.5.4.3     tls 
    991      1.1  nonaka 	urtwn_bb_write(sc, R92C_LSSI_PARAM(chain),
    992      1.1  nonaka 	    SM(R92C_LSSI_PARAM_ADDR, addr) | SM(R92C_LSSI_PARAM_DATA, val));
    993      1.1  nonaka }
    994      1.1  nonaka 
    995  1.5.4.3     tls static void
    996  1.5.4.3     tls urtwn_r88e_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr,
    997  1.5.4.3     tls     uint32_t val)
    998  1.5.4.3     tls {
    999  1.5.4.3     tls 
   1000  1.5.4.3     tls 	urtwn_bb_write(sc, R92C_LSSI_PARAM(chain),
   1001  1.5.4.3     tls 	    SM(R88E_LSSI_PARAM_ADDR, addr) | SM(R92C_LSSI_PARAM_DATA, val));
   1002  1.5.4.3     tls }
   1003  1.5.4.3     tls 
   1004      1.1  nonaka static uint32_t
   1005      1.1  nonaka urtwn_rf_read(struct urtwn_softc *sc, int chain, uint8_t addr)
   1006      1.1  nonaka {
   1007      1.1  nonaka 	uint32_t reg[R92C_MAX_CHAINS], val;
   1008      1.1  nonaka 
   1009      1.1  nonaka 	reg[0] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(0));
   1010      1.1  nonaka 	if (chain != 0) {
   1011      1.1  nonaka 		reg[chain] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(chain));
   1012      1.1  nonaka 	}
   1013      1.1  nonaka 
   1014      1.1  nonaka 	urtwn_bb_write(sc, R92C_HSSI_PARAM2(0),
   1015      1.1  nonaka 	    reg[0] & ~R92C_HSSI_PARAM2_READ_EDGE);
   1016      1.1  nonaka 	DELAY(1000);
   1017      1.1  nonaka 
   1018      1.1  nonaka 	urtwn_bb_write(sc, R92C_HSSI_PARAM2(chain),
   1019      1.1  nonaka 	    RW(reg[chain], R92C_HSSI_PARAM2_READ_ADDR, addr) |
   1020      1.1  nonaka 	    R92C_HSSI_PARAM2_READ_EDGE);
   1021      1.1  nonaka 	DELAY(1000);
   1022      1.1  nonaka 
   1023      1.1  nonaka 	urtwn_bb_write(sc, R92C_HSSI_PARAM2(0),
   1024      1.1  nonaka 	    reg[0] | R92C_HSSI_PARAM2_READ_EDGE);
   1025      1.1  nonaka 	DELAY(1000);
   1026      1.1  nonaka 
   1027      1.1  nonaka 	if (urtwn_bb_read(sc, R92C_HSSI_PARAM1(chain)) & R92C_HSSI_PARAM1_PI) {
   1028      1.1  nonaka 		val = urtwn_bb_read(sc, R92C_HSPI_READBACK(chain));
   1029      1.1  nonaka 	} else {
   1030      1.1  nonaka 		val = urtwn_bb_read(sc, R92C_LSSI_READBACK(chain));
   1031      1.1  nonaka 	}
   1032      1.1  nonaka 	return (MS(val, R92C_LSSI_READBACK_DATA));
   1033      1.1  nonaka }
   1034      1.1  nonaka 
   1035      1.1  nonaka static int
   1036      1.1  nonaka urtwn_llt_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data)
   1037      1.1  nonaka {
   1038      1.1  nonaka 	int ntries;
   1039      1.1  nonaka 
   1040  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   1041  1.5.4.1     tls 
   1042      1.1  nonaka 	urtwn_write_4(sc, R92C_LLT_INIT,
   1043      1.1  nonaka 	    SM(R92C_LLT_INIT_OP, R92C_LLT_INIT_OP_WRITE) |
   1044      1.1  nonaka 	    SM(R92C_LLT_INIT_ADDR, addr) |
   1045      1.1  nonaka 	    SM(R92C_LLT_INIT_DATA, data));
   1046      1.1  nonaka 	/* Wait for write operation to complete. */
   1047      1.1  nonaka 	for (ntries = 0; ntries < 20; ntries++) {
   1048      1.1  nonaka 		if (MS(urtwn_read_4(sc, R92C_LLT_INIT), R92C_LLT_INIT_OP) ==
   1049      1.1  nonaka 		    R92C_LLT_INIT_OP_NO_ACTIVE) {
   1050      1.1  nonaka 			/* Done */
   1051      1.1  nonaka 			return (0);
   1052      1.1  nonaka 		}
   1053      1.1  nonaka 		DELAY(5);
   1054      1.1  nonaka 	}
   1055      1.1  nonaka 	return (ETIMEDOUT);
   1056      1.1  nonaka }
   1057      1.1  nonaka 
   1058      1.1  nonaka static uint8_t
   1059      1.1  nonaka urtwn_efuse_read_1(struct urtwn_softc *sc, uint16_t addr)
   1060      1.1  nonaka {
   1061      1.1  nonaka 	uint32_t reg;
   1062      1.1  nonaka 	int ntries;
   1063      1.1  nonaka 
   1064  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   1065  1.5.4.1     tls 
   1066      1.1  nonaka 	reg = urtwn_read_4(sc, R92C_EFUSE_CTRL);
   1067      1.1  nonaka 	reg = RW(reg, R92C_EFUSE_CTRL_ADDR, addr);
   1068      1.1  nonaka 	reg &= ~R92C_EFUSE_CTRL_VALID;
   1069      1.1  nonaka 	urtwn_write_4(sc, R92C_EFUSE_CTRL, reg);
   1070      1.1  nonaka 
   1071      1.1  nonaka 	/* Wait for read operation to complete. */
   1072      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   1073      1.1  nonaka 		reg = urtwn_read_4(sc, R92C_EFUSE_CTRL);
   1074      1.1  nonaka 		if (reg & R92C_EFUSE_CTRL_VALID) {
   1075      1.1  nonaka 			/* Done */
   1076      1.1  nonaka 			return (MS(reg, R92C_EFUSE_CTRL_DATA));
   1077      1.1  nonaka 		}
   1078      1.1  nonaka 		DELAY(5);
   1079      1.1  nonaka 	}
   1080      1.1  nonaka 	aprint_error_dev(sc->sc_dev,
   1081      1.1  nonaka 	    "could not read efuse byte at address 0x%04x\n", addr);
   1082      1.1  nonaka 	return (0xff);
   1083      1.1  nonaka }
   1084      1.1  nonaka 
   1085      1.1  nonaka static void
   1086      1.1  nonaka urtwn_efuse_read(struct urtwn_softc *sc)
   1087      1.1  nonaka {
   1088      1.1  nonaka 	uint8_t *rom = (uint8_t *)&sc->rom;
   1089      1.1  nonaka 	uint32_t reg;
   1090      1.1  nonaka 	uint16_t addr = 0;
   1091      1.1  nonaka 	uint8_t off, msk;
   1092  1.5.4.2     tls 	size_t i;
   1093      1.1  nonaka 
   1094      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   1095      1.1  nonaka 
   1096  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   1097  1.5.4.1     tls 
   1098  1.5.4.3     tls 	urtwn_efuse_switch_power(sc);
   1099  1.5.4.3     tls 
   1100      1.1  nonaka 	memset(&sc->rom, 0xff, sizeof(sc->rom));
   1101      1.1  nonaka 	while (addr < 512) {
   1102      1.1  nonaka 		reg = urtwn_efuse_read_1(sc, addr);
   1103      1.1  nonaka 		if (reg == 0xff)
   1104      1.1  nonaka 			break;
   1105      1.1  nonaka 		addr++;
   1106      1.1  nonaka 		off = reg >> 4;
   1107      1.1  nonaka 		msk = reg & 0xf;
   1108      1.1  nonaka 		for (i = 0; i < 4; i++) {
   1109      1.1  nonaka 			if (msk & (1U << i))
   1110      1.1  nonaka 				continue;
   1111      1.1  nonaka 
   1112      1.1  nonaka 			rom[off * 8 + i * 2 + 0] = urtwn_efuse_read_1(sc, addr);
   1113      1.1  nonaka 			addr++;
   1114      1.1  nonaka 			rom[off * 8 + i * 2 + 1] = urtwn_efuse_read_1(sc, addr);
   1115      1.1  nonaka 			addr++;
   1116      1.1  nonaka 		}
   1117      1.1  nonaka 	}
   1118      1.1  nonaka #ifdef URTWN_DEBUG
   1119      1.1  nonaka 	if (urtwn_debug & DBG_INIT) {
   1120      1.1  nonaka 		/* Dump ROM content. */
   1121      1.1  nonaka 		printf("%s: %s", device_xname(sc->sc_dev), __func__);
   1122      1.1  nonaka 		for (i = 0; i < (int)sizeof(sc->rom); i++)
   1123      1.1  nonaka 			printf(":%02x", rom[i]);
   1124      1.1  nonaka 		printf("\n");
   1125      1.1  nonaka 	}
   1126      1.1  nonaka #endif
   1127      1.1  nonaka }
   1128      1.1  nonaka 
   1129  1.5.4.3     tls static void
   1130  1.5.4.3     tls urtwn_efuse_switch_power(struct urtwn_softc *sc)
   1131  1.5.4.3     tls {
   1132  1.5.4.3     tls 	uint32_t reg;
   1133  1.5.4.3     tls 
   1134  1.5.4.3     tls 	reg = urtwn_read_2(sc, R92C_SYS_ISO_CTRL);
   1135  1.5.4.3     tls 	if (!(reg & R92C_SYS_ISO_CTRL_PWC_EV12V)) {
   1136  1.5.4.3     tls 		urtwn_write_2(sc, R92C_SYS_ISO_CTRL,
   1137  1.5.4.3     tls 		    reg | R92C_SYS_ISO_CTRL_PWC_EV12V);
   1138  1.5.4.3     tls 	}
   1139  1.5.4.3     tls 	reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
   1140  1.5.4.3     tls 	if (!(reg & R92C_SYS_FUNC_EN_ELDR)) {
   1141  1.5.4.3     tls 		urtwn_write_2(sc, R92C_SYS_FUNC_EN,
   1142  1.5.4.3     tls 		    reg | R92C_SYS_FUNC_EN_ELDR);
   1143  1.5.4.3     tls 	}
   1144  1.5.4.3     tls 	reg = urtwn_read_2(sc, R92C_SYS_CLKR);
   1145  1.5.4.3     tls 	if ((reg & (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) !=
   1146  1.5.4.3     tls 	    (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) {
   1147  1.5.4.3     tls 		urtwn_write_2(sc, R92C_SYS_CLKR,
   1148  1.5.4.3     tls 		    reg | R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M);
   1149  1.5.4.3     tls 	}
   1150  1.5.4.3     tls }
   1151  1.5.4.3     tls 
   1152      1.1  nonaka static int
   1153      1.1  nonaka urtwn_read_chipid(struct urtwn_softc *sc)
   1154      1.1  nonaka {
   1155      1.1  nonaka 	uint32_t reg;
   1156      1.1  nonaka 
   1157      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   1158      1.1  nonaka 
   1159  1.5.4.3     tls 	if (ISSET(sc->chip, URTWN_CHIP_88E))
   1160  1.5.4.3     tls 		return (0);
   1161  1.5.4.3     tls 
   1162      1.1  nonaka 	reg = urtwn_read_4(sc, R92C_SYS_CFG);
   1163      1.1  nonaka 	if (reg & R92C_SYS_CFG_TRP_VAUX_EN) {
   1164      1.1  nonaka 		/* test chip, not supported */
   1165      1.1  nonaka 		return (EIO);
   1166      1.1  nonaka 	}
   1167      1.1  nonaka 	if (reg & R92C_SYS_CFG_TYPE_92C) {
   1168      1.1  nonaka 		sc->chip |= URTWN_CHIP_92C;
   1169      1.1  nonaka 		/* Check if it is a castrated 8192C. */
   1170      1.1  nonaka 		if (MS(urtwn_read_4(sc, R92C_HPON_FSM),
   1171      1.1  nonaka 		    R92C_HPON_FSM_CHIP_BONDING_ID) ==
   1172      1.1  nonaka 		    R92C_HPON_FSM_CHIP_BONDING_ID_92C_1T2R) {
   1173      1.1  nonaka 			sc->chip |= URTWN_CHIP_92C_1T2R;
   1174      1.1  nonaka 		}
   1175      1.1  nonaka 	}
   1176      1.1  nonaka 	if (reg & R92C_SYS_CFG_VENDOR_UMC) {
   1177      1.1  nonaka 		sc->chip |= URTWN_CHIP_UMC;
   1178      1.1  nonaka 		if (MS(reg, R92C_SYS_CFG_CHIP_VER_RTL) == 0) {
   1179      1.1  nonaka 			sc->chip |= URTWN_CHIP_UMC_A_CUT;
   1180      1.1  nonaka 		}
   1181      1.1  nonaka 	}
   1182      1.1  nonaka 	return (0);
   1183      1.1  nonaka }
   1184      1.1  nonaka 
   1185      1.1  nonaka #ifdef URTWN_DEBUG
   1186      1.1  nonaka static void
   1187      1.1  nonaka urtwn_dump_rom(struct urtwn_softc *sc, struct r92c_rom *rp)
   1188      1.1  nonaka {
   1189      1.1  nonaka 
   1190      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1191      1.1  nonaka 	    "id 0x%04x, dbg_sel 0x%x, vid 0x%x, pid 0x%x\n",
   1192      1.1  nonaka 	    rp->id, rp->dbg_sel, rp->vid, rp->pid);
   1193      1.1  nonaka 
   1194      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1195      1.1  nonaka 	    "usb_opt 0x%x, ep_setting 0x%x, usb_phy 0x%x\n",
   1196      1.1  nonaka 	    rp->usb_opt, rp->ep_setting, rp->usb_phy);
   1197      1.1  nonaka 
   1198      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1199      1.1  nonaka 	    "macaddr %02x:%02x:%02x:%02x:%02x:%02x\n",
   1200      1.1  nonaka 	    rp->macaddr[0], rp->macaddr[1],
   1201      1.1  nonaka 	    rp->macaddr[2], rp->macaddr[3],
   1202      1.1  nonaka 	    rp->macaddr[4], rp->macaddr[5]);
   1203      1.1  nonaka 
   1204      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1205      1.1  nonaka 	    "string %s, subcustomer_id 0x%x\n",
   1206      1.1  nonaka 	    rp->string, rp->subcustomer_id);
   1207      1.1  nonaka 
   1208      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1209      1.1  nonaka 	    "cck_tx_pwr c0: %d %d %d, c1: %d %d %d\n",
   1210      1.1  nonaka 	    rp->cck_tx_pwr[0][0], rp->cck_tx_pwr[0][1], rp->cck_tx_pwr[0][2],
   1211      1.1  nonaka 	    rp->cck_tx_pwr[1][0], rp->cck_tx_pwr[1][1], rp->cck_tx_pwr[1][2]);
   1212      1.1  nonaka 
   1213      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1214      1.1  nonaka 	    "ht40_1s_tx_pwr c0 %d %d %d, c1 %d %d %d\n",
   1215      1.1  nonaka 	    rp->ht40_1s_tx_pwr[0][0], rp->ht40_1s_tx_pwr[0][1],
   1216      1.1  nonaka 	    rp->ht40_1s_tx_pwr[0][2],
   1217      1.1  nonaka 	    rp->ht40_1s_tx_pwr[1][0], rp->ht40_1s_tx_pwr[1][1],
   1218      1.1  nonaka 	    rp->ht40_1s_tx_pwr[1][2]);
   1219      1.1  nonaka 
   1220      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1221      1.1  nonaka 	    "ht40_2s_tx_pwr_diff c0: %d %d %d, c1: %d %d %d\n",
   1222      1.1  nonaka 	    rp->ht40_2s_tx_pwr_diff[0] & 0xf, rp->ht40_2s_tx_pwr_diff[1] & 0xf,
   1223      1.1  nonaka 	    rp->ht40_2s_tx_pwr_diff[2] & 0xf,
   1224      1.1  nonaka 	    rp->ht40_2s_tx_pwr_diff[0] >> 4, rp->ht40_2s_tx_pwr_diff[1] & 0xf,
   1225      1.1  nonaka 	    rp->ht40_2s_tx_pwr_diff[2] >> 4);
   1226      1.1  nonaka 
   1227      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1228      1.1  nonaka 	    "ht20_tx_pwr_diff c0: %d %d %d, c1: %d %d %d\n",
   1229      1.1  nonaka 	    rp->ht20_tx_pwr_diff[0] & 0xf, rp->ht20_tx_pwr_diff[1] & 0xf,
   1230      1.1  nonaka 	    rp->ht20_tx_pwr_diff[2] & 0xf,
   1231      1.1  nonaka 	    rp->ht20_tx_pwr_diff[0] >> 4, rp->ht20_tx_pwr_diff[1] >> 4,
   1232      1.1  nonaka 	    rp->ht20_tx_pwr_diff[2] >> 4);
   1233      1.1  nonaka 
   1234      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1235      1.1  nonaka 	    "ofdm_tx_pwr_diff c0: %d %d %d, c1: %d %d %d\n",
   1236      1.1  nonaka 	    rp->ofdm_tx_pwr_diff[0] & 0xf, rp->ofdm_tx_pwr_diff[1] & 0xf,
   1237      1.1  nonaka 	    rp->ofdm_tx_pwr_diff[2] & 0xf,
   1238      1.1  nonaka 	    rp->ofdm_tx_pwr_diff[0] >> 4, rp->ofdm_tx_pwr_diff[1] >> 4,
   1239      1.1  nonaka 	    rp->ofdm_tx_pwr_diff[2] >> 4);
   1240      1.1  nonaka 
   1241      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1242      1.1  nonaka 	    "ht40_max_pwr_offset c0: %d %d %d, c1: %d %d %d\n",
   1243      1.1  nonaka 	    rp->ht40_max_pwr[0] & 0xf, rp->ht40_max_pwr[1] & 0xf,
   1244      1.1  nonaka 	    rp->ht40_max_pwr[2] & 0xf,
   1245      1.1  nonaka 	    rp->ht40_max_pwr[0] >> 4, rp->ht40_max_pwr[1] >> 4,
   1246      1.1  nonaka 	    rp->ht40_max_pwr[2] >> 4);
   1247      1.1  nonaka 
   1248      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1249      1.1  nonaka 	    "ht20_max_pwr_offset c0: %d %d %d, c1: %d %d %d\n",
   1250      1.1  nonaka 	    rp->ht20_max_pwr[0] & 0xf, rp->ht20_max_pwr[1] & 0xf,
   1251      1.1  nonaka 	    rp->ht20_max_pwr[2] & 0xf,
   1252      1.1  nonaka 	    rp->ht20_max_pwr[0] >> 4, rp->ht20_max_pwr[1] >> 4,
   1253      1.1  nonaka 	    rp->ht20_max_pwr[2] >> 4);
   1254      1.1  nonaka 
   1255      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1256      1.1  nonaka 	    "xtal_calib %d, tssi %d %d, thermal %d\n",
   1257      1.1  nonaka 	    rp->xtal_calib, rp->tssi[0], rp->tssi[1], rp->thermal_meter);
   1258      1.1  nonaka 
   1259      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1260      1.1  nonaka 	    "rf_opt1 0x%x, rf_opt2 0x%x, rf_opt3 0x%x, rf_opt4 0x%x\n",
   1261      1.1  nonaka 	    rp->rf_opt1, rp->rf_opt2, rp->rf_opt3, rp->rf_opt4);
   1262      1.1  nonaka 
   1263      1.1  nonaka 	aprint_normal_dev(sc->sc_dev,
   1264      1.1  nonaka 	    "channnel_plan %d, version %d customer_id 0x%x\n",
   1265      1.1  nonaka 	    rp->channel_plan, rp->version, rp->curstomer_id);
   1266      1.1  nonaka }
   1267      1.1  nonaka #endif
   1268      1.1  nonaka 
   1269      1.1  nonaka static void
   1270      1.1  nonaka urtwn_read_rom(struct urtwn_softc *sc)
   1271      1.1  nonaka {
   1272      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   1273      1.1  nonaka 	struct r92c_rom *rom = &sc->rom;
   1274      1.1  nonaka 
   1275      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   1276      1.1  nonaka 
   1277  1.5.4.1     tls 	mutex_enter(&sc->sc_write_mtx);
   1278  1.5.4.1     tls 
   1279      1.1  nonaka 	/* Read full ROM image. */
   1280      1.1  nonaka 	urtwn_efuse_read(sc);
   1281      1.1  nonaka #ifdef URTWN_DEBUG
   1282      1.1  nonaka 	if (urtwn_debug & DBG_REG)
   1283      1.1  nonaka 		urtwn_dump_rom(sc, rom);
   1284      1.1  nonaka #endif
   1285      1.1  nonaka 
   1286      1.1  nonaka 	/* XXX Weird but this is what the vendor driver does. */
   1287      1.1  nonaka 	sc->pa_setting = urtwn_efuse_read_1(sc, 0x1fa);
   1288      1.1  nonaka 	sc->board_type = MS(rom->rf_opt1, R92C_ROM_RF1_BOARD_TYPE);
   1289      1.1  nonaka 	sc->regulatory = MS(rom->rf_opt1, R92C_ROM_RF1_REGULATORY);
   1290      1.1  nonaka 
   1291      1.1  nonaka 	DPRINTFN(DBG_INIT,
   1292      1.1  nonaka 	    ("%s: %s: PA setting=0x%x, board=0x%x, regulatory=%d\n",
   1293      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, sc->pa_setting,
   1294      1.1  nonaka 	    sc->board_type, sc->regulatory));
   1295      1.1  nonaka 
   1296      1.1  nonaka 	IEEE80211_ADDR_COPY(ic->ic_myaddr, rom->macaddr);
   1297  1.5.4.1     tls 
   1298  1.5.4.3     tls 	sc->sc_rf_write = urtwn_r92c_rf_write;
   1299  1.5.4.3     tls 	sc->sc_power_on = urtwn_r92c_power_on;
   1300  1.5.4.3     tls 	sc->sc_dma_init = urtwn_r92c_dma_init;
   1301  1.5.4.3     tls 
   1302  1.5.4.3     tls 	mutex_exit(&sc->sc_write_mtx);
   1303  1.5.4.3     tls }
   1304  1.5.4.3     tls 
   1305  1.5.4.3     tls static void
   1306  1.5.4.3     tls urtwn_r88e_read_rom(struct urtwn_softc *sc)
   1307  1.5.4.3     tls {
   1308  1.5.4.3     tls 	struct ieee80211com *ic = &sc->sc_ic;
   1309  1.5.4.3     tls 	uint8_t *rom = sc->r88e_rom;
   1310  1.5.4.3     tls 	uint32_t reg;
   1311  1.5.4.3     tls 	uint16_t addr = 0;
   1312  1.5.4.3     tls 	uint8_t off, msk, tmp;
   1313  1.5.4.3     tls 	int i;
   1314  1.5.4.3     tls 
   1315  1.5.4.3     tls 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   1316  1.5.4.3     tls 
   1317  1.5.4.3     tls 	mutex_enter(&sc->sc_write_mtx);
   1318  1.5.4.3     tls 
   1319  1.5.4.3     tls 	off = 0;
   1320  1.5.4.3     tls 	urtwn_efuse_switch_power(sc);
   1321  1.5.4.3     tls 
   1322  1.5.4.3     tls 	/* Read full ROM image. */
   1323  1.5.4.3     tls 	memset(&sc->r88e_rom, 0xff, sizeof(sc->r88e_rom));
   1324  1.5.4.3     tls 	while (addr < 1024) {
   1325  1.5.4.3     tls 		reg = urtwn_efuse_read_1(sc, addr);
   1326  1.5.4.3     tls 		if (reg == 0xff)
   1327  1.5.4.3     tls 			break;
   1328  1.5.4.3     tls 		addr++;
   1329  1.5.4.3     tls 		if ((reg & 0x1f) == 0x0f) {
   1330  1.5.4.3     tls 			tmp = (reg & 0xe0) >> 5;
   1331  1.5.4.3     tls 			reg = urtwn_efuse_read_1(sc, addr);
   1332  1.5.4.3     tls 			if ((reg & 0x0f) != 0x0f)
   1333  1.5.4.3     tls 				off = ((reg & 0xf0) >> 1) | tmp;
   1334  1.5.4.3     tls 			addr++;
   1335  1.5.4.3     tls 		} else
   1336  1.5.4.3     tls 			off = reg >> 4;
   1337  1.5.4.3     tls 		msk = reg & 0xf;
   1338  1.5.4.3     tls 		for (i = 0; i < 4; i++) {
   1339  1.5.4.3     tls 			if (msk & (1 << i))
   1340  1.5.4.3     tls 				continue;
   1341  1.5.4.3     tls 			rom[off * 8 + i * 2 + 0] = urtwn_efuse_read_1(sc, addr);
   1342  1.5.4.3     tls 			addr++;
   1343  1.5.4.3     tls 			rom[off * 8 + i * 2 + 1] = urtwn_efuse_read_1(sc, addr);
   1344  1.5.4.3     tls 			addr++;
   1345  1.5.4.3     tls 		}
   1346  1.5.4.3     tls 	}
   1347  1.5.4.3     tls #ifdef URTWN_DEBUG
   1348  1.5.4.3     tls 	if (urtwn_debug & DBG_REG) {
   1349  1.5.4.3     tls 	}
   1350  1.5.4.3     tls #endif
   1351  1.5.4.3     tls 
   1352  1.5.4.3     tls 	addr = 0x10;
   1353  1.5.4.3     tls 	for (i = 0; i < 6; i++)
   1354  1.5.4.3     tls 		sc->cck_tx_pwr[i] = sc->r88e_rom[addr++];
   1355  1.5.4.3     tls 	for (i = 0; i < 5; i++)
   1356  1.5.4.3     tls 		sc->ht40_tx_pwr[i] = sc->r88e_rom[addr++];
   1357  1.5.4.3     tls 	sc->bw20_tx_pwr_diff = (sc->r88e_rom[addr] & 0xf0) >> 4;
   1358  1.5.4.3     tls 	if (sc->bw20_tx_pwr_diff & 0x08)
   1359  1.5.4.3     tls 		sc->bw20_tx_pwr_diff |= 0xf0;
   1360  1.5.4.3     tls 	sc->ofdm_tx_pwr_diff = (sc->r88e_rom[addr] & 0xf);
   1361  1.5.4.3     tls 	if (sc->ofdm_tx_pwr_diff & 0x08)
   1362  1.5.4.3     tls 		sc->ofdm_tx_pwr_diff |= 0xf0;
   1363  1.5.4.3     tls 	sc->regulatory = MS(sc->r88e_rom[0xc1], R92C_ROM_RF1_REGULATORY);
   1364  1.5.4.3     tls 
   1365  1.5.4.3     tls 	IEEE80211_ADDR_COPY(ic->ic_myaddr, &sc->r88e_rom[0xd7]);
   1366  1.5.4.3     tls 
   1367  1.5.4.3     tls 	sc->sc_rf_write = urtwn_r88e_rf_write;
   1368  1.5.4.3     tls 	sc->sc_power_on = urtwn_r88e_power_on;
   1369  1.5.4.3     tls 	sc->sc_dma_init = urtwn_r88e_dma_init;
   1370  1.5.4.3     tls 
   1371  1.5.4.1     tls 	mutex_exit(&sc->sc_write_mtx);
   1372      1.1  nonaka }
   1373      1.1  nonaka 
   1374      1.1  nonaka static int
   1375      1.1  nonaka urtwn_media_change(struct ifnet *ifp)
   1376      1.1  nonaka {
   1377      1.1  nonaka #ifdef URTWN_DEBUG
   1378      1.1  nonaka 	struct urtwn_softc *sc = ifp->if_softc;
   1379      1.1  nonaka #endif
   1380      1.1  nonaka 	int error;
   1381      1.1  nonaka 
   1382      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   1383      1.1  nonaka 
   1384      1.1  nonaka 	if ((error = ieee80211_media_change(ifp)) != ENETRESET)
   1385      1.1  nonaka 		return (error);
   1386      1.1  nonaka 
   1387      1.1  nonaka 	if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) ==
   1388      1.1  nonaka 	    (IFF_UP | IFF_RUNNING)) {
   1389      1.1  nonaka 		urtwn_init(ifp);
   1390      1.1  nonaka 	}
   1391      1.1  nonaka 	return (0);
   1392      1.1  nonaka }
   1393      1.1  nonaka 
   1394      1.1  nonaka /*
   1395      1.1  nonaka  * Initialize rate adaptation in firmware.
   1396      1.1  nonaka  */
   1397      1.1  nonaka static int
   1398      1.1  nonaka urtwn_ra_init(struct urtwn_softc *sc)
   1399      1.1  nonaka {
   1400      1.1  nonaka 	static const uint8_t map[] = {
   1401      1.1  nonaka 		2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108
   1402      1.1  nonaka 	};
   1403      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   1404      1.1  nonaka 	struct ieee80211_node *ni = ic->ic_bss;
   1405      1.1  nonaka 	struct ieee80211_rateset *rs = &ni->ni_rates;
   1406      1.1  nonaka 	struct r92c_fw_cmd_macid_cfg cmd;
   1407      1.1  nonaka 	uint32_t rates, basicrates;
   1408      1.1  nonaka 	uint32_t mask;
   1409      1.1  nonaka 	uint8_t mode;
   1410  1.5.4.2     tls 	size_t maxrate, maxbasicrate, i, j;
   1411  1.5.4.2     tls 	int error;
   1412      1.1  nonaka 
   1413      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   1414      1.1  nonaka 
   1415  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   1416  1.5.4.1     tls 
   1417      1.1  nonaka 	/* Get normal and basic rates mask. */
   1418      1.1  nonaka 	rates = basicrates = 0;
   1419      1.1  nonaka 	maxrate = maxbasicrate = 0;
   1420      1.1  nonaka 	for (i = 0; i < rs->rs_nrates; i++) {
   1421      1.1  nonaka 		/* Convert 802.11 rate to HW rate index. */
   1422  1.5.4.2     tls 		for (j = 0; j < __arraycount(map); j++) {
   1423      1.1  nonaka 			if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == map[j]) {
   1424      1.1  nonaka 				break;
   1425      1.1  nonaka 			}
   1426      1.1  nonaka 		}
   1427      1.1  nonaka 		if (j == __arraycount(map)) {
   1428      1.1  nonaka 			/* Unknown rate, skip. */
   1429      1.1  nonaka 			continue;
   1430      1.1  nonaka 		}
   1431      1.1  nonaka 
   1432      1.1  nonaka 		rates |= 1U << j;
   1433      1.1  nonaka 		if (j > maxrate) {
   1434      1.1  nonaka 			maxrate = j;
   1435      1.1  nonaka 		}
   1436      1.1  nonaka 
   1437      1.1  nonaka 		if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) {
   1438      1.1  nonaka 			basicrates |= 1U << j;
   1439      1.1  nonaka 			if (j > maxbasicrate) {
   1440      1.1  nonaka 				maxbasicrate = j;
   1441      1.1  nonaka 			}
   1442      1.1  nonaka 		}
   1443      1.1  nonaka 	}
   1444      1.1  nonaka 	if (ic->ic_curmode == IEEE80211_MODE_11B) {
   1445      1.1  nonaka 		mode = R92C_RAID_11B;
   1446      1.1  nonaka 	} else {
   1447      1.1  nonaka 		mode = R92C_RAID_11BG;
   1448      1.1  nonaka 	}
   1449      1.1  nonaka 	DPRINTFN(DBG_INIT, ("%s: %s: mode=0x%x rates=0x%x, basicrates=0x%x, "
   1450  1.5.4.2     tls 	    "maxrate=%zx, maxbasicrate=%zx\n",
   1451      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, mode, rates, basicrates,
   1452      1.1  nonaka 	    maxrate, maxbasicrate));
   1453      1.1  nonaka 	if (basicrates == 0) {
   1454      1.1  nonaka 		basicrates |= 1;	/* add 1Mbps */
   1455      1.1  nonaka 	}
   1456      1.1  nonaka 
   1457      1.1  nonaka 	/* Set rates mask for group addressed frames. */
   1458      1.1  nonaka 	cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID;
   1459      1.1  nonaka 	mask = (mode << 28) | basicrates;
   1460      1.1  nonaka 	cmd.mask[0] = (uint8_t)mask;
   1461      1.1  nonaka 	cmd.mask[1] = (uint8_t)(mask >> 8);
   1462      1.1  nonaka 	cmd.mask[2] = (uint8_t)(mask >> 16);
   1463      1.1  nonaka 	cmd.mask[3] = (uint8_t)(mask >> 24);
   1464      1.1  nonaka 	error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd));
   1465      1.1  nonaka 	if (error != 0) {
   1466      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   1467      1.1  nonaka 		    "could not add broadcast station\n");
   1468      1.1  nonaka 		return (error);
   1469      1.1  nonaka 	}
   1470      1.1  nonaka 	/* Set initial MRR rate. */
   1471  1.5.4.2     tls 	DPRINTFN(DBG_INIT, ("%s: %s: maxbasicrate=%zd\n",
   1472      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, maxbasicrate));
   1473      1.1  nonaka 	urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC), maxbasicrate);
   1474      1.1  nonaka 
   1475      1.1  nonaka 	/* Set rates mask for unicast frames. */
   1476      1.1  nonaka 	cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID;
   1477      1.1  nonaka 	mask = (mode << 28) | rates;
   1478      1.1  nonaka 	cmd.mask[0] = (uint8_t)mask;
   1479      1.1  nonaka 	cmd.mask[1] = (uint8_t)(mask >> 8);
   1480      1.1  nonaka 	cmd.mask[2] = (uint8_t)(mask >> 16);
   1481      1.1  nonaka 	cmd.mask[3] = (uint8_t)(mask >> 24);
   1482      1.1  nonaka 	error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd));
   1483      1.1  nonaka 	if (error != 0) {
   1484      1.1  nonaka 		aprint_error_dev(sc->sc_dev, "could not add BSS station\n");
   1485      1.1  nonaka 		return (error);
   1486      1.1  nonaka 	}
   1487      1.1  nonaka 	/* Set initial MRR rate. */
   1488  1.5.4.2     tls 	DPRINTFN(DBG_INIT, ("%s: %s: maxrate=%zd\n", device_xname(sc->sc_dev),
   1489      1.1  nonaka 	    __func__, maxrate));
   1490      1.1  nonaka 	urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS), maxrate);
   1491      1.1  nonaka 
   1492      1.1  nonaka 	/* Indicate highest supported rate. */
   1493      1.1  nonaka 	ni->ni_txrate = rs->rs_nrates - 1;
   1494      1.1  nonaka 
   1495      1.1  nonaka 	return (0);
   1496      1.1  nonaka }
   1497      1.1  nonaka 
   1498      1.1  nonaka static int
   1499      1.1  nonaka urtwn_get_nettype(struct urtwn_softc *sc)
   1500      1.1  nonaka {
   1501      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   1502      1.1  nonaka 	int type;
   1503      1.1  nonaka 
   1504      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   1505      1.1  nonaka 
   1506      1.1  nonaka 	switch (ic->ic_opmode) {
   1507      1.1  nonaka 	case IEEE80211_M_STA:
   1508      1.1  nonaka 		type = R92C_CR_NETTYPE_INFRA;
   1509      1.1  nonaka 		break;
   1510      1.1  nonaka 
   1511      1.1  nonaka 	case IEEE80211_M_IBSS:
   1512      1.1  nonaka 		type = R92C_CR_NETTYPE_ADHOC;
   1513      1.1  nonaka 		break;
   1514      1.1  nonaka 
   1515      1.1  nonaka 	default:
   1516      1.1  nonaka 		type = R92C_CR_NETTYPE_NOLINK;
   1517      1.1  nonaka 		break;
   1518      1.1  nonaka 	}
   1519      1.1  nonaka 
   1520      1.1  nonaka 	return (type);
   1521      1.1  nonaka }
   1522      1.1  nonaka 
   1523      1.1  nonaka static void
   1524      1.1  nonaka urtwn_set_nettype0_msr(struct urtwn_softc *sc, uint8_t type)
   1525      1.1  nonaka {
   1526      1.1  nonaka 	uint8_t	reg;
   1527      1.1  nonaka 
   1528      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: type=%d\n", device_xname(sc->sc_dev),
   1529      1.1  nonaka 	    __func__, type));
   1530      1.1  nonaka 
   1531  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   1532  1.5.4.1     tls 
   1533      1.1  nonaka 	reg = urtwn_read_1(sc, R92C_CR + 2) & 0x0c;
   1534      1.1  nonaka 	urtwn_write_1(sc, R92C_CR + 2, reg | type);
   1535      1.1  nonaka }
   1536      1.1  nonaka 
   1537      1.1  nonaka static void
   1538      1.1  nonaka urtwn_tsf_sync_enable(struct urtwn_softc *sc)
   1539      1.1  nonaka {
   1540      1.1  nonaka 	struct ieee80211_node *ni = sc->sc_ic.ic_bss;
   1541      1.1  nonaka 	uint64_t tsf;
   1542      1.1  nonaka 
   1543      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   1544      1.1  nonaka 
   1545  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   1546  1.5.4.1     tls 
   1547      1.1  nonaka 	/* Enable TSF synchronization. */
   1548      1.1  nonaka 	urtwn_write_1(sc, R92C_BCN_CTRL,
   1549      1.1  nonaka 	    urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_DIS_TSF_UDT0);
   1550      1.1  nonaka 
   1551      1.1  nonaka 	/* Correct TSF */
   1552      1.1  nonaka 	urtwn_write_1(sc, R92C_BCN_CTRL,
   1553      1.1  nonaka 	    urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN);
   1554      1.1  nonaka 
   1555      1.1  nonaka 	/* Set initial TSF. */
   1556      1.1  nonaka 	tsf = ni->ni_tstamp.tsf;
   1557      1.1  nonaka 	tsf = le64toh(tsf);
   1558      1.1  nonaka 	tsf = tsf - (tsf % (ni->ni_intval * IEEE80211_DUR_TU));
   1559      1.1  nonaka 	tsf -= IEEE80211_DUR_TU;
   1560      1.1  nonaka 	urtwn_write_4(sc, R92C_TSFTR + 0, (uint32_t)tsf);
   1561      1.1  nonaka 	urtwn_write_4(sc, R92C_TSFTR + 4, (uint32_t)(tsf >> 32));
   1562      1.1  nonaka 
   1563      1.1  nonaka 	urtwn_write_1(sc, R92C_BCN_CTRL,
   1564      1.1  nonaka 	    urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN);
   1565      1.1  nonaka }
   1566      1.1  nonaka 
   1567      1.1  nonaka static void
   1568      1.1  nonaka urtwn_set_led(struct urtwn_softc *sc, int led, int on)
   1569      1.1  nonaka {
   1570      1.1  nonaka 	uint8_t reg;
   1571      1.1  nonaka 
   1572      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: led=%d, on=%d\n", device_xname(sc->sc_dev),
   1573      1.1  nonaka 	    __func__, led, on));
   1574      1.1  nonaka 
   1575  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   1576  1.5.4.1     tls 
   1577      1.1  nonaka 	if (led == URTWN_LED_LINK) {
   1578  1.5.4.3     tls 		if (ISSET(sc->chip, URTWN_CHIP_88E)) {
   1579  1.5.4.3     tls 			reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0xf0;
   1580  1.5.4.3     tls 			urtwn_write_1(sc, R92C_LEDCFG2, reg | 0x60);
   1581  1.5.4.3     tls 			if (!on) {
   1582  1.5.4.3     tls 				reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0x90;
   1583  1.5.4.3     tls 				urtwn_write_1(sc, R92C_LEDCFG2,
   1584  1.5.4.3     tls 				    reg | R92C_LEDCFG0_DIS);
   1585  1.5.4.3     tls 				reg = urtwn_read_1(sc, R92C_MAC_PINMUX_CFG);
   1586  1.5.4.3     tls 				urtwn_write_1(sc, R92C_MAC_PINMUX_CFG,
   1587  1.5.4.3     tls 				    reg & 0xfe);
   1588  1.5.4.3     tls 			}
   1589  1.5.4.3     tls 		} else {
   1590  1.5.4.3     tls 			reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70;
   1591  1.5.4.3     tls 			if (!on) {
   1592  1.5.4.3     tls 				reg |= R92C_LEDCFG0_DIS;
   1593  1.5.4.3     tls 			}
   1594  1.5.4.3     tls 			urtwn_write_1(sc, R92C_LEDCFG0, reg);
   1595      1.1  nonaka 		}
   1596      1.1  nonaka 		sc->ledlink = on;	/* Save LED state. */
   1597      1.1  nonaka 	}
   1598      1.1  nonaka }
   1599      1.1  nonaka 
   1600      1.1  nonaka static void
   1601      1.1  nonaka urtwn_calib_to(void *arg)
   1602      1.1  nonaka {
   1603      1.1  nonaka 	struct urtwn_softc *sc = arg;
   1604      1.1  nonaka 
   1605      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   1606      1.1  nonaka 
   1607      1.1  nonaka 	if (sc->sc_dying)
   1608      1.1  nonaka 		return;
   1609      1.1  nonaka 
   1610      1.1  nonaka 	/* Do it in a process context. */
   1611      1.1  nonaka 	urtwn_do_async(sc, urtwn_calib_to_cb, NULL, 0);
   1612      1.1  nonaka }
   1613      1.1  nonaka 
   1614      1.1  nonaka /* ARGSUSED */
   1615      1.1  nonaka static void
   1616      1.1  nonaka urtwn_calib_to_cb(struct urtwn_softc *sc, void *arg)
   1617      1.1  nonaka {
   1618      1.1  nonaka 	struct r92c_fw_cmd_rssi cmd;
   1619      1.1  nonaka 
   1620      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   1621      1.1  nonaka 
   1622      1.1  nonaka 	if (sc->sc_ic.ic_state != IEEE80211_S_RUN)
   1623      1.1  nonaka 		goto restart_timer;
   1624      1.1  nonaka 
   1625  1.5.4.1     tls 	mutex_enter(&sc->sc_write_mtx);
   1626      1.1  nonaka 	if (sc->avg_pwdb != -1) {
   1627      1.1  nonaka 		/* Indicate Rx signal strength to FW for rate adaptation. */
   1628      1.1  nonaka 		memset(&cmd, 0, sizeof(cmd));
   1629      1.1  nonaka 		cmd.macid = 0;	/* BSS. */
   1630      1.1  nonaka 		cmd.pwdb = sc->avg_pwdb;
   1631      1.1  nonaka 		DPRINTFN(DBG_RF, ("%s: %s: sending RSSI command avg=%d\n",
   1632      1.1  nonaka 		    device_xname(sc->sc_dev), __func__, sc->avg_pwdb));
   1633      1.1  nonaka 		urtwn_fw_cmd(sc, R92C_CMD_RSSI_SETTING, &cmd, sizeof(cmd));
   1634      1.1  nonaka 	}
   1635      1.1  nonaka 
   1636      1.1  nonaka 	/* Do temperature compensation. */
   1637      1.1  nonaka 	urtwn_temp_calib(sc);
   1638  1.5.4.1     tls 	mutex_exit(&sc->sc_write_mtx);
   1639      1.1  nonaka 
   1640      1.1  nonaka  restart_timer:
   1641      1.1  nonaka 	if (!sc->sc_dying) {
   1642      1.1  nonaka 		/* Restart calibration timer. */
   1643      1.1  nonaka 		callout_schedule(&sc->sc_calib_to, hz);
   1644      1.1  nonaka 	}
   1645      1.1  nonaka }
   1646      1.1  nonaka 
   1647      1.1  nonaka static void
   1648      1.1  nonaka urtwn_next_scan(void *arg)
   1649      1.1  nonaka {
   1650      1.1  nonaka 	struct urtwn_softc *sc = arg;
   1651  1.5.4.1     tls 	int s;
   1652      1.1  nonaka 
   1653      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   1654      1.1  nonaka 
   1655      1.1  nonaka 	if (sc->sc_dying)
   1656      1.1  nonaka 		return;
   1657      1.1  nonaka 
   1658  1.5.4.1     tls 	s = splnet();
   1659      1.1  nonaka 	if (sc->sc_ic.ic_state == IEEE80211_S_SCAN)
   1660      1.1  nonaka 		ieee80211_next_scan(&sc->sc_ic);
   1661  1.5.4.1     tls 	splx(s);
   1662      1.1  nonaka }
   1663      1.1  nonaka 
   1664  1.5.4.3     tls static void
   1665  1.5.4.3     tls urtwn_newassoc(struct ieee80211_node *ni, int isnew)
   1666  1.5.4.3     tls {
   1667  1.5.4.3     tls 	DPRINTFN(DBG_FN, ("%s: new node %s\n", __func__,
   1668  1.5.4.3     tls 	    ether_sprintf(ni->ni_macaddr)));
   1669  1.5.4.3     tls 	/* start with lowest Tx rate */
   1670  1.5.4.3     tls 	ni->ni_txrate = 0;
   1671  1.5.4.3     tls }
   1672  1.5.4.3     tls 
   1673      1.1  nonaka static int
   1674      1.1  nonaka urtwn_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
   1675      1.1  nonaka {
   1676      1.1  nonaka 	struct urtwn_softc *sc = ic->ic_ifp->if_softc;
   1677      1.1  nonaka 	struct urtwn_cmd_newstate cmd;
   1678      1.1  nonaka 
   1679      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: nstate=%s(%d), arg=%d\n",
   1680      1.1  nonaka 	    device_xname(sc->sc_dev), __func__,
   1681      1.1  nonaka 	    ieee80211_state_name[nstate], nstate, arg));
   1682      1.1  nonaka 
   1683      1.1  nonaka 	callout_stop(&sc->sc_scan_to);
   1684      1.1  nonaka 	callout_stop(&sc->sc_calib_to);
   1685      1.1  nonaka 
   1686      1.1  nonaka 	/* Do it in a process context. */
   1687      1.1  nonaka 	cmd.state = nstate;
   1688      1.1  nonaka 	cmd.arg = arg;
   1689      1.1  nonaka 	urtwn_do_async(sc, urtwn_newstate_cb, &cmd, sizeof(cmd));
   1690      1.1  nonaka 	return (0);
   1691      1.1  nonaka }
   1692      1.1  nonaka 
   1693      1.1  nonaka static void
   1694      1.1  nonaka urtwn_newstate_cb(struct urtwn_softc *sc, void *arg)
   1695      1.1  nonaka {
   1696      1.1  nonaka 	struct urtwn_cmd_newstate *cmd = arg;
   1697      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   1698      1.1  nonaka 	struct ieee80211_node *ni;
   1699      1.1  nonaka 	enum ieee80211_state ostate = ic->ic_state;
   1700      1.1  nonaka 	enum ieee80211_state nstate = cmd->state;
   1701      1.1  nonaka 	uint32_t reg;
   1702  1.5.4.3     tls 	uint8_t sifs_time, msr;
   1703      1.1  nonaka 	int s;
   1704      1.1  nonaka 
   1705      1.1  nonaka 	DPRINTFN(DBG_FN|DBG_STM, ("%s: %s: %s(%d)->%s(%d)\n",
   1706      1.1  nonaka 	    device_xname(sc->sc_dev), __func__,
   1707      1.1  nonaka 	    ieee80211_state_name[ostate], ostate,
   1708      1.1  nonaka 	    ieee80211_state_name[nstate], nstate));
   1709      1.1  nonaka 
   1710      1.1  nonaka 	s = splnet();
   1711  1.5.4.1     tls 	mutex_enter(&sc->sc_write_mtx);
   1712  1.5.4.1     tls 
   1713  1.5.4.1     tls 	callout_stop(&sc->sc_scan_to);
   1714  1.5.4.1     tls 	callout_stop(&sc->sc_calib_to);
   1715      1.1  nonaka 
   1716      1.1  nonaka 	switch (ostate) {
   1717      1.1  nonaka 	case IEEE80211_S_INIT:
   1718      1.1  nonaka 		break;
   1719      1.1  nonaka 
   1720      1.1  nonaka 	case IEEE80211_S_SCAN:
   1721      1.1  nonaka 		if (nstate != IEEE80211_S_SCAN) {
   1722      1.1  nonaka 			/*
   1723      1.1  nonaka 			 * End of scanning
   1724      1.1  nonaka 			 */
   1725      1.1  nonaka 			/* flush 4-AC Queue after site_survey */
   1726      1.1  nonaka 			urtwn_write_1(sc, R92C_TXPAUSE, 0x0);
   1727      1.1  nonaka 
   1728      1.1  nonaka 			/* Allow Rx from our BSSID only. */
   1729      1.1  nonaka 			urtwn_write_4(sc, R92C_RCR,
   1730      1.1  nonaka 			    urtwn_read_4(sc, R92C_RCR) |
   1731      1.1  nonaka 			      R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN);
   1732      1.1  nonaka 		}
   1733      1.1  nonaka 		break;
   1734  1.5.4.1     tls 
   1735      1.1  nonaka 	case IEEE80211_S_AUTH:
   1736      1.1  nonaka 	case IEEE80211_S_ASSOC:
   1737      1.1  nonaka 		break;
   1738      1.1  nonaka 
   1739      1.1  nonaka 	case IEEE80211_S_RUN:
   1740      1.1  nonaka 		/* Turn link LED off. */
   1741      1.1  nonaka 		urtwn_set_led(sc, URTWN_LED_LINK, 0);
   1742      1.1  nonaka 
   1743      1.1  nonaka 		/* Set media status to 'No Link'. */
   1744      1.1  nonaka 		urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
   1745      1.1  nonaka 
   1746      1.1  nonaka 		/* Stop Rx of data frames. */
   1747      1.1  nonaka 		urtwn_write_2(sc, R92C_RXFLTMAP2, 0);
   1748      1.1  nonaka 
   1749      1.1  nonaka 		/* Reset TSF. */
   1750      1.1  nonaka 		urtwn_write_1(sc, R92C_DUAL_TSF_RST, 0x03);
   1751      1.1  nonaka 
   1752      1.1  nonaka 		/* Disable TSF synchronization. */
   1753      1.1  nonaka 		urtwn_write_1(sc, R92C_BCN_CTRL,
   1754      1.1  nonaka 		    urtwn_read_1(sc, R92C_BCN_CTRL) |
   1755      1.1  nonaka 		      R92C_BCN_CTRL_DIS_TSF_UDT0);
   1756      1.1  nonaka 
   1757      1.1  nonaka 		/* Back to 20MHz mode */
   1758  1.5.4.1     tls 		urtwn_set_chan(sc, ic->ic_curchan,
   1759      1.1  nonaka 		    IEEE80211_HTINFO_2NDCHAN_NONE);
   1760      1.1  nonaka 
   1761      1.1  nonaka 		if (ic->ic_opmode == IEEE80211_M_IBSS ||
   1762      1.1  nonaka 		    ic->ic_opmode == IEEE80211_M_HOSTAP) {
   1763      1.1  nonaka 			/* Stop BCN */
   1764      1.1  nonaka 			urtwn_write_1(sc, R92C_BCN_CTRL,
   1765      1.1  nonaka 			    urtwn_read_1(sc, R92C_BCN_CTRL) &
   1766      1.1  nonaka 			    ~(R92C_BCN_CTRL_EN_BCN | R92C_BCN_CTRL_TXBCN_RPT));
   1767      1.1  nonaka 		}
   1768      1.1  nonaka 
   1769      1.1  nonaka 		/* Reset EDCA parameters. */
   1770      1.1  nonaka 		urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217);
   1771      1.1  nonaka 		urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317);
   1772      1.1  nonaka 		urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320);
   1773      1.1  nonaka 		urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444);
   1774      1.1  nonaka 
   1775      1.1  nonaka 		/* flush all cam entries */
   1776      1.1  nonaka 		urtwn_cam_init(sc);
   1777      1.1  nonaka 		break;
   1778      1.1  nonaka 	}
   1779      1.1  nonaka 
   1780      1.1  nonaka 	switch (nstate) {
   1781      1.1  nonaka 	case IEEE80211_S_INIT:
   1782      1.1  nonaka 		/* Turn link LED off. */
   1783      1.1  nonaka 		urtwn_set_led(sc, URTWN_LED_LINK, 0);
   1784      1.1  nonaka 		break;
   1785      1.1  nonaka 
   1786      1.1  nonaka 	case IEEE80211_S_SCAN:
   1787      1.1  nonaka 		if (ostate != IEEE80211_S_SCAN) {
   1788      1.1  nonaka 			/*
   1789      1.1  nonaka 			 * Begin of scanning
   1790      1.1  nonaka 			 */
   1791      1.1  nonaka 
   1792      1.1  nonaka 			/* Set gain for scanning. */
   1793      1.1  nonaka 			reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
   1794      1.1  nonaka 			reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
   1795      1.1  nonaka 			urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
   1796      1.1  nonaka 
   1797  1.5.4.3     tls 			if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
   1798  1.5.4.3     tls 				reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
   1799  1.5.4.3     tls 				reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
   1800  1.5.4.3     tls 				urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
   1801  1.5.4.3     tls 			}
   1802      1.1  nonaka 
   1803      1.1  nonaka 			/* Set media status to 'No Link'. */
   1804      1.1  nonaka 			urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
   1805      1.1  nonaka 
   1806      1.1  nonaka 			/* Allow Rx from any BSSID. */
   1807      1.1  nonaka 			urtwn_write_4(sc, R92C_RCR,
   1808      1.1  nonaka 			    urtwn_read_4(sc, R92C_RCR) &
   1809      1.1  nonaka 			    ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
   1810      1.1  nonaka 
   1811      1.1  nonaka 			/* Stop Rx of data frames. */
   1812      1.1  nonaka 			urtwn_write_2(sc, R92C_RXFLTMAP2, 0);
   1813      1.1  nonaka 
   1814      1.1  nonaka 			/* Disable update TSF */
   1815      1.1  nonaka 			urtwn_write_1(sc, R92C_BCN_CTRL,
   1816      1.1  nonaka 			    urtwn_read_1(sc, R92C_BCN_CTRL) |
   1817      1.1  nonaka 			      R92C_BCN_CTRL_DIS_TSF_UDT0);
   1818      1.1  nonaka 		}
   1819      1.1  nonaka 
   1820      1.1  nonaka 		/* Make link LED blink during scan. */
   1821      1.1  nonaka 		urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink);
   1822      1.1  nonaka 
   1823      1.1  nonaka 		/* Pause AC Tx queues. */
   1824      1.1  nonaka 		urtwn_write_1(sc, R92C_TXPAUSE,
   1825      1.1  nonaka 		    urtwn_read_1(sc, R92C_TXPAUSE) | 0x0f);
   1826      1.1  nonaka 
   1827      1.1  nonaka 		urtwn_set_chan(sc, ic->ic_curchan,
   1828      1.1  nonaka 		    IEEE80211_HTINFO_2NDCHAN_NONE);
   1829      1.1  nonaka 
   1830      1.1  nonaka 		/* Start periodic scan. */
   1831      1.1  nonaka 		if (!sc->sc_dying)
   1832      1.1  nonaka 			callout_schedule(&sc->sc_scan_to, hz / 5);
   1833      1.1  nonaka 		break;
   1834      1.1  nonaka 
   1835      1.1  nonaka 	case IEEE80211_S_AUTH:
   1836      1.1  nonaka 		/* Set initial gain under link. */
   1837      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
   1838  1.5.4.1     tls #ifdef doaslinux
   1839      1.1  nonaka 		reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32);
   1840  1.5.4.1     tls #else
   1841  1.5.4.1     tls 		reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
   1842  1.5.4.1     tls #endif
   1843      1.1  nonaka 		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
   1844      1.1  nonaka 
   1845  1.5.4.3     tls 		if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
   1846  1.5.4.3     tls 			reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
   1847  1.5.4.1     tls #ifdef doaslinux
   1848  1.5.4.3     tls 			reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32);
   1849  1.5.4.1     tls #else
   1850  1.5.4.3     tls 			reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
   1851  1.5.4.1     tls #endif
   1852  1.5.4.3     tls 			urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
   1853  1.5.4.3     tls 		}
   1854      1.1  nonaka 
   1855      1.1  nonaka 		/* Set media status to 'No Link'. */
   1856      1.1  nonaka 		urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
   1857      1.1  nonaka 
   1858      1.1  nonaka 		/* Allow Rx from any BSSID. */
   1859      1.1  nonaka 		urtwn_write_4(sc, R92C_RCR,
   1860      1.1  nonaka 		    urtwn_read_4(sc, R92C_RCR) &
   1861      1.1  nonaka 		      ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
   1862      1.1  nonaka 
   1863      1.1  nonaka 		urtwn_set_chan(sc, ic->ic_curchan,
   1864      1.1  nonaka 		    IEEE80211_HTINFO_2NDCHAN_NONE);
   1865      1.1  nonaka 		break;
   1866      1.1  nonaka 
   1867      1.1  nonaka 	case IEEE80211_S_ASSOC:
   1868      1.1  nonaka 		break;
   1869      1.1  nonaka 
   1870      1.1  nonaka 	case IEEE80211_S_RUN:
   1871      1.1  nonaka 		ni = ic->ic_bss;
   1872      1.1  nonaka 
   1873      1.1  nonaka 		/* XXX: Set 20MHz mode */
   1874      1.1  nonaka 		urtwn_set_chan(sc, ic->ic_curchan,
   1875      1.1  nonaka 		    IEEE80211_HTINFO_2NDCHAN_NONE);
   1876      1.1  nonaka 
   1877      1.1  nonaka 		if (ic->ic_opmode == IEEE80211_M_MONITOR) {
   1878      1.1  nonaka 			/* Back to 20MHz mode */
   1879  1.5.4.1     tls 			urtwn_set_chan(sc, ic->ic_curchan,
   1880      1.1  nonaka 			    IEEE80211_HTINFO_2NDCHAN_NONE);
   1881      1.1  nonaka 
   1882  1.5.4.1     tls 			/* Set media status to 'No Link'. */
   1883  1.5.4.1     tls 			urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
   1884  1.5.4.1     tls 
   1885      1.1  nonaka 			/* Enable Rx of data frames. */
   1886      1.1  nonaka 			urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
   1887      1.1  nonaka 
   1888  1.5.4.1     tls 			/* Allow Rx from any BSSID. */
   1889  1.5.4.1     tls 			urtwn_write_4(sc, R92C_RCR,
   1890  1.5.4.1     tls 			    urtwn_read_4(sc, R92C_RCR) &
   1891  1.5.4.1     tls 			    ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
   1892  1.5.4.1     tls 
   1893  1.5.4.1     tls 			/* Accept Rx data/control/management frames */
   1894  1.5.4.1     tls 			urtwn_write_4(sc, R92C_RCR,
   1895  1.5.4.1     tls 			    urtwn_read_4(sc, R92C_RCR) |
   1896  1.5.4.1     tls 			    R92C_RCR_ADF | R92C_RCR_ACF | R92C_RCR_AMF);
   1897  1.5.4.1     tls 
   1898      1.1  nonaka 			/* Turn link LED on. */
   1899      1.1  nonaka 			urtwn_set_led(sc, URTWN_LED_LINK, 1);
   1900      1.1  nonaka 			break;
   1901      1.1  nonaka 		}
   1902      1.1  nonaka 
   1903      1.1  nonaka 		/* Set media status to 'Associated'. */
   1904      1.1  nonaka 		urtwn_set_nettype0_msr(sc, urtwn_get_nettype(sc));
   1905      1.1  nonaka 
   1906      1.1  nonaka 		/* Set BSSID. */
   1907      1.1  nonaka 		urtwn_write_4(sc, R92C_BSSID + 0, LE_READ_4(&ni->ni_bssid[0]));
   1908      1.1  nonaka 		urtwn_write_4(sc, R92C_BSSID + 4, LE_READ_2(&ni->ni_bssid[4]));
   1909      1.1  nonaka 
   1910      1.1  nonaka 		if (ic->ic_curmode == IEEE80211_MODE_11B) {
   1911      1.1  nonaka 			urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0);
   1912      1.1  nonaka 		} else {
   1913      1.1  nonaka 			/* 802.11b/g */
   1914      1.1  nonaka 			urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3);
   1915      1.1  nonaka 		}
   1916      1.1  nonaka 
   1917      1.1  nonaka 		/* Enable Rx of data frames. */
   1918      1.1  nonaka 		urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
   1919      1.1  nonaka 
   1920      1.1  nonaka 		/* Set beacon interval. */
   1921      1.1  nonaka 		urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval);
   1922      1.1  nonaka 
   1923  1.5.4.3     tls 		msr = urtwn_read_1(sc, R92C_MSR);
   1924  1.5.4.3     tls 		msr &= R92C_MSR_MASK;
   1925  1.5.4.3     tls 		switch (ic->ic_opmode) {
   1926  1.5.4.3     tls 		case IEEE80211_M_STA:
   1927      1.1  nonaka 			/* Allow Rx from our BSSID only. */
   1928      1.1  nonaka 			urtwn_write_4(sc, R92C_RCR,
   1929      1.1  nonaka 			    urtwn_read_4(sc, R92C_RCR) |
   1930      1.1  nonaka 			      R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN);
   1931      1.1  nonaka 
   1932      1.1  nonaka 			/* Enable TSF synchronization. */
   1933      1.1  nonaka 			urtwn_tsf_sync_enable(sc);
   1934  1.5.4.3     tls 
   1935  1.5.4.3     tls 			msr |= R92C_MSR_INFRA;
   1936  1.5.4.3     tls 			break;
   1937  1.5.4.3     tls 		case IEEE80211_M_HOSTAP:
   1938  1.5.4.3     tls 			urtwn_write_2(sc, R92C_BCNTCFG, 0x000f);
   1939  1.5.4.3     tls 
   1940  1.5.4.3     tls 			/* Allow Rx from any BSSID. */
   1941  1.5.4.3     tls 			urtwn_write_4(sc, R92C_RCR,
   1942  1.5.4.3     tls 			    urtwn_read_4(sc, R92C_RCR) &
   1943  1.5.4.3     tls 			    ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
   1944  1.5.4.3     tls 
   1945  1.5.4.3     tls 			/* Reset TSF timer to zero. */
   1946  1.5.4.3     tls 			reg = urtwn_read_4(sc, R92C_TCR);
   1947  1.5.4.3     tls 			reg &= ~0x01;
   1948  1.5.4.3     tls 			urtwn_write_4(sc, R92C_TCR, reg);
   1949  1.5.4.3     tls 			reg |= 0x01;
   1950  1.5.4.3     tls 			urtwn_write_4(sc, R92C_TCR, reg);
   1951  1.5.4.3     tls 
   1952  1.5.4.3     tls 			msr |= R92C_MSR_AP;
   1953  1.5.4.3     tls 			break;
   1954  1.5.4.3     tls 		default:
   1955  1.5.4.3     tls 			msr |= R92C_MSR_ADHOC;
   1956  1.5.4.3     tls 			break;
   1957      1.1  nonaka 		}
   1958  1.5.4.3     tls 		urtwn_write_1(sc, R92C_MSR, msr);
   1959      1.1  nonaka 
   1960      1.1  nonaka 		sifs_time = 10;
   1961      1.1  nonaka 		urtwn_write_1(sc, R92C_SIFS_CCK + 1, sifs_time);
   1962      1.1  nonaka 		urtwn_write_1(sc, R92C_SIFS_OFDM + 1, sifs_time);
   1963      1.1  nonaka 		urtwn_write_1(sc, R92C_SPEC_SIFS + 1, sifs_time);
   1964      1.1  nonaka 		urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, sifs_time);
   1965      1.1  nonaka 		urtwn_write_1(sc, R92C_R2T_SIFS + 1, sifs_time);
   1966      1.1  nonaka 		urtwn_write_1(sc, R92C_T2T_SIFS + 1, sifs_time);
   1967      1.1  nonaka 
   1968      1.1  nonaka 		/* Intialize rate adaptation. */
   1969  1.5.4.3     tls 		if (ISSET(sc->chip, URTWN_CHIP_88E))
   1970  1.5.4.3     tls 			ni->ni_txrate = ni->ni_rates.rs_nrates - 1;
   1971  1.5.4.3     tls 		else
   1972  1.5.4.3     tls 			urtwn_ra_init(sc);
   1973      1.1  nonaka 
   1974      1.1  nonaka 		/* Turn link LED on. */
   1975      1.1  nonaka 		urtwn_set_led(sc, URTWN_LED_LINK, 1);
   1976      1.1  nonaka 
   1977      1.1  nonaka 		/* Reset average RSSI. */
   1978      1.1  nonaka 		sc->avg_pwdb = -1;
   1979      1.1  nonaka 
   1980      1.1  nonaka 		/* Reset temperature calibration state machine. */
   1981      1.1  nonaka 		sc->thcal_state = 0;
   1982      1.1  nonaka 		sc->thcal_lctemp = 0;
   1983      1.1  nonaka 
   1984      1.1  nonaka 		/* Start periodic calibration. */
   1985      1.1  nonaka 		if (!sc->sc_dying)
   1986      1.1  nonaka 			callout_schedule(&sc->sc_calib_to, hz);
   1987      1.1  nonaka 		break;
   1988      1.1  nonaka 	}
   1989      1.1  nonaka 
   1990      1.1  nonaka 	(*sc->sc_newstate)(ic, nstate, cmd->arg);
   1991      1.1  nonaka 
   1992  1.5.4.1     tls 	mutex_exit(&sc->sc_write_mtx);
   1993      1.1  nonaka 	splx(s);
   1994      1.1  nonaka }
   1995      1.1  nonaka 
   1996      1.1  nonaka static int
   1997      1.1  nonaka urtwn_wme_update(struct ieee80211com *ic)
   1998      1.1  nonaka {
   1999      1.1  nonaka 	struct urtwn_softc *sc = ic->ic_ifp->if_softc;
   2000      1.1  nonaka 
   2001      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   2002      1.1  nonaka 
   2003      1.1  nonaka 	/* don't override default WME values if WME is not actually enabled */
   2004      1.1  nonaka 	if (!(ic->ic_flags & IEEE80211_F_WME))
   2005      1.1  nonaka 		return (0);
   2006      1.1  nonaka 
   2007      1.1  nonaka 	/* Do it in a process context. */
   2008      1.1  nonaka 	urtwn_do_async(sc, urtwn_wme_update_cb, NULL, 0);
   2009      1.1  nonaka 	return (0);
   2010      1.1  nonaka }
   2011      1.1  nonaka 
   2012      1.1  nonaka static void
   2013      1.1  nonaka urtwn_wme_update_cb(struct urtwn_softc *sc, void *arg)
   2014      1.1  nonaka {
   2015      1.1  nonaka 	static const uint16_t ac2reg[WME_NUM_AC] = {
   2016      1.1  nonaka 		R92C_EDCA_BE_PARAM,
   2017      1.1  nonaka 		R92C_EDCA_BK_PARAM,
   2018      1.1  nonaka 		R92C_EDCA_VI_PARAM,
   2019      1.1  nonaka 		R92C_EDCA_VO_PARAM
   2020      1.1  nonaka 	};
   2021      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2022      1.1  nonaka 	const struct wmeParams *wmep;
   2023      1.1  nonaka 	int ac, aifs, slottime;
   2024      1.1  nonaka 	int s;
   2025      1.1  nonaka 
   2026      1.1  nonaka 	DPRINTFN(DBG_FN|DBG_STM, ("%s: %s\n", device_xname(sc->sc_dev),
   2027      1.1  nonaka 	    __func__));
   2028      1.1  nonaka 
   2029      1.1  nonaka 	s = splnet();
   2030  1.5.4.1     tls 	mutex_enter(&sc->sc_write_mtx);
   2031      1.1  nonaka 	slottime = (ic->ic_flags & IEEE80211_F_SHSLOT) ? 9 : 20;
   2032      1.1  nonaka 	for (ac = 0; ac < WME_NUM_AC; ac++) {
   2033      1.1  nonaka 		wmep = &ic->ic_wme.wme_chanParams.cap_wmeParams[ac];
   2034      1.1  nonaka 		/* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */
   2035      1.1  nonaka 		aifs = wmep->wmep_aifsn * slottime + 10;
   2036      1.1  nonaka 		urtwn_write_4(sc, ac2reg[ac],
   2037      1.1  nonaka 		    SM(R92C_EDCA_PARAM_TXOP, wmep->wmep_txopLimit) |
   2038      1.1  nonaka 		    SM(R92C_EDCA_PARAM_ECWMIN, wmep->wmep_logcwmin) |
   2039      1.1  nonaka 		    SM(R92C_EDCA_PARAM_ECWMAX, wmep->wmep_logcwmax) |
   2040      1.1  nonaka 		    SM(R92C_EDCA_PARAM_AIFS, aifs));
   2041      1.1  nonaka 	}
   2042  1.5.4.1     tls 	mutex_exit(&sc->sc_write_mtx);
   2043      1.1  nonaka 	splx(s);
   2044      1.1  nonaka }
   2045      1.1  nonaka 
   2046      1.1  nonaka static void
   2047      1.1  nonaka urtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi)
   2048      1.1  nonaka {
   2049      1.1  nonaka 	int pwdb;
   2050      1.1  nonaka 
   2051      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: rate=%d, rsst=%d\n",
   2052      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, rate, rssi));
   2053      1.1  nonaka 
   2054      1.1  nonaka 	/* Convert antenna signal to percentage. */
   2055      1.1  nonaka 	if (rssi <= -100 || rssi >= 20)
   2056      1.1  nonaka 		pwdb = 0;
   2057      1.1  nonaka 	else if (rssi >= 0)
   2058      1.1  nonaka 		pwdb = 100;
   2059      1.1  nonaka 	else
   2060      1.1  nonaka 		pwdb = 100 + rssi;
   2061  1.5.4.3     tls 	if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
   2062  1.5.4.3     tls 		if (rate <= 3) {
   2063  1.5.4.3     tls 			/* CCK gain is smaller than OFDM/MCS gain. */
   2064  1.5.4.3     tls 			pwdb += 6;
   2065  1.5.4.3     tls 			if (pwdb > 100)
   2066  1.5.4.3     tls 				pwdb = 100;
   2067  1.5.4.3     tls 			if (pwdb <= 14)
   2068  1.5.4.3     tls 				pwdb -= 4;
   2069  1.5.4.3     tls 			else if (pwdb <= 26)
   2070  1.5.4.3     tls 				pwdb -= 8;
   2071  1.5.4.3     tls 			else if (pwdb <= 34)
   2072  1.5.4.3     tls 				pwdb -= 6;
   2073  1.5.4.3     tls 			else if (pwdb <= 42)
   2074  1.5.4.3     tls 				pwdb -= 2;
   2075  1.5.4.3     tls 		}
   2076      1.1  nonaka 	}
   2077      1.1  nonaka 	if (sc->avg_pwdb == -1)	/* Init. */
   2078      1.1  nonaka 		sc->avg_pwdb = pwdb;
   2079      1.1  nonaka 	else if (sc->avg_pwdb < pwdb)
   2080      1.1  nonaka 		sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1;
   2081      1.1  nonaka 	else
   2082      1.1  nonaka 		sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20);
   2083      1.1  nonaka 
   2084  1.5.4.1     tls 	DPRINTFN(DBG_RF, ("%s: %s: rate=%d rssi=%d PWDB=%d EMA=%d\n",
   2085  1.5.4.1     tls 		     device_xname(sc->sc_dev), __func__,
   2086  1.5.4.1     tls 		     rate, rssi, pwdb, sc->avg_pwdb));
   2087      1.1  nonaka }
   2088      1.1  nonaka 
   2089      1.1  nonaka static int8_t
   2090      1.1  nonaka urtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt)
   2091      1.1  nonaka {
   2092      1.1  nonaka 	static const int8_t cckoff[] = { 16, -12, -26, -46 };
   2093      1.1  nonaka 	struct r92c_rx_phystat *phy;
   2094      1.1  nonaka 	struct r92c_rx_cck *cck;
   2095      1.1  nonaka 	uint8_t rpt;
   2096      1.1  nonaka 	int8_t rssi;
   2097      1.1  nonaka 
   2098      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: rate=%d\n", device_xname(sc->sc_dev),
   2099      1.1  nonaka 	    __func__, rate));
   2100      1.1  nonaka 
   2101      1.1  nonaka 	if (rate <= 3) {
   2102      1.1  nonaka 		cck = (struct r92c_rx_cck *)physt;
   2103      1.1  nonaka 		if (ISSET(sc->sc_flags, URTWN_FLAG_CCK_HIPWR)) {
   2104      1.1  nonaka 			rpt = (cck->agc_rpt >> 5) & 0x3;
   2105      1.1  nonaka 			rssi = (cck->agc_rpt & 0x1f) << 1;
   2106      1.1  nonaka 		} else {
   2107      1.1  nonaka 			rpt = (cck->agc_rpt >> 6) & 0x3;
   2108      1.1  nonaka 			rssi = cck->agc_rpt & 0x3e;
   2109      1.1  nonaka 		}
   2110      1.1  nonaka 		rssi = cckoff[rpt] - rssi;
   2111      1.1  nonaka 	} else {	/* OFDM/HT. */
   2112      1.1  nonaka 		phy = (struct r92c_rx_phystat *)physt;
   2113      1.1  nonaka 		rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110;
   2114      1.1  nonaka 	}
   2115      1.1  nonaka 	return (rssi);
   2116      1.1  nonaka }
   2117      1.1  nonaka 
   2118  1.5.4.3     tls static int8_t
   2119  1.5.4.3     tls urtwn_r88e_get_rssi(struct urtwn_softc *sc, int rate, void *physt)
   2120  1.5.4.3     tls {
   2121  1.5.4.3     tls 	struct r92c_rx_phystat *phy;
   2122  1.5.4.3     tls 	struct r88e_rx_cck *cck;
   2123  1.5.4.3     tls 	uint8_t cck_agc_rpt, lna_idx, vga_idx;
   2124  1.5.4.3     tls 	int8_t rssi;
   2125  1.5.4.3     tls 
   2126  1.5.4.3     tls 	DPRINTFN(DBG_FN, ("%s: %s: rate=%d\n", device_xname(sc->sc_dev),
   2127  1.5.4.3     tls 	    __func__, rate));
   2128  1.5.4.3     tls 
   2129  1.5.4.3     tls 	rssi = 0;
   2130  1.5.4.3     tls 	if (rate <= 3) {
   2131  1.5.4.3     tls 		cck = (struct r88e_rx_cck *)physt;
   2132  1.5.4.3     tls 		cck_agc_rpt = cck->agc_rpt;
   2133  1.5.4.3     tls 		lna_idx = (cck_agc_rpt & 0xe0) >> 5;
   2134  1.5.4.3     tls 		vga_idx = cck_agc_rpt & 0x1f;
   2135  1.5.4.3     tls 		switch (lna_idx) {
   2136  1.5.4.3     tls 		case 7:
   2137  1.5.4.3     tls 			if (vga_idx <= 27)
   2138  1.5.4.3     tls 				rssi = -100 + 2* (27 - vga_idx);
   2139  1.5.4.3     tls 			else
   2140  1.5.4.3     tls 				rssi = -100;
   2141  1.5.4.3     tls 			break;
   2142  1.5.4.3     tls 		case 6:
   2143  1.5.4.3     tls 			rssi = -48 + 2 * (2 - vga_idx);
   2144  1.5.4.3     tls 			break;
   2145  1.5.4.3     tls 		case 5:
   2146  1.5.4.3     tls 			rssi = -42 + 2 * (7 - vga_idx);
   2147  1.5.4.3     tls 			break;
   2148  1.5.4.3     tls 		case 4:
   2149  1.5.4.3     tls 			rssi = -36 + 2 * (7 - vga_idx);
   2150  1.5.4.3     tls 			break;
   2151  1.5.4.3     tls 		case 3:
   2152  1.5.4.3     tls 			rssi = -24 + 2 * (7 - vga_idx);
   2153  1.5.4.3     tls 			break;
   2154  1.5.4.3     tls 		case 2:
   2155  1.5.4.3     tls 			rssi = -12 + 2 * (5 - vga_idx);
   2156  1.5.4.3     tls 			break;
   2157  1.5.4.3     tls 		case 1:
   2158  1.5.4.3     tls 			rssi = 8 - (2 * vga_idx);
   2159  1.5.4.3     tls 			break;
   2160  1.5.4.3     tls 		case 0:
   2161  1.5.4.3     tls 			rssi = 14 - (2 * vga_idx);
   2162  1.5.4.3     tls 			break;
   2163  1.5.4.3     tls 		}
   2164  1.5.4.3     tls 		rssi += 6;
   2165  1.5.4.3     tls 	} else {	/* OFDM/HT. */
   2166  1.5.4.3     tls 		phy = (struct r92c_rx_phystat *)physt;
   2167  1.5.4.3     tls 		rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110;
   2168  1.5.4.3     tls 	}
   2169  1.5.4.3     tls 	return (rssi);
   2170  1.5.4.3     tls }
   2171  1.5.4.3     tls 
   2172      1.1  nonaka static void
   2173      1.1  nonaka urtwn_rx_frame(struct urtwn_softc *sc, uint8_t *buf, int pktlen)
   2174      1.1  nonaka {
   2175      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2176      1.1  nonaka 	struct ifnet *ifp = ic->ic_ifp;
   2177      1.1  nonaka 	struct ieee80211_frame *wh;
   2178      1.1  nonaka 	struct ieee80211_node *ni;
   2179      1.1  nonaka 	struct r92c_rx_stat *stat;
   2180      1.1  nonaka 	uint32_t rxdw0, rxdw3;
   2181      1.1  nonaka 	struct mbuf *m;
   2182      1.1  nonaka 	uint8_t rate;
   2183      1.1  nonaka 	int8_t rssi = 0;
   2184      1.1  nonaka 	int s, infosz;
   2185      1.1  nonaka 
   2186      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: buf=%p, pktlen=%d\n",
   2187      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, buf, pktlen));
   2188      1.1  nonaka 
   2189      1.1  nonaka 	stat = (struct r92c_rx_stat *)buf;
   2190      1.1  nonaka 	rxdw0 = le32toh(stat->rxdw0);
   2191      1.1  nonaka 	rxdw3 = le32toh(stat->rxdw3);
   2192      1.1  nonaka 
   2193      1.1  nonaka 	if (__predict_false(rxdw0 & (R92C_RXDW0_CRCERR | R92C_RXDW0_ICVERR))) {
   2194      1.1  nonaka 		/*
   2195      1.1  nonaka 		 * This should not happen since we setup our Rx filter
   2196      1.1  nonaka 		 * to not receive these frames.
   2197      1.1  nonaka 		 */
   2198      1.1  nonaka 		DPRINTFN(DBG_RX, ("%s: %s: CRC error\n",
   2199      1.1  nonaka 		    device_xname(sc->sc_dev), __func__));
   2200      1.1  nonaka 		ifp->if_ierrors++;
   2201      1.1  nonaka 		return;
   2202      1.1  nonaka 	}
   2203  1.5.4.1     tls 	/*
   2204  1.5.4.1     tls 	 * XXX: This will drop most control packets.  Do we really
   2205  1.5.4.1     tls 	 * want this in IEEE80211_M_MONITOR mode?
   2206  1.5.4.1     tls 	 */
   2207  1.5.4.2     tls //	if (__predict_false(pktlen < (int)sizeof(*wh))) {
   2208  1.5.4.2     tls 	if (__predict_false(pktlen < (int)sizeof(struct ieee80211_frame_ack))) {
   2209      1.1  nonaka 		DPRINTFN(DBG_RX, ("%s: %s: packet too short %d\n",
   2210      1.1  nonaka 		    device_xname(sc->sc_dev), __func__, pktlen));
   2211      1.1  nonaka 		ic->ic_stats.is_rx_tooshort++;
   2212      1.1  nonaka 		ifp->if_ierrors++;
   2213      1.1  nonaka 		return;
   2214      1.1  nonaka 	}
   2215      1.1  nonaka 	if (__predict_false(pktlen > MCLBYTES)) {
   2216      1.1  nonaka 		DPRINTFN(DBG_RX, ("%s: %s: packet too big %d\n",
   2217      1.1  nonaka 		    device_xname(sc->sc_dev), __func__, pktlen));
   2218      1.1  nonaka 		ifp->if_ierrors++;
   2219      1.1  nonaka 		return;
   2220      1.1  nonaka 	}
   2221      1.1  nonaka 
   2222      1.1  nonaka 	rate = MS(rxdw3, R92C_RXDW3_RATE);
   2223      1.1  nonaka 	infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8;
   2224      1.1  nonaka 
   2225      1.1  nonaka 	/* Get RSSI from PHY status descriptor if present. */
   2226      1.1  nonaka 	if (infosz != 0 && (rxdw0 & R92C_RXDW0_PHYST)) {
   2227  1.5.4.3     tls 		if (ISSET(sc->chip, URTWN_CHIP_88E))
   2228  1.5.4.3     tls 			rssi = urtwn_r88e_get_rssi(sc, rate, &stat[1]);
   2229  1.5.4.3     tls 		else
   2230  1.5.4.3     tls 			rssi = urtwn_get_rssi(sc, rate, &stat[1]);
   2231      1.1  nonaka 		/* Update our average RSSI. */
   2232      1.1  nonaka 		urtwn_update_avgrssi(sc, rate, rssi);
   2233      1.1  nonaka 	}
   2234      1.1  nonaka 
   2235      1.1  nonaka 	DPRINTFN(DBG_RX, ("%s: %s: Rx frame len=%d rate=%d infosz=%d rssi=%d\n",
   2236      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, pktlen, rate, infosz, rssi));
   2237      1.1  nonaka 
   2238      1.1  nonaka 	MGETHDR(m, M_DONTWAIT, MT_DATA);
   2239      1.1  nonaka 	if (__predict_false(m == NULL)) {
   2240      1.1  nonaka 		aprint_error_dev(sc->sc_dev, "couldn't allocate rx mbuf\n");
   2241      1.1  nonaka 		ic->ic_stats.is_rx_nobuf++;
   2242      1.1  nonaka 		ifp->if_ierrors++;
   2243      1.1  nonaka 		return;
   2244      1.1  nonaka 	}
   2245      1.1  nonaka 	if (pktlen > (int)MHLEN) {
   2246      1.1  nonaka 		MCLGET(m, M_DONTWAIT);
   2247      1.1  nonaka 		if (__predict_false(!(m->m_flags & M_EXT))) {
   2248      1.1  nonaka 			aprint_error_dev(sc->sc_dev,
   2249      1.1  nonaka 			    "couldn't allocate rx mbuf cluster\n");
   2250      1.1  nonaka 			m_freem(m);
   2251      1.1  nonaka 			ic->ic_stats.is_rx_nobuf++;
   2252      1.1  nonaka 			ifp->if_ierrors++;
   2253      1.1  nonaka 			return;
   2254      1.1  nonaka 		}
   2255      1.1  nonaka 	}
   2256      1.1  nonaka 
   2257      1.1  nonaka 	/* Finalize mbuf. */
   2258      1.1  nonaka 	m->m_pkthdr.rcvif = ifp;
   2259      1.1  nonaka 	wh = (struct ieee80211_frame *)((uint8_t *)&stat[1] + infosz);
   2260      1.1  nonaka 	memcpy(mtod(m, uint8_t *), wh, pktlen);
   2261      1.1  nonaka 	m->m_pkthdr.len = m->m_len = pktlen;
   2262      1.1  nonaka 
   2263      1.1  nonaka 	s = splnet();
   2264      1.1  nonaka 	if (__predict_false(sc->sc_drvbpf != NULL)) {
   2265      1.1  nonaka 		struct urtwn_rx_radiotap_header *tap = &sc->sc_rxtap;
   2266      1.1  nonaka 
   2267  1.5.4.1     tls 		tap->wr_flags = 0;
   2268      1.1  nonaka 		if (!(rxdw3 & R92C_RXDW3_HT)) {
   2269      1.1  nonaka 			switch (rate) {
   2270      1.1  nonaka 			/* CCK. */
   2271      1.1  nonaka 			case  0: tap->wr_rate =   2; break;
   2272      1.1  nonaka 			case  1: tap->wr_rate =   4; break;
   2273      1.1  nonaka 			case  2: tap->wr_rate =  11; break;
   2274      1.1  nonaka 			case  3: tap->wr_rate =  22; break;
   2275      1.1  nonaka 			/* OFDM. */
   2276      1.1  nonaka 			case  4: tap->wr_rate =  12; break;
   2277      1.1  nonaka 			case  5: tap->wr_rate =  18; break;
   2278      1.1  nonaka 			case  6: tap->wr_rate =  24; break;
   2279      1.1  nonaka 			case  7: tap->wr_rate =  36; break;
   2280      1.1  nonaka 			case  8: tap->wr_rate =  48; break;
   2281      1.1  nonaka 			case  9: tap->wr_rate =  72; break;
   2282      1.1  nonaka 			case 10: tap->wr_rate =  96; break;
   2283      1.1  nonaka 			case 11: tap->wr_rate = 108; break;
   2284      1.1  nonaka 			}
   2285      1.1  nonaka 		} else if (rate >= 12) {	/* MCS0~15. */
   2286      1.1  nonaka 			/* Bit 7 set means HT MCS instead of rate. */
   2287      1.1  nonaka 			tap->wr_rate = 0x80 | (rate - 12);
   2288      1.1  nonaka 		}
   2289      1.1  nonaka 		tap->wr_dbm_antsignal = rssi;
   2290  1.5.4.1     tls 		tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq);
   2291  1.5.4.1     tls 		tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags);
   2292      1.1  nonaka 
   2293      1.1  nonaka 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m);
   2294      1.1  nonaka 	}
   2295      1.1  nonaka 
   2296      1.1  nonaka 	ni = ieee80211_find_rxnode(ic, (struct ieee80211_frame_min *)wh);
   2297      1.1  nonaka 
   2298      1.1  nonaka 	/* push the frame up to the 802.11 stack */
   2299      1.1  nonaka 	ieee80211_input(ic, m, ni, rssi, 0);
   2300      1.1  nonaka 
   2301      1.1  nonaka 	/* Node is no longer needed. */
   2302      1.1  nonaka 	ieee80211_free_node(ni);
   2303      1.1  nonaka 
   2304      1.1  nonaka 	splx(s);
   2305      1.1  nonaka }
   2306      1.1  nonaka 
   2307      1.1  nonaka static void
   2308      1.1  nonaka urtwn_rxeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
   2309      1.1  nonaka {
   2310      1.1  nonaka 	struct urtwn_rx_data *data = priv;
   2311      1.1  nonaka 	struct urtwn_softc *sc = data->sc;
   2312      1.1  nonaka 	struct r92c_rx_stat *stat;
   2313      1.1  nonaka 	uint32_t rxdw0;
   2314      1.1  nonaka 	uint8_t *buf;
   2315      1.1  nonaka 	int len, totlen, pktlen, infosz, npkts;
   2316      1.1  nonaka 
   2317      1.1  nonaka 	DPRINTFN(DBG_FN|DBG_RX, ("%s: %s: status=%d\n",
   2318      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, status));
   2319      1.1  nonaka 
   2320      1.1  nonaka 	if (__predict_false(status != USBD_NORMAL_COMPLETION)) {
   2321      1.1  nonaka 		if (status == USBD_STALLED)
   2322      1.1  nonaka 			usbd_clear_endpoint_stall_async(sc->rx_pipe);
   2323      1.1  nonaka 		else if (status != USBD_CANCELLED)
   2324      1.1  nonaka 			goto resubmit;
   2325      1.1  nonaka 		return;
   2326      1.1  nonaka 	}
   2327      1.1  nonaka 	usbd_get_xfer_status(xfer, NULL, NULL, &len, NULL);
   2328      1.1  nonaka 
   2329      1.1  nonaka 	if (__predict_false(len < (int)sizeof(*stat))) {
   2330      1.1  nonaka 		DPRINTFN(DBG_RX, ("%s: %s: xfer too short %d\n",
   2331      1.1  nonaka 		    device_xname(sc->sc_dev), __func__, len));
   2332      1.1  nonaka 		goto resubmit;
   2333      1.1  nonaka 	}
   2334      1.1  nonaka 	buf = data->buf;
   2335      1.1  nonaka 
   2336      1.1  nonaka 	/* Get the number of encapsulated frames. */
   2337      1.1  nonaka 	stat = (struct r92c_rx_stat *)buf;
   2338      1.1  nonaka 	npkts = MS(le32toh(stat->rxdw2), R92C_RXDW2_PKTCNT);
   2339      1.1  nonaka 	DPRINTFN(DBG_RX, ("%s: %s: Rx %d frames in one chunk\n",
   2340      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, npkts));
   2341      1.1  nonaka 
   2342      1.1  nonaka 	/* Process all of them. */
   2343      1.1  nonaka 	while (npkts-- > 0) {
   2344      1.1  nonaka 		if (__predict_false(len < (int)sizeof(*stat))) {
   2345      1.1  nonaka 			DPRINTFN(DBG_RX,
   2346      1.1  nonaka 			    ("%s: %s: len(%d) is short than header\n",
   2347      1.1  nonaka 			    device_xname(sc->sc_dev), __func__, len));
   2348      1.1  nonaka 			break;
   2349      1.1  nonaka 		}
   2350      1.1  nonaka 		stat = (struct r92c_rx_stat *)buf;
   2351      1.1  nonaka 		rxdw0 = le32toh(stat->rxdw0);
   2352      1.1  nonaka 
   2353      1.1  nonaka 		pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN);
   2354      1.1  nonaka 		if (__predict_false(pktlen == 0)) {
   2355      1.1  nonaka 			DPRINTFN(DBG_RX, ("%s: %s: pktlen is 0 byte\n",
   2356      1.1  nonaka 			    device_xname(sc->sc_dev), __func__));
   2357      1.1  nonaka 			break;
   2358      1.1  nonaka 		}
   2359      1.1  nonaka 
   2360      1.1  nonaka 		infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8;
   2361      1.1  nonaka 
   2362      1.1  nonaka 		/* Make sure everything fits in xfer. */
   2363      1.1  nonaka 		totlen = sizeof(*stat) + infosz + pktlen;
   2364      1.1  nonaka 		if (__predict_false(totlen > len)) {
   2365      1.1  nonaka 			DPRINTFN(DBG_RX, ("%s: %s: pktlen %d(%d+%d+%d) > %d\n",
   2366      1.1  nonaka 			    device_xname(sc->sc_dev), __func__, totlen,
   2367      1.1  nonaka 			    (int)sizeof(*stat), infosz, pktlen, len));
   2368      1.1  nonaka 			break;
   2369      1.1  nonaka 		}
   2370      1.1  nonaka 
   2371      1.1  nonaka 		/* Process 802.11 frame. */
   2372      1.1  nonaka 		urtwn_rx_frame(sc, buf, pktlen);
   2373      1.1  nonaka 
   2374      1.1  nonaka 		/* Next chunk is 128-byte aligned. */
   2375      1.1  nonaka 		totlen = roundup2(totlen, 128);
   2376      1.1  nonaka 		buf += totlen;
   2377      1.1  nonaka 		len -= totlen;
   2378      1.1  nonaka 	}
   2379      1.1  nonaka 
   2380      1.1  nonaka  resubmit:
   2381      1.1  nonaka 	/* Setup a new transfer. */
   2382      1.1  nonaka 	usbd_setup_xfer(xfer, sc->rx_pipe, data, data->buf, URTWN_RXBUFSZ,
   2383      1.1  nonaka 	    USBD_SHORT_XFER_OK | USBD_NO_COPY, USBD_NO_TIMEOUT, urtwn_rxeof);
   2384      1.1  nonaka 	(void)usbd_transfer(xfer);
   2385      1.1  nonaka }
   2386      1.1  nonaka 
   2387      1.1  nonaka static void
   2388      1.1  nonaka urtwn_txeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
   2389      1.1  nonaka {
   2390      1.1  nonaka 	struct urtwn_tx_data *data = priv;
   2391      1.1  nonaka 	struct urtwn_softc *sc = data->sc;
   2392      1.1  nonaka 	struct ifnet *ifp = &sc->sc_if;
   2393  1.5.4.1     tls 	usbd_pipe_handle pipe = data->pipe;
   2394      1.1  nonaka 	int s;
   2395      1.1  nonaka 
   2396      1.1  nonaka 	DPRINTFN(DBG_FN|DBG_TX, ("%s: %s: status=%d\n",
   2397      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, status));
   2398      1.1  nonaka 
   2399      1.1  nonaka 	mutex_enter(&sc->sc_tx_mtx);
   2400      1.1  nonaka 	/* Put this Tx buffer back to our free list. */
   2401      1.1  nonaka 	TAILQ_INSERT_TAIL(&sc->tx_free_list, data, next);
   2402      1.1  nonaka 	mutex_exit(&sc->sc_tx_mtx);
   2403      1.1  nonaka 
   2404  1.5.4.1     tls 	s = splnet();
   2405  1.5.4.1     tls 	sc->tx_timer = 0;
   2406  1.5.4.1     tls 	ifp->if_flags &= ~IFF_OACTIVE;
   2407  1.5.4.1     tls 
   2408      1.1  nonaka 	if (__predict_false(status != USBD_NORMAL_COMPLETION)) {
   2409      1.1  nonaka 		if (status != USBD_NOT_STARTED && status != USBD_CANCELLED) {
   2410      1.1  nonaka 			if (status == USBD_STALLED)
   2411  1.5.4.1     tls 				usbd_clear_endpoint_stall_async(pipe);
   2412      1.1  nonaka 			ifp->if_oerrors++;
   2413      1.1  nonaka 		}
   2414  1.5.4.1     tls 		splx(s);
   2415      1.1  nonaka 		return;
   2416      1.1  nonaka 	}
   2417      1.1  nonaka 
   2418      1.1  nonaka 	ifp->if_opackets++;
   2419  1.5.4.1     tls 	urtwn_start(ifp);
   2420      1.1  nonaka 
   2421      1.1  nonaka 	splx(s);
   2422      1.1  nonaka }
   2423      1.1  nonaka 
   2424      1.1  nonaka static int
   2425  1.5.4.1     tls urtwn_tx(struct urtwn_softc *sc, struct mbuf *m, struct ieee80211_node *ni,
   2426  1.5.4.1     tls     struct urtwn_tx_data *data)
   2427      1.1  nonaka {
   2428      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2429      1.1  nonaka 	struct ieee80211_frame *wh;
   2430      1.1  nonaka 	struct ieee80211_key *k = NULL;
   2431      1.1  nonaka 	struct r92c_tx_desc *txd;
   2432      1.1  nonaka 	usbd_pipe_handle pipe;
   2433  1.5.4.2     tls 	size_t i, padsize, xferlen;
   2434      1.1  nonaka 	uint16_t seq, sum;
   2435      1.1  nonaka 	uint8_t raid, type, tid, qid;
   2436  1.5.4.2     tls 	int s, hasqos, error;
   2437      1.1  nonaka 
   2438      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   2439      1.1  nonaka 
   2440      1.1  nonaka 	wh = mtod(m, struct ieee80211_frame *);
   2441      1.1  nonaka 	type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
   2442      1.1  nonaka 
   2443      1.1  nonaka 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
   2444      1.1  nonaka 		k = ieee80211_crypto_encap(ic, ni, m);
   2445  1.5.4.1     tls 		if (k == NULL)
   2446  1.5.4.1     tls 			return ENOBUFS;
   2447  1.5.4.1     tls 
   2448      1.1  nonaka 		/* packet header may have moved, reset our local pointer */
   2449      1.1  nonaka 		wh = mtod(m, struct ieee80211_frame *);
   2450      1.1  nonaka 	}
   2451      1.1  nonaka 
   2452      1.1  nonaka 	if (__predict_false(sc->sc_drvbpf != NULL)) {
   2453      1.1  nonaka 		struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap;
   2454      1.1  nonaka 
   2455      1.1  nonaka 		tap->wt_flags = 0;
   2456  1.5.4.1     tls 		tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
   2457  1.5.4.1     tls 		tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
   2458      1.1  nonaka 		if (wh->i_fc[1] & IEEE80211_FC1_WEP)
   2459      1.1  nonaka 			tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP;
   2460      1.1  nonaka 
   2461  1.5.4.1     tls 		/* XXX: set tap->wt_rate? */
   2462  1.5.4.1     tls 
   2463      1.1  nonaka 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m);
   2464      1.1  nonaka 	}
   2465      1.1  nonaka 
   2466  1.5.4.2     tls 	if ((hasqos = ieee80211_has_qos(wh))) {
   2467      1.1  nonaka 		/* data frames in 11n mode */
   2468      1.1  nonaka 		struct ieee80211_qosframe *qwh = (void *)wh;
   2469      1.1  nonaka 		tid = qwh->i_qos[0] & IEEE80211_QOS_TID;
   2470      1.1  nonaka 		qid = TID_TO_WME_AC(tid);
   2471      1.1  nonaka 	} else if (type != IEEE80211_FC0_TYPE_DATA) {
   2472      1.1  nonaka 		/* Use AC_VO for management frames. */
   2473      1.1  nonaka 		qid = WME_AC_VO;
   2474      1.1  nonaka 		tid = 0;	/* compiler happy */
   2475      1.1  nonaka 	} else {
   2476      1.1  nonaka 		/* non-qos data frames */
   2477      1.1  nonaka 		tid = R92C_TXDW1_QSEL_BE;
   2478      1.1  nonaka 		qid = WME_AC_BE;
   2479      1.1  nonaka 	}
   2480      1.1  nonaka 
   2481      1.1  nonaka 	/* Get the USB pipe to use for this AC. */
   2482      1.1  nonaka 	pipe = sc->tx_pipe[sc->ac2idx[qid]];
   2483      1.1  nonaka 
   2484      1.1  nonaka 	if (((sizeof(*txd) + m->m_pkthdr.len) % 64) == 0) /* XXX: 64 */
   2485      1.1  nonaka 		padsize = 8;
   2486      1.1  nonaka 	else
   2487      1.1  nonaka 		padsize = 0;
   2488      1.1  nonaka 
   2489      1.1  nonaka 	/* Fill Tx descriptor. */
   2490      1.1  nonaka 	txd = (struct r92c_tx_desc *)data->buf;
   2491      1.1  nonaka 	memset(txd, 0, sizeof(*txd) + padsize);
   2492      1.1  nonaka 
   2493      1.1  nonaka 	txd->txdw0 |= htole32(
   2494      1.1  nonaka 	    SM(R92C_TXDW0_PKTLEN, m->m_pkthdr.len) |
   2495      1.1  nonaka 	    SM(R92C_TXDW0_OFFSET, sizeof(*txd)) |
   2496      1.1  nonaka 	    R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
   2497      1.1  nonaka 
   2498      1.1  nonaka 	if (IEEE80211_IS_MULTICAST(wh->i_addr1))
   2499      1.1  nonaka 		txd->txdw0 |= htole32(R92C_TXDW0_BMCAST);
   2500      1.1  nonaka 
   2501      1.1  nonaka 	/* fix pad field */
   2502      1.1  nonaka 	if (padsize > 0) {
   2503  1.5.4.2     tls 		DPRINTFN(DBG_TX, ("%s: %s: padding: size=%zd\n",
   2504      1.1  nonaka 		    device_xname(sc->sc_dev), __func__, padsize));
   2505      1.1  nonaka 		txd->txdw1 |= htole32(SM(R92C_TXDW1_PKTOFF, (padsize / 8)));
   2506      1.1  nonaka 	}
   2507      1.1  nonaka 
   2508      1.1  nonaka 	if (!IEEE80211_IS_MULTICAST(wh->i_addr1) &&
   2509      1.1  nonaka 	    type == IEEE80211_FC0_TYPE_DATA) {
   2510      1.1  nonaka 		if (ic->ic_curmode == IEEE80211_MODE_11B)
   2511      1.1  nonaka 			raid = R92C_RAID_11B;
   2512      1.1  nonaka 		else
   2513      1.1  nonaka 			raid = R92C_RAID_11BG;
   2514      1.1  nonaka 		DPRINTFN(DBG_TX,
   2515      1.1  nonaka 		    ("%s: %s: data packet: tid=%d, raid=%d\n",
   2516      1.1  nonaka 		    device_xname(sc->sc_dev), __func__, tid, raid));
   2517      1.1  nonaka 
   2518  1.5.4.3     tls 		if (ISSET(sc->chip, URTWN_CHIP_88E)) {
   2519  1.5.4.3     tls 			txd->txdw1 |= htole32(
   2520  1.5.4.3     tls 			    SM(R88E_TXDW1_MACID, URTWN_MACID_BSS) |
   2521  1.5.4.3     tls 			    SM(R92C_TXDW1_QSEL, tid) |
   2522  1.5.4.3     tls 			    SM(R92C_TXDW1_RAID, raid) |
   2523  1.5.4.3     tls 			    R92C_TXDW1_AGGBK);
   2524  1.5.4.3     tls 			txd->txdw2 |= htole32(R88E_TXDW2_AGGBK);
   2525  1.5.4.3     tls 		} else
   2526  1.5.4.3     tls 			txd->txdw1 |= htole32(
   2527  1.5.4.3     tls 			    SM(R92C_TXDW1_MACID, URTWN_MACID_BSS) |
   2528  1.5.4.3     tls 			    SM(R92C_TXDW1_QSEL, tid) |
   2529  1.5.4.3     tls 			    SM(R92C_TXDW1_RAID, raid) |
   2530  1.5.4.3     tls 			    R92C_TXDW1_AGGBK);
   2531      1.1  nonaka 
   2532      1.1  nonaka 		if (hasqos) {
   2533      1.1  nonaka 			txd->txdw4 |= htole32(R92C_TXDW4_QOS);
   2534      1.1  nonaka 		}
   2535      1.1  nonaka 
   2536      1.1  nonaka 		if (ic->ic_flags & IEEE80211_F_USEPROT) {
   2537      1.1  nonaka 			/* for 11g */
   2538      1.1  nonaka 			if (ic->ic_protmode == IEEE80211_PROT_CTSONLY) {
   2539      1.1  nonaka 				txd->txdw4 |= htole32(R92C_TXDW4_CTS2SELF |
   2540      1.1  nonaka 				    R92C_TXDW4_HWRTSEN);
   2541      1.1  nonaka 			} else if (ic->ic_protmode == IEEE80211_PROT_RTSCTS) {
   2542      1.1  nonaka 				txd->txdw4 |= htole32(R92C_TXDW4_RTSEN |
   2543      1.1  nonaka 				    R92C_TXDW4_HWRTSEN);
   2544      1.1  nonaka 			}
   2545      1.1  nonaka 		}
   2546      1.1  nonaka 		/* Send RTS at OFDM24. */
   2547      1.1  nonaka 		txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 8));
   2548      1.1  nonaka 		txd->txdw5 |= htole32(0x0001ff00);
   2549      1.1  nonaka 		/* Send data at OFDM54. */
   2550  1.5.4.3     tls 		if (ISSET(sc->chip, URTWN_CHIP_88E))
   2551  1.5.4.3     tls 			txd->txdw5 |= htole32(0x13 & 0x3f);
   2552  1.5.4.3     tls 		else
   2553  1.5.4.3     tls 			txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 11));
   2554      1.1  nonaka 	} else if (type == IEEE80211_FC0_TYPE_MGT) {
   2555      1.1  nonaka 		DPRINTFN(DBG_TX, ("%s: %s: mgmt packet\n",
   2556      1.1  nonaka 		    device_xname(sc->sc_dev), __func__));
   2557      1.1  nonaka 		txd->txdw1 |= htole32(
   2558      1.1  nonaka 		    SM(R92C_TXDW1_MACID, URTWN_MACID_BSS) |
   2559      1.1  nonaka 		    SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_MGNT) |
   2560      1.1  nonaka 		    SM(R92C_TXDW1_RAID, R92C_RAID_11B));
   2561      1.1  nonaka 
   2562      1.1  nonaka 		/* Force CCK1. */
   2563      1.1  nonaka 		txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE);
   2564      1.1  nonaka 		/* Use 1Mbps */
   2565      1.1  nonaka 		txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 0));
   2566      1.1  nonaka 	} else {
   2567      1.1  nonaka 		/* broadcast or multicast packets */
   2568      1.1  nonaka 		DPRINTFN(DBG_TX, ("%s: %s: bc or mc packet\n",
   2569      1.1  nonaka 		    device_xname(sc->sc_dev), __func__));
   2570      1.1  nonaka 		txd->txdw1 |= htole32(
   2571      1.1  nonaka 		    SM(R92C_TXDW1_MACID, URTWN_MACID_BC) |
   2572      1.1  nonaka 		    SM(R92C_TXDW1_RAID, R92C_RAID_11B));
   2573      1.1  nonaka 
   2574      1.1  nonaka 		/* Force CCK1. */
   2575      1.1  nonaka 		txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE);
   2576      1.1  nonaka 		/* Use 1Mbps */
   2577      1.1  nonaka 		txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 0));
   2578      1.1  nonaka 	}
   2579      1.1  nonaka 
   2580      1.1  nonaka 	/* Set sequence number */
   2581      1.1  nonaka 	seq = LE_READ_2(&wh->i_seq[0]) >> IEEE80211_SEQ_SEQ_SHIFT;
   2582      1.1  nonaka 	txd->txdseq |= htole16(seq);
   2583      1.1  nonaka 
   2584      1.1  nonaka 	if (!hasqos) {
   2585      1.1  nonaka 		/* Use HW sequence numbering for non-QoS frames. */
   2586      1.1  nonaka 		txd->txdw4  |= htole32(R92C_TXDW4_HWSEQ);
   2587      1.1  nonaka 		txd->txdseq |= htole16(0x8000);		/* WTF? */
   2588      1.1  nonaka 	}
   2589      1.1  nonaka 
   2590      1.1  nonaka 	/* Compute Tx descriptor checksum. */
   2591      1.1  nonaka 	sum = 0;
   2592  1.5.4.2     tls 	for (i = 0; i < sizeof(*txd) / 2; i++)
   2593      1.1  nonaka 		sum ^= ((uint16_t *)txd)[i];
   2594      1.1  nonaka 	txd->txdsum = sum;	/* NB: already little endian. */
   2595      1.1  nonaka 
   2596      1.1  nonaka 	xferlen = sizeof(*txd) + m->m_pkthdr.len + padsize;
   2597      1.1  nonaka 	m_copydata(m, 0, m->m_pkthdr.len, (char *)&txd[1] + padsize);
   2598      1.1  nonaka 
   2599      1.1  nonaka 	s = splnet();
   2600      1.1  nonaka 	data->pipe = pipe;
   2601      1.1  nonaka 	usbd_setup_xfer(data->xfer, pipe, data, data->buf, xferlen,
   2602      1.1  nonaka 	    USBD_FORCE_SHORT_XFER | USBD_NO_COPY, URTWN_TX_TIMEOUT,
   2603      1.1  nonaka 	    urtwn_txeof);
   2604      1.1  nonaka 	error = usbd_transfer(data->xfer);
   2605      1.1  nonaka 	if (__predict_false(error != USBD_NORMAL_COMPLETION &&
   2606      1.1  nonaka 	    error != USBD_IN_PROGRESS)) {
   2607      1.1  nonaka 		splx(s);
   2608      1.1  nonaka 		DPRINTFN(DBG_TX, ("%s: %s: transfer failed %d\n",
   2609      1.1  nonaka 		    device_xname(sc->sc_dev), __func__, error));
   2610  1.5.4.1     tls 		return error;
   2611      1.1  nonaka 	}
   2612      1.1  nonaka 	splx(s);
   2613  1.5.4.1     tls 	return 0;
   2614      1.1  nonaka }
   2615      1.1  nonaka 
   2616      1.1  nonaka static void
   2617      1.1  nonaka urtwn_start(struct ifnet *ifp)
   2618      1.1  nonaka {
   2619      1.1  nonaka 	struct urtwn_softc *sc = ifp->if_softc;
   2620      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2621  1.5.4.1     tls 	struct urtwn_tx_data *data;
   2622      1.1  nonaka 	struct ether_header *eh;
   2623      1.1  nonaka 	struct ieee80211_node *ni;
   2624      1.1  nonaka 	struct mbuf *m;
   2625      1.1  nonaka 
   2626      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   2627      1.1  nonaka 
   2628      1.1  nonaka 	if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
   2629      1.1  nonaka 		return;
   2630      1.1  nonaka 
   2631  1.5.4.1     tls 	data = NULL;
   2632      1.1  nonaka 	for (;;) {
   2633      1.1  nonaka 		mutex_enter(&sc->sc_tx_mtx);
   2634  1.5.4.1     tls 		if (data == NULL && !TAILQ_EMPTY(&sc->tx_free_list)) {
   2635  1.5.4.1     tls 			data = TAILQ_FIRST(&sc->tx_free_list);
   2636  1.5.4.1     tls 			TAILQ_REMOVE(&sc->tx_free_list, data, next);
   2637      1.1  nonaka 		}
   2638      1.1  nonaka 		mutex_exit(&sc->sc_tx_mtx);
   2639      1.1  nonaka 
   2640  1.5.4.1     tls 		if (data == NULL) {
   2641  1.5.4.1     tls 			ifp->if_flags |= IFF_OACTIVE;
   2642  1.5.4.1     tls 			DPRINTFN(DBG_TX, ("%s: empty tx_free_list\n",
   2643  1.5.4.1     tls 				     device_xname(sc->sc_dev)));
   2644  1.5.4.1     tls 			return;
   2645  1.5.4.1     tls 		}
   2646  1.5.4.1     tls 
   2647      1.1  nonaka 		/* Send pending management frames first. */
   2648      1.1  nonaka 		IF_DEQUEUE(&ic->ic_mgtq, m);
   2649      1.1  nonaka 		if (m != NULL) {
   2650      1.1  nonaka 			ni = (void *)m->m_pkthdr.rcvif;
   2651      1.1  nonaka 			m->m_pkthdr.rcvif = NULL;
   2652      1.1  nonaka 			goto sendit;
   2653      1.1  nonaka 		}
   2654      1.1  nonaka 		if (ic->ic_state != IEEE80211_S_RUN)
   2655      1.1  nonaka 			break;
   2656      1.1  nonaka 
   2657      1.1  nonaka 		/* Encapsulate and send data frames. */
   2658      1.1  nonaka 		IFQ_DEQUEUE(&ifp->if_snd, m);
   2659      1.1  nonaka 		if (m == NULL)
   2660      1.1  nonaka 			break;
   2661  1.5.4.1     tls 
   2662      1.1  nonaka 		if (m->m_len < (int)sizeof(*eh) &&
   2663      1.1  nonaka 		    (m = m_pullup(m, sizeof(*eh))) == NULL) {
   2664      1.1  nonaka 			ifp->if_oerrors++;
   2665      1.1  nonaka 			continue;
   2666      1.1  nonaka 		}
   2667      1.1  nonaka 		eh = mtod(m, struct ether_header *);
   2668      1.1  nonaka 		ni = ieee80211_find_txnode(ic, eh->ether_dhost);
   2669      1.1  nonaka 		if (ni == NULL) {
   2670      1.1  nonaka 			m_freem(m);
   2671      1.1  nonaka 			ifp->if_oerrors++;
   2672      1.1  nonaka 			continue;
   2673      1.1  nonaka 		}
   2674      1.1  nonaka 
   2675      1.1  nonaka 		bpf_mtap(ifp, m);
   2676      1.1  nonaka 
   2677      1.1  nonaka 		if ((m = ieee80211_encap(ic, m, ni)) == NULL) {
   2678      1.1  nonaka 			ieee80211_free_node(ni);
   2679      1.1  nonaka 			ifp->if_oerrors++;
   2680      1.1  nonaka 			continue;
   2681      1.1  nonaka 		}
   2682      1.1  nonaka  sendit:
   2683      1.1  nonaka 		bpf_mtap3(ic->ic_rawbpf, m);
   2684      1.1  nonaka 
   2685  1.5.4.1     tls 		if (urtwn_tx(sc, m, ni, data) != 0) {
   2686  1.5.4.1     tls 			m_freem(m);
   2687      1.1  nonaka 			ieee80211_free_node(ni);
   2688      1.1  nonaka 			ifp->if_oerrors++;
   2689      1.1  nonaka 			continue;
   2690      1.1  nonaka 		}
   2691  1.5.4.1     tls 		data = NULL;
   2692  1.5.4.1     tls 		m_freem(m);
   2693  1.5.4.1     tls 		ieee80211_free_node(ni);
   2694      1.1  nonaka 		sc->tx_timer = 5;
   2695      1.1  nonaka 		ifp->if_timer = 1;
   2696      1.1  nonaka 	}
   2697  1.5.4.1     tls 
   2698  1.5.4.1     tls 	/* Return the Tx buffer to the free list */
   2699  1.5.4.1     tls 	mutex_enter(&sc->sc_tx_mtx);
   2700  1.5.4.1     tls 	TAILQ_INSERT_TAIL(&sc->tx_free_list, data, next);
   2701  1.5.4.1     tls 	mutex_exit(&sc->sc_tx_mtx);
   2702      1.1  nonaka }
   2703      1.1  nonaka 
   2704      1.1  nonaka static void
   2705      1.1  nonaka urtwn_watchdog(struct ifnet *ifp)
   2706      1.1  nonaka {
   2707      1.1  nonaka 	struct urtwn_softc *sc = ifp->if_softc;
   2708      1.1  nonaka 
   2709      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   2710      1.1  nonaka 
   2711      1.1  nonaka 	ifp->if_timer = 0;
   2712      1.1  nonaka 
   2713      1.1  nonaka 	if (sc->tx_timer > 0) {
   2714      1.1  nonaka 		if (--sc->tx_timer == 0) {
   2715      1.1  nonaka 			aprint_error_dev(sc->sc_dev, "device timeout\n");
   2716      1.1  nonaka 			/* urtwn_init(ifp); XXX needs a process context! */
   2717      1.1  nonaka 			ifp->if_oerrors++;
   2718      1.1  nonaka 			return;
   2719      1.1  nonaka 		}
   2720      1.1  nonaka 		ifp->if_timer = 1;
   2721      1.1  nonaka 	}
   2722      1.1  nonaka 	ieee80211_watchdog(&sc->sc_ic);
   2723      1.1  nonaka }
   2724      1.1  nonaka 
   2725      1.1  nonaka static int
   2726      1.1  nonaka urtwn_ioctl(struct ifnet *ifp, u_long cmd, void *data)
   2727      1.1  nonaka {
   2728      1.1  nonaka 	struct urtwn_softc *sc = ifp->if_softc;
   2729      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2730      1.1  nonaka 	int s, error = 0;
   2731      1.1  nonaka 
   2732      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: cmd=0x%08lx, data=%p\n",
   2733      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, cmd, data));
   2734      1.1  nonaka 
   2735      1.1  nonaka 	s = splnet();
   2736      1.1  nonaka 
   2737      1.1  nonaka 	switch (cmd) {
   2738      1.1  nonaka 	case SIOCSIFFLAGS:
   2739      1.1  nonaka 		if ((error = ifioctl_common(ifp, cmd, data)) != 0)
   2740      1.1  nonaka 			break;
   2741  1.5.4.1     tls 		switch (ifp->if_flags & (IFF_UP | IFF_RUNNING)) {
   2742  1.5.4.1     tls 		case IFF_UP | IFF_RUNNING:
   2743      1.1  nonaka 			break;
   2744      1.1  nonaka 		case IFF_UP:
   2745      1.1  nonaka 			urtwn_init(ifp);
   2746      1.1  nonaka 			break;
   2747      1.1  nonaka 		case IFF_RUNNING:
   2748      1.1  nonaka 			urtwn_stop(ifp, 1);
   2749      1.1  nonaka 			break;
   2750      1.1  nonaka 		case 0:
   2751      1.1  nonaka 			break;
   2752      1.1  nonaka 		}
   2753      1.1  nonaka 		break;
   2754      1.1  nonaka 
   2755      1.1  nonaka 	case SIOCADDMULTI:
   2756      1.1  nonaka 	case SIOCDELMULTI:
   2757      1.1  nonaka 		if ((error = ether_ioctl(ifp, cmd, data)) == ENETRESET) {
   2758      1.1  nonaka 			/* setup multicast filter, etc */
   2759      1.1  nonaka 			error = 0;
   2760      1.1  nonaka 		}
   2761      1.1  nonaka 		break;
   2762      1.1  nonaka 
   2763      1.1  nonaka 	default:
   2764      1.1  nonaka 		error = ieee80211_ioctl(ic, cmd, data);
   2765      1.1  nonaka 		break;
   2766      1.1  nonaka 	}
   2767      1.1  nonaka 	if (error == ENETRESET) {
   2768      1.1  nonaka 		if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) ==
   2769  1.5.4.1     tls 		    (IFF_UP | IFF_RUNNING) &&
   2770  1.5.4.1     tls 		    ic->ic_roaming != IEEE80211_ROAMING_MANUAL) {
   2771      1.1  nonaka 			urtwn_init(ifp);
   2772      1.1  nonaka 		}
   2773      1.1  nonaka 		error = 0;
   2774      1.1  nonaka 	}
   2775      1.1  nonaka 
   2776      1.1  nonaka 	splx(s);
   2777      1.1  nonaka 
   2778      1.1  nonaka 	return (error);
   2779      1.1  nonaka }
   2780      1.1  nonaka 
   2781  1.5.4.3     tls static __inline int
   2782      1.1  nonaka urtwn_power_on(struct urtwn_softc *sc)
   2783      1.1  nonaka {
   2784  1.5.4.3     tls 
   2785  1.5.4.3     tls 	return sc->sc_power_on(sc);
   2786  1.5.4.3     tls }
   2787  1.5.4.3     tls 
   2788  1.5.4.3     tls static int
   2789  1.5.4.3     tls urtwn_r92c_power_on(struct urtwn_softc *sc)
   2790  1.5.4.3     tls {
   2791      1.1  nonaka 	uint32_t reg;
   2792      1.1  nonaka 	int ntries;
   2793      1.1  nonaka 
   2794      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   2795      1.1  nonaka 
   2796  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   2797  1.5.4.1     tls 
   2798      1.1  nonaka 	/* Wait for autoload done bit. */
   2799      1.1  nonaka 	for (ntries = 0; ntries < 1000; ntries++) {
   2800      1.1  nonaka 		if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN)
   2801      1.1  nonaka 			break;
   2802      1.1  nonaka 		DELAY(5);
   2803      1.1  nonaka 	}
   2804      1.1  nonaka 	if (ntries == 1000) {
   2805      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   2806      1.1  nonaka 		    "timeout waiting for chip autoload\n");
   2807      1.1  nonaka 		return (ETIMEDOUT);
   2808      1.1  nonaka 	}
   2809      1.1  nonaka 
   2810      1.1  nonaka 	/* Unlock ISO/CLK/Power control register. */
   2811      1.1  nonaka 	urtwn_write_1(sc, R92C_RSV_CTRL, 0);
   2812      1.1  nonaka 	/* Move SPS into PWM mode. */
   2813      1.1  nonaka 	urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b);
   2814      1.1  nonaka 	DELAY(100);
   2815      1.1  nonaka 
   2816      1.1  nonaka 	reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL);
   2817      1.1  nonaka 	if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) {
   2818      1.1  nonaka 		urtwn_write_1(sc, R92C_LDOV12D_CTRL,
   2819      1.1  nonaka 		    reg | R92C_LDOV12D_CTRL_LDV12_EN);
   2820      1.1  nonaka 		DELAY(100);
   2821      1.1  nonaka 		urtwn_write_1(sc, R92C_SYS_ISO_CTRL,
   2822      1.1  nonaka 		    urtwn_read_1(sc, R92C_SYS_ISO_CTRL) &
   2823      1.1  nonaka 		    ~R92C_SYS_ISO_CTRL_MD2PP);
   2824      1.1  nonaka 	}
   2825      1.1  nonaka 
   2826      1.1  nonaka 	/* Auto enable WLAN. */
   2827      1.1  nonaka 	urtwn_write_2(sc, R92C_APS_FSMCO,
   2828      1.1  nonaka 	    urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC);
   2829      1.1  nonaka 	for (ntries = 0; ntries < 1000; ntries++) {
   2830      1.1  nonaka 		if (!(urtwn_read_2(sc, R92C_APS_FSMCO) &
   2831      1.1  nonaka 		    R92C_APS_FSMCO_APFM_ONMAC))
   2832      1.1  nonaka 			break;
   2833      1.1  nonaka 		DELAY(5);
   2834      1.1  nonaka 	}
   2835      1.1  nonaka 	if (ntries == 1000) {
   2836      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   2837      1.1  nonaka 		    "timeout waiting for MAC auto ON\n");
   2838      1.1  nonaka 		return (ETIMEDOUT);
   2839      1.1  nonaka 	}
   2840      1.1  nonaka 
   2841      1.1  nonaka 	/* Enable radio, GPIO and LED functions. */
   2842      1.1  nonaka 	KASSERT((R92C_APS_FSMCO_AFSM_HSUS | R92C_APS_FSMCO_PDN_EN |
   2843      1.1  nonaka 	    R92C_APS_FSMCO_PFM_ALDN) == 0x0812);
   2844      1.1  nonaka 	urtwn_write_2(sc, R92C_APS_FSMCO,
   2845      1.1  nonaka 	    R92C_APS_FSMCO_AFSM_HSUS |
   2846      1.1  nonaka 	    R92C_APS_FSMCO_PDN_EN |
   2847      1.1  nonaka 	    R92C_APS_FSMCO_PFM_ALDN);
   2848      1.1  nonaka 
   2849      1.1  nonaka 	/* Release RF digital isolation. */
   2850      1.1  nonaka 	urtwn_write_2(sc, R92C_SYS_ISO_CTRL,
   2851      1.1  nonaka 	    urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR);
   2852      1.1  nonaka 
   2853      1.1  nonaka 	/* Initialize MAC. */
   2854      1.1  nonaka 	urtwn_write_1(sc, R92C_APSD_CTRL,
   2855      1.1  nonaka 	    urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF);
   2856      1.1  nonaka 	for (ntries = 0; ntries < 200; ntries++) {
   2857      1.1  nonaka 		if (!(urtwn_read_1(sc, R92C_APSD_CTRL) &
   2858      1.1  nonaka 		    R92C_APSD_CTRL_OFF_STATUS))
   2859      1.1  nonaka 			break;
   2860      1.1  nonaka 		DELAY(5);
   2861      1.1  nonaka 	}
   2862      1.1  nonaka 	if (ntries == 200) {
   2863      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   2864      1.1  nonaka 		    "timeout waiting for MAC initialization\n");
   2865      1.1  nonaka 		return (ETIMEDOUT);
   2866      1.1  nonaka 	}
   2867      1.1  nonaka 
   2868      1.1  nonaka 	/* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */
   2869      1.1  nonaka 	reg = urtwn_read_2(sc, R92C_CR);
   2870      1.1  nonaka 	reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
   2871      1.1  nonaka 	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
   2872      1.1  nonaka 	    R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN |
   2873      1.1  nonaka 	    R92C_CR_ENSEC;
   2874      1.1  nonaka 	urtwn_write_2(sc, R92C_CR, reg);
   2875      1.1  nonaka 
   2876      1.1  nonaka 	urtwn_write_1(sc, 0xfe10, 0x19);
   2877      1.1  nonaka 	return (0);
   2878      1.1  nonaka }
   2879      1.1  nonaka 
   2880      1.1  nonaka static int
   2881  1.5.4.3     tls urtwn_r88e_power_on(struct urtwn_softc *sc)
   2882  1.5.4.3     tls {
   2883  1.5.4.3     tls 	uint32_t reg;
   2884  1.5.4.3     tls 	uint8_t val;
   2885  1.5.4.3     tls 	int ntries;
   2886  1.5.4.3     tls 
   2887  1.5.4.3     tls 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   2888  1.5.4.3     tls 
   2889  1.5.4.3     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   2890  1.5.4.3     tls 
   2891  1.5.4.3     tls 	/* Wait for power ready bit. */
   2892  1.5.4.3     tls 	for (ntries = 0; ntries < 5000; ntries++) {
   2893  1.5.4.3     tls 		val = urtwn_read_1(sc, 0x6) & 0x2;
   2894  1.5.4.3     tls 		if (val == 0x2)
   2895  1.5.4.3     tls 			break;
   2896  1.5.4.3     tls 		DELAY(10);
   2897  1.5.4.3     tls 	}
   2898  1.5.4.3     tls 	if (ntries == 5000) {
   2899  1.5.4.3     tls 		aprint_error_dev(sc->sc_dev,
   2900  1.5.4.3     tls 		    "timeout waiting for chip power up\n");
   2901  1.5.4.3     tls 		return (ETIMEDOUT);
   2902  1.5.4.3     tls 	}
   2903  1.5.4.3     tls 
   2904  1.5.4.3     tls 	/* Reset BB. */
   2905  1.5.4.3     tls 	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
   2906  1.5.4.3     tls 	urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~(R92C_SYS_FUNC_EN_BBRSTB |
   2907  1.5.4.3     tls 	    R92C_SYS_FUNC_EN_BB_GLB_RST));
   2908  1.5.4.3     tls 
   2909  1.5.4.3     tls 	urtwn_write_1(sc, 0x26, urtwn_read_1(sc, 0x26) | 0x80);
   2910  1.5.4.3     tls 
   2911  1.5.4.3     tls 	/* Disable HWPDN. */
   2912  1.5.4.3     tls 	urtwn_write_1(sc, 0x5, urtwn_read_1(sc, 0x5) & ~0x80);
   2913  1.5.4.3     tls 
   2914  1.5.4.3     tls 	/* Disable WL suspend. */
   2915  1.5.4.3     tls 	urtwn_write_1(sc, 0x5, urtwn_read_1(sc, 0x5) & ~0x18);
   2916  1.5.4.3     tls 
   2917  1.5.4.3     tls 	urtwn_write_1(sc, 0x5, urtwn_read_1(sc, 0x5) | 0x1);
   2918  1.5.4.3     tls 	for (ntries = 0; ntries < 5000; ntries++) {
   2919  1.5.4.3     tls 		if (!(urtwn_read_1(sc, 0x5) & 0x1))
   2920  1.5.4.3     tls 			break;
   2921  1.5.4.3     tls 		DELAY(10);
   2922  1.5.4.3     tls 	}
   2923  1.5.4.3     tls 	if (ntries == 5000)
   2924  1.5.4.3     tls 		return (ETIMEDOUT);
   2925  1.5.4.3     tls 
   2926  1.5.4.3     tls 	/* Enable LDO normal mode. */
   2927  1.5.4.3     tls 	urtwn_write_1(sc, 0x23, urtwn_read_1(sc, 0x23) & ~0x10);
   2928  1.5.4.3     tls 
   2929  1.5.4.3     tls 	/* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */
   2930  1.5.4.3     tls 	urtwn_write_2(sc, R92C_CR, 0);
   2931  1.5.4.3     tls 	reg = urtwn_read_2(sc, R92C_CR);
   2932  1.5.4.3     tls 	reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
   2933  1.5.4.3     tls 	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
   2934  1.5.4.3     tls 	    R92C_CR_SCHEDULE_EN | R92C_CR_ENSEC | R92C_CR_CALTMR_EN;
   2935  1.5.4.3     tls 	urtwn_write_2(sc, R92C_CR, reg);
   2936  1.5.4.3     tls 
   2937  1.5.4.3     tls 	return (0);
   2938  1.5.4.3     tls }
   2939  1.5.4.3     tls 
   2940  1.5.4.3     tls static int
   2941      1.1  nonaka urtwn_llt_init(struct urtwn_softc *sc)
   2942      1.1  nonaka {
   2943  1.5.4.3     tls 	size_t i, page_count, pktbuf_count;
   2944  1.5.4.2     tls 	int error;
   2945      1.1  nonaka 
   2946      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   2947      1.1  nonaka 
   2948  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   2949  1.5.4.1     tls 
   2950  1.5.4.3     tls 	page_count = (sc->chip & URTWN_CHIP_88E) ?
   2951  1.5.4.3     tls 	    R88E_TX_PAGE_COUNT : R92C_TX_PAGE_COUNT;
   2952  1.5.4.3     tls 	pktbuf_count = (sc->chip & URTWN_CHIP_88E) ?
   2953  1.5.4.3     tls 	    R88E_TXPKTBUF_COUNT : R92C_TXPKTBUF_COUNT;
   2954  1.5.4.3     tls 
   2955  1.5.4.3     tls 	/* Reserve pages [0; page_count]. */
   2956  1.5.4.3     tls 	for (i = 0; i < page_count; i++) {
   2957      1.1  nonaka 		if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
   2958      1.1  nonaka 			return (error);
   2959      1.1  nonaka 	}
   2960      1.1  nonaka 	/* NB: 0xff indicates end-of-list. */
   2961      1.1  nonaka 	if ((error = urtwn_llt_write(sc, i, 0xff)) != 0)
   2962      1.1  nonaka 		return (error);
   2963      1.1  nonaka 	/*
   2964  1.5.4.3     tls 	 * Use pages [page_count + 1; pktbuf_count - 1]
   2965      1.1  nonaka 	 * as ring buffer.
   2966      1.1  nonaka 	 */
   2967  1.5.4.3     tls 	for (++i; i < pktbuf_count - 1; i++) {
   2968      1.1  nonaka 		if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
   2969      1.1  nonaka 			return (error);
   2970      1.1  nonaka 	}
   2971      1.1  nonaka 	/* Make the last page point to the beginning of the ring buffer. */
   2972  1.5.4.3     tls 	error = urtwn_llt_write(sc, i, pktbuf_count + 1);
   2973      1.1  nonaka 	return (error);
   2974      1.1  nonaka }
   2975      1.1  nonaka 
   2976      1.1  nonaka static void
   2977      1.1  nonaka urtwn_fw_reset(struct urtwn_softc *sc)
   2978      1.1  nonaka {
   2979      1.1  nonaka 	uint16_t reg;
   2980      1.1  nonaka 	int ntries;
   2981      1.1  nonaka 
   2982      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   2983      1.1  nonaka 
   2984  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   2985  1.5.4.1     tls 
   2986      1.1  nonaka 	/* Tell 8051 to reset itself. */
   2987      1.1  nonaka 	urtwn_write_1(sc, R92C_HMETFR + 3, 0x20);
   2988      1.1  nonaka 
   2989      1.1  nonaka 	/* Wait until 8051 resets by itself. */
   2990      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   2991      1.1  nonaka 		reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
   2992      1.1  nonaka 		if (!(reg & R92C_SYS_FUNC_EN_CPUEN))
   2993      1.1  nonaka 			return;
   2994      1.1  nonaka 		DELAY(50);
   2995      1.1  nonaka 	}
   2996      1.1  nonaka 	/* Force 8051 reset. */
   2997  1.5.4.3     tls 	urtwn_write_2(sc, R92C_SYS_FUNC_EN,
   2998  1.5.4.3     tls 	    urtwn_read_2(sc, R92C_SYS_FUNC_EN) & ~R92C_SYS_FUNC_EN_CPUEN);
   2999  1.5.4.3     tls }
   3000  1.5.4.3     tls 
   3001  1.5.4.3     tls static void
   3002  1.5.4.3     tls urtwn_r88e_fw_reset(struct urtwn_softc *sc)
   3003  1.5.4.3     tls {
   3004  1.5.4.3     tls 	uint16_t reg;
   3005  1.5.4.3     tls 
   3006  1.5.4.3     tls 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3007  1.5.4.3     tls 
   3008  1.5.4.3     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   3009  1.5.4.3     tls 
   3010  1.5.4.3     tls 	reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
   3011      1.1  nonaka 	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN);
   3012  1.5.4.3     tls 	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg | R92C_SYS_FUNC_EN_CPUEN);
   3013      1.1  nonaka }
   3014      1.1  nonaka 
   3015      1.1  nonaka static int
   3016      1.1  nonaka urtwn_fw_loadpage(struct urtwn_softc *sc, int page, uint8_t *buf, int len)
   3017      1.1  nonaka {
   3018      1.1  nonaka 	uint32_t reg;
   3019      1.1  nonaka 	int off, mlen, error = 0;
   3020      1.1  nonaka 
   3021      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: page=%d, buf=%p, len=%d\n",
   3022      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, page, buf, len));
   3023      1.1  nonaka 
   3024      1.1  nonaka 	reg = urtwn_read_4(sc, R92C_MCUFWDL);
   3025      1.1  nonaka 	reg = RW(reg, R92C_MCUFWDL_PAGE, page);
   3026      1.1  nonaka 	urtwn_write_4(sc, R92C_MCUFWDL, reg);
   3027      1.1  nonaka 
   3028      1.1  nonaka 	off = R92C_FW_START_ADDR;
   3029      1.1  nonaka 	while (len > 0) {
   3030      1.1  nonaka 		if (len > 196)
   3031      1.1  nonaka 			mlen = 196;
   3032      1.1  nonaka 		else if (len > 4)
   3033      1.1  nonaka 			mlen = 4;
   3034      1.1  nonaka 		else
   3035      1.1  nonaka 			mlen = 1;
   3036      1.1  nonaka 		error = urtwn_write_region(sc, off, buf, mlen);
   3037      1.1  nonaka 		if (error != 0)
   3038      1.1  nonaka 			break;
   3039      1.1  nonaka 		off += mlen;
   3040      1.1  nonaka 		buf += mlen;
   3041      1.1  nonaka 		len -= mlen;
   3042      1.1  nonaka 	}
   3043      1.1  nonaka 	return (error);
   3044      1.1  nonaka }
   3045      1.1  nonaka 
   3046      1.1  nonaka static int
   3047      1.1  nonaka urtwn_load_firmware(struct urtwn_softc *sc)
   3048      1.1  nonaka {
   3049      1.1  nonaka 	firmware_handle_t fwh;
   3050      1.1  nonaka 	const struct r92c_fw_hdr *hdr;
   3051      1.1  nonaka 	const char *name;
   3052      1.1  nonaka 	u_char *fw, *ptr;
   3053      1.1  nonaka 	size_t len;
   3054      1.1  nonaka 	uint32_t reg;
   3055      1.1  nonaka 	int mlen, ntries, page, error;
   3056      1.1  nonaka 
   3057      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3058      1.1  nonaka 
   3059  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   3060  1.5.4.1     tls 
   3061      1.1  nonaka 	/* Read firmware image from the filesystem. */
   3062  1.5.4.3     tls 	if (ISSET(sc->chip, URTWN_CHIP_88E))
   3063  1.5.4.3     tls 		name = "rtl8188eufw.bin";
   3064  1.5.4.3     tls 	else if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
   3065      1.1  nonaka 	    URTWN_CHIP_UMC_A_CUT)
   3066      1.5     riz 		name = "rtl8192cfwU.bin";
   3067      1.1  nonaka 	else
   3068      1.5     riz 		name = "rtl8192cfw.bin";
   3069      1.5     riz 	if ((error = firmware_open("if_urtwn", name, &fwh)) != 0) {
   3070      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   3071  1.5.4.3     tls 		    "failed load firmware of file %s (error %d)\n", name,
   3072  1.5.4.3     tls 		    error);
   3073      1.1  nonaka 		return (error);
   3074      1.1  nonaka 	}
   3075      1.1  nonaka 	len = firmware_get_size(fwh);
   3076      1.1  nonaka 	fw = firmware_malloc(len);
   3077      1.1  nonaka 	if (fw == NULL) {
   3078      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   3079      1.1  nonaka 		    "failed to allocate firmware memory\n");
   3080      1.1  nonaka 		firmware_close(fwh);
   3081      1.1  nonaka 		return (ENOMEM);
   3082      1.1  nonaka 	}
   3083      1.1  nonaka 	error = firmware_read(fwh, 0, fw, len);
   3084      1.1  nonaka 	firmware_close(fwh);
   3085      1.1  nonaka 	if (error != 0) {
   3086      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   3087      1.1  nonaka 		    "failed to read firmware (error %d)\n", error);
   3088      1.1  nonaka 		firmware_free(fw, 0);
   3089      1.1  nonaka 		return (error);
   3090      1.1  nonaka 	}
   3091      1.1  nonaka 
   3092      1.1  nonaka 	ptr = fw;
   3093      1.1  nonaka 	hdr = (const struct r92c_fw_hdr *)ptr;
   3094      1.1  nonaka 	/* Check if there is a valid FW header and skip it. */
   3095      1.1  nonaka 	if ((le16toh(hdr->signature) >> 4) == 0x88c ||
   3096  1.5.4.3     tls 	    (le16toh(hdr->signature) >> 4) == 0x88e ||
   3097      1.1  nonaka 	    (le16toh(hdr->signature) >> 4) == 0x92c) {
   3098      1.1  nonaka 		DPRINTFN(DBG_INIT, ("%s: %s: FW V%d.%d %02d-%02d %02d:%02d\n",
   3099      1.1  nonaka 		    device_xname(sc->sc_dev), __func__,
   3100      1.1  nonaka 		    le16toh(hdr->version), le16toh(hdr->subversion),
   3101      1.1  nonaka 		    hdr->month, hdr->date, hdr->hour, hdr->minute));
   3102      1.1  nonaka 		ptr += sizeof(*hdr);
   3103      1.1  nonaka 		len -= sizeof(*hdr);
   3104      1.1  nonaka 	}
   3105      1.1  nonaka 
   3106  1.5.4.3     tls 	if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RAM_DL_SEL) {
   3107  1.5.4.3     tls 		if (ISSET(sc->chip, URTWN_CHIP_88E))
   3108  1.5.4.3     tls 			urtwn_r88e_fw_reset(sc);
   3109  1.5.4.3     tls 		else
   3110  1.5.4.3     tls 			urtwn_fw_reset(sc);
   3111      1.1  nonaka 		urtwn_write_1(sc, R92C_MCUFWDL, 0);
   3112      1.1  nonaka 	}
   3113  1.5.4.3     tls 	if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
   3114  1.5.4.3     tls 		urtwn_write_2(sc, R92C_SYS_FUNC_EN,
   3115  1.5.4.3     tls 		    urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
   3116  1.5.4.3     tls 		    R92C_SYS_FUNC_EN_CPUEN);
   3117  1.5.4.3     tls 	}
   3118      1.1  nonaka 
   3119      1.1  nonaka 	/* download enabled */
   3120      1.1  nonaka 	urtwn_write_1(sc, R92C_MCUFWDL,
   3121      1.1  nonaka 	    urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN);
   3122      1.1  nonaka 	urtwn_write_1(sc, R92C_MCUFWDL + 2,
   3123      1.1  nonaka 	    urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08);
   3124      1.1  nonaka 
   3125  1.5.4.3     tls 	/* Reset the FWDL checksum. */
   3126  1.5.4.3     tls 	urtwn_write_1(sc, R92C_MCUFWDL,
   3127  1.5.4.3     tls 	    urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_CHKSUM_RPT);
   3128  1.5.4.3     tls 
   3129      1.1  nonaka 	/* download firmware */
   3130      1.1  nonaka 	for (page = 0; len > 0; page++) {
   3131      1.1  nonaka 		mlen = MIN(len, R92C_FW_PAGE_SIZE);
   3132      1.1  nonaka 		error = urtwn_fw_loadpage(sc, page, ptr, mlen);
   3133      1.1  nonaka 		if (error != 0) {
   3134      1.1  nonaka 			aprint_error_dev(sc->sc_dev,
   3135      1.1  nonaka 			    "could not load firmware page %d\n", page);
   3136      1.1  nonaka 			goto fail;
   3137      1.1  nonaka 		}
   3138      1.1  nonaka 		ptr += mlen;
   3139      1.1  nonaka 		len -= mlen;
   3140      1.1  nonaka 	}
   3141      1.1  nonaka 
   3142      1.1  nonaka 	/* download disable */
   3143      1.1  nonaka 	urtwn_write_1(sc, R92C_MCUFWDL,
   3144      1.1  nonaka 	    urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN);
   3145      1.1  nonaka 	urtwn_write_1(sc, R92C_MCUFWDL + 1, 0);
   3146      1.1  nonaka 
   3147      1.1  nonaka 	/* Wait for checksum report. */
   3148      1.1  nonaka 	for (ntries = 0; ntries < 1000; ntries++) {
   3149      1.1  nonaka 		if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT)
   3150      1.1  nonaka 			break;
   3151      1.1  nonaka 		DELAY(5);
   3152      1.1  nonaka 	}
   3153      1.1  nonaka 	if (ntries == 1000) {
   3154      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   3155      1.1  nonaka 		    "timeout waiting for checksum report\n");
   3156      1.1  nonaka 		error = ETIMEDOUT;
   3157      1.1  nonaka 		goto fail;
   3158      1.1  nonaka 	}
   3159      1.1  nonaka 
   3160      1.1  nonaka 	/* Wait for firmware readiness. */
   3161      1.1  nonaka 	reg = urtwn_read_4(sc, R92C_MCUFWDL);
   3162      1.1  nonaka 	reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY;
   3163      1.1  nonaka 	urtwn_write_4(sc, R92C_MCUFWDL, reg);
   3164  1.5.4.3     tls 	if (ISSET(sc->chip, URTWN_CHIP_88E))
   3165  1.5.4.3     tls 		urtwn_r88e_fw_reset(sc);
   3166      1.1  nonaka 	for (ntries = 0; ntries < 1000; ntries++) {
   3167      1.1  nonaka 		if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY)
   3168      1.1  nonaka 			break;
   3169      1.1  nonaka 		DELAY(5);
   3170      1.1  nonaka 	}
   3171      1.1  nonaka 	if (ntries == 1000) {
   3172      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   3173      1.1  nonaka 		    "timeout waiting for firmware readiness\n");
   3174      1.1  nonaka 		error = ETIMEDOUT;
   3175      1.1  nonaka 		goto fail;
   3176      1.1  nonaka 	}
   3177      1.1  nonaka  fail:
   3178      1.1  nonaka 	firmware_free(fw, 0);
   3179      1.1  nonaka 	return (error);
   3180      1.1  nonaka }
   3181      1.1  nonaka 
   3182  1.5.4.3     tls static __inline int
   3183      1.1  nonaka urtwn_dma_init(struct urtwn_softc *sc)
   3184      1.1  nonaka {
   3185  1.5.4.3     tls 
   3186  1.5.4.3     tls 	return sc->sc_dma_init(sc);
   3187  1.5.4.3     tls }
   3188  1.5.4.3     tls 
   3189  1.5.4.3     tls static int
   3190  1.5.4.3     tls urtwn_r92c_dma_init(struct urtwn_softc *sc)
   3191  1.5.4.3     tls {
   3192      1.1  nonaka 	int hashq, hasnq, haslq, nqueues, nqpages, nrempages;
   3193      1.1  nonaka 	uint32_t reg;
   3194      1.1  nonaka 	int error;
   3195      1.1  nonaka 
   3196      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3197      1.1  nonaka 
   3198  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   3199  1.5.4.1     tls 
   3200      1.1  nonaka 	/* Initialize LLT table. */
   3201      1.1  nonaka 	error = urtwn_llt_init(sc);
   3202      1.1  nonaka 	if (error != 0)
   3203      1.1  nonaka 		return (error);
   3204      1.1  nonaka 
   3205      1.1  nonaka 	/* Get Tx queues to USB endpoints mapping. */
   3206      1.1  nonaka 	hashq = hasnq = haslq = 0;
   3207      1.1  nonaka 	reg = urtwn_read_2(sc, R92C_USB_EP + 1);
   3208      1.1  nonaka 	DPRINTFN(DBG_INIT, ("%s: %s: USB endpoints mapping 0x%x\n",
   3209      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, reg));
   3210      1.1  nonaka 	if (MS(reg, R92C_USB_EP_HQ) != 0)
   3211      1.1  nonaka 		hashq = 1;
   3212      1.1  nonaka 	if (MS(reg, R92C_USB_EP_NQ) != 0)
   3213      1.1  nonaka 		hasnq = 1;
   3214      1.1  nonaka 	if (MS(reg, R92C_USB_EP_LQ) != 0)
   3215      1.1  nonaka 		haslq = 1;
   3216      1.1  nonaka 	nqueues = hashq + hasnq + haslq;
   3217      1.1  nonaka 	if (nqueues == 0)
   3218      1.1  nonaka 		return (EIO);
   3219      1.1  nonaka 	/* Get the number of pages for each queue. */
   3220      1.1  nonaka 	nqpages = (R92C_TX_PAGE_COUNT - R92C_PUBQ_NPAGES) / nqueues;
   3221      1.1  nonaka 	/* The remaining pages are assigned to the high priority queue. */
   3222      1.1  nonaka 	nrempages = (R92C_TX_PAGE_COUNT - R92C_PUBQ_NPAGES) % nqueues;
   3223      1.1  nonaka 
   3224      1.1  nonaka 	/* Set number of pages for normal priority queue. */
   3225      1.1  nonaka 	urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0);
   3226      1.1  nonaka 	urtwn_write_4(sc, R92C_RQPN,
   3227      1.1  nonaka 	    /* Set number of pages for public queue. */
   3228      1.1  nonaka 	    SM(R92C_RQPN_PUBQ, R92C_PUBQ_NPAGES) |
   3229      1.1  nonaka 	    /* Set number of pages for high priority queue. */
   3230      1.1  nonaka 	    SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) |
   3231      1.1  nonaka 	    /* Set number of pages for low priority queue. */
   3232      1.1  nonaka 	    SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) |
   3233      1.1  nonaka 	    /* Load values. */
   3234      1.1  nonaka 	    R92C_RQPN_LD);
   3235      1.1  nonaka 
   3236      1.1  nonaka 	urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, R92C_TX_PAGE_BOUNDARY);
   3237      1.1  nonaka 	urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, R92C_TX_PAGE_BOUNDARY);
   3238      1.1  nonaka 	urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, R92C_TX_PAGE_BOUNDARY);
   3239      1.1  nonaka 	urtwn_write_1(sc, R92C_TRXFF_BNDY, R92C_TX_PAGE_BOUNDARY);
   3240      1.1  nonaka 	urtwn_write_1(sc, R92C_TDECTRL + 1, R92C_TX_PAGE_BOUNDARY);
   3241      1.1  nonaka 
   3242      1.1  nonaka 	/* Set queue to USB pipe mapping. */
   3243      1.1  nonaka 	reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL);
   3244      1.1  nonaka 	reg &= ~R92C_TRXDMA_CTRL_QMAP_M;
   3245      1.1  nonaka 	if (nqueues == 1) {
   3246      1.1  nonaka 		if (hashq) {
   3247      1.1  nonaka 			reg |= R92C_TRXDMA_CTRL_QMAP_HQ;
   3248      1.1  nonaka 		} else if (hasnq) {
   3249      1.1  nonaka 			reg |= R92C_TRXDMA_CTRL_QMAP_NQ;
   3250      1.1  nonaka 		} else {
   3251      1.1  nonaka 			reg |= R92C_TRXDMA_CTRL_QMAP_LQ;
   3252      1.1  nonaka 		}
   3253      1.1  nonaka 	} else if (nqueues == 2) {
   3254      1.1  nonaka 		/* All 2-endpoints configs have a high priority queue. */
   3255      1.1  nonaka 		if (!hashq) {
   3256      1.1  nonaka 			return (EIO);
   3257      1.1  nonaka 		}
   3258      1.1  nonaka 		if (hasnq) {
   3259      1.1  nonaka 			reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ;
   3260      1.1  nonaka 		} else {
   3261      1.1  nonaka 			reg |= R92C_TRXDMA_CTRL_QMAP_HQ_LQ;
   3262      1.1  nonaka 		}
   3263      1.1  nonaka 	} else {
   3264      1.1  nonaka 		reg |= R92C_TRXDMA_CTRL_QMAP_3EP;
   3265      1.1  nonaka 	}
   3266      1.1  nonaka 	urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg);
   3267      1.1  nonaka 
   3268      1.1  nonaka 	/* Set Tx/Rx transfer page boundary. */
   3269      1.1  nonaka 	urtwn_write_2(sc, R92C_TRXFF_BNDY + 2, 0x27ff);
   3270      1.1  nonaka 
   3271      1.1  nonaka 	/* Set Tx/Rx transfer page size. */
   3272      1.1  nonaka 	urtwn_write_1(sc, R92C_PBP,
   3273      1.1  nonaka 	    SM(R92C_PBP_PSRX, R92C_PBP_128) | SM(R92C_PBP_PSTX, R92C_PBP_128));
   3274      1.1  nonaka 	return (0);
   3275      1.1  nonaka }
   3276      1.1  nonaka 
   3277  1.5.4.3     tls static int
   3278  1.5.4.3     tls urtwn_r88e_dma_init(struct urtwn_softc *sc)
   3279  1.5.4.3     tls {
   3280  1.5.4.3     tls 	usb_interface_descriptor_t *id;
   3281  1.5.4.3     tls 	uint32_t reg;
   3282  1.5.4.3     tls 	int nqueues;
   3283  1.5.4.3     tls 	int error;
   3284  1.5.4.3     tls 
   3285  1.5.4.3     tls 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3286  1.5.4.3     tls 
   3287  1.5.4.3     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   3288  1.5.4.3     tls 
   3289  1.5.4.3     tls 	/* Initialize LLT table. */
   3290  1.5.4.3     tls 	error = urtwn_llt_init(sc);
   3291  1.5.4.3     tls 	if (error != 0)
   3292  1.5.4.3     tls 		return (error);
   3293  1.5.4.3     tls 
   3294  1.5.4.3     tls 	/* Get Tx queues to USB endpoints mapping. */
   3295  1.5.4.3     tls 	id = usbd_get_interface_descriptor(sc->sc_iface);
   3296  1.5.4.3     tls 	nqueues = id->bNumEndpoints - 1;
   3297  1.5.4.3     tls 	if (nqueues == 0)
   3298  1.5.4.3     tls 		return (EIO);
   3299  1.5.4.3     tls 
   3300  1.5.4.3     tls 	/* Set number of pages for normal priority queue. */
   3301  1.5.4.3     tls 	urtwn_write_2(sc, R92C_RQPN_NPQ, 0);
   3302  1.5.4.3     tls 	urtwn_write_2(sc, R92C_RQPN_NPQ, 0x000d);
   3303  1.5.4.3     tls 	urtwn_write_4(sc, R92C_RQPN, 0x808e000d);
   3304  1.5.4.3     tls 
   3305  1.5.4.3     tls 	urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, R88E_TX_PAGE_BOUNDARY);
   3306  1.5.4.3     tls 	urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, R88E_TX_PAGE_BOUNDARY);
   3307  1.5.4.3     tls 	urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, R88E_TX_PAGE_BOUNDARY);
   3308  1.5.4.3     tls 	urtwn_write_1(sc, R92C_TRXFF_BNDY, R88E_TX_PAGE_BOUNDARY);
   3309  1.5.4.3     tls 	urtwn_write_1(sc, R92C_TDECTRL + 1, R88E_TX_PAGE_BOUNDARY);
   3310  1.5.4.3     tls 
   3311  1.5.4.3     tls 	/* Set queue to USB pipe mapping. */
   3312  1.5.4.3     tls 	reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL);
   3313  1.5.4.3     tls 	reg &= ~R92C_TRXDMA_CTRL_QMAP_M;
   3314  1.5.4.3     tls 	if (nqueues == 1)
   3315  1.5.4.3     tls 		reg |= R92C_TRXDMA_CTRL_QMAP_LQ;
   3316  1.5.4.3     tls 	else if (nqueues == 2)
   3317  1.5.4.3     tls 		reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ;
   3318  1.5.4.3     tls 	else
   3319  1.5.4.3     tls 		reg |= R92C_TRXDMA_CTRL_QMAP_3EP;
   3320  1.5.4.3     tls 	urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg);
   3321  1.5.4.3     tls 
   3322  1.5.4.3     tls 	/* Set Tx/Rx transfer page boundary. */
   3323  1.5.4.3     tls 	urtwn_write_2(sc, R92C_TRXFF_BNDY + 2, 0x23ff);
   3324  1.5.4.3     tls 
   3325  1.5.4.3     tls 	/* Set Tx/Rx transfer page size. */
   3326  1.5.4.3     tls 	urtwn_write_1(sc, R92C_PBP,
   3327  1.5.4.3     tls 	    SM(R92C_PBP_PSRX, R92C_PBP_128) | SM(R92C_PBP_PSTX, R92C_PBP_128));
   3328  1.5.4.3     tls 
   3329  1.5.4.3     tls 	return (0);
   3330  1.5.4.3     tls }
   3331  1.5.4.3     tls 
   3332      1.1  nonaka static void
   3333      1.1  nonaka urtwn_mac_init(struct urtwn_softc *sc)
   3334      1.1  nonaka {
   3335  1.5.4.2     tls 	size_t i;
   3336      1.1  nonaka 
   3337      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3338      1.1  nonaka 
   3339  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   3340  1.5.4.1     tls 
   3341      1.1  nonaka 	/* Write MAC initialization values. */
   3342  1.5.4.3     tls 	if (ISSET(sc->chip, URTWN_CHIP_88E)) {
   3343  1.5.4.3     tls 		for (i = 0; i < __arraycount(rtl8188eu_mac); i++)
   3344  1.5.4.3     tls 			urtwn_write_1(sc, rtl8188eu_mac[i].reg,
   3345  1.5.4.3     tls 			    rtl8188eu_mac[i].val);
   3346  1.5.4.3     tls 	} else {
   3347  1.5.4.3     tls 		for (i = 0; i < __arraycount(rtl8192cu_mac); i++)
   3348  1.5.4.3     tls 			urtwn_write_1(sc, rtl8192cu_mac[i].reg,
   3349  1.5.4.3     tls 			    rtl8192cu_mac[i].val);
   3350  1.5.4.3     tls 	}
   3351      1.1  nonaka }
   3352      1.1  nonaka 
   3353      1.1  nonaka static void
   3354      1.1  nonaka urtwn_bb_init(struct urtwn_softc *sc)
   3355      1.1  nonaka {
   3356      1.1  nonaka 	const struct urtwn_bb_prog *prog;
   3357      1.1  nonaka 	uint32_t reg;
   3358  1.5.4.3     tls 	uint8_t crystalcap;
   3359  1.5.4.2     tls 	size_t i;
   3360      1.1  nonaka 
   3361      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3362      1.1  nonaka 
   3363  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   3364  1.5.4.1     tls 
   3365      1.1  nonaka 	/* Enable BB and RF. */
   3366      1.1  nonaka 	urtwn_write_2(sc, R92C_SYS_FUNC_EN,
   3367      1.1  nonaka 	    urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
   3368      1.1  nonaka 	    R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST |
   3369      1.1  nonaka 	    R92C_SYS_FUNC_EN_DIO_RF);
   3370      1.1  nonaka 
   3371  1.5.4.3     tls 	if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
   3372  1.5.4.3     tls 		urtwn_write_1(sc, R92C_AFE_PLL_CTRL, 0x83);
   3373  1.5.4.3     tls 		urtwn_write_1(sc, R92C_AFE_PLL_CTRL + 1, 0xdb);
   3374  1.5.4.3     tls 	}
   3375      1.1  nonaka 
   3376      1.1  nonaka 	urtwn_write_1(sc, R92C_RF_CTRL,
   3377      1.1  nonaka 	    R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB);
   3378      1.1  nonaka 	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
   3379      1.1  nonaka 	    R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD |
   3380      1.1  nonaka 	    R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB);
   3381      1.1  nonaka 
   3382  1.5.4.3     tls 	if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
   3383  1.5.4.3     tls 		urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f);
   3384  1.5.4.3     tls 		urtwn_write_1(sc, 0x15, 0xe9);
   3385  1.5.4.3     tls 		urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80);
   3386  1.5.4.3     tls 	}
   3387      1.1  nonaka 
   3388      1.1  nonaka 	/* Select BB programming based on board type. */
   3389  1.5.4.3     tls 	if (ISSET(sc->chip, URTWN_CHIP_88E))
   3390  1.5.4.3     tls 		prog = &rtl8188eu_bb_prog;
   3391  1.5.4.3     tls 	else if (!(sc->chip & URTWN_CHIP_92C)) {
   3392      1.1  nonaka 		if (sc->board_type == R92C_BOARD_TYPE_MINICARD) {
   3393      1.1  nonaka 			prog = &rtl8188ce_bb_prog;
   3394      1.1  nonaka 		} else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) {
   3395      1.1  nonaka 			prog = &rtl8188ru_bb_prog;
   3396      1.1  nonaka 		} else {
   3397      1.1  nonaka 			prog = &rtl8188cu_bb_prog;
   3398      1.1  nonaka 		}
   3399      1.1  nonaka 	} else {
   3400      1.1  nonaka 		if (sc->board_type == R92C_BOARD_TYPE_MINICARD) {
   3401      1.1  nonaka 			prog = &rtl8192ce_bb_prog;
   3402      1.1  nonaka 		} else {
   3403      1.1  nonaka 			prog = &rtl8192cu_bb_prog;
   3404      1.1  nonaka 		}
   3405      1.1  nonaka 	}
   3406      1.1  nonaka 	/* Write BB initialization values. */
   3407      1.1  nonaka 	for (i = 0; i < prog->count; i++) {
   3408      1.1  nonaka 		/* additional delay depend on registers */
   3409      1.1  nonaka 		switch (prog->regs[i]) {
   3410      1.1  nonaka 		case 0xfe:
   3411      1.1  nonaka 			usbd_delay_ms(sc->sc_udev, 50);
   3412      1.1  nonaka 			break;
   3413      1.1  nonaka 		case 0xfd:
   3414      1.1  nonaka 			usbd_delay_ms(sc->sc_udev, 5);
   3415      1.1  nonaka 			break;
   3416      1.1  nonaka 		case 0xfc:
   3417      1.1  nonaka 			usbd_delay_ms(sc->sc_udev, 1);
   3418      1.1  nonaka 			break;
   3419      1.1  nonaka 		case 0xfb:
   3420      1.1  nonaka 			DELAY(50);
   3421      1.1  nonaka 			break;
   3422      1.1  nonaka 		case 0xfa:
   3423      1.1  nonaka 			DELAY(5);
   3424      1.1  nonaka 			break;
   3425      1.1  nonaka 		case 0xf9:
   3426      1.1  nonaka 			DELAY(1);
   3427      1.1  nonaka 			break;
   3428      1.1  nonaka 		}
   3429      1.1  nonaka 		urtwn_bb_write(sc, prog->regs[i], prog->vals[i]);
   3430      1.1  nonaka 		DELAY(1);
   3431      1.1  nonaka 	}
   3432      1.1  nonaka 
   3433      1.1  nonaka 	if (sc->chip & URTWN_CHIP_92C_1T2R) {
   3434      1.1  nonaka 		/* 8192C 1T only configuration. */
   3435      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO);
   3436      1.1  nonaka 		reg = (reg & ~0x00000003) | 0x2;
   3437      1.1  nonaka 		urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg);
   3438      1.1  nonaka 
   3439      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO);
   3440      1.1  nonaka 		reg = (reg & ~0x00300033) | 0x00200022;
   3441      1.1  nonaka 		urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg);
   3442      1.1  nonaka 
   3443      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING);
   3444      1.1  nonaka 		reg = (reg & ~0xff000000) | (0x45 << 24);
   3445      1.1  nonaka 		urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg);
   3446      1.1  nonaka 
   3447      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA);
   3448      1.1  nonaka 		reg = (reg & ~0x000000ff) | 0x23;
   3449      1.1  nonaka 		urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg);
   3450      1.1  nonaka 
   3451      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1);
   3452      1.1  nonaka 		reg = (reg & ~0x00000030) | (1 << 4);
   3453      1.1  nonaka 		urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg);
   3454      1.1  nonaka 
   3455      1.1  nonaka 		reg = urtwn_bb_read(sc, 0xe74);
   3456      1.1  nonaka 		reg = (reg & ~0x0c000000) | (2 << 26);
   3457      1.1  nonaka 		urtwn_bb_write(sc, 0xe74, reg);
   3458      1.1  nonaka 		reg = urtwn_bb_read(sc, 0xe78);
   3459      1.1  nonaka 		reg = (reg & ~0x0c000000) | (2 << 26);
   3460      1.1  nonaka 		urtwn_bb_write(sc, 0xe78, reg);
   3461      1.1  nonaka 		reg = urtwn_bb_read(sc, 0xe7c);
   3462      1.1  nonaka 		reg = (reg & ~0x0c000000) | (2 << 26);
   3463      1.1  nonaka 		urtwn_bb_write(sc, 0xe7c, reg);
   3464      1.1  nonaka 		reg = urtwn_bb_read(sc, 0xe80);
   3465      1.1  nonaka 		reg = (reg & ~0x0c000000) | (2 << 26);
   3466      1.1  nonaka 		urtwn_bb_write(sc, 0xe80, reg);
   3467      1.1  nonaka 		reg = urtwn_bb_read(sc, 0xe88);
   3468      1.1  nonaka 		reg = (reg & ~0x0c000000) | (2 << 26);
   3469      1.1  nonaka 		urtwn_bb_write(sc, 0xe88, reg);
   3470      1.1  nonaka 	}
   3471      1.1  nonaka 
   3472      1.1  nonaka 	/* Write AGC values. */
   3473      1.1  nonaka 	for (i = 0; i < prog->agccount; i++) {
   3474      1.1  nonaka 		urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE, prog->agcvals[i]);
   3475      1.1  nonaka 		DELAY(1);
   3476      1.1  nonaka 	}
   3477      1.1  nonaka 
   3478  1.5.4.3     tls 	if (ISSET(sc->chip, URTWN_CHIP_88E)) {
   3479  1.5.4.3     tls 		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553422);
   3480  1.5.4.3     tls 		DELAY(1);
   3481  1.5.4.3     tls 		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553420);
   3482  1.5.4.3     tls 		DELAY(1);
   3483  1.5.4.3     tls 
   3484  1.5.4.3     tls 		crystalcap = sc->r88e_rom[0xb9];
   3485  1.5.4.3     tls 		if (crystalcap == 0xff)
   3486  1.5.4.3     tls 			crystalcap = 0x20;
   3487  1.5.4.3     tls 		crystalcap &= 0x3f;
   3488  1.5.4.3     tls 		reg = urtwn_bb_read(sc, R92C_AFE_XTAL_CTRL);
   3489  1.5.4.3     tls 		urtwn_bb_write(sc, R92C_AFE_XTAL_CTRL,
   3490  1.5.4.3     tls 		    RW(reg, R92C_AFE_XTAL_CTRL_ADDR,
   3491  1.5.4.3     tls 		    crystalcap | crystalcap << 6));
   3492  1.5.4.3     tls 	} else {
   3493  1.5.4.3     tls 		if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) &
   3494  1.5.4.3     tls 		    R92C_HSSI_PARAM2_CCK_HIPWR) {
   3495  1.5.4.3     tls 			SET(sc->sc_flags, URTWN_FLAG_CCK_HIPWR);
   3496  1.5.4.3     tls 		}
   3497      1.1  nonaka 	}
   3498      1.1  nonaka }
   3499      1.1  nonaka 
   3500      1.1  nonaka static void
   3501      1.1  nonaka urtwn_rf_init(struct urtwn_softc *sc)
   3502      1.1  nonaka {
   3503      1.1  nonaka 	const struct urtwn_rf_prog *prog;
   3504      1.1  nonaka 	uint32_t reg, mask, saved;
   3505  1.5.4.2     tls 	size_t i, j, idx;
   3506      1.1  nonaka 
   3507      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3508      1.1  nonaka 
   3509      1.1  nonaka 	/* Select RF programming based on board type. */
   3510  1.5.4.3     tls 	if (ISSET(sc->chip, URTWN_CHIP_88E))
   3511  1.5.4.3     tls 		prog = rtl8188eu_rf_prog;
   3512  1.5.4.3     tls 	else if (!(sc->chip & URTWN_CHIP_92C)) {
   3513      1.1  nonaka 		if (sc->board_type == R92C_BOARD_TYPE_MINICARD) {
   3514      1.1  nonaka 			prog = rtl8188ce_rf_prog;
   3515      1.1  nonaka 		} else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) {
   3516      1.1  nonaka 			prog = rtl8188ru_rf_prog;
   3517      1.1  nonaka 		} else {
   3518      1.1  nonaka 			prog = rtl8188cu_rf_prog;
   3519      1.1  nonaka 		}
   3520      1.1  nonaka 	} else {
   3521      1.1  nonaka 		prog = rtl8192ce_rf_prog;
   3522      1.1  nonaka 	}
   3523      1.1  nonaka 
   3524      1.1  nonaka 	for (i = 0; i < sc->nrxchains; i++) {
   3525      1.1  nonaka 		/* Save RF_ENV control type. */
   3526      1.1  nonaka 		idx = i / 2;
   3527      1.1  nonaka 		mask = 0xffffU << ((i % 2) * 16);
   3528      1.1  nonaka 		saved = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)) & mask;
   3529      1.1  nonaka 
   3530      1.1  nonaka 		/* Set RF_ENV enable. */
   3531      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
   3532      1.1  nonaka 		reg |= 0x100000;
   3533      1.1  nonaka 		urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
   3534      1.1  nonaka 		DELAY(1);
   3535      1.1  nonaka 
   3536      1.1  nonaka 		/* Set RF_ENV output high. */
   3537      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
   3538      1.1  nonaka 		reg |= 0x10;
   3539      1.1  nonaka 		urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
   3540      1.1  nonaka 		DELAY(1);
   3541      1.1  nonaka 
   3542      1.1  nonaka 		/* Set address and data lengths of RF registers. */
   3543      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
   3544      1.1  nonaka 		reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH;
   3545      1.1  nonaka 		urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
   3546      1.1  nonaka 		DELAY(1);
   3547      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
   3548      1.1  nonaka 		reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH;
   3549      1.1  nonaka 		urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
   3550      1.1  nonaka 		DELAY(1);
   3551      1.1  nonaka 
   3552      1.1  nonaka 		/* Write RF initialization values for this chain. */
   3553      1.1  nonaka 		for (j = 0; j < prog[i].count; j++) {
   3554      1.1  nonaka 			if (prog[i].regs[j] >= 0xf9 &&
   3555      1.1  nonaka 			    prog[i].regs[j] <= 0xfe) {
   3556      1.1  nonaka 				/*
   3557      1.1  nonaka 				 * These are fake RF registers offsets that
   3558      1.1  nonaka 				 * indicate a delay is required.
   3559      1.1  nonaka 				 */
   3560      1.1  nonaka 				usbd_delay_ms(sc->sc_udev, 50);
   3561      1.1  nonaka 				continue;
   3562      1.1  nonaka 			}
   3563      1.1  nonaka 			urtwn_rf_write(sc, i, prog[i].regs[j], prog[i].vals[j]);
   3564      1.1  nonaka 			DELAY(1);
   3565      1.1  nonaka 		}
   3566      1.1  nonaka 
   3567      1.1  nonaka 		/* Restore RF_ENV control type. */
   3568      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)) & ~mask;
   3569      1.1  nonaka 		urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg | saved);
   3570      1.1  nonaka 	}
   3571      1.1  nonaka 
   3572      1.1  nonaka 	if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
   3573      1.1  nonaka 	    URTWN_CHIP_UMC_A_CUT) {
   3574      1.1  nonaka 		urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255);
   3575      1.1  nonaka 		urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00);
   3576      1.1  nonaka 	}
   3577      1.1  nonaka 
   3578      1.1  nonaka 	/* Cache RF register CHNLBW. */
   3579      1.1  nonaka 	for (i = 0; i < 2; i++) {
   3580      1.1  nonaka 		sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW);
   3581      1.1  nonaka 	}
   3582      1.1  nonaka }
   3583      1.1  nonaka 
   3584      1.1  nonaka static void
   3585      1.1  nonaka urtwn_cam_init(struct urtwn_softc *sc)
   3586      1.1  nonaka {
   3587      1.1  nonaka 	uint32_t content, command;
   3588      1.1  nonaka 	uint8_t idx;
   3589  1.5.4.2     tls 	size_t i;
   3590      1.1  nonaka 
   3591      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3592      1.1  nonaka 
   3593  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   3594  1.5.4.1     tls 
   3595      1.1  nonaka 	for (idx = 0; idx < R92C_CAM_ENTRY_COUNT; idx++) {
   3596      1.1  nonaka 		content = (idx & 3)
   3597      1.1  nonaka 		    | (R92C_CAM_ALGO_AES << R92C_CAM_ALGO_S)
   3598      1.1  nonaka 		    | R92C_CAM_VALID;
   3599      1.1  nonaka 
   3600      1.1  nonaka 		command = R92C_CAMCMD_POLLING
   3601      1.1  nonaka 		    | R92C_CAMCMD_WRITE
   3602      1.1  nonaka 		    | R92C_CAM_CTL0(idx);
   3603      1.1  nonaka 
   3604      1.1  nonaka 		urtwn_write_4(sc, R92C_CAMWRITE, content);
   3605      1.1  nonaka 		urtwn_write_4(sc, R92C_CAMCMD, command);
   3606      1.1  nonaka 	}
   3607      1.1  nonaka 
   3608      1.1  nonaka 	for (idx = 0; idx < R92C_CAM_ENTRY_COUNT; idx++) {
   3609      1.1  nonaka 		for (i = 0; i < /* CAM_CONTENT_COUNT */ 8; i++) {
   3610      1.1  nonaka 			if (i == 0) {
   3611      1.1  nonaka 				content = (idx & 3)
   3612      1.1  nonaka 				    | (R92C_CAM_ALGO_AES << R92C_CAM_ALGO_S)
   3613      1.1  nonaka 				    | R92C_CAM_VALID;
   3614      1.1  nonaka 			} else {
   3615      1.1  nonaka 				content = 0;
   3616      1.1  nonaka 			}
   3617      1.1  nonaka 
   3618      1.1  nonaka 			command = R92C_CAMCMD_POLLING
   3619      1.1  nonaka 			    | R92C_CAMCMD_WRITE
   3620      1.1  nonaka 			    | R92C_CAM_CTL0(idx)
   3621  1.5.4.2     tls 			    | i;
   3622      1.1  nonaka 
   3623      1.1  nonaka 			urtwn_write_4(sc, R92C_CAMWRITE, content);
   3624      1.1  nonaka 			urtwn_write_4(sc, R92C_CAMCMD, command);
   3625      1.1  nonaka 		}
   3626      1.1  nonaka 	}
   3627      1.1  nonaka 
   3628      1.1  nonaka 	/* Invalidate all CAM entries. */
   3629      1.1  nonaka 	urtwn_write_4(sc, R92C_CAMCMD, R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR);
   3630      1.1  nonaka }
   3631      1.1  nonaka 
   3632      1.1  nonaka static void
   3633      1.1  nonaka urtwn_pa_bias_init(struct urtwn_softc *sc)
   3634      1.1  nonaka {
   3635      1.1  nonaka 	uint8_t reg;
   3636  1.5.4.2     tls 	size_t i;
   3637      1.1  nonaka 
   3638      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3639      1.1  nonaka 
   3640  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   3641  1.5.4.1     tls 
   3642      1.1  nonaka 	for (i = 0; i < sc->nrxchains; i++) {
   3643      1.1  nonaka 		if (sc->pa_setting & (1U << i))
   3644      1.1  nonaka 			continue;
   3645      1.1  nonaka 
   3646      1.1  nonaka 		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406);
   3647      1.1  nonaka 		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406);
   3648      1.1  nonaka 		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406);
   3649      1.1  nonaka 		urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406);
   3650      1.1  nonaka 	}
   3651      1.1  nonaka 	if (!(sc->pa_setting & 0x10)) {
   3652      1.1  nonaka 		reg = urtwn_read_1(sc, 0x16);
   3653      1.1  nonaka 		reg = (reg & ~0xf0) | 0x90;
   3654      1.1  nonaka 		urtwn_write_1(sc, 0x16, reg);
   3655      1.1  nonaka 	}
   3656      1.1  nonaka }
   3657      1.1  nonaka 
   3658      1.1  nonaka static void
   3659      1.1  nonaka urtwn_rxfilter_init(struct urtwn_softc *sc)
   3660      1.1  nonaka {
   3661      1.1  nonaka 
   3662      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3663      1.1  nonaka 
   3664  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   3665  1.5.4.1     tls 
   3666      1.1  nonaka 	/* Initialize Rx filter. */
   3667      1.1  nonaka 	/* TODO: use better filter for monitor mode. */
   3668      1.1  nonaka 	urtwn_write_4(sc, R92C_RCR,
   3669      1.1  nonaka 	    R92C_RCR_AAP | R92C_RCR_APM | R92C_RCR_AM | R92C_RCR_AB |
   3670      1.1  nonaka 	    R92C_RCR_APP_ICV | R92C_RCR_AMF | R92C_RCR_HTC_LOC_CTRL |
   3671      1.1  nonaka 	    R92C_RCR_APP_MIC | R92C_RCR_APP_PHYSTS);
   3672      1.1  nonaka 	/* Accept all multicast frames. */
   3673      1.1  nonaka 	urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff);
   3674      1.1  nonaka 	urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff);
   3675      1.1  nonaka 	/* Accept all management frames. */
   3676      1.1  nonaka 	urtwn_write_2(sc, R92C_RXFLTMAP0, 0xffff);
   3677      1.1  nonaka 	/* Reject all control frames. */
   3678      1.1  nonaka 	urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000);
   3679      1.1  nonaka 	/* Accept all data frames. */
   3680      1.1  nonaka 	urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
   3681      1.1  nonaka }
   3682      1.1  nonaka 
   3683      1.1  nonaka static void
   3684      1.1  nonaka urtwn_edca_init(struct urtwn_softc *sc)
   3685      1.1  nonaka {
   3686      1.1  nonaka 
   3687      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3688      1.1  nonaka 
   3689  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   3690  1.5.4.1     tls 
   3691      1.1  nonaka 	/* set spec SIFS (used in NAV) */
   3692      1.1  nonaka 	urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a);
   3693      1.1  nonaka 	urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a);
   3694      1.1  nonaka 
   3695      1.1  nonaka 	/* set SIFS CCK/OFDM */
   3696      1.1  nonaka 	urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a);
   3697      1.1  nonaka 	urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a);
   3698      1.1  nonaka 
   3699      1.1  nonaka 	/* TXOP */
   3700      1.1  nonaka 	urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b);
   3701      1.1  nonaka 	urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f);
   3702      1.1  nonaka 	urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324);
   3703      1.1  nonaka 	urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226);
   3704      1.1  nonaka }
   3705      1.1  nonaka 
   3706      1.1  nonaka static void
   3707      1.1  nonaka urtwn_write_txpower(struct urtwn_softc *sc, int chain,
   3708      1.1  nonaka     uint16_t power[URTWN_RIDX_COUNT])
   3709      1.1  nonaka {
   3710      1.1  nonaka 	uint32_t reg;
   3711      1.1  nonaka 
   3712      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: chain=%d\n", device_xname(sc->sc_dev),
   3713      1.1  nonaka 	    __func__, chain));
   3714      1.1  nonaka 
   3715      1.1  nonaka 	/* Write per-CCK rate Tx power. */
   3716      1.1  nonaka 	if (chain == 0) {
   3717      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32);
   3718      1.1  nonaka 		reg = RW(reg, R92C_TXAGC_A_CCK1,  power[0]);
   3719      1.1  nonaka 		urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg);
   3720      1.1  nonaka 
   3721      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
   3722      1.1  nonaka 		reg = RW(reg, R92C_TXAGC_A_CCK2,  power[1]);
   3723      1.1  nonaka 		reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]);
   3724      1.1  nonaka 		reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]);
   3725      1.1  nonaka 		urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
   3726      1.1  nonaka 	} else {
   3727      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32);
   3728      1.1  nonaka 		reg = RW(reg, R92C_TXAGC_B_CCK1,  power[0]);
   3729      1.1  nonaka 		reg = RW(reg, R92C_TXAGC_B_CCK2,  power[1]);
   3730      1.1  nonaka 		reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]);
   3731      1.1  nonaka 		urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg);
   3732      1.1  nonaka 
   3733      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
   3734      1.1  nonaka 		reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]);
   3735      1.1  nonaka 		urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
   3736      1.1  nonaka 	}
   3737      1.1  nonaka 	/* Write per-OFDM rate Tx power. */
   3738      1.1  nonaka 	urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain),
   3739      1.1  nonaka 	    SM(R92C_TXAGC_RATE06, power[ 4]) |
   3740      1.1  nonaka 	    SM(R92C_TXAGC_RATE09, power[ 5]) |
   3741      1.1  nonaka 	    SM(R92C_TXAGC_RATE12, power[ 6]) |
   3742      1.1  nonaka 	    SM(R92C_TXAGC_RATE18, power[ 7]));
   3743      1.1  nonaka 	urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain),
   3744      1.1  nonaka 	    SM(R92C_TXAGC_RATE24, power[ 8]) |
   3745      1.1  nonaka 	    SM(R92C_TXAGC_RATE36, power[ 9]) |
   3746      1.1  nonaka 	    SM(R92C_TXAGC_RATE48, power[10]) |
   3747      1.1  nonaka 	    SM(R92C_TXAGC_RATE54, power[11]));
   3748      1.1  nonaka 	/* Write per-MCS Tx power. */
   3749      1.1  nonaka 	urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain),
   3750      1.1  nonaka 	    SM(R92C_TXAGC_MCS00,  power[12]) |
   3751      1.1  nonaka 	    SM(R92C_TXAGC_MCS01,  power[13]) |
   3752      1.1  nonaka 	    SM(R92C_TXAGC_MCS02,  power[14]) |
   3753      1.1  nonaka 	    SM(R92C_TXAGC_MCS03,  power[15]));
   3754      1.1  nonaka 	urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain),
   3755      1.1  nonaka 	    SM(R92C_TXAGC_MCS04,  power[16]) |
   3756      1.1  nonaka 	    SM(R92C_TXAGC_MCS05,  power[17]) |
   3757      1.1  nonaka 	    SM(R92C_TXAGC_MCS06,  power[18]) |
   3758      1.1  nonaka 	    SM(R92C_TXAGC_MCS07,  power[19]));
   3759      1.1  nonaka 	urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain),
   3760      1.1  nonaka 	    SM(R92C_TXAGC_MCS08,  power[20]) |
   3761      1.1  nonaka 	    SM(R92C_TXAGC_MCS09,  power[21]) |
   3762      1.1  nonaka 	    SM(R92C_TXAGC_MCS10,  power[22]) |
   3763      1.1  nonaka 	    SM(R92C_TXAGC_MCS11,  power[23]));
   3764      1.1  nonaka 	urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain),
   3765      1.1  nonaka 	    SM(R92C_TXAGC_MCS12,  power[24]) |
   3766      1.1  nonaka 	    SM(R92C_TXAGC_MCS13,  power[25]) |
   3767      1.1  nonaka 	    SM(R92C_TXAGC_MCS14,  power[26]) |
   3768      1.1  nonaka 	    SM(R92C_TXAGC_MCS15,  power[27]));
   3769      1.1  nonaka }
   3770      1.1  nonaka 
   3771      1.1  nonaka static void
   3772  1.5.4.2     tls urtwn_get_txpower(struct urtwn_softc *sc, size_t chain, u_int chan, u_int ht40m,
   3773      1.1  nonaka     uint16_t power[URTWN_RIDX_COUNT])
   3774      1.1  nonaka {
   3775      1.1  nonaka 	struct r92c_rom *rom = &sc->rom;
   3776      1.1  nonaka 	uint16_t cckpow, ofdmpow, htpow, diff, maxpow;
   3777      1.1  nonaka 	const struct urtwn_txpwr *base;
   3778      1.1  nonaka 	int ridx, group;
   3779      1.1  nonaka 
   3780  1.5.4.2     tls 	DPRINTFN(DBG_FN, ("%s: %s: chain=%zd, chan=%d\n",
   3781      1.1  nonaka 	    device_xname(sc->sc_dev), __func__, chain, chan));
   3782      1.1  nonaka 
   3783      1.1  nonaka 	/* Determine channel group. */
   3784      1.1  nonaka 	if (chan <= 3) {
   3785      1.1  nonaka 		group = 0;
   3786      1.1  nonaka 	} else if (chan <= 9) {
   3787      1.1  nonaka 		group = 1;
   3788      1.1  nonaka 	} else {
   3789      1.1  nonaka 		group = 2;
   3790      1.1  nonaka 	}
   3791      1.1  nonaka 
   3792      1.1  nonaka 	/* Get original Tx power based on board type and RF chain. */
   3793      1.1  nonaka 	if (!(sc->chip & URTWN_CHIP_92C)) {
   3794      1.1  nonaka 		if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) {
   3795      1.1  nonaka 			base = &rtl8188ru_txagc[chain];
   3796      1.1  nonaka 		} else {
   3797      1.1  nonaka 			base = &rtl8192cu_txagc[chain];
   3798      1.1  nonaka 		}
   3799      1.1  nonaka 	} else {
   3800      1.1  nonaka 		base = &rtl8192cu_txagc[chain];
   3801      1.1  nonaka 	}
   3802      1.1  nonaka 
   3803      1.1  nonaka 	memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0]));
   3804      1.1  nonaka 	if (sc->regulatory == 0) {
   3805      1.1  nonaka 		for (ridx = 0; ridx <= 3; ridx++) {
   3806      1.1  nonaka 			power[ridx] = base->pwr[0][ridx];
   3807      1.1  nonaka 		}
   3808      1.1  nonaka 	}
   3809      1.1  nonaka 	for (ridx = 4; ridx < URTWN_RIDX_COUNT; ridx++) {
   3810      1.1  nonaka 		if (sc->regulatory == 3) {
   3811      1.1  nonaka 			power[ridx] = base->pwr[0][ridx];
   3812      1.1  nonaka 			/* Apply vendor limits. */
   3813      1.1  nonaka 			if (ht40m != IEEE80211_HTINFO_2NDCHAN_NONE) {
   3814      1.1  nonaka 				maxpow = rom->ht40_max_pwr[group];
   3815      1.1  nonaka 			} else {
   3816      1.1  nonaka 				maxpow = rom->ht20_max_pwr[group];
   3817      1.1  nonaka 			}
   3818      1.1  nonaka 			maxpow = (maxpow >> (chain * 4)) & 0xf;
   3819      1.1  nonaka 			if (power[ridx] > maxpow) {
   3820      1.1  nonaka 				power[ridx] = maxpow;
   3821      1.1  nonaka 			}
   3822      1.1  nonaka 		} else if (sc->regulatory == 1) {
   3823      1.1  nonaka 			if (ht40m == IEEE80211_HTINFO_2NDCHAN_NONE) {
   3824      1.1  nonaka 				power[ridx] = base->pwr[group][ridx];
   3825      1.1  nonaka 			}
   3826      1.1  nonaka 		} else if (sc->regulatory != 2) {
   3827      1.1  nonaka 			power[ridx] = base->pwr[0][ridx];
   3828      1.1  nonaka 		}
   3829      1.1  nonaka 	}
   3830      1.1  nonaka 
   3831      1.1  nonaka 	/* Compute per-CCK rate Tx power. */
   3832      1.1  nonaka 	cckpow = rom->cck_tx_pwr[chain][group];
   3833      1.1  nonaka 	for (ridx = 0; ridx <= 3; ridx++) {
   3834      1.1  nonaka 		power[ridx] += cckpow;
   3835      1.1  nonaka 		if (power[ridx] > R92C_MAX_TX_PWR) {
   3836      1.1  nonaka 			power[ridx] = R92C_MAX_TX_PWR;
   3837      1.1  nonaka 		}
   3838      1.1  nonaka 	}
   3839      1.1  nonaka 
   3840      1.1  nonaka 	htpow = rom->ht40_1s_tx_pwr[chain][group];
   3841      1.1  nonaka 	if (sc->ntxchains > 1) {
   3842      1.1  nonaka 		/* Apply reduction for 2 spatial streams. */
   3843      1.1  nonaka 		diff = rom->ht40_2s_tx_pwr_diff[group];
   3844      1.1  nonaka 		diff = (diff >> (chain * 4)) & 0xf;
   3845      1.1  nonaka 		htpow = (htpow > diff) ? htpow - diff : 0;
   3846      1.1  nonaka 	}
   3847      1.1  nonaka 
   3848      1.1  nonaka 	/* Compute per-OFDM rate Tx power. */
   3849      1.1  nonaka 	diff = rom->ofdm_tx_pwr_diff[group];
   3850      1.1  nonaka 	diff = (diff >> (chain * 4)) & 0xf;
   3851      1.1  nonaka 	ofdmpow = htpow + diff;	/* HT->OFDM correction. */
   3852      1.1  nonaka 	for (ridx = 4; ridx <= 11; ridx++) {
   3853      1.1  nonaka 		power[ridx] += ofdmpow;
   3854      1.1  nonaka 		if (power[ridx] > R92C_MAX_TX_PWR) {
   3855      1.1  nonaka 			power[ridx] = R92C_MAX_TX_PWR;
   3856      1.1  nonaka 		}
   3857      1.1  nonaka 	}
   3858      1.1  nonaka 
   3859      1.1  nonaka 	/* Compute per-MCS Tx power. */
   3860      1.1  nonaka 	if (ht40m == IEEE80211_HTINFO_2NDCHAN_NONE) {
   3861      1.1  nonaka 		diff = rom->ht20_tx_pwr_diff[group];
   3862      1.1  nonaka 		diff = (diff >> (chain * 4)) & 0xf;
   3863      1.1  nonaka 		htpow += diff;	/* HT40->HT20 correction. */
   3864      1.1  nonaka 	}
   3865      1.1  nonaka 	for (ridx = 12; ridx < URTWN_RIDX_COUNT; ridx++) {
   3866      1.1  nonaka 		power[ridx] += htpow;
   3867      1.1  nonaka 		if (power[ridx] > R92C_MAX_TX_PWR) {
   3868      1.1  nonaka 			power[ridx] = R92C_MAX_TX_PWR;
   3869      1.1  nonaka 		}
   3870      1.1  nonaka 	}
   3871      1.1  nonaka #ifdef URTWN_DEBUG
   3872      1.1  nonaka 	if (urtwn_debug & DBG_RF) {
   3873      1.1  nonaka 		/* Dump per-rate Tx power values. */
   3874  1.5.4.2     tls 		printf("%s: %s: Tx power for chain %zd:\n",
   3875      1.1  nonaka 		    device_xname(sc->sc_dev), __func__, chain);
   3876      1.1  nonaka 		for (ridx = 0; ridx < URTWN_RIDX_COUNT; ridx++) {
   3877      1.1  nonaka 			printf("%s: %s: Rate %d = %u\n",
   3878      1.1  nonaka 			    device_xname(sc->sc_dev), __func__, ridx,
   3879      1.1  nonaka 			    power[ridx]);
   3880      1.1  nonaka 		}
   3881      1.1  nonaka 	}
   3882      1.1  nonaka #endif
   3883      1.1  nonaka }
   3884      1.1  nonaka 
   3885  1.5.4.3     tls void
   3886  1.5.4.3     tls urtwn_r88e_get_txpower(struct urtwn_softc *sc, size_t chain, u_int chan,
   3887  1.5.4.3     tls     u_int ht40m, uint16_t power[URTWN_RIDX_COUNT])
   3888  1.5.4.3     tls {
   3889  1.5.4.3     tls 	uint16_t cckpow, ofdmpow, bw20pow, htpow;
   3890  1.5.4.3     tls 	const struct urtwn_r88e_txpwr *base;
   3891  1.5.4.3     tls 	int ridx, group;
   3892  1.5.4.3     tls 
   3893  1.5.4.3     tls 	DPRINTFN(DBG_FN, ("%s: %s: chain=%zd, chan=%d\n",
   3894  1.5.4.3     tls 	    device_xname(sc->sc_dev), __func__, chain, chan));
   3895  1.5.4.3     tls 
   3896  1.5.4.3     tls 	/* Determine channel group. */
   3897  1.5.4.3     tls 	if (chan <= 2)
   3898  1.5.4.3     tls 		group = 0;
   3899  1.5.4.3     tls 	else if (chan <= 5)
   3900  1.5.4.3     tls 		group = 1;
   3901  1.5.4.3     tls 	else if (chan <= 8)
   3902  1.5.4.3     tls 		group = 2;
   3903  1.5.4.3     tls 	else if (chan <= 11)
   3904  1.5.4.3     tls 		group = 3;
   3905  1.5.4.3     tls 	else if (chan <= 13)
   3906  1.5.4.3     tls 		group = 4;
   3907  1.5.4.3     tls 	else
   3908  1.5.4.3     tls 		group = 5;
   3909  1.5.4.3     tls 
   3910  1.5.4.3     tls 	/* Get original Tx power based on board type and RF chain. */
   3911  1.5.4.3     tls 	base = &rtl8188eu_txagc[chain];
   3912  1.5.4.3     tls 
   3913  1.5.4.3     tls 	memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0]));
   3914  1.5.4.3     tls 	if (sc->regulatory == 0) {
   3915  1.5.4.3     tls 		for (ridx = 0; ridx <= 3; ridx++)
   3916  1.5.4.3     tls 			power[ridx] = base->pwr[0][ridx];
   3917  1.5.4.3     tls 	}
   3918  1.5.4.3     tls 	for (ridx = 4; ridx < URTWN_RIDX_COUNT; ridx++) {
   3919  1.5.4.3     tls 		if (sc->regulatory == 3)
   3920  1.5.4.3     tls 			power[ridx] = base->pwr[0][ridx];
   3921  1.5.4.3     tls 		else if (sc->regulatory == 1) {
   3922  1.5.4.3     tls 			if (ht40m == IEEE80211_HTINFO_2NDCHAN_NONE)
   3923  1.5.4.3     tls 				power[ridx] = base->pwr[group][ridx];
   3924  1.5.4.3     tls 		} else if (sc->regulatory != 2)
   3925  1.5.4.3     tls 			power[ridx] = base->pwr[0][ridx];
   3926  1.5.4.3     tls 	}
   3927  1.5.4.3     tls 
   3928  1.5.4.3     tls 	/* Compute per-CCK rate Tx power. */
   3929  1.5.4.3     tls 	cckpow = sc->cck_tx_pwr[group];
   3930  1.5.4.3     tls 	for (ridx = 0; ridx <= 3; ridx++) {
   3931  1.5.4.3     tls 		power[ridx] += cckpow;
   3932  1.5.4.3     tls 		if (power[ridx] > R92C_MAX_TX_PWR)
   3933  1.5.4.3     tls 			power[ridx] = R92C_MAX_TX_PWR;
   3934  1.5.4.3     tls 	}
   3935  1.5.4.3     tls 
   3936  1.5.4.3     tls 	htpow = sc->ht40_tx_pwr[group];
   3937  1.5.4.3     tls 
   3938  1.5.4.3     tls 	/* Compute per-OFDM rate Tx power. */
   3939  1.5.4.3     tls 	ofdmpow = htpow + sc->ofdm_tx_pwr_diff;
   3940  1.5.4.3     tls 	for (ridx = 4; ridx <= 11; ridx++) {
   3941  1.5.4.3     tls 		power[ridx] += ofdmpow;
   3942  1.5.4.3     tls 		if (power[ridx] > R92C_MAX_TX_PWR)
   3943  1.5.4.3     tls 			power[ridx] = R92C_MAX_TX_PWR;
   3944  1.5.4.3     tls 	}
   3945  1.5.4.3     tls 
   3946  1.5.4.3     tls 	bw20pow = htpow + sc->bw20_tx_pwr_diff;
   3947  1.5.4.3     tls 	for (ridx = 12; ridx <= 27; ridx++) {
   3948  1.5.4.3     tls 		power[ridx] += bw20pow;
   3949  1.5.4.3     tls 		if (power[ridx] > R92C_MAX_TX_PWR)
   3950  1.5.4.3     tls 			power[ridx] = R92C_MAX_TX_PWR;
   3951  1.5.4.3     tls 	}
   3952  1.5.4.3     tls }
   3953  1.5.4.3     tls 
   3954      1.1  nonaka static void
   3955      1.1  nonaka urtwn_set_txpower(struct urtwn_softc *sc, u_int chan, u_int ht40m)
   3956      1.1  nonaka {
   3957      1.1  nonaka 	uint16_t power[URTWN_RIDX_COUNT];
   3958  1.5.4.2     tls 	size_t i;
   3959      1.1  nonaka 
   3960      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   3961      1.1  nonaka 
   3962      1.1  nonaka 	for (i = 0; i < sc->ntxchains; i++) {
   3963      1.1  nonaka 		/* Compute per-rate Tx power values. */
   3964  1.5.4.3     tls 		if (ISSET(sc->chip, URTWN_CHIP_88E))
   3965  1.5.4.3     tls 			urtwn_r88e_get_txpower(sc, i, chan, ht40m, power);
   3966  1.5.4.3     tls 		else
   3967  1.5.4.3     tls 			urtwn_get_txpower(sc, i, chan, ht40m, power);
   3968      1.1  nonaka 		/* Write per-rate Tx power values to hardware. */
   3969      1.1  nonaka 		urtwn_write_txpower(sc, i, power);
   3970      1.1  nonaka 	}
   3971      1.1  nonaka }
   3972      1.1  nonaka 
   3973      1.1  nonaka static void
   3974      1.1  nonaka urtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c, u_int ht40m)
   3975      1.1  nonaka {
   3976      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   3977      1.1  nonaka 	u_int chan;
   3978  1.5.4.2     tls 	size_t i;
   3979      1.1  nonaka 
   3980      1.1  nonaka 	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
   3981      1.1  nonaka 
   3982      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: chan=%d\n", device_xname(sc->sc_dev),
   3983      1.1  nonaka 	    __func__, chan));
   3984      1.1  nonaka 
   3985  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   3986  1.5.4.1     tls 
   3987      1.1  nonaka 	if (ht40m == IEEE80211_HTINFO_2NDCHAN_ABOVE) {
   3988      1.1  nonaka 		chan += 2;
   3989      1.1  nonaka 	} else if (ht40m == IEEE80211_HTINFO_2NDCHAN_BELOW){
   3990      1.1  nonaka 		chan -= 2;
   3991      1.1  nonaka 	}
   3992      1.1  nonaka 
   3993      1.1  nonaka 	/* Set Tx power for this new channel. */
   3994      1.1  nonaka 	urtwn_set_txpower(sc, chan, ht40m);
   3995      1.1  nonaka 
   3996      1.1  nonaka 	for (i = 0; i < sc->nrxchains; i++) {
   3997      1.1  nonaka 		urtwn_rf_write(sc, i, R92C_RF_CHNLBW,
   3998      1.1  nonaka 		    RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan));
   3999      1.1  nonaka 	}
   4000      1.1  nonaka 
   4001      1.1  nonaka 	if (ht40m) {
   4002      1.1  nonaka 		/* Is secondary channel below or above primary? */
   4003      1.1  nonaka 		int prichlo = (ht40m == IEEE80211_HTINFO_2NDCHAN_ABOVE);
   4004      1.1  nonaka 		uint32_t reg;
   4005      1.1  nonaka 
   4006      1.1  nonaka 		urtwn_write_1(sc, R92C_BWOPMODE,
   4007      1.1  nonaka 		    urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ);
   4008      1.1  nonaka 
   4009      1.1  nonaka 		reg = urtwn_read_1(sc, R92C_RRSR + 2);
   4010      1.1  nonaka 		reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5;
   4011      1.1  nonaka 		urtwn_write_1(sc, R92C_RRSR + 2, (uint8_t)reg);
   4012      1.1  nonaka 
   4013      1.1  nonaka 		urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
   4014      1.1  nonaka 		    urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ);
   4015      1.1  nonaka 		urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
   4016      1.1  nonaka 		    urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ);
   4017      1.1  nonaka 
   4018      1.1  nonaka 		/* Set CCK side band. */
   4019      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM);
   4020      1.1  nonaka 		reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4;
   4021      1.1  nonaka 		urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg);
   4022      1.1  nonaka 
   4023      1.1  nonaka 		reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF);
   4024      1.1  nonaka 		reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10;
   4025      1.1  nonaka 		urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg);
   4026      1.1  nonaka 
   4027      1.1  nonaka 		urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
   4028      1.1  nonaka 		    urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) &
   4029      1.1  nonaka 		    ~R92C_FPGA0_ANAPARAM2_CBW20);
   4030      1.1  nonaka 
   4031      1.1  nonaka 		reg = urtwn_bb_read(sc, 0x818);
   4032      1.1  nonaka 		reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26;
   4033      1.1  nonaka 		urtwn_bb_write(sc, 0x818, reg);
   4034      1.1  nonaka 
   4035      1.1  nonaka 		/* Select 40MHz bandwidth. */
   4036      1.1  nonaka 		urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
   4037      1.1  nonaka 		    (sc->rf_chnlbw[0] & ~0xfff) | chan);
   4038      1.1  nonaka 	} else {
   4039      1.1  nonaka 		urtwn_write_1(sc, R92C_BWOPMODE,
   4040      1.1  nonaka 		    urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ);
   4041      1.1  nonaka 
   4042      1.1  nonaka 		urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
   4043      1.1  nonaka 		    urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ);
   4044      1.1  nonaka 		urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
   4045      1.1  nonaka 		    urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ);
   4046      1.1  nonaka 
   4047  1.5.4.3     tls 		if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
   4048  1.5.4.3     tls 			urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
   4049  1.5.4.3     tls 			    urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) |
   4050  1.5.4.3     tls 			    R92C_FPGA0_ANAPARAM2_CBW20);
   4051  1.5.4.3     tls 		}
   4052      1.1  nonaka 
   4053      1.1  nonaka 		/* Select 20MHz bandwidth. */
   4054      1.1  nonaka 		urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
   4055  1.5.4.3     tls 		    (sc->rf_chnlbw[0] & ~0xfff) | chan |
   4056  1.5.4.3     tls 		    (ISSET(sc->chip, URTWN_CHIP_88E) ?
   4057  1.5.4.3     tls 		      R88E_RF_CHNLBW_BW20 : R92C_RF_CHNLBW_BW20));
   4058      1.1  nonaka 	}
   4059      1.1  nonaka }
   4060      1.1  nonaka 
   4061      1.1  nonaka static void
   4062      1.1  nonaka urtwn_iq_calib(struct urtwn_softc *sc, bool inited)
   4063      1.1  nonaka {
   4064      1.1  nonaka 
   4065      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s: inited=%d\n", device_xname(sc->sc_dev),
   4066      1.1  nonaka 	    __func__, inited));
   4067      1.1  nonaka 
   4068      1.1  nonaka 	/* TODO */
   4069      1.1  nonaka }
   4070      1.1  nonaka 
   4071      1.1  nonaka static void
   4072      1.1  nonaka urtwn_lc_calib(struct urtwn_softc *sc)
   4073      1.1  nonaka {
   4074      1.1  nonaka 	uint32_t rf_ac[2];
   4075      1.1  nonaka 	uint8_t txmode;
   4076  1.5.4.2     tls 	size_t i;
   4077      1.1  nonaka 
   4078      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   4079      1.1  nonaka 
   4080  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   4081  1.5.4.1     tls 
   4082      1.1  nonaka 	txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3);
   4083      1.1  nonaka 	if ((txmode & 0x70) != 0) {
   4084      1.1  nonaka 		/* Disable all continuous Tx. */
   4085      1.1  nonaka 		urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70);
   4086      1.1  nonaka 
   4087      1.1  nonaka 		/* Set RF mode to standby mode. */
   4088      1.1  nonaka 		for (i = 0; i < sc->nrxchains; i++) {
   4089      1.1  nonaka 			rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC);
   4090      1.1  nonaka 			urtwn_rf_write(sc, i, R92C_RF_AC,
   4091      1.1  nonaka 			    RW(rf_ac[i], R92C_RF_AC_MODE,
   4092      1.1  nonaka 				R92C_RF_AC_MODE_STANDBY));
   4093      1.1  nonaka 		}
   4094      1.1  nonaka 	} else {
   4095      1.1  nonaka 		/* Block all Tx queues. */
   4096      1.1  nonaka 		urtwn_write_1(sc, R92C_TXPAUSE, 0xff);
   4097      1.1  nonaka 	}
   4098      1.1  nonaka 	/* Start calibration. */
   4099      1.1  nonaka 	urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
   4100      1.1  nonaka 	    urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART);
   4101      1.1  nonaka 
   4102      1.1  nonaka 	/* Give calibration the time to complete. */
   4103      1.1  nonaka 	usbd_delay_ms(sc->sc_udev, 100);
   4104      1.1  nonaka 
   4105      1.1  nonaka 	/* Restore configuration. */
   4106      1.1  nonaka 	if ((txmode & 0x70) != 0) {
   4107      1.1  nonaka 		/* Restore Tx mode. */
   4108      1.1  nonaka 		urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode);
   4109      1.1  nonaka 		/* Restore RF mode. */
   4110      1.1  nonaka 		for (i = 0; i < sc->nrxchains; i++) {
   4111      1.1  nonaka 			urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]);
   4112      1.1  nonaka 		}
   4113      1.1  nonaka 	} else {
   4114      1.1  nonaka 		/* Unblock all Tx queues. */
   4115      1.1  nonaka 		urtwn_write_1(sc, R92C_TXPAUSE, 0x00);
   4116      1.1  nonaka 	}
   4117      1.1  nonaka }
   4118      1.1  nonaka 
   4119      1.1  nonaka static void
   4120      1.1  nonaka urtwn_temp_calib(struct urtwn_softc *sc)
   4121      1.1  nonaka {
   4122      1.1  nonaka 	int temp;
   4123      1.1  nonaka 
   4124      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   4125      1.1  nonaka 
   4126  1.5.4.1     tls 	KASSERT(mutex_owned(&sc->sc_write_mtx));
   4127  1.5.4.1     tls 
   4128      1.1  nonaka 	if (sc->thcal_state == 0) {
   4129      1.1  nonaka 		/* Start measuring temperature. */
   4130      1.1  nonaka 		DPRINTFN(DBG_RF, ("%s: %s: start measuring temperature\n",
   4131      1.1  nonaka 		    device_xname(sc->sc_dev), __func__));
   4132      1.1  nonaka 		urtwn_rf_write(sc, 0, R92C_RF_T_METER, 0x60);
   4133      1.1  nonaka 		sc->thcal_state = 1;
   4134      1.1  nonaka 		return;
   4135      1.1  nonaka 	}
   4136      1.1  nonaka 	sc->thcal_state = 0;
   4137      1.1  nonaka 
   4138      1.1  nonaka 	/* Read measured temperature. */
   4139      1.1  nonaka 	temp = urtwn_rf_read(sc, 0, R92C_RF_T_METER) & 0x1f;
   4140      1.1  nonaka 	DPRINTFN(DBG_RF, ("%s: %s: temperature=%d\n", device_xname(sc->sc_dev),
   4141      1.1  nonaka 	    __func__, temp));
   4142      1.1  nonaka 	if (temp == 0)	/* Read failed, skip. */
   4143      1.1  nonaka 		return;
   4144      1.1  nonaka 
   4145      1.1  nonaka 	/*
   4146      1.1  nonaka 	 * Redo LC calibration if temperature changed significantly since
   4147      1.1  nonaka 	 * last calibration.
   4148      1.1  nonaka 	 */
   4149      1.1  nonaka 	if (sc->thcal_lctemp == 0) {
   4150      1.1  nonaka 		/* First LC calibration is performed in urtwn_init(). */
   4151      1.1  nonaka 		sc->thcal_lctemp = temp;
   4152      1.1  nonaka 	} else if (abs(temp - sc->thcal_lctemp) > 1) {
   4153      1.1  nonaka 		DPRINTFN(DBG_RF,
   4154      1.1  nonaka 		    ("%s: %s: LC calib triggered by temp: %d -> %d\n",
   4155      1.1  nonaka 		    device_xname(sc->sc_dev), __func__, sc->thcal_lctemp,
   4156      1.1  nonaka 		    temp));
   4157      1.1  nonaka 		urtwn_lc_calib(sc);
   4158      1.1  nonaka 		/* Record temperature of last LC calibration. */
   4159      1.1  nonaka 		sc->thcal_lctemp = temp;
   4160      1.1  nonaka 	}
   4161      1.1  nonaka }
   4162      1.1  nonaka 
   4163      1.1  nonaka static int
   4164      1.1  nonaka urtwn_init(struct ifnet *ifp)
   4165      1.1  nonaka {
   4166      1.1  nonaka 	struct urtwn_softc *sc = ifp->if_softc;
   4167      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   4168      1.1  nonaka 	struct urtwn_rx_data *data;
   4169      1.1  nonaka 	uint32_t reg;
   4170  1.5.4.2     tls 	size_t i;
   4171  1.5.4.2     tls 	int error;
   4172      1.1  nonaka 
   4173      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   4174      1.1  nonaka 
   4175      1.1  nonaka 	urtwn_stop(ifp, 0);
   4176      1.1  nonaka 
   4177  1.5.4.1     tls 	mutex_enter(&sc->sc_write_mtx);
   4178  1.5.4.1     tls 
   4179      1.1  nonaka 	mutex_enter(&sc->sc_task_mtx);
   4180      1.1  nonaka 	/* Init host async commands ring. */
   4181      1.1  nonaka 	sc->cmdq.cur = sc->cmdq.next = sc->cmdq.queued = 0;
   4182      1.1  nonaka 	mutex_exit(&sc->sc_task_mtx);
   4183      1.1  nonaka 
   4184      1.1  nonaka 	mutex_enter(&sc->sc_fwcmd_mtx);
   4185      1.1  nonaka 	/* Init firmware commands ring. */
   4186      1.1  nonaka 	sc->fwcur = 0;
   4187      1.1  nonaka 	mutex_exit(&sc->sc_fwcmd_mtx);
   4188      1.1  nonaka 
   4189      1.1  nonaka 	/* Allocate Tx/Rx buffers. */
   4190      1.1  nonaka 	error = urtwn_alloc_rx_list(sc);
   4191      1.1  nonaka 	if (error != 0) {
   4192      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   4193      1.1  nonaka 		    "could not allocate Rx buffers\n");
   4194      1.1  nonaka 		goto fail;
   4195      1.1  nonaka 	}
   4196      1.1  nonaka 	error = urtwn_alloc_tx_list(sc);
   4197      1.1  nonaka 	if (error != 0) {
   4198      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   4199      1.1  nonaka 		    "could not allocate Tx buffers\n");
   4200      1.1  nonaka 		goto fail;
   4201      1.1  nonaka 	}
   4202      1.1  nonaka 
   4203      1.1  nonaka 	/* Power on adapter. */
   4204      1.1  nonaka 	error = urtwn_power_on(sc);
   4205      1.1  nonaka 	if (error != 0)
   4206      1.1  nonaka 		goto fail;
   4207      1.1  nonaka 
   4208      1.1  nonaka 	/* Initialize DMA. */
   4209      1.1  nonaka 	error = urtwn_dma_init(sc);
   4210      1.1  nonaka 	if (error != 0)
   4211      1.1  nonaka 		goto fail;
   4212      1.1  nonaka 
   4213      1.1  nonaka 	/* Set info size in Rx descriptors (in 64-bit words). */
   4214      1.1  nonaka 	urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4);
   4215      1.1  nonaka 
   4216      1.1  nonaka 	/* Init interrupts. */
   4217  1.5.4.3     tls 	if (ISSET(sc->chip, URTWN_CHIP_88E)) {
   4218  1.5.4.3     tls 		urtwn_write_4(sc, R88E_HISR, 0xffffffff);
   4219  1.5.4.3     tls 		urtwn_write_4(sc, R88E_HIMR, R88E_HIMR_CPWM | R88E_HIMR_CPWM2 |
   4220  1.5.4.3     tls 		    R88E_HIMR_TBDER | R88E_HIMR_PSTIMEOUT);
   4221  1.5.4.3     tls 		urtwn_write_4(sc, R88E_HIMRE, R88E_HIMRE_RXFOVW |
   4222  1.5.4.3     tls 		    R88E_HIMRE_TXFOVW | R88E_HIMRE_RXERR | R88E_HIMRE_TXERR);
   4223  1.5.4.3     tls 		urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION,
   4224  1.5.4.3     tls 		    urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) |
   4225  1.5.4.3     tls 		      R92C_USB_SPECIAL_OPTION_INT_BULK_SEL);
   4226  1.5.4.3     tls 	} else {
   4227  1.5.4.3     tls 		urtwn_write_4(sc, R92C_HISR, 0xffffffff);
   4228  1.5.4.3     tls 		urtwn_write_4(sc, R92C_HIMR, 0xffffffff);
   4229  1.5.4.3     tls 	}
   4230      1.1  nonaka 
   4231      1.1  nonaka 	/* Set MAC address. */
   4232      1.1  nonaka 	IEEE80211_ADDR_COPY(ic->ic_myaddr, CLLADDR(ifp->if_sadl));
   4233      1.1  nonaka 	urtwn_write_region(sc, R92C_MACID, ic->ic_myaddr, IEEE80211_ADDR_LEN);
   4234      1.1  nonaka 
   4235      1.1  nonaka 	/* Set initial network type. */
   4236      1.1  nonaka 	reg = urtwn_read_4(sc, R92C_CR);
   4237      1.1  nonaka 	switch (ic->ic_opmode) {
   4238      1.1  nonaka 	case IEEE80211_M_STA:
   4239      1.1  nonaka 	default:
   4240      1.1  nonaka 		reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_INFRA);
   4241      1.1  nonaka 		break;
   4242  1.5.4.1     tls 
   4243      1.1  nonaka 	case IEEE80211_M_IBSS:
   4244      1.1  nonaka 		reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_ADHOC);
   4245      1.1  nonaka 		break;
   4246      1.1  nonaka 	}
   4247      1.1  nonaka 	urtwn_write_4(sc, R92C_CR, reg);
   4248      1.1  nonaka 
   4249      1.1  nonaka 	/* Set response rate */
   4250      1.1  nonaka 	reg = urtwn_read_4(sc, R92C_RRSR);
   4251      1.1  nonaka 	reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M);
   4252      1.1  nonaka 	urtwn_write_4(sc, R92C_RRSR, reg);
   4253      1.1  nonaka 
   4254      1.1  nonaka 	/* SIFS (used in NAV) */
   4255      1.1  nonaka 	urtwn_write_2(sc, R92C_SPEC_SIFS,
   4256      1.1  nonaka 	    SM(R92C_SPEC_SIFS_CCK, 0x10) | SM(R92C_SPEC_SIFS_OFDM, 0x10));
   4257      1.1  nonaka 
   4258      1.1  nonaka 	/* Set short/long retry limits. */
   4259      1.1  nonaka 	urtwn_write_2(sc, R92C_RL,
   4260      1.1  nonaka 	    SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30));
   4261      1.1  nonaka 
   4262      1.1  nonaka 	/* Initialize EDCA parameters. */
   4263      1.1  nonaka 	urtwn_edca_init(sc);
   4264      1.1  nonaka 
   4265      1.1  nonaka 	/* Setup rate fallback. */
   4266  1.5.4.3     tls 	if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
   4267  1.5.4.3     tls 		urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000);
   4268  1.5.4.3     tls 		urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404);
   4269  1.5.4.3     tls 		urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201);
   4270  1.5.4.3     tls 		urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605);
   4271  1.5.4.3     tls 	}
   4272      1.1  nonaka 
   4273      1.1  nonaka 	urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL,
   4274      1.1  nonaka 	    urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) |
   4275      1.1  nonaka 	    R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW);
   4276      1.1  nonaka 	/* Set ACK timeout. */
   4277      1.1  nonaka 	urtwn_write_1(sc, R92C_ACKTO, 0x40);
   4278      1.1  nonaka 
   4279      1.1  nonaka 	/* Setup USB aggregation. */
   4280      1.1  nonaka 	/* Tx */
   4281      1.1  nonaka 	reg = urtwn_read_4(sc, R92C_TDECTRL);
   4282      1.1  nonaka 	reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6);
   4283      1.1  nonaka 	urtwn_write_4(sc, R92C_TDECTRL, reg);
   4284      1.1  nonaka 	/* Rx */
   4285      1.1  nonaka 	urtwn_write_1(sc, R92C_TRXDMA_CTRL,
   4286      1.1  nonaka 	    urtwn_read_1(sc, R92C_TRXDMA_CTRL) |
   4287      1.1  nonaka 	      R92C_TRXDMA_CTRL_RXDMA_AGG_EN);
   4288      1.1  nonaka 	urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION,
   4289      1.1  nonaka 	    urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) &
   4290      1.1  nonaka 	      ~R92C_USB_SPECIAL_OPTION_AGG_EN);
   4291      1.1  nonaka 	urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48);
   4292  1.5.4.3     tls 	if (ISSET(sc->chip, URTWN_CHIP_88E))
   4293  1.5.4.3     tls 		urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH + 1, 4);
   4294  1.5.4.3     tls 	else
   4295  1.5.4.3     tls 		urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4);
   4296      1.1  nonaka 
   4297      1.1  nonaka 	/* Initialize beacon parameters. */
   4298  1.5.4.3     tls 	urtwn_write_2(sc, R92C_BCN_CTRL, 0x1010);
   4299      1.1  nonaka 	urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404);
   4300  1.5.4.3     tls 	urtwn_write_1(sc, R92C_DRVERLYINT, R92C_DRIVER_EARLY_INT_TIME);
   4301  1.5.4.3     tls 	urtwn_write_1(sc, R92C_BCNDMATIM, R92C_DMA_ATIME_INT_TIME);
   4302      1.1  nonaka 	urtwn_write_2(sc, R92C_BCNTCFG, 0x660f);
   4303      1.1  nonaka 
   4304  1.5.4.3     tls 	if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
   4305  1.5.4.3     tls 		/* Setup AMPDU aggregation. */
   4306  1.5.4.3     tls 		urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631);	/* MCS7~0 */
   4307  1.5.4.3     tls 		urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16);
   4308  1.5.4.3     tls 		urtwn_write_2(sc, 0x4ca, 0x0708);
   4309      1.1  nonaka 
   4310  1.5.4.3     tls 		urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff);
   4311  1.5.4.3     tls 		urtwn_write_1(sc, R92C_BCN_CTRL, R92C_BCN_CTRL_DIS_TSF_UDT0);
   4312  1.5.4.3     tls 	}
   4313      1.1  nonaka 
   4314      1.1  nonaka 	/* Load 8051 microcode. */
   4315      1.1  nonaka 	error = urtwn_load_firmware(sc);
   4316      1.1  nonaka 	if (error != 0)
   4317      1.1  nonaka 		goto fail;
   4318      1.1  nonaka 	SET(sc->sc_flags, URTWN_FLAG_FWREADY);
   4319      1.1  nonaka 
   4320      1.1  nonaka 	/* Initialize MAC/BB/RF blocks. */
   4321  1.5.4.1     tls 	/*
   4322  1.5.4.1     tls 	 * XXX: urtwn_mac_init() sets R92C_RCR[0:15] = R92C_RCR_APM |
   4323  1.5.4.1     tls 	 * R92C_RCR_AM | R92C_RCR_AB | R92C_RCR_AICV | R92C_RCR_AMF.
   4324  1.5.4.1     tls 	 * XXX: This setting should be removed from rtl8192cu_mac[].
   4325  1.5.4.1     tls 	 */
   4326  1.5.4.1     tls 	urtwn_mac_init(sc);		// sets R92C_RCR[0:15]
   4327  1.5.4.1     tls 	urtwn_rxfilter_init(sc);	// reset R92C_RCR
   4328      1.1  nonaka 	urtwn_bb_init(sc);
   4329      1.1  nonaka 	urtwn_rf_init(sc);
   4330      1.1  nonaka 
   4331  1.5.4.3     tls 	if (ISSET(sc->chip, URTWN_CHIP_88E)) {
   4332  1.5.4.3     tls 		urtwn_write_2(sc, R92C_CR,
   4333  1.5.4.3     tls 		    urtwn_read_2(sc, R92C_CR) | R92C_CR_MACTXEN |
   4334  1.5.4.3     tls 		      R92C_CR_MACRXEN);
   4335  1.5.4.3     tls 	}
   4336  1.5.4.3     tls 
   4337      1.1  nonaka 	/* Turn CCK and OFDM blocks on. */
   4338      1.1  nonaka 	reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
   4339      1.1  nonaka 	reg |= R92C_RFMOD_CCK_EN;
   4340      1.1  nonaka 	urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
   4341      1.1  nonaka 	reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
   4342      1.1  nonaka 	reg |= R92C_RFMOD_OFDM_EN;
   4343      1.1  nonaka 	urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
   4344      1.1  nonaka 
   4345      1.1  nonaka 	/* Clear per-station keys table. */
   4346      1.1  nonaka 	urtwn_cam_init(sc);
   4347      1.1  nonaka 
   4348      1.1  nonaka 	/* Enable hardware sequence numbering. */
   4349      1.1  nonaka 	urtwn_write_1(sc, R92C_HWSEQ_CTRL, 0xff);
   4350      1.1  nonaka 
   4351      1.1  nonaka 	/* Perform LO and IQ calibrations. */
   4352      1.1  nonaka 	urtwn_iq_calib(sc, sc->iqk_inited);
   4353      1.1  nonaka 	sc->iqk_inited = true;
   4354      1.1  nonaka 
   4355      1.1  nonaka 	/* Perform LC calibration. */
   4356      1.1  nonaka 	urtwn_lc_calib(sc);
   4357      1.1  nonaka 
   4358  1.5.4.3     tls 	if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
   4359  1.5.4.3     tls 		/* Fix USB interference issue. */
   4360  1.5.4.3     tls 		urtwn_write_1(sc, 0xfe40, 0xe0);
   4361  1.5.4.3     tls 		urtwn_write_1(sc, 0xfe41, 0x8d);
   4362  1.5.4.3     tls 		urtwn_write_1(sc, 0xfe42, 0x80);
   4363  1.5.4.3     tls 		urtwn_write_4(sc, 0x20c, 0xfd0320);
   4364      1.1  nonaka 
   4365  1.5.4.3     tls 		urtwn_pa_bias_init(sc);
   4366  1.5.4.3     tls 	}
   4367      1.1  nonaka 
   4368      1.1  nonaka 	if (!(sc->chip & (URTWN_CHIP_92C | URTWN_CHIP_92C_1T2R))) {
   4369      1.1  nonaka 		/* 1T1R */
   4370      1.1  nonaka 		urtwn_bb_write(sc, R92C_FPGA0_RFPARAM(0),
   4371      1.1  nonaka 		    urtwn_bb_read(sc, R92C_FPGA0_RFPARAM(0)) | __BIT(13));
   4372      1.1  nonaka 	}
   4373      1.1  nonaka 
   4374      1.1  nonaka 	/* Initialize GPIO setting. */
   4375      1.1  nonaka 	urtwn_write_1(sc, R92C_GPIO_MUXCFG,
   4376      1.1  nonaka 	    urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT);
   4377      1.1  nonaka 
   4378      1.1  nonaka 	/* Fix for lower temperature. */
   4379  1.5.4.3     tls 	if (!ISSET(sc->chip, URTWN_CHIP_88E))
   4380  1.5.4.3     tls 		urtwn_write_1(sc, 0x15, 0xe9);
   4381      1.1  nonaka 
   4382      1.1  nonaka 	/* Set default channel. */
   4383  1.5.4.1     tls 	urtwn_set_chan(sc, ic->ic_curchan, IEEE80211_HTINFO_2NDCHAN_NONE);
   4384      1.1  nonaka 
   4385      1.1  nonaka 	/* Queue Rx xfers. */
   4386      1.1  nonaka 	for (i = 0; i < URTWN_RX_LIST_COUNT; i++) {
   4387      1.1  nonaka 		data = &sc->rx_data[i];
   4388      1.1  nonaka 		usbd_setup_xfer(data->xfer, sc->rx_pipe, data, data->buf,
   4389      1.1  nonaka 		    URTWN_RXBUFSZ, USBD_SHORT_XFER_OK | USBD_NO_COPY,
   4390      1.1  nonaka 		    USBD_NO_TIMEOUT, urtwn_rxeof);
   4391      1.1  nonaka 		error = usbd_transfer(data->xfer);
   4392      1.1  nonaka 		if (__predict_false(error != USBD_NORMAL_COMPLETION &&
   4393      1.1  nonaka 		    error != USBD_IN_PROGRESS))
   4394      1.1  nonaka 			goto fail;
   4395      1.1  nonaka 	}
   4396      1.1  nonaka 
   4397      1.1  nonaka 	/* We're ready to go. */
   4398      1.1  nonaka 	ifp->if_flags &= ~IFF_OACTIVE;
   4399      1.1  nonaka 	ifp->if_flags |= IFF_RUNNING;
   4400      1.1  nonaka 
   4401  1.5.4.1     tls 	mutex_exit(&sc->sc_write_mtx);
   4402  1.5.4.1     tls 
   4403      1.1  nonaka 	if (ic->ic_opmode == IEEE80211_M_MONITOR)
   4404      1.1  nonaka 		ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
   4405  1.5.4.1     tls 	else if (ic->ic_roaming != IEEE80211_ROAMING_MANUAL)
   4406      1.1  nonaka 		ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
   4407  1.5.4.1     tls 	urtwn_wait_async(sc);
   4408  1.5.4.1     tls 
   4409      1.1  nonaka 	return (0);
   4410      1.1  nonaka 
   4411      1.1  nonaka  fail:
   4412  1.5.4.1     tls 	mutex_exit(&sc->sc_write_mtx);
   4413  1.5.4.1     tls 
   4414      1.1  nonaka 	urtwn_stop(ifp, 1);
   4415      1.1  nonaka 	return (error);
   4416      1.1  nonaka }
   4417      1.1  nonaka 
   4418      1.1  nonaka static void
   4419      1.1  nonaka urtwn_stop(struct ifnet *ifp, int disable)
   4420      1.1  nonaka {
   4421      1.1  nonaka 	struct urtwn_softc *sc = ifp->if_softc;
   4422      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   4423  1.5.4.2     tls 	size_t i;
   4424  1.5.4.2     tls 	int s;
   4425      1.1  nonaka 
   4426      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   4427      1.1  nonaka 
   4428      1.1  nonaka 	s = splusb();
   4429      1.1  nonaka 	ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
   4430      1.1  nonaka 	urtwn_wait_async(sc);
   4431      1.1  nonaka 	splx(s);
   4432      1.1  nonaka 
   4433  1.5.4.1     tls 	sc->tx_timer = 0;
   4434  1.5.4.1     tls 	ifp->if_timer = 0;
   4435  1.5.4.1     tls 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
   4436  1.5.4.1     tls 
   4437      1.1  nonaka 	callout_stop(&sc->sc_scan_to);
   4438      1.1  nonaka 	callout_stop(&sc->sc_calib_to);
   4439      1.1  nonaka 
   4440      1.1  nonaka 	/* Abort Tx. */
   4441      1.1  nonaka 	for (i = 0; i < R92C_MAX_EPOUT; i++) {
   4442      1.1  nonaka 		if (sc->tx_pipe[i] != NULL)
   4443      1.1  nonaka 			usbd_abort_pipe(sc->tx_pipe[i]);
   4444      1.1  nonaka 	}
   4445      1.1  nonaka 
   4446      1.1  nonaka 	/* Stop Rx pipe. */
   4447      1.1  nonaka 	usbd_abort_pipe(sc->rx_pipe);
   4448      1.1  nonaka 
   4449      1.1  nonaka 	/* Free Tx/Rx buffers. */
   4450      1.1  nonaka 	urtwn_free_tx_list(sc);
   4451      1.1  nonaka 	urtwn_free_rx_list(sc);
   4452      1.1  nonaka 
   4453      1.1  nonaka 	if (disable)
   4454      1.1  nonaka 		urtwn_chip_stop(sc);
   4455      1.1  nonaka }
   4456      1.1  nonaka 
   4457  1.5.4.1     tls static int
   4458  1.5.4.1     tls urtwn_reset(struct ifnet *ifp)
   4459  1.5.4.1     tls {
   4460  1.5.4.1     tls 	struct urtwn_softc *sc = ifp->if_softc;
   4461  1.5.4.1     tls 	struct ieee80211com *ic = &sc->sc_ic;
   4462  1.5.4.1     tls 
   4463  1.5.4.1     tls 	if (ic->ic_opmode != IEEE80211_M_MONITOR)
   4464  1.5.4.1     tls 		return ENETRESET;
   4465  1.5.4.1     tls 
   4466  1.5.4.1     tls 	urtwn_set_chan(sc, ic->ic_curchan, IEEE80211_HTINFO_2NDCHAN_NONE);
   4467  1.5.4.1     tls 
   4468  1.5.4.1     tls 	return 0;
   4469  1.5.4.1     tls }
   4470  1.5.4.1     tls 
   4471      1.1  nonaka static void
   4472      1.1  nonaka urtwn_chip_stop(struct urtwn_softc *sc)
   4473      1.1  nonaka {
   4474      1.1  nonaka 	uint32_t reg;
   4475      1.1  nonaka 	bool disabled = true;
   4476      1.1  nonaka 
   4477      1.1  nonaka 	DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
   4478      1.1  nonaka 
   4479  1.5.4.1     tls 	mutex_enter(&sc->sc_write_mtx);
   4480  1.5.4.1     tls 
   4481      1.1  nonaka 	/*
   4482      1.1  nonaka 	 * RF Off Sequence
   4483      1.1  nonaka 	 */
   4484      1.1  nonaka 	/* Pause MAC TX queue */
   4485      1.1  nonaka 	urtwn_write_1(sc, R92C_TXPAUSE, 0xFF);
   4486      1.1  nonaka 
   4487      1.1  nonaka 	/* Disable RF */
   4488      1.1  nonaka 	urtwn_rf_write(sc, 0, 0, 0);
   4489      1.1  nonaka 
   4490      1.1  nonaka 	urtwn_write_1(sc, R92C_APSD_CTRL, R92C_APSD_CTRL_OFF);
   4491      1.1  nonaka 
   4492      1.1  nonaka 	/* Reset BB state machine */
   4493      1.1  nonaka 	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
   4494      1.1  nonaka 	    R92C_SYS_FUNC_EN_USBD |
   4495      1.1  nonaka 	    R92C_SYS_FUNC_EN_USBA |
   4496      1.1  nonaka 	    R92C_SYS_FUNC_EN_BB_GLB_RST);
   4497      1.1  nonaka 	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
   4498      1.1  nonaka 	    R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA);
   4499      1.1  nonaka 
   4500      1.1  nonaka 	/*
   4501      1.1  nonaka 	 * Reset digital sequence
   4502      1.1  nonaka 	 */
   4503      1.1  nonaka 	if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY) {
   4504      1.1  nonaka 		/* Reset MCU ready status */
   4505      1.1  nonaka 		urtwn_write_1(sc, R92C_MCUFWDL, 0);
   4506      1.1  nonaka 		/* If firmware in ram code, do reset */
   4507      1.1  nonaka 		if (ISSET(sc->sc_flags, URTWN_FLAG_FWREADY)) {
   4508  1.5.4.3     tls 			if (ISSET(sc->chip, URTWN_CHIP_88E))
   4509  1.5.4.3     tls 				urtwn_r88e_fw_reset(sc);
   4510  1.5.4.3     tls 			else
   4511  1.5.4.3     tls 				urtwn_fw_reset(sc);
   4512      1.1  nonaka 			CLR(sc->sc_flags, URTWN_FLAG_FWREADY);
   4513      1.1  nonaka 		}
   4514      1.1  nonaka 	}
   4515      1.1  nonaka 
   4516      1.1  nonaka 	/* Reset MAC and Enable 8051 */
   4517      1.1  nonaka 	urtwn_write_1(sc, R92C_SYS_FUNC_EN + 1, 0x54);
   4518      1.1  nonaka 
   4519      1.1  nonaka 	/* Reset MCU ready status */
   4520      1.1  nonaka 	urtwn_write_1(sc, R92C_MCUFWDL, 0);
   4521      1.1  nonaka 
   4522      1.1  nonaka 	if (disabled) {
   4523      1.1  nonaka 		/* Disable MAC clock */
   4524      1.1  nonaka 		urtwn_write_2(sc, R92C_SYS_CLKR, 0x70A3);
   4525      1.1  nonaka 		/* Disable AFE PLL */
   4526      1.1  nonaka 		urtwn_write_1(sc, R92C_AFE_PLL_CTRL, 0x80);
   4527      1.1  nonaka 		/* Gated AFE DIG_CLOCK */
   4528      1.1  nonaka 		urtwn_write_2(sc, R92C_AFE_XTAL_CTRL, 0x880F);
   4529      1.1  nonaka 		/* Isolated digital to PON */
   4530      1.1  nonaka 		urtwn_write_1(sc, R92C_SYS_ISO_CTRL, 0xF9);
   4531      1.1  nonaka 	}
   4532      1.1  nonaka 
   4533      1.1  nonaka 	/*
   4534      1.1  nonaka 	 * Pull GPIO PIN to balance level and LED control
   4535      1.1  nonaka 	 */
   4536      1.1  nonaka 	/* 1. Disable GPIO[7:0] */
   4537      1.1  nonaka 	urtwn_write_2(sc, R92C_GPIO_PIN_CTRL + 2, 0x0000);
   4538      1.1  nonaka 
   4539      1.1  nonaka 	reg = urtwn_read_4(sc, R92C_GPIO_PIN_CTRL) & ~0x0000ff00;
   4540      1.1  nonaka 	reg |= ((reg << 8) & 0x0000ff00) | 0x00ff0000;
   4541      1.1  nonaka 	urtwn_write_4(sc, R92C_GPIO_PIN_CTRL, reg);
   4542      1.1  nonaka 
   4543  1.5.4.3     tls 	/* Disable GPIO[10:8] */
   4544  1.5.4.3     tls 	urtwn_write_1(sc, R92C_GPIO_MUXCFG + 3, 0x00);
   4545      1.1  nonaka 
   4546      1.1  nonaka 	reg = urtwn_read_2(sc, R92C_GPIO_MUXCFG + 2) & ~0x00f0;
   4547  1.5.4.3     tls 	reg |= (((reg & 0x000f) << 4) | 0x0780);
   4548  1.5.4.3     tls 	urtwn_write_2(sc, R92C_GPIO_PIN_CTRL+2, reg);
   4549      1.1  nonaka 
   4550      1.1  nonaka 	/* Disable LED0 & 1 */
   4551  1.5.4.3     tls 	urtwn_write_2(sc, R92C_LEDCFG0, 0x8080);
   4552      1.1  nonaka 
   4553      1.1  nonaka 	/*
   4554      1.1  nonaka 	 * Reset digital sequence
   4555      1.1  nonaka 	 */
   4556  1.5.4.3     tls 	if (disabled) {
   4557      1.1  nonaka 		/* Disable ELDR clock */
   4558      1.1  nonaka 		urtwn_write_2(sc, R92C_SYS_CLKR, 0x70A3);
   4559      1.1  nonaka 		/* Isolated ELDR to PON */
   4560      1.1  nonaka 		urtwn_write_1(sc, R92C_SYS_ISO_CTRL + 1, 0x82);
   4561      1.1  nonaka 	}
   4562      1.1  nonaka 
   4563      1.1  nonaka 	/*
   4564      1.1  nonaka 	 * Disable analog sequence
   4565      1.1  nonaka 	 */
   4566  1.5.4.3     tls 	if (disabled) {
   4567      1.1  nonaka 		/* Disable A15 power */
   4568  1.5.4.3     tls 		urtwn_write_1(sc, R92C_LDOA15_CTRL, 0x04);
   4569      1.1  nonaka 		/* Disable digital core power */
   4570  1.5.4.3     tls 		urtwn_write_1(sc, R92C_LDOV12D_CTRL,
   4571  1.5.4.3     tls 		    urtwn_read_1(sc, R92C_LDOV12D_CTRL) &
   4572      1.1  nonaka 		      ~R92C_LDOV12D_CTRL_LDV12_EN);
   4573  1.5.4.3     tls 	}
   4574      1.1  nonaka 
   4575      1.1  nonaka 	/* Enter PFM mode */
   4576      1.1  nonaka 	urtwn_write_1(sc, R92C_SPS0_CTRL, 0x23);
   4577      1.1  nonaka 
   4578      1.1  nonaka 	/* Set USB suspend */
   4579      1.1  nonaka 	urtwn_write_2(sc, R92C_APS_FSMCO,
   4580      1.1  nonaka 	    R92C_APS_FSMCO_APDM_HOST |
   4581      1.1  nonaka 	    R92C_APS_FSMCO_AFSM_HSUS |
   4582      1.1  nonaka 	    R92C_APS_FSMCO_PFM_ALDN);
   4583      1.1  nonaka 
   4584      1.1  nonaka 	urtwn_write_1(sc, R92C_RSV_CTRL, 0x0E);
   4585  1.5.4.1     tls 
   4586  1.5.4.1     tls 	mutex_exit(&sc->sc_write_mtx);
   4587      1.1  nonaka }
   4588      1.1  nonaka 
   4589      1.4  nonaka MODULE(MODULE_CLASS_DRIVER, if_urtwn, "bpf");
   4590      1.1  nonaka 
   4591      1.1  nonaka #ifdef _MODULE
   4592      1.1  nonaka #include "ioconf.c"
   4593      1.1  nonaka #endif
   4594      1.1  nonaka 
   4595      1.1  nonaka static int
   4596      1.1  nonaka if_urtwn_modcmd(modcmd_t cmd, void *aux)
   4597      1.1  nonaka {
   4598      1.1  nonaka 	int error = 0;
   4599      1.1  nonaka 
   4600      1.1  nonaka 	switch (cmd) {
   4601      1.1  nonaka 	case MODULE_CMD_INIT:
   4602      1.1  nonaka #ifdef _MODULE
   4603      1.1  nonaka 		error = config_init_component(cfdriver_ioconf_urtwn,
   4604      1.1  nonaka 		    cfattach_ioconf_urtwn, cfdata_ioconf_urtwn);
   4605      1.1  nonaka #endif
   4606      1.1  nonaka 		return (error);
   4607      1.1  nonaka 	case MODULE_CMD_FINI:
   4608      1.1  nonaka #ifdef _MODULE
   4609      1.1  nonaka 		error = config_fini_component(cfdriver_ioconf_urtwn,
   4610      1.1  nonaka 		    cfattach_ioconf_urtwn, cfdata_ioconf_urtwn);
   4611      1.1  nonaka #endif
   4612      1.1  nonaka 		return (error);
   4613      1.1  nonaka 	default:
   4614      1.1  nonaka 		return (ENOTTY);
   4615      1.1  nonaka 	}
   4616      1.1  nonaka }
   4617