Home | History | Annotate | Line # | Download | only in usb
if_run.c revision 1.4.2.3
      1  1.4.2.2     tls /*	$NetBSD: if_run.c,v 1.4.2.3 2014/08/20 00:03:51 tls Exp $	*/
      2      1.1  nonaka /*	$OpenBSD: if_run.c,v 1.90 2012/03/24 15:11:04 jsg Exp $	*/
      3      1.1  nonaka 
      4      1.1  nonaka /*-
      5      1.1  nonaka  * Copyright (c) 2008-2010 Damien Bergamini <damien.bergamini (at) free.fr>
      6      1.1  nonaka  *
      7      1.1  nonaka  * Permission to use, copy, modify, and distribute this software for any
      8      1.1  nonaka  * purpose with or without fee is hereby granted, provided that the above
      9      1.1  nonaka  * copyright notice and this permission notice appear in all copies.
     10      1.1  nonaka  *
     11      1.1  nonaka  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     12      1.1  nonaka  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     13      1.1  nonaka  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     14      1.1  nonaka  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     15      1.1  nonaka  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     16      1.1  nonaka  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     17      1.1  nonaka  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     18      1.1  nonaka  */
     19      1.1  nonaka 
     20      1.1  nonaka /*-
     21      1.1  nonaka  * Ralink Technology RT2700U/RT2800U/RT3000U chipset driver.
     22      1.1  nonaka  * http://www.ralinktech.com/
     23      1.1  nonaka  */
     24      1.1  nonaka 
     25      1.1  nonaka #include <sys/cdefs.h>
     26  1.4.2.2     tls __KERNEL_RCSID(0, "$NetBSD: if_run.c,v 1.4.2.3 2014/08/20 00:03:51 tls Exp $");
     27      1.1  nonaka 
     28      1.1  nonaka #include <sys/param.h>
     29      1.1  nonaka #include <sys/sockio.h>
     30      1.1  nonaka #include <sys/sysctl.h>
     31      1.1  nonaka #include <sys/mbuf.h>
     32      1.1  nonaka #include <sys/kernel.h>
     33      1.1  nonaka #include <sys/socket.h>
     34      1.1  nonaka #include <sys/systm.h>
     35      1.1  nonaka #include <sys/malloc.h>
     36      1.1  nonaka #include <sys/callout.h>
     37      1.1  nonaka #include <sys/module.h>
     38      1.1  nonaka #include <sys/conf.h>
     39      1.1  nonaka #include <sys/device.h>
     40      1.1  nonaka 
     41      1.1  nonaka #include <sys/bus.h>
     42      1.1  nonaka #include <machine/endian.h>
     43      1.1  nonaka #include <sys/intr.h>
     44      1.1  nonaka 
     45      1.1  nonaka #include <net/bpf.h>
     46      1.1  nonaka #include <net/if.h>
     47      1.1  nonaka #include <net/if_arp.h>
     48      1.1  nonaka #include <net/if_dl.h>
     49      1.1  nonaka #include <net/if_ether.h>
     50      1.1  nonaka #include <net/if_media.h>
     51      1.1  nonaka #include <net/if_types.h>
     52      1.1  nonaka 
     53      1.1  nonaka #include <net80211/ieee80211_var.h>
     54      1.1  nonaka #include <net80211/ieee80211_amrr.h>
     55      1.1  nonaka #include <net80211/ieee80211_radiotap.h>
     56      1.1  nonaka 
     57      1.1  nonaka #include <dev/firmload.h>
     58      1.1  nonaka 
     59      1.1  nonaka #include <dev/usb/usb.h>
     60      1.1  nonaka #include <dev/usb/usbdi.h>
     61      1.1  nonaka #include <dev/usb/usbdivar.h>
     62      1.1  nonaka #include <dev/usb/usbdi_util.h>
     63      1.1  nonaka #include <dev/usb/usbdevs.h>
     64      1.1  nonaka 
     65      1.1  nonaka #include <dev/ic/rt2860reg.h>		/* shared with ral(4) */
     66      1.1  nonaka #include <dev/usb/if_runvar.h>
     67      1.1  nonaka 
     68      1.1  nonaka #ifdef RUN_DEBUG
     69      1.1  nonaka #define DPRINTF(x)	do { if (run_debug) printf x; } while (0)
     70      1.1  nonaka #define DPRINTFN(n, x)	do { if (run_debug >= (n)) printf x; } while (0)
     71      1.1  nonaka int run_debug = 0;
     72      1.1  nonaka #else
     73      1.1  nonaka #define DPRINTF(x)
     74      1.1  nonaka #define DPRINTFN(n, x)
     75      1.1  nonaka #endif
     76      1.1  nonaka 
     77      1.1  nonaka #define USB_ID(v, p)	{ USB_VENDOR_##v, USB_PRODUCT_##v##_##p }
     78      1.1  nonaka static const struct usb_devno run_devs[] = {
     79      1.1  nonaka 	USB_ID(ABOCOM,		RT2770),
     80      1.1  nonaka 	USB_ID(ABOCOM,		RT2870),
     81      1.1  nonaka 	USB_ID(ABOCOM,		RT3070),
     82      1.1  nonaka 	USB_ID(ABOCOM,		RT3071),
     83      1.1  nonaka 	USB_ID(ABOCOM,		RT3072),
     84      1.1  nonaka 	USB_ID(ABOCOM2,		RT2870_1),
     85      1.1  nonaka 	USB_ID(ACCTON,		RT2770),
     86      1.1  nonaka 	USB_ID(ACCTON,		RT2870_1),
     87      1.1  nonaka 	USB_ID(ACCTON,		RT2870_2),
     88      1.1  nonaka 	USB_ID(ACCTON,		RT2870_3),
     89      1.1  nonaka 	USB_ID(ACCTON,		RT2870_4),
     90      1.1  nonaka 	USB_ID(ACCTON,		RT2870_5),
     91      1.1  nonaka 	USB_ID(ACCTON,		RT3070),
     92      1.1  nonaka 	USB_ID(ACCTON,		RT3070_1),
     93      1.1  nonaka 	USB_ID(ACCTON,		RT3070_2),
     94      1.1  nonaka 	USB_ID(ACCTON,		RT3070_3),
     95      1.1  nonaka 	USB_ID(ACCTON,		RT3070_4),
     96      1.1  nonaka 	USB_ID(ACCTON,		RT3070_5),
     97      1.1  nonaka 	USB_ID(ACCTON,		RT3070_6),
     98      1.1  nonaka 	USB_ID(AIRTIES,		RT3070),
     99      1.1  nonaka 	USB_ID(AIRTIES,		RT3070_2),
    100      1.1  nonaka 	USB_ID(ALLWIN,		RT2070),
    101      1.1  nonaka 	USB_ID(ALLWIN,		RT2770),
    102      1.1  nonaka 	USB_ID(ALLWIN,		RT2870),
    103      1.1  nonaka 	USB_ID(ALLWIN,		RT3070),
    104      1.1  nonaka 	USB_ID(ALLWIN,		RT3071),
    105      1.1  nonaka 	USB_ID(ALLWIN,		RT3072),
    106      1.1  nonaka 	USB_ID(ALLWIN,		RT3572),
    107      1.1  nonaka 	USB_ID(AMIGO,		RT2870_1),
    108      1.1  nonaka 	USB_ID(AMIGO,		RT2870_2),
    109      1.1  nonaka 	USB_ID(AMIT,		CGWLUSB2GNR),
    110      1.1  nonaka 	USB_ID(AMIT,		RT2870_1),
    111      1.1  nonaka 	USB_ID(AMIT2,		RT2870),
    112      1.1  nonaka 	USB_ID(ASUSTEK,		RT2870_1),
    113      1.1  nonaka 	USB_ID(ASUSTEK,		RT2870_2),
    114      1.1  nonaka 	USB_ID(ASUSTEK,		RT2870_3),
    115      1.1  nonaka 	USB_ID(ASUSTEK,		RT2870_4),
    116      1.1  nonaka 	USB_ID(ASUSTEK,		RT2870_5),
    117      1.1  nonaka 	USB_ID(ASUSTEK,		RT3070),
    118      1.1  nonaka 	USB_ID(ASUSTEK,		RT3070_1),
    119      1.1  nonaka 	USB_ID(ASUSTEK2,	USBN11),
    120      1.1  nonaka 	USB_ID(AZUREWAVE,	RT2870_1),
    121      1.1  nonaka 	USB_ID(AZUREWAVE,	RT2870_2),
    122      1.1  nonaka 	USB_ID(AZUREWAVE,	RT3070),
    123      1.1  nonaka 	USB_ID(AZUREWAVE,	RT3070_2),
    124      1.1  nonaka 	USB_ID(AZUREWAVE,	RT3070_3),
    125      1.1  nonaka 	USB_ID(AZUREWAVE,	RT3070_4),
    126      1.1  nonaka 	USB_ID(AZUREWAVE,	RT3070_5),
    127      1.1  nonaka 	USB_ID(BELKIN,		F5D8053V3),
    128      1.1  nonaka 	USB_ID(BELKIN,		F5D8055),
    129      1.1  nonaka 	USB_ID(BELKIN,		F5D8055V2),
    130      1.1  nonaka 	USB_ID(BELKIN,		F6D4050V1),
    131      1.1  nonaka 	USB_ID(BELKIN,		F6D4050V2),
    132      1.1  nonaka 	USB_ID(BELKIN,		F7D1101V2),
    133      1.1  nonaka 	USB_ID(BELKIN,		RT2870_1),
    134      1.1  nonaka 	USB_ID(BELKIN,		RT2870_2),
    135      1.1  nonaka 	USB_ID(BEWAN,		RT3070),
    136      1.1  nonaka 	USB_ID(CISCOLINKSYS,	AE1000),
    137      1.1  nonaka 	USB_ID(CISCOLINKSYS,	AM10),
    138      1.1  nonaka 	USB_ID(CISCOLINKSYS2,	RT3070),
    139      1.1  nonaka 	USB_ID(CISCOLINKSYS3,	RT3070),
    140      1.1  nonaka 	USB_ID(CONCEPTRONIC,	RT2870_1),
    141      1.1  nonaka 	USB_ID(CONCEPTRONIC,	RT2870_2),
    142      1.1  nonaka 	USB_ID(CONCEPTRONIC,	RT2870_3),
    143      1.1  nonaka 	USB_ID(CONCEPTRONIC,	RT2870_4),
    144      1.1  nonaka 	USB_ID(CONCEPTRONIC,	RT2870_5),
    145      1.1  nonaka 	USB_ID(CONCEPTRONIC,	RT2870_6),
    146      1.1  nonaka 	USB_ID(CONCEPTRONIC,	RT2870_7),
    147      1.1  nonaka 	USB_ID(CONCEPTRONIC,	RT2870_8),
    148      1.1  nonaka 	USB_ID(CONCEPTRONIC,	RT3070_1),
    149      1.1  nonaka 	USB_ID(CONCEPTRONIC,	RT3070_2),
    150      1.1  nonaka 	USB_ID(CONCEPTRONIC,	RT3070_3),
    151      1.1  nonaka 	USB_ID(COREGA,		CGWLUSB300GNM),
    152      1.1  nonaka 	USB_ID(COREGA,		RT2870_1),
    153      1.1  nonaka 	USB_ID(COREGA,		RT2870_2),
    154      1.1  nonaka 	USB_ID(COREGA,		RT2870_3),
    155      1.1  nonaka 	USB_ID(COREGA,		RT3070),
    156      1.1  nonaka 	USB_ID(CYBERTAN,	RT2870),
    157      1.1  nonaka 	USB_ID(DLINK,		RT2870),
    158      1.1  nonaka 	USB_ID(DLINK,		RT3072),
    159      1.1  nonaka 	USB_ID(DLINK2,		DWA130),
    160      1.1  nonaka 	USB_ID(DLINK2,		RT2870_1),
    161      1.1  nonaka 	USB_ID(DLINK2,		RT2870_2),
    162      1.1  nonaka 	USB_ID(DLINK2,		RT3070_1),
    163      1.1  nonaka 	USB_ID(DLINK2,		RT3070_2),
    164      1.1  nonaka 	USB_ID(DLINK2,		RT3070_3),
    165      1.1  nonaka 	USB_ID(DLINK2,		RT3070_4),
    166      1.1  nonaka 	USB_ID(DLINK2,		RT3070_5),
    167      1.1  nonaka 	USB_ID(DLINK2,		RT3072),
    168      1.1  nonaka 	USB_ID(DLINK2,		RT3072_1),
    169      1.1  nonaka 	USB_ID(DVICO,		RT3070),
    170      1.1  nonaka 	USB_ID(EDIMAX,		EW7717),
    171      1.1  nonaka 	USB_ID(EDIMAX,		EW7718),
    172      1.1  nonaka 	USB_ID(EDIMAX,		EW7722UTN),
    173      1.1  nonaka 	USB_ID(EDIMAX,		RT2870_1),
    174      1.1  nonaka 	USB_ID(ENCORE,		RT3070),
    175      1.1  nonaka 	USB_ID(ENCORE,		RT3070_2),
    176      1.1  nonaka 	USB_ID(ENCORE,		RT3070_3),
    177      1.1  nonaka 	USB_ID(GIGABYTE,	GNWB31N),
    178      1.1  nonaka 	USB_ID(GIGABYTE,	GNWB32L),
    179      1.1  nonaka 	USB_ID(GIGABYTE,	RT2870_1),
    180      1.1  nonaka 	USB_ID(GIGASET,		RT3070_1),
    181      1.1  nonaka 	USB_ID(GIGASET,		RT3070_2),
    182      1.1  nonaka 	USB_ID(GUILLEMOT,	HWNU300),
    183      1.1  nonaka 	USB_ID(HAWKING,		HWUN2),
    184      1.1  nonaka 	USB_ID(HAWKING,		RT2870_1),
    185      1.1  nonaka 	USB_ID(HAWKING,		RT2870_2),
    186      1.1  nonaka 	USB_ID(HAWKING,		RT2870_3),
    187      1.1  nonaka 	USB_ID(HAWKING,		RT2870_4),
    188      1.1  nonaka 	USB_ID(HAWKING,		RT2870_5),
    189      1.1  nonaka 	USB_ID(HAWKING,		RT3070),
    190      1.1  nonaka 	USB_ID(IODATA,		RT3072_1),
    191      1.1  nonaka 	USB_ID(IODATA,		RT3072_2),
    192      1.1  nonaka 	USB_ID(IODATA,		RT3072_3),
    193      1.1  nonaka 	USB_ID(IODATA,		RT3072_4),
    194      1.1  nonaka 	USB_ID(LINKSYS4,	RT3070),
    195      1.1  nonaka 	USB_ID(LINKSYS4,	WUSB100),
    196      1.1  nonaka 	USB_ID(LINKSYS4,	WUSB54GC_3),
    197      1.1  nonaka 	USB_ID(LINKSYS4,	WUSB600N),
    198      1.1  nonaka 	USB_ID(LINKSYS4,	WUSB600NV2),
    199      1.1  nonaka 	USB_ID(LOGITEC,		LANW300NU2),
    200      1.1  nonaka 	USB_ID(LOGITEC,		RT2870_1),
    201      1.1  nonaka 	USB_ID(LOGITEC,		RT2870_2),
    202      1.1  nonaka 	USB_ID(LOGITEC,		RT2870_3),
    203      1.1  nonaka 	USB_ID(LOGITEC,		RT3020),
    204      1.1  nonaka 	USB_ID(MELCO,		RT2870_1),
    205      1.1  nonaka 	USB_ID(MELCO,		RT2870_2),
    206      1.1  nonaka 	USB_ID(MELCO,		WLIUCAG300N),
    207      1.1  nonaka 	USB_ID(MELCO,		WLIUCG300N),
    208      1.1  nonaka 	USB_ID(MELCO,		WLIUCG301N),
    209      1.1  nonaka 	USB_ID(MELCO,		WLIUCGN),
    210      1.1  nonaka 	USB_ID(MELCO,		WLIUCGNHP),
    211      1.1  nonaka 	USB_ID(MELCO,		WLIUCGNM),
    212      1.1  nonaka 	USB_ID(MELCO,		WLIUCGNM2T),
    213      1.1  nonaka 	USB_ID(MOTOROLA4,	RT2770),
    214      1.1  nonaka 	USB_ID(MOTOROLA4,	RT3070),
    215      1.1  nonaka 	USB_ID(MSI,		RT3070),
    216      1.1  nonaka 	USB_ID(MSI,		RT3070_2),
    217      1.1  nonaka 	USB_ID(MSI,		RT3070_3),
    218      1.1  nonaka 	USB_ID(MSI,		RT3070_4),
    219      1.1  nonaka 	USB_ID(MSI,		RT3070_5),
    220      1.1  nonaka 	USB_ID(MSI,		RT3070_6),
    221      1.1  nonaka 	USB_ID(MSI,		RT3070_7),
    222      1.1  nonaka 	USB_ID(MSI,		RT3070_8),
    223      1.1  nonaka 	USB_ID(MSI,		RT3070_9),
    224      1.1  nonaka 	USB_ID(MSI,		RT3070_10),
    225      1.1  nonaka 	USB_ID(MSI,		RT3070_11),
    226      1.1  nonaka 	USB_ID(MSI,		RT3070_12),
    227      1.1  nonaka 	USB_ID(MSI,		RT3070_13),
    228      1.1  nonaka 	USB_ID(MSI,		RT3070_14),
    229      1.1  nonaka 	USB_ID(MSI,		RT3070_15),
    230      1.1  nonaka 	USB_ID(OVISLINK,	RT3071),
    231      1.1  nonaka 	USB_ID(OVISLINK,	RT3072),
    232      1.1  nonaka 	USB_ID(PARA,		RT3070),
    233      1.1  nonaka 	USB_ID(PEGATRON,	RT2870),
    234      1.1  nonaka 	USB_ID(PEGATRON,	RT3070),
    235      1.1  nonaka 	USB_ID(PEGATRON,	RT3070_2),
    236      1.1  nonaka 	USB_ID(PEGATRON,	RT3070_3),
    237      1.1  nonaka 	USB_ID(PEGATRON,	RT3072),
    238      1.1  nonaka 	USB_ID(PHILIPS,		RT2870),
    239      1.1  nonaka 	USB_ID(PLANEX2,		GWUS300MINIS),
    240      1.1  nonaka 	USB_ID(PLANEX2,		GWUSMICRO300),
    241      1.1  nonaka 	USB_ID(PLANEX2,		GWUSMICRON),
    242      1.1  nonaka 	USB_ID(PLANEX2,		GWUS300MINIX),
    243      1.1  nonaka 	USB_ID(PLANEX2,		RT3070),
    244      1.1  nonaka 	USB_ID(QCOM,		RT2870),
    245      1.1  nonaka 	USB_ID(QUANTA,		RT3070),
    246      1.1  nonaka 	USB_ID(RALINK,		RT2070),
    247      1.1  nonaka 	USB_ID(RALINK,		RT2770),
    248      1.1  nonaka 	USB_ID(RALINK,		RT2870),
    249      1.1  nonaka 	USB_ID(RALINK,		RT3070),
    250      1.1  nonaka 	USB_ID(RALINK,		RT3071),
    251      1.1  nonaka 	USB_ID(RALINK,		RT3072),
    252      1.1  nonaka 	USB_ID(RALINK,		RT3370),
    253      1.1  nonaka 	USB_ID(RALINK,		RT3572),
    254      1.1  nonaka 	USB_ID(RALINK,		RT8070),
    255      1.1  nonaka 	USB_ID(SAMSUNG,		RT2870_1),
    256      1.1  nonaka 	USB_ID(SENAO,		RT2870_1),
    257      1.1  nonaka 	USB_ID(SENAO,		RT2870_2),
    258      1.1  nonaka 	USB_ID(SENAO,		RT2870_3),
    259      1.1  nonaka 	USB_ID(SENAO,		RT2870_4),
    260      1.1  nonaka 	USB_ID(SENAO,		RT3070),
    261      1.1  nonaka 	USB_ID(SENAO,		RT3071),
    262      1.1  nonaka 	USB_ID(SENAO,		RT3072),
    263      1.1  nonaka 	USB_ID(SENAO,		RT3072_2),
    264      1.1  nonaka 	USB_ID(SENAO,		RT3072_3),
    265      1.1  nonaka 	USB_ID(SENAO,		RT3072_4),
    266      1.1  nonaka 	USB_ID(SENAO,		RT3072_5),
    267      1.1  nonaka 	USB_ID(SITECOMEU,	RT2870_1),
    268      1.1  nonaka 	USB_ID(SITECOMEU,	RT2870_2),
    269      1.1  nonaka 	USB_ID(SITECOMEU,	RT2870_3),
    270      1.1  nonaka 	USB_ID(SITECOMEU,	RT3070_1),
    271      1.1  nonaka 	USB_ID(SITECOMEU,	RT3072_3),
    272      1.1  nonaka 	USB_ID(SITECOMEU,	RT3072_4),
    273      1.1  nonaka 	USB_ID(SITECOMEU,	RT3072_5),
    274      1.1  nonaka 	USB_ID(SITECOMEU,	WL302),
    275      1.1  nonaka 	USB_ID(SITECOMEU,	WL315),
    276      1.1  nonaka 	USB_ID(SITECOMEU,	WL321),
    277      1.1  nonaka 	USB_ID(SITECOMEU,	WL324),
    278      1.1  nonaka 	USB_ID(SITECOMEU,	WL329),
    279      1.1  nonaka 	USB_ID(SITECOMEU,	WL343),
    280      1.1  nonaka 	USB_ID(SITECOMEU,	WL344),
    281      1.1  nonaka 	USB_ID(SITECOMEU,	WL345),
    282      1.1  nonaka 	USB_ID(SITECOMEU,	WL349V4),
    283      1.1  nonaka 	USB_ID(SITECOMEU,	WL608),
    284      1.1  nonaka 	USB_ID(SITECOMEU,	WLA4000),
    285      1.1  nonaka 	USB_ID(SITECOMEU,	WLA5000),
    286      1.1  nonaka 	USB_ID(SPARKLAN,	RT2870_1),
    287      1.1  nonaka 	USB_ID(SPARKLAN,	RT2870_2),
    288      1.1  nonaka 	USB_ID(SPARKLAN,	RT3070),
    289      1.1  nonaka 	USB_ID(SWEEX2,		LW153),
    290      1.1  nonaka 	USB_ID(SWEEX2,		LW303),
    291      1.1  nonaka 	USB_ID(SWEEX2,		LW313),
    292      1.1  nonaka 	USB_ID(TOSHIBA,		RT3070),
    293      1.1  nonaka 	USB_ID(UMEDIA,		RT2870_1),
    294      1.1  nonaka 	USB_ID(UMEDIA,		TEW645UB),
    295      1.1  nonaka 	USB_ID(ZCOM,		RT2870_1),
    296      1.1  nonaka 	USB_ID(ZCOM,		RT2870_2),
    297      1.1  nonaka 	USB_ID(ZINWELL,		RT2870_1),
    298      1.1  nonaka 	USB_ID(ZINWELL,		RT2870_2),
    299      1.1  nonaka 	USB_ID(ZINWELL,		RT3070),
    300      1.1  nonaka 	USB_ID(ZINWELL,		RT3072),
    301      1.1  nonaka 	USB_ID(ZINWELL,		RT3072_2),
    302      1.1  nonaka 	USB_ID(ZYXEL,		NWD2105),
    303      1.1  nonaka 	USB_ID(ZYXEL,		NWD211AN),
    304      1.1  nonaka 	USB_ID(ZYXEL,		RT2870_1),
    305      1.1  nonaka 	USB_ID(ZYXEL,		RT2870_2),
    306      1.1  nonaka 	USB_ID(ZYXEL,		RT3070),
    307      1.1  nonaka };
    308      1.1  nonaka 
    309      1.1  nonaka static int		run_match(device_t, cfdata_t, void *);
    310      1.1  nonaka static void		run_attach(device_t, device_t, void *);
    311      1.1  nonaka static int		run_detach(device_t, int);
    312      1.1  nonaka static int		run_activate(device_t, enum devact);
    313      1.1  nonaka 
    314      1.1  nonaka CFATTACH_DECL_NEW(run, sizeof(struct run_softc),
    315      1.1  nonaka 	run_match, run_attach, run_detach, run_activate);
    316      1.1  nonaka 
    317      1.1  nonaka static int		run_alloc_rx_ring(struct run_softc *);
    318      1.1  nonaka static void		run_free_rx_ring(struct run_softc *);
    319      1.1  nonaka static int		run_alloc_tx_ring(struct run_softc *, int);
    320      1.1  nonaka static void		run_free_tx_ring(struct run_softc *, int);
    321      1.1  nonaka static int		run_load_microcode(struct run_softc *);
    322      1.1  nonaka static int		run_reset(struct run_softc *);
    323      1.1  nonaka static int		run_read(struct run_softc *, uint16_t, uint32_t *);
    324      1.1  nonaka static int		run_read_region_1(struct run_softc *, uint16_t,
    325      1.1  nonaka 			    uint8_t *, int);
    326      1.1  nonaka static int		run_write_2(struct run_softc *, uint16_t, uint16_t);
    327      1.1  nonaka static int		run_write(struct run_softc *, uint16_t, uint32_t);
    328      1.1  nonaka static int		run_write_region_1(struct run_softc *, uint16_t,
    329      1.1  nonaka 			    const uint8_t *, int);
    330      1.1  nonaka static int		run_set_region_4(struct run_softc *, uint16_t,
    331      1.1  nonaka 			    uint32_t, int);
    332      1.1  nonaka static int		run_efuse_read_2(struct run_softc *, uint16_t,
    333      1.1  nonaka 			    uint16_t *);
    334      1.1  nonaka static int		run_eeprom_read_2(struct run_softc *, uint16_t,
    335      1.1  nonaka 			    uint16_t *);
    336      1.1  nonaka static int		run_rt2870_rf_write(struct run_softc *, uint8_t,
    337      1.1  nonaka 			    uint32_t);
    338      1.1  nonaka static int		run_rt3070_rf_read(struct run_softc *, uint8_t,
    339      1.1  nonaka 			    uint8_t *);
    340      1.1  nonaka static int		run_rt3070_rf_write(struct run_softc *, uint8_t,
    341      1.1  nonaka 			    uint8_t);
    342      1.1  nonaka static int		run_bbp_read(struct run_softc *, uint8_t, uint8_t *);
    343      1.1  nonaka static int		run_bbp_write(struct run_softc *, uint8_t, uint8_t);
    344      1.1  nonaka static int		run_mcu_cmd(struct run_softc *, uint8_t, uint16_t);
    345      1.1  nonaka static const char *	run_get_rf(int);
    346      1.1  nonaka static int		run_read_eeprom(struct run_softc *);
    347      1.1  nonaka static struct ieee80211_node *
    348      1.1  nonaka 			run_node_alloc(struct ieee80211_node_table *);
    349      1.1  nonaka static int		run_media_change(struct ifnet *);
    350      1.1  nonaka static void		run_next_scan(void *);
    351      1.1  nonaka static void		run_task(void *);
    352      1.1  nonaka static void		run_do_async(struct run_softc *,
    353      1.1  nonaka 			    void (*)(struct run_softc *, void *), void *, int);
    354      1.1  nonaka static int		run_newstate(struct ieee80211com *,
    355      1.1  nonaka 			    enum ieee80211_state, int);
    356      1.1  nonaka static void		run_newstate_cb(struct run_softc *, void *);
    357      1.1  nonaka static int		run_updateedca(struct ieee80211com *);
    358      1.1  nonaka static void		run_updateedca_cb(struct run_softc *, void *);
    359      1.1  nonaka #ifdef RUN_HWCRYPTO
    360      1.1  nonaka static int		run_set_key(struct ieee80211com *,
    361      1.1  nonaka 			    const struct ieee80211_key *, const uint8_t *);
    362      1.1  nonaka static void		run_set_key_cb(struct run_softc *, void *);
    363      1.1  nonaka static int		run_delete_key(struct ieee80211com *,
    364      1.1  nonaka 			    const struct ieee80211_key *);
    365      1.1  nonaka static void		run_delete_key_cb(struct run_softc *, void *);
    366      1.1  nonaka #endif
    367      1.1  nonaka static void		run_calibrate_to(void *);
    368      1.1  nonaka static void		run_calibrate_cb(struct run_softc *, void *);
    369      1.1  nonaka static void		run_newassoc(struct ieee80211_node *, int);
    370      1.1  nonaka static void		run_rx_frame(struct run_softc *, uint8_t *, int);
    371      1.1  nonaka static void		run_rxeof(usbd_xfer_handle, usbd_private_handle,
    372      1.1  nonaka 			    usbd_status);
    373      1.1  nonaka static void		run_txeof(usbd_xfer_handle, usbd_private_handle,
    374      1.1  nonaka 			    usbd_status);
    375      1.1  nonaka static int		run_tx(struct run_softc *, struct mbuf *,
    376      1.1  nonaka 			    struct ieee80211_node *);
    377      1.1  nonaka static void		run_start(struct ifnet *);
    378      1.1  nonaka static void		run_watchdog(struct ifnet *);
    379      1.1  nonaka static int		run_ioctl(struct ifnet *, u_long, void *);
    380      1.1  nonaka static void		run_select_chan_group(struct run_softc *, int);
    381      1.1  nonaka static void		run_set_agc(struct run_softc *, uint8_t);
    382      1.1  nonaka static void		run_set_rx_antenna(struct run_softc *, int);
    383      1.1  nonaka static void		run_rt2870_set_chan(struct run_softc *, u_int);
    384      1.1  nonaka static void		run_rt3070_set_chan(struct run_softc *, u_int);
    385      1.1  nonaka static void		run_rt3572_set_chan(struct run_softc *, u_int);
    386      1.1  nonaka static int		run_set_chan(struct run_softc *,
    387      1.1  nonaka 			    struct ieee80211_channel *);
    388      1.1  nonaka static void		run_enable_tsf_sync(struct run_softc *);
    389      1.1  nonaka static void		run_enable_mrr(struct run_softc *);
    390      1.1  nonaka static void		run_set_txpreamble(struct run_softc *);
    391      1.1  nonaka static void		run_set_basicrates(struct run_softc *);
    392      1.1  nonaka static void		run_set_leds(struct run_softc *, uint16_t);
    393      1.1  nonaka static void		run_set_bssid(struct run_softc *, const uint8_t *);
    394      1.1  nonaka static void		run_set_macaddr(struct run_softc *, const uint8_t *);
    395      1.1  nonaka static void		run_updateslot(struct ifnet *);
    396      1.1  nonaka static void		run_updateslot_cb(struct run_softc *, void *);
    397      1.1  nonaka static int8_t		run_rssi2dbm(struct run_softc *, uint8_t, uint8_t);
    398      1.1  nonaka static int		run_bbp_init(struct run_softc *);
    399      1.1  nonaka static int		run_rt3070_rf_init(struct run_softc *);
    400      1.1  nonaka static int		run_rt3070_filter_calib(struct run_softc *, uint8_t,
    401      1.1  nonaka 			    uint8_t, uint8_t *);
    402      1.1  nonaka static void		run_rt3070_rf_setup(struct run_softc *);
    403      1.1  nonaka static int		run_txrx_enable(struct run_softc *);
    404      1.1  nonaka static int		run_init(struct ifnet *);
    405      1.1  nonaka static void		run_stop(struct ifnet *, int);
    406      1.1  nonaka #ifndef IEEE80211_STA_ONLY
    407      1.1  nonaka static int		run_setup_beacon(struct run_softc *);
    408      1.1  nonaka #endif
    409      1.1  nonaka 
    410      1.1  nonaka static const struct {
    411      1.1  nonaka 	uint32_t reg;
    412      1.1  nonaka 	uint32_t val;
    413      1.1  nonaka } rt2870_def_mac[] = {
    414      1.1  nonaka 	RT2870_DEF_MAC
    415      1.1  nonaka };
    416      1.1  nonaka 
    417      1.1  nonaka static const struct {
    418      1.1  nonaka 	uint8_t reg;
    419      1.1  nonaka 	uint8_t val;
    420      1.1  nonaka } rt2860_def_bbp[] = {
    421      1.1  nonaka 	RT2860_DEF_BBP
    422      1.1  nonaka };
    423      1.1  nonaka 
    424      1.1  nonaka static const struct rfprog {
    425      1.1  nonaka 	uint8_t chan;
    426      1.1  nonaka 	uint32_t r1, r2, r3, r4;
    427      1.1  nonaka } rt2860_rf2850[] = {
    428      1.1  nonaka 	RT2860_RF2850
    429      1.1  nonaka };
    430      1.1  nonaka 
    431      1.1  nonaka static const struct {
    432      1.1  nonaka 	uint8_t n, r, k;
    433      1.1  nonaka } rt3070_freqs[] = {
    434      1.1  nonaka 	RT3070_RF3052
    435      1.1  nonaka };
    436      1.1  nonaka 
    437      1.1  nonaka static const struct {
    438      1.1  nonaka 	uint8_t reg;
    439      1.1  nonaka 	uint8_t val;
    440      1.1  nonaka } rt3070_def_rf[] = {
    441      1.1  nonaka 	RT3070_DEF_RF
    442      1.1  nonaka }, rt3572_def_rf[] = {
    443      1.1  nonaka 	RT3572_DEF_RF
    444      1.1  nonaka };
    445      1.1  nonaka 
    446      1.1  nonaka static int
    447      1.1  nonaka firmware_load(const char *dname, const char *iname, uint8_t **ucodep,
    448      1.1  nonaka     size_t *sizep)
    449      1.1  nonaka {
    450      1.1  nonaka 	firmware_handle_t fh;
    451      1.1  nonaka 	int error;
    452      1.1  nonaka 
    453      1.1  nonaka 	if ((error = firmware_open(dname, iname, &fh)) != 0)
    454      1.1  nonaka 		return (error);
    455      1.1  nonaka 	*sizep = firmware_get_size(fh);
    456      1.1  nonaka 	if ((*ucodep = firmware_malloc(*sizep)) == NULL) {
    457      1.1  nonaka 		firmware_close(fh);
    458      1.1  nonaka 		return (ENOMEM);
    459      1.1  nonaka 	}
    460      1.1  nonaka 	if ((error = firmware_read(fh, 0, *ucodep, *sizep)) != 0)
    461      1.1  nonaka 		firmware_free(*ucodep, *sizep);
    462      1.1  nonaka 	firmware_close(fh);
    463      1.1  nonaka 
    464      1.1  nonaka 	return (error);
    465      1.1  nonaka }
    466      1.1  nonaka 
    467      1.1  nonaka static int
    468      1.1  nonaka run_match(device_t parent, cfdata_t match, void *aux)
    469      1.1  nonaka {
    470      1.1  nonaka 	struct usb_attach_arg *uaa = aux;
    471      1.1  nonaka 
    472      1.1  nonaka 	return (usb_lookup(run_devs, uaa->vendor, uaa->product) != NULL) ?
    473      1.1  nonaka 	    UMATCH_VENDOR_PRODUCT : UMATCH_NONE;
    474      1.1  nonaka }
    475      1.1  nonaka 
    476      1.1  nonaka static void
    477      1.1  nonaka run_attach(device_t parent, device_t self, void *aux)
    478      1.1  nonaka {
    479      1.1  nonaka 	struct run_softc *sc = device_private(self);
    480      1.1  nonaka 	struct usb_attach_arg *uaa = aux;
    481      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
    482      1.1  nonaka 	struct ifnet *ifp = &sc->sc_if;
    483      1.1  nonaka 	usb_interface_descriptor_t *id;
    484      1.1  nonaka 	usb_endpoint_descriptor_t *ed;
    485      1.1  nonaka 	char *devinfop;
    486      1.1  nonaka 	int i, nrx, ntx, ntries, error;
    487      1.1  nonaka 	uint32_t ver;
    488      1.1  nonaka 
    489      1.1  nonaka 	aprint_naive("\n");
    490      1.1  nonaka 	aprint_normal("\n");
    491      1.1  nonaka 
    492      1.1  nonaka 	sc->sc_dev = self;
    493      1.1  nonaka 	sc->sc_udev = uaa->device;
    494      1.1  nonaka 
    495      1.1  nonaka 	devinfop = usbd_devinfo_alloc(sc->sc_udev, 0);
    496      1.1  nonaka 	aprint_normal_dev(sc->sc_dev, "%s\n", devinfop);
    497      1.1  nonaka 	usbd_devinfo_free(devinfop);
    498      1.1  nonaka 
    499  1.4.2.1     tls 	error = usbd_set_config_no(sc->sc_udev, 1, 0);
    500  1.4.2.1     tls 	if (error != 0) {
    501  1.4.2.1     tls 		aprint_error_dev(sc->sc_dev, "failed to set configuration"
    502  1.4.2.1     tls 		    ", err=%s\n", usbd_errstr(error));
    503      1.1  nonaka 		return;
    504      1.1  nonaka 	}
    505      1.1  nonaka 
    506      1.1  nonaka 	/* get the first interface handle */
    507      1.1  nonaka 	error = usbd_device2interface_handle(sc->sc_udev, 0, &sc->sc_iface);
    508      1.1  nonaka 	if (error != 0) {
    509      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
    510      1.1  nonaka 		    "could not get interface handle\n");
    511      1.1  nonaka 		return;
    512      1.1  nonaka 	}
    513      1.1  nonaka 
    514      1.1  nonaka 	/*
    515      1.1  nonaka 	 * Find all bulk endpoints.  There are 7 bulk endpoints: 1 for RX
    516      1.1  nonaka 	 * and 6 for TX (4 EDCAs + HCCA + Prio).
    517      1.1  nonaka 	 * Update 03-14-2009:  some devices like the Planex GW-US300MiniS
    518      1.1  nonaka 	 * seem to have only 4 TX bulk endpoints (Fukaumi Naoki).
    519      1.1  nonaka 	 */
    520      1.1  nonaka 	nrx = ntx = 0;
    521      1.1  nonaka 	id = usbd_get_interface_descriptor(sc->sc_iface);
    522      1.1  nonaka 	for (i = 0; i < id->bNumEndpoints; i++) {
    523      1.1  nonaka 		ed = usbd_interface2endpoint_descriptor(sc->sc_iface, i);
    524      1.1  nonaka 		if (ed == NULL || UE_GET_XFERTYPE(ed->bmAttributes) != UE_BULK)
    525      1.1  nonaka 			continue;
    526      1.1  nonaka 
    527      1.1  nonaka 		if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN) {
    528      1.1  nonaka 			sc->rxq.pipe_no = ed->bEndpointAddress;
    529      1.1  nonaka 			nrx++;
    530      1.1  nonaka 		} else if (ntx < 4) {
    531      1.1  nonaka 			sc->txq[ntx].pipe_no = ed->bEndpointAddress;
    532      1.1  nonaka 			ntx++;
    533      1.1  nonaka 		}
    534      1.1  nonaka 	}
    535      1.1  nonaka 	/* make sure we've got them all */
    536      1.1  nonaka 	if (nrx < 1 || ntx < 4) {
    537      1.1  nonaka 		aprint_error_dev(sc->sc_dev, "missing endpoint\n");
    538      1.1  nonaka 		return;
    539      1.1  nonaka 	}
    540      1.1  nonaka 
    541  1.4.2.1     tls 	usb_init_task(&sc->sc_task, run_task, sc, 0);
    542      1.1  nonaka 	callout_init(&sc->scan_to, 0);
    543      1.1  nonaka 	callout_setfunc(&sc->scan_to, run_next_scan, sc);
    544      1.1  nonaka 	callout_init(&sc->calib_to, 0);
    545      1.1  nonaka 	callout_setfunc(&sc->calib_to, run_calibrate_to, sc);
    546      1.1  nonaka 
    547      1.1  nonaka 	sc->amrr.amrr_min_success_threshold =  1;
    548      1.1  nonaka 	sc->amrr.amrr_max_success_threshold = 10;
    549      1.1  nonaka 
    550      1.1  nonaka 	/* wait for the chip to settle */
    551      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
    552      1.1  nonaka 		if (run_read(sc, RT2860_ASIC_VER_ID, &ver) != 0)
    553      1.1  nonaka 			return;
    554      1.1  nonaka 		if (ver != 0 && ver != 0xffffffff)
    555      1.1  nonaka 			break;
    556      1.1  nonaka 		DELAY(10);
    557      1.1  nonaka 	}
    558      1.1  nonaka 	if (ntries == 100) {
    559      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
    560      1.1  nonaka 		    "timeout waiting for NIC to initialize\n");
    561      1.1  nonaka 		return;
    562      1.1  nonaka 	}
    563      1.1  nonaka 	sc->mac_ver = ver >> 16;
    564      1.1  nonaka 	sc->mac_rev = ver & 0xffff;
    565      1.1  nonaka 
    566      1.1  nonaka 	/* retrieve RF rev. no and various other things from EEPROM */
    567      1.1  nonaka 	run_read_eeprom(sc);
    568      1.1  nonaka 
    569      1.1  nonaka 	aprint_error_dev(sc->sc_dev,
    570      1.1  nonaka 	    "MAC/BBP RT%04X (rev 0x%04X), RF %s (MIMO %dT%dR), address %s\n",
    571      1.1  nonaka 	    sc->mac_ver, sc->mac_rev, run_get_rf(sc->rf_rev), sc->ntxchains,
    572      1.1  nonaka 	    sc->nrxchains, ether_sprintf(ic->ic_myaddr));
    573      1.1  nonaka 
    574      1.1  nonaka 	ic->ic_ifp = ifp;
    575      1.1  nonaka 	ic->ic_phytype = IEEE80211_T_OFDM;	/* not only, but not used */
    576      1.1  nonaka 	ic->ic_opmode = IEEE80211_M_STA;	/* default to BSS mode */
    577      1.1  nonaka 	ic->ic_state = IEEE80211_S_INIT;
    578      1.1  nonaka 
    579      1.1  nonaka 	/* set device capabilities */
    580      1.1  nonaka 	ic->ic_caps =
    581      1.1  nonaka 	    IEEE80211_C_MONITOR |	/* monitor mode supported */
    582      1.1  nonaka #ifndef IEEE80211_STA_ONLY
    583      1.1  nonaka 	    IEEE80211_C_IBSS |		/* IBSS mode supported */
    584      1.1  nonaka 	    IEEE80211_C_HOSTAP |	/* HostAP mode supported */
    585      1.1  nonaka #endif
    586      1.1  nonaka 	    IEEE80211_C_SHPREAMBLE |	/* short preamble supported */
    587      1.1  nonaka 	    IEEE80211_C_SHSLOT |	/* short slot time supported */
    588      1.1  nonaka #ifdef RUN_HWCRYPTO
    589      1.1  nonaka 	    IEEE80211_C_WEP |		/* WEP */
    590      1.1  nonaka 	    IEEE80211_C_TKIP |		/* TKIP */
    591      1.1  nonaka 	    IEEE80211_C_AES_CCM |	/* AES CCMP */
    592      1.1  nonaka 	    IEEE80211_C_TKIPMIC |	/* TKIPMIC */
    593      1.1  nonaka #endif
    594      1.1  nonaka 	    IEEE80211_C_WME |		/* WME */
    595      1.1  nonaka 	    IEEE80211_C_WPA;		/* WPA/RSN */
    596      1.1  nonaka 
    597      1.1  nonaka 	if (sc->rf_rev == RT2860_RF_2750 ||
    598      1.1  nonaka 	    sc->rf_rev == RT2860_RF_2850 ||
    599      1.1  nonaka 	    sc->rf_rev == RT3070_RF_3052) {
    600      1.1  nonaka 		/* set supported .11a rates */
    601      1.1  nonaka 		ic->ic_sup_rates[IEEE80211_MODE_11A] =
    602      1.1  nonaka 		    ieee80211_std_rateset_11a;
    603      1.1  nonaka 
    604      1.1  nonaka 		/* set supported .11a channels */
    605      1.1  nonaka 		for (i = 14; i < (int)__arraycount(rt2860_rf2850); i++) {
    606      1.1  nonaka 			uint8_t chan = rt2860_rf2850[i].chan;
    607      1.1  nonaka 			ic->ic_channels[chan].ic_freq =
    608      1.1  nonaka 			    ieee80211_ieee2mhz(chan, IEEE80211_CHAN_5GHZ);
    609      1.1  nonaka 			ic->ic_channels[chan].ic_flags = IEEE80211_CHAN_A;
    610      1.1  nonaka 		}
    611      1.1  nonaka 	}
    612      1.1  nonaka 
    613      1.1  nonaka 	/* set supported .11b and .11g rates */
    614      1.1  nonaka 	ic->ic_sup_rates[IEEE80211_MODE_11B] = ieee80211_std_rateset_11b;
    615      1.1  nonaka 	ic->ic_sup_rates[IEEE80211_MODE_11G] = ieee80211_std_rateset_11g;
    616      1.1  nonaka 
    617      1.1  nonaka 	/* set supported .11b and .11g channels (1 through 14) */
    618      1.1  nonaka 	for (i = 1; i <= 14; i++) {
    619      1.1  nonaka 		ic->ic_channels[i].ic_freq =
    620      1.1  nonaka 		    ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ);
    621      1.1  nonaka 		ic->ic_channels[i].ic_flags =
    622      1.1  nonaka 		    IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM |
    623      1.1  nonaka 		    IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ;
    624      1.1  nonaka 	}
    625      1.1  nonaka 
    626      1.1  nonaka 	ifp->if_softc = sc;
    627      1.1  nonaka 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    628      1.1  nonaka 	ifp->if_init = run_init;
    629      1.1  nonaka 	ifp->if_ioctl = run_ioctl;
    630      1.1  nonaka 	ifp->if_start = run_start;
    631      1.1  nonaka 	ifp->if_watchdog = run_watchdog;
    632      1.1  nonaka 	IFQ_SET_READY(&ifp->if_snd);
    633      1.1  nonaka 	memcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
    634      1.1  nonaka 
    635      1.1  nonaka 	if_attach(ifp);
    636      1.1  nonaka 	ieee80211_ifattach(ic);
    637      1.1  nonaka 	ic->ic_node_alloc = run_node_alloc;
    638      1.1  nonaka 	ic->ic_newassoc = run_newassoc;
    639      1.1  nonaka 	ic->ic_updateslot = run_updateslot;
    640      1.1  nonaka 	ic->ic_wme.wme_update = run_updateedca;
    641      1.1  nonaka #ifdef RUN_HWCRYPTO
    642      1.1  nonaka 	ic->ic_crypto.cs_key_set = run_set_key;
    643      1.1  nonaka 	ic->ic_crypto.cs_key_delete = run_delete_key;
    644      1.1  nonaka #endif
    645      1.1  nonaka 	/* override state transition machine */
    646      1.1  nonaka 	sc->sc_newstate = ic->ic_newstate;
    647      1.1  nonaka 	ic->ic_newstate = run_newstate;
    648      1.1  nonaka 	ieee80211_media_init(ic, run_media_change, ieee80211_media_status);
    649      1.1  nonaka 
    650      1.1  nonaka 	bpf_attach2(ifp, DLT_IEEE802_11_RADIO,
    651      1.1  nonaka 	    sizeof(struct ieee80211_frame) + IEEE80211_RADIOTAP_HDRLEN,
    652      1.1  nonaka 	    &sc->sc_drvbpf);
    653      1.1  nonaka 
    654      1.1  nonaka 	sc->sc_rxtap_len = sizeof(sc->sc_rxtapu);
    655      1.1  nonaka 	sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len);
    656      1.1  nonaka 	sc->sc_rxtap.wr_ihdr.it_present = htole32(RUN_RX_RADIOTAP_PRESENT);
    657      1.1  nonaka 
    658      1.1  nonaka 	sc->sc_txtap_len = sizeof(sc->sc_txtapu);
    659      1.1  nonaka 	sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len);
    660      1.1  nonaka 	sc->sc_txtap.wt_ihdr.it_present = htole32(RUN_TX_RADIOTAP_PRESENT);
    661      1.1  nonaka 
    662      1.1  nonaka 	ieee80211_announce(ic);
    663      1.1  nonaka 
    664      1.1  nonaka 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, sc->sc_dev);
    665      1.1  nonaka }
    666      1.1  nonaka 
    667      1.1  nonaka static int
    668      1.1  nonaka run_detach(device_t self, int flags)
    669      1.1  nonaka {
    670      1.1  nonaka 	struct run_softc *sc = device_private(self);
    671      1.1  nonaka 	struct ifnet *ifp = &sc->sc_if;
    672      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
    673      1.1  nonaka 	int s;
    674      1.1  nonaka 
    675      1.1  nonaka 	if (ifp->if_softc == NULL)
    676      1.1  nonaka 		return (0);
    677      1.1  nonaka 
    678      1.1  nonaka 	s = splnet();
    679      1.1  nonaka 
    680      1.1  nonaka 	sc->sc_flags |= RUN_DETACHING;
    681      1.1  nonaka 
    682      1.1  nonaka 	if (ifp->if_flags & IFF_RUNNING) {
    683      1.1  nonaka 		usb_rem_task(sc->sc_udev, &sc->sc_task);
    684      1.1  nonaka 		run_stop(ifp, 0);
    685      1.1  nonaka 	}
    686      1.1  nonaka 
    687      1.1  nonaka 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
    688      1.1  nonaka 	bpf_detach(ifp);
    689      1.1  nonaka 	ieee80211_ifdetach(ic);
    690      1.1  nonaka 	if_detach(ifp);
    691      1.1  nonaka 
    692      1.1  nonaka 	splx(s);
    693      1.1  nonaka 
    694      1.1  nonaka 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev);
    695      1.1  nonaka 
    696      1.1  nonaka 	callout_destroy(&sc->scan_to);
    697      1.1  nonaka 	callout_destroy(&sc->calib_to);
    698      1.1  nonaka 
    699      1.1  nonaka 	return (0);
    700      1.1  nonaka }
    701      1.1  nonaka 
    702      1.1  nonaka static int
    703      1.1  nonaka run_activate(device_t self, enum devact act)
    704      1.1  nonaka {
    705      1.1  nonaka 	struct run_softc *sc = device_private(self);
    706      1.1  nonaka 
    707      1.1  nonaka 	switch (act) {
    708      1.1  nonaka 	case DVACT_DEACTIVATE:
    709      1.1  nonaka 		if_deactivate(sc->sc_ic.ic_ifp);
    710      1.1  nonaka 		return (0);
    711      1.1  nonaka 	default:
    712      1.1  nonaka 		return (EOPNOTSUPP);
    713      1.1  nonaka 	}
    714      1.1  nonaka }
    715      1.1  nonaka 
    716      1.1  nonaka static int
    717      1.1  nonaka run_alloc_rx_ring(struct run_softc *sc)
    718      1.1  nonaka {
    719      1.1  nonaka 	struct run_rx_ring *rxq = &sc->rxq;
    720      1.1  nonaka 	int i, error;
    721      1.1  nonaka 
    722      1.1  nonaka 	error = usbd_open_pipe(sc->sc_iface, rxq->pipe_no, 0, &rxq->pipeh);
    723      1.1  nonaka 	if (error != 0)
    724      1.1  nonaka 		goto fail;
    725      1.1  nonaka 
    726      1.1  nonaka 	for (i = 0; i < RUN_RX_RING_COUNT; i++) {
    727      1.1  nonaka 		struct run_rx_data *data = &rxq->data[i];
    728      1.1  nonaka 
    729      1.1  nonaka 		data->sc = sc;	/* backpointer for callbacks */
    730      1.1  nonaka 
    731      1.1  nonaka 		data->xfer = usbd_alloc_xfer(sc->sc_udev);
    732      1.1  nonaka 		if (data->xfer == NULL) {
    733      1.1  nonaka 			error = ENOMEM;
    734      1.1  nonaka 			goto fail;
    735      1.1  nonaka 		}
    736      1.1  nonaka 		data->buf = usbd_alloc_buffer(data->xfer, RUN_MAX_RXSZ);
    737      1.1  nonaka 		if (data->buf == NULL) {
    738      1.1  nonaka 			error = ENOMEM;
    739      1.1  nonaka 			goto fail;
    740      1.1  nonaka 		}
    741      1.1  nonaka 	}
    742      1.1  nonaka 	if (error != 0)
    743      1.1  nonaka fail:		run_free_rx_ring(sc);
    744      1.1  nonaka 	return (error);
    745      1.1  nonaka }
    746      1.1  nonaka 
    747      1.1  nonaka static void
    748      1.1  nonaka run_free_rx_ring(struct run_softc *sc)
    749      1.1  nonaka {
    750      1.1  nonaka 	struct run_rx_ring *rxq = &sc->rxq;
    751      1.1  nonaka 	int i;
    752      1.1  nonaka 
    753      1.1  nonaka 	if (rxq->pipeh != NULL) {
    754      1.1  nonaka 		usbd_abort_pipe(rxq->pipeh);
    755      1.1  nonaka 		usbd_close_pipe(rxq->pipeh);
    756      1.1  nonaka 		rxq->pipeh = NULL;
    757      1.1  nonaka 	}
    758      1.1  nonaka 	for (i = 0; i < RUN_RX_RING_COUNT; i++) {
    759      1.1  nonaka 		if (rxq->data[i].xfer != NULL)
    760      1.1  nonaka 			usbd_free_xfer(rxq->data[i].xfer);
    761      1.1  nonaka 		rxq->data[i].xfer = NULL;
    762      1.1  nonaka 	}
    763      1.1  nonaka }
    764      1.1  nonaka 
    765      1.1  nonaka static int
    766      1.1  nonaka run_alloc_tx_ring(struct run_softc *sc, int qid)
    767      1.1  nonaka {
    768      1.1  nonaka 	struct run_tx_ring *txq = &sc->txq[qid];
    769      1.1  nonaka 	int i, error;
    770      1.1  nonaka 
    771      1.1  nonaka 	txq->cur = txq->queued = 0;
    772      1.1  nonaka 
    773      1.1  nonaka 	error = usbd_open_pipe(sc->sc_iface, txq->pipe_no, 0, &txq->pipeh);
    774      1.1  nonaka 	if (error != 0)
    775      1.1  nonaka 		goto fail;
    776      1.1  nonaka 
    777      1.1  nonaka 	for (i = 0; i < RUN_TX_RING_COUNT; i++) {
    778      1.1  nonaka 		struct run_tx_data *data = &txq->data[i];
    779      1.1  nonaka 
    780      1.1  nonaka 		data->sc = sc;	/* backpointer for callbacks */
    781      1.1  nonaka 		data->qid = qid;
    782      1.1  nonaka 
    783      1.1  nonaka 		data->xfer = usbd_alloc_xfer(sc->sc_udev);
    784      1.1  nonaka 		if (data->xfer == NULL) {
    785      1.1  nonaka 			error = ENOMEM;
    786      1.1  nonaka 			goto fail;
    787      1.1  nonaka 		}
    788      1.1  nonaka 		data->buf = usbd_alloc_buffer(data->xfer, RUN_MAX_TXSZ);
    789      1.1  nonaka 		if (data->buf == NULL) {
    790      1.1  nonaka 			error = ENOMEM;
    791      1.1  nonaka 			goto fail;
    792      1.1  nonaka 		}
    793      1.1  nonaka 		/* zeroize the TXD + TXWI part */
    794      1.1  nonaka 		memset(data->buf, 0, sizeof (struct rt2870_txd) +
    795      1.1  nonaka 		    sizeof (struct rt2860_txwi));
    796      1.1  nonaka 	}
    797      1.1  nonaka 	if (error != 0)
    798      1.1  nonaka fail:		run_free_tx_ring(sc, qid);
    799      1.1  nonaka 	return (error);
    800      1.1  nonaka }
    801      1.1  nonaka 
    802      1.1  nonaka static void
    803      1.1  nonaka run_free_tx_ring(struct run_softc *sc, int qid)
    804      1.1  nonaka {
    805      1.1  nonaka 	struct run_tx_ring *txq = &sc->txq[qid];
    806      1.1  nonaka 	int i;
    807      1.1  nonaka 
    808      1.1  nonaka 	if (txq->pipeh != NULL) {
    809      1.1  nonaka 		usbd_abort_pipe(txq->pipeh);
    810      1.1  nonaka 		usbd_close_pipe(txq->pipeh);
    811      1.1  nonaka 		txq->pipeh = NULL;
    812      1.1  nonaka 	}
    813      1.1  nonaka 	for (i = 0; i < RUN_TX_RING_COUNT; i++) {
    814      1.1  nonaka 		if (txq->data[i].xfer != NULL)
    815      1.1  nonaka 			usbd_free_xfer(txq->data[i].xfer);
    816      1.1  nonaka 		txq->data[i].xfer = NULL;
    817      1.1  nonaka 	}
    818      1.1  nonaka }
    819      1.1  nonaka 
    820      1.1  nonaka static int
    821      1.1  nonaka run_load_microcode(struct run_softc *sc)
    822      1.1  nonaka {
    823      1.1  nonaka 	usb_device_request_t req;
    824      1.1  nonaka 	const char *fwname;
    825  1.4.2.3     tls 	u_char *ucode = NULL;	/* XXX gcc 4.8.3: maybe-uninitialized */
    826  1.4.2.3     tls 	size_t size = 0;	/* XXX gcc 4.8.3: maybe-uninitialized */
    827      1.1  nonaka 	uint32_t tmp;
    828      1.1  nonaka 	int ntries, error;
    829      1.1  nonaka 
    830      1.1  nonaka 	/* RT3071/RT3072 use a different firmware */
    831      1.1  nonaka 	if (sc->mac_ver != 0x2860 &&
    832      1.1  nonaka 	    sc->mac_ver != 0x2872 &&
    833      1.1  nonaka 	    sc->mac_ver != 0x3070)
    834      1.1  nonaka 		fwname = "run-rt3071";
    835      1.1  nonaka 	else
    836      1.1  nonaka 		fwname = "run-rt2870";
    837      1.1  nonaka 
    838      1.3  nonaka 	if ((error = firmware_load("run", fwname, &ucode, &size)) != 0) {
    839      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
    840      1.1  nonaka 		    "error %d, could not read firmware %s\n", error, fwname);
    841      1.1  nonaka 		return (error);
    842      1.1  nonaka 	}
    843      1.1  nonaka 	if (size != 4096) {
    844      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
    845      1.1  nonaka 		    "invalid firmware size (should be 4KB)\n");
    846      1.1  nonaka 		firmware_free(ucode, size);
    847      1.1  nonaka 		return (EINVAL);
    848      1.1  nonaka 	}
    849      1.1  nonaka 
    850      1.1  nonaka 	run_read(sc, RT2860_ASIC_VER_ID, &tmp);
    851      1.1  nonaka 	/* write microcode image */
    852      1.1  nonaka 	run_write_region_1(sc, RT2870_FW_BASE, ucode, size);
    853      1.1  nonaka 	firmware_free(ucode, size);
    854      1.1  nonaka 	run_write(sc, RT2860_H2M_MAILBOX_CID, 0xffffffff);
    855      1.1  nonaka 	run_write(sc, RT2860_H2M_MAILBOX_STATUS, 0xffffffff);
    856      1.1  nonaka 
    857      1.1  nonaka 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    858      1.1  nonaka 	req.bRequest = RT2870_RESET;
    859      1.1  nonaka 	USETW(req.wValue, 8);
    860      1.1  nonaka 	USETW(req.wIndex, 0);
    861      1.1  nonaka 	USETW(req.wLength, 0);
    862      1.1  nonaka 	if ((error = usbd_do_request(sc->sc_udev, &req, NULL)) != 0)
    863      1.1  nonaka 		return (error);
    864      1.1  nonaka 
    865      1.1  nonaka 	usbd_delay_ms(sc->sc_udev, 10);
    866      1.1  nonaka 	run_write(sc, RT2860_H2M_MAILBOX, 0);
    867      1.1  nonaka 	if ((error = run_mcu_cmd(sc, RT2860_MCU_CMD_RFRESET, 0)) != 0)
    868      1.1  nonaka 		return (error);
    869      1.1  nonaka 
    870      1.1  nonaka 	/* wait until microcontroller is ready */
    871      1.1  nonaka 	for (ntries = 0; ntries < 1000; ntries++) {
    872      1.1  nonaka 		if ((error = run_read(sc, RT2860_SYS_CTRL, &tmp)) != 0)
    873      1.1  nonaka 			return (error);
    874      1.1  nonaka 		if (tmp & RT2860_MCU_READY)
    875      1.1  nonaka 			break;
    876      1.1  nonaka 		DELAY(1000);
    877      1.1  nonaka 	}
    878      1.1  nonaka 	if (ntries == 1000) {
    879      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
    880      1.1  nonaka 		    "timeout waiting for MCU to initialize\n");
    881      1.1  nonaka 		return (ETIMEDOUT);
    882      1.1  nonaka 	}
    883      1.1  nonaka 
    884      1.1  nonaka 	sc->sc_flags |= RUN_FWLOADED;
    885      1.1  nonaka 
    886      1.1  nonaka 	DPRINTF(("microcode successfully loaded after %d tries\n", ntries));
    887      1.1  nonaka 	return (0);
    888      1.1  nonaka }
    889      1.1  nonaka 
    890      1.1  nonaka static int
    891      1.1  nonaka run_reset(struct run_softc *sc)
    892      1.1  nonaka {
    893      1.1  nonaka 	usb_device_request_t req;
    894      1.1  nonaka 
    895      1.1  nonaka 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    896      1.1  nonaka 	req.bRequest = RT2870_RESET;
    897      1.1  nonaka 	USETW(req.wValue, 1);
    898      1.1  nonaka 	USETW(req.wIndex, 0);
    899      1.1  nonaka 	USETW(req.wLength, 0);
    900      1.1  nonaka 	return usbd_do_request(sc->sc_udev, &req, NULL);
    901      1.1  nonaka }
    902      1.1  nonaka 
    903      1.1  nonaka static int
    904      1.1  nonaka run_read(struct run_softc *sc, uint16_t reg, uint32_t *val)
    905      1.1  nonaka {
    906      1.1  nonaka 	uint32_t tmp;
    907      1.1  nonaka 	int error;
    908      1.1  nonaka 
    909      1.1  nonaka 	error = run_read_region_1(sc, reg, (uint8_t *)&tmp, sizeof tmp);
    910      1.1  nonaka 	if (error == 0)
    911      1.1  nonaka 		*val = le32toh(tmp);
    912      1.1  nonaka 	else
    913      1.1  nonaka 		*val = 0xffffffff;
    914      1.1  nonaka 	return (error);
    915      1.1  nonaka }
    916      1.1  nonaka 
    917      1.1  nonaka static int
    918      1.1  nonaka run_read_region_1(struct run_softc *sc, uint16_t reg, uint8_t *buf, int len)
    919      1.1  nonaka {
    920      1.1  nonaka 	usb_device_request_t req;
    921      1.1  nonaka 
    922      1.1  nonaka 	req.bmRequestType = UT_READ_VENDOR_DEVICE;
    923      1.1  nonaka 	req.bRequest = RT2870_READ_REGION_1;
    924      1.1  nonaka 	USETW(req.wValue, 0);
    925      1.1  nonaka 	USETW(req.wIndex, reg);
    926      1.1  nonaka 	USETW(req.wLength, len);
    927      1.1  nonaka 	return usbd_do_request(sc->sc_udev, &req, buf);
    928      1.1  nonaka }
    929      1.1  nonaka 
    930      1.1  nonaka static int
    931      1.1  nonaka run_write_2(struct run_softc *sc, uint16_t reg, uint16_t val)
    932      1.1  nonaka {
    933      1.1  nonaka 	usb_device_request_t req;
    934      1.1  nonaka 
    935      1.1  nonaka 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    936      1.1  nonaka 	req.bRequest = RT2870_WRITE_2;
    937      1.1  nonaka 	USETW(req.wValue, val);
    938      1.1  nonaka 	USETW(req.wIndex, reg);
    939      1.1  nonaka 	USETW(req.wLength, 0);
    940      1.1  nonaka 	return usbd_do_request(sc->sc_udev, &req, NULL);
    941      1.1  nonaka }
    942      1.1  nonaka 
    943      1.1  nonaka static int
    944      1.1  nonaka run_write(struct run_softc *sc, uint16_t reg, uint32_t val)
    945      1.1  nonaka {
    946      1.1  nonaka 	int error;
    947      1.1  nonaka 
    948      1.1  nonaka 	if ((error = run_write_2(sc, reg, val & 0xffff)) == 0)
    949      1.1  nonaka 		error = run_write_2(sc, reg + 2, val >> 16);
    950      1.1  nonaka 	return (error);
    951      1.1  nonaka }
    952      1.1  nonaka 
    953      1.1  nonaka static int
    954      1.1  nonaka run_write_region_1(struct run_softc *sc, uint16_t reg, const uint8_t *buf,
    955      1.1  nonaka     int len)
    956      1.1  nonaka {
    957      1.1  nonaka #if 1
    958      1.1  nonaka 	int i, error = 0;
    959      1.1  nonaka 	/*
    960      1.1  nonaka 	 * NB: the WRITE_REGION_1 command is not stable on RT2860.
    961      1.1  nonaka 	 * We thus issue multiple WRITE_2 commands instead.
    962      1.1  nonaka 	 */
    963      1.1  nonaka 	KASSERT((len & 1) == 0);
    964      1.1  nonaka 	for (i = 0; i < len && error == 0; i += 2)
    965      1.1  nonaka 		error = run_write_2(sc, reg + i, buf[i] | buf[i + 1] << 8);
    966      1.1  nonaka 	return (error);
    967      1.1  nonaka #else
    968      1.1  nonaka 	usb_device_request_t req;
    969      1.1  nonaka 
    970      1.1  nonaka 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    971      1.1  nonaka 	req.bRequest = RT2870_WRITE_REGION_1;
    972      1.1  nonaka 	USETW(req.wValue, 0);
    973      1.1  nonaka 	USETW(req.wIndex, reg);
    974      1.1  nonaka 	USETW(req.wLength, len);
    975      1.1  nonaka 	return usbd_do_request(sc->sc_udev, &req, buf);
    976      1.1  nonaka #endif
    977      1.1  nonaka }
    978      1.1  nonaka 
    979      1.1  nonaka static int
    980      1.1  nonaka run_set_region_4(struct run_softc *sc, uint16_t reg, uint32_t val, int count)
    981      1.1  nonaka {
    982      1.1  nonaka 	int error = 0;
    983      1.1  nonaka 
    984      1.1  nonaka 	for (; count > 0 && error == 0; count--, reg += 4)
    985      1.1  nonaka 		error = run_write(sc, reg, val);
    986      1.1  nonaka 	return (error);
    987      1.1  nonaka }
    988      1.1  nonaka 
    989      1.1  nonaka /* Read 16-bit from eFUSE ROM (RT3070 only.) */
    990      1.1  nonaka static int
    991      1.1  nonaka run_efuse_read_2(struct run_softc *sc, uint16_t addr, uint16_t *val)
    992      1.1  nonaka {
    993      1.1  nonaka 	uint32_t tmp;
    994      1.1  nonaka 	uint16_t reg;
    995      1.1  nonaka 	int error, ntries;
    996      1.1  nonaka 
    997      1.1  nonaka 	if ((error = run_read(sc, RT3070_EFUSE_CTRL, &tmp)) != 0)
    998      1.1  nonaka 		return (error);
    999      1.1  nonaka 
   1000      1.1  nonaka 	addr *= 2;
   1001      1.1  nonaka 	/*-
   1002      1.1  nonaka 	 * Read one 16-byte block into registers EFUSE_DATA[0-3]:
   1003      1.1  nonaka 	 * DATA0: F E D C
   1004      1.1  nonaka 	 * DATA1: B A 9 8
   1005      1.1  nonaka 	 * DATA2: 7 6 5 4
   1006      1.1  nonaka 	 * DATA3: 3 2 1 0
   1007      1.1  nonaka 	 */
   1008      1.1  nonaka 	tmp &= ~(RT3070_EFSROM_MODE_MASK | RT3070_EFSROM_AIN_MASK);
   1009      1.1  nonaka 	tmp |= (addr & ~0xf) << RT3070_EFSROM_AIN_SHIFT | RT3070_EFSROM_KICK;
   1010      1.1  nonaka 	run_write(sc, RT3070_EFUSE_CTRL, tmp);
   1011      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   1012      1.1  nonaka 		if ((error = run_read(sc, RT3070_EFUSE_CTRL, &tmp)) != 0)
   1013      1.1  nonaka 			return (error);
   1014      1.1  nonaka 		if (!(tmp & RT3070_EFSROM_KICK))
   1015      1.1  nonaka 			break;
   1016      1.1  nonaka 		DELAY(2);
   1017      1.1  nonaka 	}
   1018      1.1  nonaka 	if (ntries == 100)
   1019      1.1  nonaka 		return (ETIMEDOUT);
   1020      1.1  nonaka 
   1021      1.1  nonaka 	if ((tmp & RT3070_EFUSE_AOUT_MASK) == RT3070_EFUSE_AOUT_MASK) {
   1022      1.1  nonaka 		*val = 0xffff;	/* address not found */
   1023      1.1  nonaka 		return (0);
   1024      1.1  nonaka 	}
   1025      1.1  nonaka 	/* determine to which 32-bit register our 16-bit word belongs */
   1026      1.1  nonaka 	reg = RT3070_EFUSE_DATA3 - (addr & 0xc);
   1027      1.1  nonaka 	if ((error = run_read(sc, reg, &tmp)) != 0)
   1028      1.1  nonaka 		return (error);
   1029      1.1  nonaka 
   1030      1.1  nonaka 	*val = (addr & 2) ? tmp >> 16 : tmp & 0xffff;
   1031      1.1  nonaka 	return (0);
   1032      1.1  nonaka }
   1033      1.1  nonaka 
   1034      1.1  nonaka static int
   1035      1.1  nonaka run_eeprom_read_2(struct run_softc *sc, uint16_t addr, uint16_t *val)
   1036      1.1  nonaka {
   1037      1.1  nonaka 	usb_device_request_t req;
   1038      1.1  nonaka 	uint16_t tmp;
   1039      1.1  nonaka 	int error;
   1040      1.1  nonaka 
   1041      1.1  nonaka 	addr *= 2;
   1042      1.1  nonaka 	req.bmRequestType = UT_READ_VENDOR_DEVICE;
   1043      1.1  nonaka 	req.bRequest = RT2870_EEPROM_READ;
   1044      1.1  nonaka 	USETW(req.wValue, 0);
   1045      1.1  nonaka 	USETW(req.wIndex, addr);
   1046      1.1  nonaka 	USETW(req.wLength, sizeof tmp);
   1047      1.1  nonaka 	error = usbd_do_request(sc->sc_udev, &req, &tmp);
   1048      1.1  nonaka 	if (error == 0)
   1049      1.1  nonaka 		*val = le16toh(tmp);
   1050      1.1  nonaka 	else
   1051      1.1  nonaka 		*val = 0xffff;
   1052      1.1  nonaka 	return (error);
   1053      1.1  nonaka }
   1054      1.1  nonaka 
   1055      1.1  nonaka static __inline int
   1056      1.1  nonaka run_srom_read(struct run_softc *sc, uint16_t addr, uint16_t *val)
   1057      1.1  nonaka {
   1058      1.1  nonaka 
   1059      1.1  nonaka 	/* either eFUSE ROM or EEPROM */
   1060      1.1  nonaka 	return sc->sc_srom_read(sc, addr, val);
   1061      1.1  nonaka }
   1062      1.1  nonaka 
   1063      1.1  nonaka static int
   1064      1.1  nonaka run_rt2870_rf_write(struct run_softc *sc, uint8_t reg, uint32_t val)
   1065      1.1  nonaka {
   1066      1.1  nonaka 	uint32_t tmp;
   1067      1.1  nonaka 	int error, ntries;
   1068      1.1  nonaka 
   1069      1.1  nonaka 	for (ntries = 0; ntries < 10; ntries++) {
   1070      1.1  nonaka 		if ((error = run_read(sc, RT2860_RF_CSR_CFG0, &tmp)) != 0)
   1071      1.1  nonaka 			return (error);
   1072      1.1  nonaka 		if (!(tmp & RT2860_RF_REG_CTRL))
   1073      1.1  nonaka 			break;
   1074      1.1  nonaka 	}
   1075      1.1  nonaka 	if (ntries == 10)
   1076      1.1  nonaka 		return (ETIMEDOUT);
   1077      1.1  nonaka 
   1078      1.1  nonaka 	/* RF registers are 24-bit on the RT2860 */
   1079      1.1  nonaka 	tmp = RT2860_RF_REG_CTRL | 24 << RT2860_RF_REG_WIDTH_SHIFT |
   1080      1.1  nonaka 	    (val & 0x3fffff) << 2 | (reg & 3);
   1081      1.1  nonaka 	return run_write(sc, RT2860_RF_CSR_CFG0, tmp);
   1082      1.1  nonaka }
   1083      1.1  nonaka 
   1084      1.1  nonaka static int
   1085      1.1  nonaka run_rt3070_rf_read(struct run_softc *sc, uint8_t reg, uint8_t *val)
   1086      1.1  nonaka {
   1087      1.1  nonaka 	uint32_t tmp;
   1088      1.1  nonaka 	int error, ntries;
   1089      1.1  nonaka 
   1090      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   1091      1.1  nonaka 		if ((error = run_read(sc, RT3070_RF_CSR_CFG, &tmp)) != 0)
   1092      1.1  nonaka 			return (error);
   1093      1.1  nonaka 		if (!(tmp & RT3070_RF_KICK))
   1094      1.1  nonaka 			break;
   1095      1.1  nonaka 	}
   1096      1.1  nonaka 	if (ntries == 100)
   1097      1.1  nonaka 		return (ETIMEDOUT);
   1098      1.1  nonaka 
   1099      1.1  nonaka 	tmp = RT3070_RF_KICK | reg << 8;
   1100      1.1  nonaka 	if ((error = run_write(sc, RT3070_RF_CSR_CFG, tmp)) != 0)
   1101      1.1  nonaka 		return (error);
   1102      1.1  nonaka 
   1103      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   1104      1.1  nonaka 		if ((error = run_read(sc, RT3070_RF_CSR_CFG, &tmp)) != 0)
   1105      1.1  nonaka 			return (error);
   1106      1.1  nonaka 		if (!(tmp & RT3070_RF_KICK))
   1107      1.1  nonaka 			break;
   1108      1.1  nonaka 	}
   1109      1.1  nonaka 	if (ntries == 100)
   1110      1.1  nonaka 		return (ETIMEDOUT);
   1111      1.1  nonaka 
   1112      1.1  nonaka 	*val = tmp & 0xff;
   1113      1.1  nonaka 	return (0);
   1114      1.1  nonaka }
   1115      1.1  nonaka 
   1116      1.1  nonaka static int
   1117      1.1  nonaka run_rt3070_rf_write(struct run_softc *sc, uint8_t reg, uint8_t val)
   1118      1.1  nonaka {
   1119      1.1  nonaka 	uint32_t tmp;
   1120      1.1  nonaka 	int error, ntries;
   1121      1.1  nonaka 
   1122      1.1  nonaka 	for (ntries = 0; ntries < 10; ntries++) {
   1123      1.1  nonaka 		if ((error = run_read(sc, RT3070_RF_CSR_CFG, &tmp)) != 0)
   1124      1.1  nonaka 			return (error);
   1125      1.1  nonaka 		if (!(tmp & RT3070_RF_KICK))
   1126      1.1  nonaka 			break;
   1127      1.1  nonaka 	}
   1128      1.1  nonaka 	if (ntries == 10)
   1129      1.1  nonaka 		return (ETIMEDOUT);
   1130      1.1  nonaka 
   1131      1.1  nonaka 	tmp = RT3070_RF_WRITE | RT3070_RF_KICK | reg << 8 | val;
   1132      1.1  nonaka 	return run_write(sc, RT3070_RF_CSR_CFG, tmp);
   1133      1.1  nonaka }
   1134      1.1  nonaka 
   1135      1.1  nonaka static int
   1136      1.1  nonaka run_bbp_read(struct run_softc *sc, uint8_t reg, uint8_t *val)
   1137      1.1  nonaka {
   1138      1.1  nonaka 	uint32_t tmp;
   1139      1.1  nonaka 	int ntries, error;
   1140      1.1  nonaka 
   1141      1.1  nonaka 	for (ntries = 0; ntries < 10; ntries++) {
   1142      1.1  nonaka 		if ((error = run_read(sc, RT2860_BBP_CSR_CFG, &tmp)) != 0)
   1143      1.1  nonaka 			return (error);
   1144      1.1  nonaka 		if (!(tmp & RT2860_BBP_CSR_KICK))
   1145      1.1  nonaka 			break;
   1146      1.1  nonaka 	}
   1147      1.1  nonaka 	if (ntries == 10)
   1148      1.1  nonaka 		return (ETIMEDOUT);
   1149      1.1  nonaka 
   1150      1.1  nonaka 	tmp = RT2860_BBP_CSR_READ | RT2860_BBP_CSR_KICK | reg << 8;
   1151      1.1  nonaka 	if ((error = run_write(sc, RT2860_BBP_CSR_CFG, tmp)) != 0)
   1152      1.1  nonaka 		return (error);
   1153      1.1  nonaka 
   1154      1.1  nonaka 	for (ntries = 0; ntries < 10; ntries++) {
   1155      1.1  nonaka 		if ((error = run_read(sc, RT2860_BBP_CSR_CFG, &tmp)) != 0)
   1156      1.1  nonaka 			return (error);
   1157      1.1  nonaka 		if (!(tmp & RT2860_BBP_CSR_KICK))
   1158      1.1  nonaka 			break;
   1159      1.1  nonaka 	}
   1160      1.1  nonaka 	if (ntries == 10)
   1161      1.1  nonaka 		return (ETIMEDOUT);
   1162      1.1  nonaka 
   1163      1.1  nonaka 	*val = tmp & 0xff;
   1164      1.1  nonaka 	return (0);
   1165      1.1  nonaka }
   1166      1.1  nonaka 
   1167      1.1  nonaka static int
   1168      1.1  nonaka run_bbp_write(struct run_softc *sc, uint8_t reg, uint8_t val)
   1169      1.1  nonaka {
   1170      1.1  nonaka 	uint32_t tmp;
   1171      1.1  nonaka 	int ntries, error;
   1172      1.1  nonaka 
   1173      1.1  nonaka 	for (ntries = 0; ntries < 10; ntries++) {
   1174      1.1  nonaka 		if ((error = run_read(sc, RT2860_BBP_CSR_CFG, &tmp)) != 0)
   1175      1.1  nonaka 			return (error);
   1176      1.1  nonaka 		if (!(tmp & RT2860_BBP_CSR_KICK))
   1177      1.1  nonaka 			break;
   1178      1.1  nonaka 	}
   1179      1.1  nonaka 	if (ntries == 10)
   1180      1.1  nonaka 		return (ETIMEDOUT);
   1181      1.1  nonaka 
   1182      1.1  nonaka 	tmp = RT2860_BBP_CSR_KICK | reg << 8 | val;
   1183      1.1  nonaka 	return run_write(sc, RT2860_BBP_CSR_CFG, tmp);
   1184      1.1  nonaka }
   1185      1.1  nonaka 
   1186      1.1  nonaka /*
   1187      1.1  nonaka  * Send a command to the 8051 microcontroller unit.
   1188      1.1  nonaka  */
   1189      1.1  nonaka static int
   1190      1.1  nonaka run_mcu_cmd(struct run_softc *sc, uint8_t cmd, uint16_t arg)
   1191      1.1  nonaka {
   1192      1.1  nonaka 	uint32_t tmp;
   1193      1.1  nonaka 	int error, ntries;
   1194      1.1  nonaka 
   1195      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   1196      1.1  nonaka 		if ((error = run_read(sc, RT2860_H2M_MAILBOX, &tmp)) != 0)
   1197      1.1  nonaka 			return (error);
   1198      1.1  nonaka 		if (!(tmp & RT2860_H2M_BUSY))
   1199      1.1  nonaka 			break;
   1200      1.1  nonaka 	}
   1201      1.1  nonaka 	if (ntries == 100)
   1202      1.1  nonaka 		return (ETIMEDOUT);
   1203      1.1  nonaka 
   1204      1.1  nonaka 	tmp = RT2860_H2M_BUSY | RT2860_TOKEN_NO_INTR << 16 | arg;
   1205      1.1  nonaka 	if ((error = run_write(sc, RT2860_H2M_MAILBOX, tmp)) == 0)
   1206      1.1  nonaka 		error = run_write(sc, RT2860_HOST_CMD, cmd);
   1207      1.1  nonaka 	return (error);
   1208      1.1  nonaka }
   1209      1.1  nonaka 
   1210      1.1  nonaka /*
   1211      1.1  nonaka  * Add `delta' (signed) to each 4-bit sub-word of a 32-bit word.
   1212      1.1  nonaka  * Used to adjust per-rate Tx power registers.
   1213      1.1  nonaka  */
   1214      1.1  nonaka static __inline uint32_t
   1215      1.1  nonaka b4inc(uint32_t b32, int8_t delta)
   1216      1.1  nonaka {
   1217      1.1  nonaka 	int8_t i, b4;
   1218      1.1  nonaka 
   1219      1.1  nonaka 	for (i = 0; i < 8; i++) {
   1220      1.1  nonaka 		b4 = b32 & 0xf;
   1221      1.1  nonaka 		b4 += delta;
   1222      1.1  nonaka 		if (b4 < 0)
   1223      1.1  nonaka 			b4 = 0;
   1224      1.1  nonaka 		else if (b4 > 0xf)
   1225      1.1  nonaka 			b4 = 0xf;
   1226      1.1  nonaka 		b32 = b32 >> 4 | b4 << 28;
   1227      1.1  nonaka 	}
   1228      1.1  nonaka 	return (b32);
   1229      1.1  nonaka }
   1230      1.1  nonaka 
   1231      1.1  nonaka static const char *
   1232      1.1  nonaka run_get_rf(int rev)
   1233      1.1  nonaka {
   1234      1.1  nonaka 	switch (rev) {
   1235      1.1  nonaka 	case RT2860_RF_2820:	return "RT2820";
   1236      1.1  nonaka 	case RT2860_RF_2850:	return "RT2850";
   1237      1.1  nonaka 	case RT2860_RF_2720:	return "RT2720";
   1238      1.1  nonaka 	case RT2860_RF_2750:	return "RT2750";
   1239      1.1  nonaka 	case RT3070_RF_3020:	return "RT3020";
   1240      1.1  nonaka 	case RT3070_RF_2020:	return "RT2020";
   1241      1.1  nonaka 	case RT3070_RF_3021:	return "RT3021";
   1242      1.1  nonaka 	case RT3070_RF_3022:	return "RT3022";
   1243      1.1  nonaka 	case RT3070_RF_3052:	return "RT3052";
   1244      1.1  nonaka 	}
   1245      1.1  nonaka 	return "unknown";
   1246      1.1  nonaka }
   1247      1.1  nonaka 
   1248      1.1  nonaka static int
   1249      1.1  nonaka run_read_eeprom(struct run_softc *sc)
   1250      1.1  nonaka {
   1251      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   1252      1.1  nonaka 	int8_t delta_2ghz, delta_5ghz;
   1253      1.1  nonaka 	uint32_t tmp;
   1254      1.1  nonaka 	uint16_t val;
   1255      1.1  nonaka 	int ridx, ant, i;
   1256      1.1  nonaka 
   1257      1.1  nonaka 	/* check whether the ROM is eFUSE ROM or EEPROM */
   1258      1.1  nonaka 	sc->sc_srom_read = run_eeprom_read_2;
   1259      1.1  nonaka 	if (sc->mac_ver >= 0x3070) {
   1260      1.1  nonaka 		run_read(sc, RT3070_EFUSE_CTRL, &tmp);
   1261      1.1  nonaka 		DPRINTF(("EFUSE_CTRL=0x%08x\n", tmp));
   1262      1.1  nonaka 		if (tmp & RT3070_SEL_EFUSE)
   1263      1.1  nonaka 			sc->sc_srom_read = run_efuse_read_2;
   1264      1.1  nonaka 	}
   1265      1.1  nonaka 
   1266      1.1  nonaka 	/* read ROM version */
   1267      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_VERSION, &val);
   1268      1.1  nonaka 	DPRINTF(("EEPROM rev=%d, FAE=%d\n", val & 0xff, val >> 8));
   1269      1.1  nonaka 
   1270      1.1  nonaka 	/* read MAC address */
   1271      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_MAC01, &val);
   1272      1.1  nonaka 	ic->ic_myaddr[0] = val & 0xff;
   1273      1.1  nonaka 	ic->ic_myaddr[1] = val >> 8;
   1274      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_MAC23, &val);
   1275      1.1  nonaka 	ic->ic_myaddr[2] = val & 0xff;
   1276      1.1  nonaka 	ic->ic_myaddr[3] = val >> 8;
   1277      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_MAC45, &val);
   1278      1.1  nonaka 	ic->ic_myaddr[4] = val & 0xff;
   1279      1.1  nonaka 	ic->ic_myaddr[5] = val >> 8;
   1280      1.1  nonaka 
   1281      1.1  nonaka 	/* read vendor BBP settings */
   1282      1.1  nonaka 	for (i = 0; i < 10; i++) {
   1283      1.1  nonaka 		run_srom_read(sc, RT2860_EEPROM_BBP_BASE + i, &val);
   1284      1.1  nonaka 		sc->bbp[i].val = val & 0xff;
   1285      1.1  nonaka 		sc->bbp[i].reg = val >> 8;
   1286      1.1  nonaka 		DPRINTF(("BBP%d=0x%02x\n", sc->bbp[i].reg, sc->bbp[i].val));
   1287      1.1  nonaka 	}
   1288      1.1  nonaka 	if (sc->mac_ver >= 0x3071) {
   1289      1.1  nonaka 		/* read vendor RF settings */
   1290      1.1  nonaka 		for (i = 0; i < 10; i++) {
   1291      1.1  nonaka 			run_srom_read(sc, RT3071_EEPROM_RF_BASE + i, &val);
   1292      1.1  nonaka 			sc->rf[i].val = val & 0xff;
   1293      1.1  nonaka 			sc->rf[i].reg = val >> 8;
   1294      1.1  nonaka 			DPRINTF(("RF%d=0x%02x\n", sc->rf[i].reg,
   1295      1.1  nonaka 			    sc->rf[i].val));
   1296      1.1  nonaka 		}
   1297      1.1  nonaka 	}
   1298      1.1  nonaka 
   1299      1.1  nonaka 	/* read RF frequency offset from EEPROM */
   1300      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_FREQ_LEDS, &val);
   1301      1.1  nonaka 	sc->freq = ((val & 0xff) != 0xff) ? val & 0xff : 0;
   1302      1.1  nonaka 	DPRINTF(("EEPROM freq offset %d\n", sc->freq & 0xff));
   1303      1.1  nonaka 
   1304      1.1  nonaka 	if ((val >> 8) != 0xff) {
   1305      1.1  nonaka 		/* read LEDs operating mode */
   1306      1.1  nonaka 		sc->leds = val >> 8;
   1307      1.1  nonaka 		run_srom_read(sc, RT2860_EEPROM_LED1, &sc->led[0]);
   1308      1.1  nonaka 		run_srom_read(sc, RT2860_EEPROM_LED2, &sc->led[1]);
   1309      1.1  nonaka 		run_srom_read(sc, RT2860_EEPROM_LED3, &sc->led[2]);
   1310      1.1  nonaka 	} else {
   1311      1.1  nonaka 		/* broken EEPROM, use default settings */
   1312      1.1  nonaka 		sc->leds = 0x01;
   1313      1.1  nonaka 		sc->led[0] = 0x5555;
   1314      1.1  nonaka 		sc->led[1] = 0x2221;
   1315      1.1  nonaka 		sc->led[2] = 0x5627;	/* differs from RT2860 */
   1316      1.1  nonaka 	}
   1317      1.1  nonaka 	DPRINTF(("EEPROM LED mode=0x%02x, LEDs=0x%04x/0x%04x/0x%04x\n",
   1318      1.1  nonaka 	    sc->leds, sc->led[0], sc->led[1], sc->led[2]));
   1319      1.1  nonaka 
   1320      1.1  nonaka 	/* read RF information */
   1321      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_ANTENNA, &val);
   1322      1.1  nonaka 	if (val == 0xffff) {
   1323      1.1  nonaka 		DPRINTF(("invalid EEPROM antenna info, using default\n"));
   1324      1.1  nonaka 		if (sc->mac_ver == 0x3572) {
   1325      1.1  nonaka 			/* default to RF3052 2T2R */
   1326      1.1  nonaka 			sc->rf_rev = RT3070_RF_3052;
   1327      1.1  nonaka 			sc->ntxchains = 2;
   1328      1.1  nonaka 			sc->nrxchains = 2;
   1329      1.1  nonaka 		} else if (sc->mac_ver >= 0x3070) {
   1330      1.1  nonaka 			/* default to RF3020 1T1R */
   1331      1.1  nonaka 			sc->rf_rev = RT3070_RF_3020;
   1332      1.1  nonaka 			sc->ntxchains = 1;
   1333      1.1  nonaka 			sc->nrxchains = 1;
   1334      1.1  nonaka 		} else {
   1335      1.1  nonaka 			/* default to RF2820 1T2R */
   1336      1.1  nonaka 			sc->rf_rev = RT2860_RF_2820;
   1337      1.1  nonaka 			sc->ntxchains = 1;
   1338      1.1  nonaka 			sc->nrxchains = 2;
   1339      1.1  nonaka 		}
   1340      1.1  nonaka 	} else {
   1341      1.1  nonaka 		sc->rf_rev = (val >> 8) & 0xf;
   1342      1.1  nonaka 		sc->ntxchains = (val >> 4) & 0xf;
   1343      1.1  nonaka 		sc->nrxchains = val & 0xf;
   1344      1.1  nonaka 	}
   1345      1.1  nonaka 	DPRINTF(("EEPROM RF rev=0x%02x chains=%dT%dR\n",
   1346      1.1  nonaka 	    sc->rf_rev, sc->ntxchains, sc->nrxchains));
   1347      1.1  nonaka 
   1348      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_CONFIG, &val);
   1349      1.1  nonaka 	DPRINTF(("EEPROM CFG 0x%04x\n", val));
   1350      1.1  nonaka 	/* check if driver should patch the DAC issue */
   1351      1.1  nonaka 	if ((val >> 8) != 0xff)
   1352      1.1  nonaka 		sc->patch_dac = (val >> 15) & 1;
   1353      1.1  nonaka 	if ((val & 0xff) != 0xff) {
   1354      1.1  nonaka 		sc->ext_5ghz_lna = (val >> 3) & 1;
   1355      1.1  nonaka 		sc->ext_2ghz_lna = (val >> 2) & 1;
   1356      1.1  nonaka 		/* check if RF supports automatic Tx access gain control */
   1357      1.1  nonaka 		sc->calib_2ghz = sc->calib_5ghz = (val >> 1) & 1;
   1358      1.1  nonaka 		/* check if we have a hardware radio switch */
   1359      1.1  nonaka 		sc->rfswitch = val & 1;
   1360      1.1  nonaka 	}
   1361      1.1  nonaka 
   1362      1.1  nonaka 	/* read power settings for 2GHz channels */
   1363      1.1  nonaka 	for (i = 0; i < 14; i += 2) {
   1364      1.1  nonaka 		run_srom_read(sc, RT2860_EEPROM_PWR2GHZ_BASE1 + i / 2, &val);
   1365      1.1  nonaka 		sc->txpow1[i + 0] = (int8_t)(val & 0xff);
   1366      1.1  nonaka 		sc->txpow1[i + 1] = (int8_t)(val >> 8);
   1367      1.1  nonaka 
   1368      1.1  nonaka 		run_srom_read(sc, RT2860_EEPROM_PWR2GHZ_BASE2 + i / 2, &val);
   1369      1.1  nonaka 		sc->txpow2[i + 0] = (int8_t)(val & 0xff);
   1370      1.1  nonaka 		sc->txpow2[i + 1] = (int8_t)(val >> 8);
   1371      1.1  nonaka 	}
   1372      1.1  nonaka 	/* fix broken Tx power entries */
   1373      1.1  nonaka 	for (i = 0; i < 14; i++) {
   1374      1.1  nonaka 		if (sc->txpow1[i] < 0 || sc->txpow1[i] > 31)
   1375      1.1  nonaka 			sc->txpow1[i] = 5;
   1376      1.1  nonaka 		if (sc->txpow2[i] < 0 || sc->txpow2[i] > 31)
   1377      1.1  nonaka 			sc->txpow2[i] = 5;
   1378      1.1  nonaka 		DPRINTF(("chan %d: power1=%d, power2=%d\n",
   1379      1.1  nonaka 		    rt2860_rf2850[i].chan, sc->txpow1[i], sc->txpow2[i]));
   1380      1.1  nonaka 	}
   1381      1.1  nonaka 	/* read power settings for 5GHz channels */
   1382      1.1  nonaka 	for (i = 0; i < 40; i += 2) {
   1383      1.1  nonaka 		run_srom_read(sc, RT2860_EEPROM_PWR5GHZ_BASE1 + i / 2, &val);
   1384      1.1  nonaka 		sc->txpow1[i + 14] = (int8_t)(val & 0xff);
   1385      1.1  nonaka 		sc->txpow1[i + 15] = (int8_t)(val >> 8);
   1386      1.1  nonaka 
   1387      1.1  nonaka 		run_srom_read(sc, RT2860_EEPROM_PWR5GHZ_BASE2 + i / 2, &val);
   1388      1.1  nonaka 		sc->txpow2[i + 14] = (int8_t)(val & 0xff);
   1389      1.1  nonaka 		sc->txpow2[i + 15] = (int8_t)(val >> 8);
   1390      1.1  nonaka 	}
   1391      1.1  nonaka 	/* fix broken Tx power entries */
   1392      1.1  nonaka 	for (i = 0; i < 40; i++) {
   1393      1.1  nonaka 		if (sc->txpow1[14 + i] < -7 || sc->txpow1[14 + i] > 15)
   1394      1.1  nonaka 			sc->txpow1[14 + i] = 5;
   1395      1.1  nonaka 		if (sc->txpow2[14 + i] < -7 || sc->txpow2[14 + i] > 15)
   1396      1.1  nonaka 			sc->txpow2[14 + i] = 5;
   1397      1.1  nonaka 		DPRINTF(("chan %d: power1=%d, power2=%d\n",
   1398      1.1  nonaka 		    rt2860_rf2850[14 + i].chan, sc->txpow1[14 + i],
   1399      1.1  nonaka 		    sc->txpow2[14 + i]));
   1400      1.1  nonaka 	}
   1401      1.1  nonaka 
   1402      1.1  nonaka 	/* read Tx power compensation for each Tx rate */
   1403      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_DELTAPWR, &val);
   1404      1.1  nonaka 	delta_2ghz = delta_5ghz = 0;
   1405      1.1  nonaka 	if ((val & 0xff) != 0xff && (val & 0x80)) {
   1406      1.1  nonaka 		delta_2ghz = val & 0xf;
   1407      1.1  nonaka 		if (!(val & 0x40))	/* negative number */
   1408      1.1  nonaka 			delta_2ghz = -delta_2ghz;
   1409      1.1  nonaka 	}
   1410      1.1  nonaka 	val >>= 8;
   1411      1.1  nonaka 	if ((val & 0xff) != 0xff && (val & 0x80)) {
   1412      1.1  nonaka 		delta_5ghz = val & 0xf;
   1413      1.1  nonaka 		if (!(val & 0x40))	/* negative number */
   1414      1.1  nonaka 			delta_5ghz = -delta_5ghz;
   1415      1.1  nonaka 	}
   1416      1.1  nonaka 	DPRINTF(("power compensation=%d (2GHz), %d (5GHz)\n",
   1417      1.1  nonaka 	    delta_2ghz, delta_5ghz));
   1418      1.1  nonaka 
   1419      1.1  nonaka 	for (ridx = 0; ridx < 5; ridx++) {
   1420      1.1  nonaka 		uint32_t reg;
   1421      1.1  nonaka 
   1422      1.1  nonaka 		run_srom_read(sc, RT2860_EEPROM_RPWR + ridx * 2, &val);
   1423      1.1  nonaka 		reg = val;
   1424      1.1  nonaka 		run_srom_read(sc, RT2860_EEPROM_RPWR + ridx * 2 + 1, &val);
   1425      1.1  nonaka 		reg |= (uint32_t)val << 16;
   1426      1.1  nonaka 
   1427      1.1  nonaka 		sc->txpow20mhz[ridx] = reg;
   1428      1.1  nonaka 		sc->txpow40mhz_2ghz[ridx] = b4inc(reg, delta_2ghz);
   1429      1.1  nonaka 		sc->txpow40mhz_5ghz[ridx] = b4inc(reg, delta_5ghz);
   1430      1.1  nonaka 
   1431      1.1  nonaka 		DPRINTF(("ridx %d: power 20MHz=0x%08x, 40MHz/2GHz=0x%08x, "
   1432      1.1  nonaka 		    "40MHz/5GHz=0x%08x\n", ridx, sc->txpow20mhz[ridx],
   1433      1.1  nonaka 		    sc->txpow40mhz_2ghz[ridx], sc->txpow40mhz_5ghz[ridx]));
   1434      1.1  nonaka 	}
   1435      1.1  nonaka 
   1436      1.1  nonaka 	/* read RSSI offsets and LNA gains from EEPROM */
   1437      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_RSSI1_2GHZ, &val);
   1438      1.1  nonaka 	sc->rssi_2ghz[0] = val & 0xff;	/* Ant A */
   1439      1.1  nonaka 	sc->rssi_2ghz[1] = val >> 8;	/* Ant B */
   1440      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_RSSI2_2GHZ, &val);
   1441      1.1  nonaka 	if (sc->mac_ver >= 0x3070) {
   1442      1.1  nonaka 		/*
   1443      1.1  nonaka 		 * On RT3070 chips (limited to 2 Rx chains), this ROM
   1444      1.1  nonaka 		 * field contains the Tx mixer gain for the 2GHz band.
   1445      1.1  nonaka 		 */
   1446      1.1  nonaka 		if ((val & 0xff) != 0xff)
   1447      1.1  nonaka 			sc->txmixgain_2ghz = val & 0x7;
   1448      1.1  nonaka 		DPRINTF(("tx mixer gain=%u (2GHz)\n", sc->txmixgain_2ghz));
   1449      1.1  nonaka 	} else {
   1450      1.1  nonaka 		sc->rssi_2ghz[2] = val & 0xff;	/* Ant C */
   1451      1.1  nonaka 	}
   1452      1.1  nonaka 	sc->lna[2] = val >> 8;		/* channel group 2 */
   1453      1.1  nonaka 
   1454      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_RSSI1_5GHZ, &val);
   1455      1.1  nonaka 	sc->rssi_5ghz[0] = val & 0xff;	/* Ant A */
   1456      1.1  nonaka 	sc->rssi_5ghz[1] = val >> 8;	/* Ant B */
   1457      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_RSSI2_5GHZ, &val);
   1458      1.1  nonaka 	if (sc->mac_ver == 0x3572) {
   1459      1.1  nonaka 		/*
   1460      1.1  nonaka 		 * On RT3572 chips (limited to 2 Rx chains), this ROM
   1461      1.1  nonaka 		 * field contains the Tx mixer gain for the 5GHz band.
   1462      1.1  nonaka 		 */
   1463      1.1  nonaka 		if ((val & 0xff) != 0xff)
   1464      1.1  nonaka 			sc->txmixgain_5ghz = val & 0x7;
   1465      1.1  nonaka 		DPRINTF(("tx mixer gain=%u (5GHz)\n", sc->txmixgain_5ghz));
   1466      1.1  nonaka 	} else {
   1467      1.1  nonaka 		sc->rssi_5ghz[2] = val & 0xff;	/* Ant C */
   1468      1.1  nonaka 	}
   1469      1.1  nonaka 	sc->lna[3] = val >> 8;		/* channel group 3 */
   1470      1.1  nonaka 
   1471      1.1  nonaka 	run_srom_read(sc, RT2860_EEPROM_LNA, &val);
   1472      1.1  nonaka 	sc->lna[0] = val & 0xff;	/* channel group 0 */
   1473      1.1  nonaka 	sc->lna[1] = val >> 8;		/* channel group 1 */
   1474      1.1  nonaka 
   1475      1.1  nonaka 	/* fix broken 5GHz LNA entries */
   1476      1.1  nonaka 	if (sc->lna[2] == 0 || sc->lna[2] == 0xff) {
   1477      1.1  nonaka 		DPRINTF(("invalid LNA for channel group %d\n", 2));
   1478      1.1  nonaka 		sc->lna[2] = sc->lna[1];
   1479      1.1  nonaka 	}
   1480      1.1  nonaka 	if (sc->lna[3] == 0 || sc->lna[3] == 0xff) {
   1481      1.1  nonaka 		DPRINTF(("invalid LNA for channel group %d\n", 3));
   1482      1.1  nonaka 		sc->lna[3] = sc->lna[1];
   1483      1.1  nonaka 	}
   1484      1.1  nonaka 
   1485      1.1  nonaka 	/* fix broken RSSI offset entries */
   1486      1.1  nonaka 	for (ant = 0; ant < 3; ant++) {
   1487      1.1  nonaka 		if (sc->rssi_2ghz[ant] < -10 || sc->rssi_2ghz[ant] > 10) {
   1488      1.1  nonaka 			DPRINTF(("invalid RSSI%d offset: %d (2GHz)\n",
   1489      1.1  nonaka 			    ant + 1, sc->rssi_2ghz[ant]));
   1490      1.1  nonaka 			sc->rssi_2ghz[ant] = 0;
   1491      1.1  nonaka 		}
   1492      1.1  nonaka 		if (sc->rssi_5ghz[ant] < -10 || sc->rssi_5ghz[ant] > 10) {
   1493      1.1  nonaka 			DPRINTF(("invalid RSSI%d offset: %d (5GHz)\n",
   1494      1.1  nonaka 			    ant + 1, sc->rssi_5ghz[ant]));
   1495      1.1  nonaka 			sc->rssi_5ghz[ant] = 0;
   1496      1.1  nonaka 		}
   1497      1.1  nonaka 	}
   1498      1.1  nonaka 	return (0);
   1499      1.1  nonaka }
   1500      1.1  nonaka 
   1501      1.1  nonaka static struct ieee80211_node *
   1502      1.1  nonaka run_node_alloc(struct ieee80211_node_table *nt)
   1503      1.1  nonaka {
   1504      1.1  nonaka 	struct run_node *rn =
   1505      1.1  nonaka 	    malloc(sizeof (struct run_node), M_DEVBUF, M_NOWAIT | M_ZERO);
   1506      1.1  nonaka 	return (rn) ? &rn->ni : NULL;
   1507      1.1  nonaka }
   1508      1.1  nonaka 
   1509      1.1  nonaka static int
   1510      1.1  nonaka run_media_change(struct ifnet *ifp)
   1511      1.1  nonaka {
   1512      1.1  nonaka 	struct run_softc *sc = ifp->if_softc;
   1513      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   1514      1.1  nonaka 	uint8_t rate, ridx;
   1515      1.1  nonaka 	int error;
   1516      1.1  nonaka 
   1517      1.1  nonaka 	error = ieee80211_media_change(ifp);
   1518      1.1  nonaka 	if (error != ENETRESET)
   1519      1.1  nonaka 		return (error);
   1520      1.1  nonaka 
   1521      1.1  nonaka 	if (ic->ic_fixed_rate != IEEE80211_FIXED_RATE_NONE) {
   1522      1.1  nonaka 		rate = ic->ic_sup_rates[ic->ic_curmode].
   1523      1.1  nonaka 		    rs_rates[ic->ic_fixed_rate] & IEEE80211_RATE_VAL;
   1524      1.1  nonaka 		for (ridx = 0; ridx <= RT2860_RIDX_MAX; ridx++)
   1525      1.1  nonaka 			if (rt2860_rates[ridx].rate == rate)
   1526      1.1  nonaka 				break;
   1527      1.1  nonaka 		sc->fixed_ridx = ridx;
   1528      1.1  nonaka 	}
   1529      1.1  nonaka 
   1530      1.1  nonaka 	if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) == (IFF_UP | IFF_RUNNING))
   1531      1.1  nonaka 		run_init(ifp);
   1532      1.1  nonaka 
   1533      1.1  nonaka 	return (0);
   1534      1.1  nonaka }
   1535      1.1  nonaka 
   1536      1.1  nonaka static void
   1537      1.1  nonaka run_next_scan(void *arg)
   1538      1.1  nonaka {
   1539      1.1  nonaka 	struct run_softc *sc = arg;
   1540      1.1  nonaka 
   1541      1.1  nonaka 	if (sc->sc_ic.ic_state == IEEE80211_S_SCAN)
   1542      1.1  nonaka 		ieee80211_next_scan(&sc->sc_ic);
   1543      1.1  nonaka }
   1544      1.1  nonaka 
   1545      1.1  nonaka static void
   1546      1.1  nonaka run_task(void *arg)
   1547      1.1  nonaka {
   1548      1.1  nonaka 	struct run_softc *sc = arg;
   1549      1.1  nonaka 	struct run_host_cmd_ring *ring = &sc->cmdq;
   1550      1.1  nonaka 	struct run_host_cmd *cmd;
   1551      1.1  nonaka 	int s;
   1552      1.1  nonaka 
   1553      1.1  nonaka 	/* process host commands */
   1554      1.1  nonaka 	s = splusb();
   1555      1.1  nonaka 	while (ring->next != ring->cur) {
   1556      1.1  nonaka 		cmd = &ring->cmd[ring->next];
   1557      1.1  nonaka 		splx(s);
   1558      1.1  nonaka 		/* callback */
   1559      1.1  nonaka 		cmd->cb(sc, cmd->data);
   1560      1.1  nonaka 		s = splusb();
   1561      1.1  nonaka 		ring->queued--;
   1562      1.1  nonaka 		ring->next = (ring->next + 1) % RUN_HOST_CMD_RING_COUNT;
   1563      1.1  nonaka 	}
   1564      1.1  nonaka 	wakeup(ring);
   1565      1.1  nonaka 	splx(s);
   1566      1.1  nonaka }
   1567      1.1  nonaka 
   1568      1.1  nonaka static void
   1569      1.1  nonaka run_do_async(struct run_softc *sc, void (*cb)(struct run_softc *, void *),
   1570      1.1  nonaka     void *arg, int len)
   1571      1.1  nonaka {
   1572      1.1  nonaka 	struct run_host_cmd_ring *ring = &sc->cmdq;
   1573      1.1  nonaka 	struct run_host_cmd *cmd;
   1574      1.1  nonaka 	int s;
   1575      1.1  nonaka 
   1576      1.1  nonaka 	if (sc->sc_flags & RUN_DETACHING)
   1577      1.1  nonaka 		return;
   1578      1.1  nonaka 
   1579      1.1  nonaka 	s = splusb();
   1580      1.1  nonaka 	cmd = &ring->cmd[ring->cur];
   1581      1.1  nonaka 	cmd->cb = cb;
   1582      1.1  nonaka 	KASSERT(len <= sizeof (cmd->data));
   1583      1.1  nonaka 	memcpy(cmd->data, arg, len);
   1584      1.1  nonaka 	ring->cur = (ring->cur + 1) % RUN_HOST_CMD_RING_COUNT;
   1585      1.1  nonaka 
   1586      1.1  nonaka 	/* if there is no pending command already, schedule a task */
   1587      1.1  nonaka 	if (++ring->queued == 1)
   1588      1.1  nonaka 		usb_add_task(sc->sc_udev, &sc->sc_task, USB_TASKQ_DRIVER);
   1589      1.1  nonaka 	splx(s);
   1590      1.1  nonaka }
   1591      1.1  nonaka 
   1592      1.1  nonaka static int
   1593      1.1  nonaka run_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
   1594      1.1  nonaka {
   1595      1.1  nonaka 	struct run_softc *sc = ic->ic_ifp->if_softc;
   1596      1.1  nonaka 	struct run_cmd_newstate cmd;
   1597      1.1  nonaka 
   1598      1.1  nonaka 	callout_stop(&sc->scan_to);
   1599      1.1  nonaka 	callout_stop(&sc->calib_to);
   1600      1.1  nonaka 
   1601      1.1  nonaka 	/* do it in a process context */
   1602      1.1  nonaka 	cmd.state = nstate;
   1603      1.1  nonaka 	cmd.arg = arg;
   1604      1.1  nonaka 	run_do_async(sc, run_newstate_cb, &cmd, sizeof cmd);
   1605      1.1  nonaka 	return (0);
   1606      1.1  nonaka }
   1607      1.1  nonaka 
   1608      1.1  nonaka static void
   1609      1.1  nonaka run_newstate_cb(struct run_softc *sc, void *arg)
   1610      1.1  nonaka {
   1611      1.1  nonaka 	struct run_cmd_newstate *cmd = arg;
   1612      1.1  nonaka 	struct ifnet *ifp = &sc->sc_if;
   1613      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   1614      1.1  nonaka 	enum ieee80211_state ostate;
   1615      1.1  nonaka 	struct ieee80211_node *ni;
   1616      1.1  nonaka 	uint32_t tmp, sta[3];
   1617      1.1  nonaka 	uint8_t wcid;
   1618      1.1  nonaka 	int s;
   1619      1.1  nonaka 
   1620      1.1  nonaka 	s = splnet();
   1621      1.1  nonaka 	ostate = ic->ic_state;
   1622      1.1  nonaka 
   1623      1.1  nonaka 	if (ostate == IEEE80211_S_RUN) {
   1624      1.1  nonaka 		/* turn link LED off */
   1625      1.1  nonaka 		run_set_leds(sc, RT2860_LED_RADIO);
   1626      1.1  nonaka 	}
   1627      1.1  nonaka 
   1628      1.1  nonaka 	switch (cmd->state) {
   1629      1.1  nonaka 	case IEEE80211_S_INIT:
   1630      1.1  nonaka 		if (ostate == IEEE80211_S_RUN) {
   1631      1.1  nonaka 			/* abort TSF synchronization */
   1632      1.1  nonaka 			run_read(sc, RT2860_BCN_TIME_CFG, &tmp);
   1633      1.1  nonaka 			run_write(sc, RT2860_BCN_TIME_CFG,
   1634      1.1  nonaka 			    tmp & ~(RT2860_BCN_TX_EN | RT2860_TSF_TIMER_EN |
   1635      1.1  nonaka 			    RT2860_TBTT_TIMER_EN));
   1636      1.1  nonaka 		}
   1637      1.1  nonaka 		break;
   1638      1.1  nonaka 
   1639      1.1  nonaka 	case IEEE80211_S_SCAN:
   1640      1.1  nonaka 		run_set_chan(sc, ic->ic_curchan);
   1641      1.1  nonaka 		callout_schedule(&sc->scan_to, hz / 5);
   1642      1.1  nonaka 		break;
   1643      1.1  nonaka 
   1644      1.1  nonaka 	case IEEE80211_S_AUTH:
   1645      1.1  nonaka 	case IEEE80211_S_ASSOC:
   1646      1.1  nonaka 		run_set_chan(sc, ic->ic_curchan);
   1647      1.1  nonaka 		break;
   1648      1.1  nonaka 
   1649      1.1  nonaka 	case IEEE80211_S_RUN:
   1650      1.1  nonaka 		run_set_chan(sc, ic->ic_curchan);
   1651      1.1  nonaka 
   1652      1.1  nonaka 		ni = ic->ic_bss;
   1653      1.1  nonaka 
   1654      1.1  nonaka 		if (ic->ic_opmode != IEEE80211_M_MONITOR) {
   1655      1.1  nonaka 			run_updateslot(ifp);
   1656      1.1  nonaka 			run_enable_mrr(sc);
   1657      1.1  nonaka 			run_set_txpreamble(sc);
   1658      1.1  nonaka 			run_set_basicrates(sc);
   1659      1.1  nonaka 			run_set_bssid(sc, ni->ni_bssid);
   1660      1.1  nonaka 		}
   1661      1.1  nonaka #ifndef IEEE80211_STA_ONLY
   1662      1.1  nonaka 		if (ic->ic_opmode == IEEE80211_M_HOSTAP ||
   1663      1.1  nonaka 		    ic->ic_opmode == IEEE80211_M_IBSS)
   1664      1.1  nonaka 			(void)run_setup_beacon(sc);
   1665      1.1  nonaka #endif
   1666      1.1  nonaka 		if (ic->ic_opmode == IEEE80211_M_STA) {
   1667      1.1  nonaka 			/* add BSS entry to the WCID table */
   1668      1.1  nonaka 			wcid = RUN_AID2WCID(ni->ni_associd);
   1669      1.1  nonaka 			run_write_region_1(sc, RT2860_WCID_ENTRY(wcid),
   1670      1.1  nonaka 			    ni->ni_macaddr, IEEE80211_ADDR_LEN);
   1671      1.1  nonaka 
   1672      1.1  nonaka 			/* fake a join to init the tx rate */
   1673      1.1  nonaka 			run_newassoc(ni, 1);
   1674      1.1  nonaka 		}
   1675      1.1  nonaka 		if (ic->ic_opmode != IEEE80211_M_MONITOR) {
   1676      1.1  nonaka 			run_enable_tsf_sync(sc);
   1677      1.1  nonaka 
   1678      1.1  nonaka 			/* clear statistic registers used by AMRR */
   1679      1.1  nonaka 			run_read_region_1(sc, RT2860_TX_STA_CNT0,
   1680      1.1  nonaka 			    (uint8_t *)sta, sizeof sta);
   1681      1.1  nonaka 			/* start calibration timer */
   1682      1.1  nonaka 			callout_schedule(&sc->calib_to, hz);
   1683      1.1  nonaka 		}
   1684      1.1  nonaka 
   1685      1.1  nonaka 		/* turn link LED on */
   1686      1.1  nonaka 		run_set_leds(sc, RT2860_LED_RADIO |
   1687      1.1  nonaka 		    (IEEE80211_IS_CHAN_2GHZ(ic->ic_curchan) ?
   1688      1.1  nonaka 		     RT2860_LED_LINK_2GHZ : RT2860_LED_LINK_5GHZ));
   1689      1.1  nonaka 		break;
   1690      1.1  nonaka 	}
   1691      1.1  nonaka 	(void)sc->sc_newstate(ic, cmd->state, cmd->arg);
   1692      1.1  nonaka 	splx(s);
   1693      1.1  nonaka }
   1694      1.1  nonaka 
   1695      1.1  nonaka static int
   1696      1.1  nonaka run_updateedca(struct ieee80211com *ic)
   1697      1.1  nonaka {
   1698      1.1  nonaka 
   1699      1.1  nonaka 	/* do it in a process context */
   1700      1.1  nonaka 	run_do_async(ic->ic_ifp->if_softc, run_updateedca_cb, NULL, 0);
   1701      1.1  nonaka 	return (0);
   1702      1.1  nonaka }
   1703      1.1  nonaka 
   1704      1.1  nonaka /* ARGSUSED */
   1705      1.1  nonaka static void
   1706      1.1  nonaka run_updateedca_cb(struct run_softc *sc, void *arg)
   1707      1.1  nonaka {
   1708      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   1709      1.1  nonaka 	int s, aci;
   1710      1.1  nonaka 
   1711      1.1  nonaka 	s = splnet();
   1712      1.1  nonaka 	/* update MAC TX configuration registers */
   1713      1.1  nonaka 	for (aci = 0; aci < WME_NUM_AC; aci++) {
   1714      1.1  nonaka 		run_write(sc, RT2860_EDCA_AC_CFG(aci),
   1715      1.1  nonaka 		    ic->ic_wme.wme_params[aci].wmep_logcwmax << 16 |
   1716      1.1  nonaka 		    ic->ic_wme.wme_params[aci].wmep_logcwmin << 12 |
   1717      1.1  nonaka 		    ic->ic_wme.wme_params[aci].wmep_aifsn  <<  8 |
   1718      1.1  nonaka 		    ic->ic_wme.wme_params[aci].wmep_txopLimit);
   1719      1.1  nonaka 	}
   1720      1.1  nonaka 
   1721      1.1  nonaka 	/* update SCH/DMA registers too */
   1722      1.1  nonaka 	run_write(sc, RT2860_WMM_AIFSN_CFG,
   1723      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_VO].wmep_aifsn  << 12 |
   1724      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_VI].wmep_aifsn  <<  8 |
   1725      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_BK].wmep_aifsn  <<  4 |
   1726      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_BE].wmep_aifsn);
   1727      1.1  nonaka 	run_write(sc, RT2860_WMM_CWMIN_CFG,
   1728      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_VO].wmep_logcwmin << 12 |
   1729      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_VI].wmep_logcwmin <<  8 |
   1730      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_BK].wmep_logcwmin <<  4 |
   1731      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_BE].wmep_logcwmin);
   1732      1.1  nonaka 	run_write(sc, RT2860_WMM_CWMAX_CFG,
   1733      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_VO].wmep_logcwmax << 12 |
   1734      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_VI].wmep_logcwmax <<  8 |
   1735      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_BK].wmep_logcwmax <<  4 |
   1736      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_BE].wmep_logcwmax);
   1737      1.1  nonaka 	run_write(sc, RT2860_WMM_TXOP0_CFG,
   1738      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_BK].wmep_txopLimit << 16 |
   1739      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_BE].wmep_txopLimit);
   1740      1.1  nonaka 	run_write(sc, RT2860_WMM_TXOP1_CFG,
   1741      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_VO].wmep_txopLimit << 16 |
   1742      1.1  nonaka 	    ic->ic_wme.wme_params[WME_AC_VI].wmep_txopLimit);
   1743      1.1  nonaka 	splx(s);
   1744      1.1  nonaka }
   1745      1.1  nonaka 
   1746      1.1  nonaka #ifdef RUN_HWCRYPTO
   1747      1.1  nonaka static int
   1748      1.1  nonaka run_set_key(struct ieee80211com *ic, const struct ieee80211_key *k,
   1749      1.1  nonaka     const uint8_t *mac)
   1750      1.1  nonaka {
   1751      1.1  nonaka 	struct run_softc *sc = ic->ic_ifp->if_softc;
   1752      1.1  nonaka 	struct ieee80211_node *ni = ic->ic_bss;
   1753      1.1  nonaka 	struct run_cmd_key cmd;
   1754      1.1  nonaka 
   1755      1.1  nonaka 	/* do it in a process context */
   1756      1.1  nonaka 	cmd.key = *k;
   1757      1.1  nonaka 	cmd.associd = (ni != NULL) ? ni->ni_associd : 0;
   1758      1.1  nonaka 	run_do_async(sc, run_set_key_cb, &cmd, sizeof cmd);
   1759      1.1  nonaka 	return 1;
   1760      1.1  nonaka }
   1761      1.1  nonaka 
   1762      1.1  nonaka static void
   1763      1.1  nonaka run_set_key_cb(struct run_softc *sc, void *arg)
   1764      1.1  nonaka {
   1765      1.1  nonaka #ifndef IEEE80211_STA_ONLY
   1766      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   1767      1.1  nonaka #endif
   1768      1.1  nonaka 	struct run_cmd_key *cmd = arg;
   1769      1.1  nonaka 	struct ieee80211_key *k = &cmd->key;
   1770      1.1  nonaka 	uint32_t attr;
   1771      1.1  nonaka 	uint16_t base;
   1772      1.1  nonaka 	uint8_t mode, wcid, iv[8];
   1773      1.1  nonaka 
   1774      1.1  nonaka 	/* map net80211 cipher to RT2860 security mode */
   1775      1.1  nonaka 	switch (k->wk_cipher->ic_cipher) {
   1776      1.1  nonaka 	case IEEE80211_CIPHER_WEP:
   1777      1.1  nonaka 		k->wk_flags |= IEEE80211_KEY_GROUP; /* XXX */
   1778      1.1  nonaka 		if (k->wk_keylen == 5)
   1779      1.1  nonaka 			mode = RT2860_MODE_WEP40;
   1780      1.1  nonaka 		else
   1781      1.1  nonaka 			mode = RT2860_MODE_WEP104;
   1782      1.1  nonaka 		break;
   1783      1.1  nonaka 	case IEEE80211_CIPHER_TKIP:
   1784      1.1  nonaka 		mode = RT2860_MODE_TKIP;
   1785      1.1  nonaka 		break;
   1786      1.1  nonaka 	case IEEE80211_CIPHER_AES_CCM:
   1787      1.1  nonaka 		mode = RT2860_MODE_AES_CCMP;
   1788      1.1  nonaka 		break;
   1789      1.1  nonaka 	default:
   1790      1.1  nonaka 		return;
   1791      1.1  nonaka 	}
   1792      1.1  nonaka 
   1793      1.1  nonaka 	if (k->wk_flags & IEEE80211_KEY_GROUP) {
   1794      1.1  nonaka 		wcid = 0;	/* NB: update WCID0 for group keys */
   1795      1.1  nonaka 		base = RT2860_SKEY(0, k->wk_keyix);
   1796      1.1  nonaka 	} else {
   1797      1.1  nonaka 		wcid = RUN_AID2WCID(cmd->associd);
   1798      1.1  nonaka 		base = RT2860_PKEY(wcid);
   1799      1.1  nonaka 	}
   1800      1.1  nonaka 
   1801      1.1  nonaka 	if (k->wk_cipher->ic_cipher == IEEE80211_CIPHER_TKIP) {
   1802      1.1  nonaka 		run_write_region_1(sc, base, k->wk_key, 16);
   1803      1.1  nonaka #ifndef IEEE80211_STA_ONLY
   1804      1.1  nonaka 		if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
   1805      1.1  nonaka 			run_write_region_1(sc, base + 16, &k->wk_key[16], 8);
   1806      1.1  nonaka 			run_write_region_1(sc, base + 24, &k->wk_key[24], 8);
   1807      1.1  nonaka 		} else
   1808      1.1  nonaka #endif
   1809      1.1  nonaka 		{
   1810      1.1  nonaka 			run_write_region_1(sc, base + 16, &k->wk_key[24], 8);
   1811      1.1  nonaka 			run_write_region_1(sc, base + 24, &k->wk_key[16], 8);
   1812      1.1  nonaka 		}
   1813      1.1  nonaka 	} else {
   1814      1.1  nonaka 		/* roundup len to 16-bit: XXX fix write_region_1() instead */
   1815      1.1  nonaka 		run_write_region_1(sc, base, k->wk_key,
   1816      1.1  nonaka 		    (k->wk_keylen + 1) & ~1);
   1817      1.1  nonaka 	}
   1818      1.1  nonaka 
   1819      1.1  nonaka 	if (!(k->wk_flags & IEEE80211_KEY_GROUP) ||
   1820      1.1  nonaka 	    (k->wk_flags & IEEE80211_KEY_XMIT)) {
   1821      1.1  nonaka 		/* set initial packet number in IV+EIV */
   1822      1.1  nonaka 		if (k->wk_cipher->ic_cipher == IEEE80211_CIPHER_WEP) {
   1823      1.1  nonaka 			memset(iv, 0, sizeof iv);
   1824      1.1  nonaka 			iv[3] = sc->sc_ic.ic_crypto.cs_def_txkey << 6;
   1825      1.1  nonaka 		} else {
   1826      1.1  nonaka 			if (k->wk_cipher->ic_cipher == IEEE80211_CIPHER_TKIP) {
   1827      1.1  nonaka 				iv[0] = k->wk_keytsc >> 8;
   1828      1.1  nonaka 				iv[1] = (iv[0] | 0x20) & 0x7f;
   1829      1.1  nonaka 				iv[2] = k->wk_keytsc;
   1830      1.1  nonaka 			} else /* CCMP */ {
   1831      1.1  nonaka 				iv[0] = k->wk_keytsc;
   1832      1.1  nonaka 				iv[1] = k->wk_keytsc >> 8;
   1833      1.1  nonaka 				iv[2] = 0;
   1834      1.1  nonaka 			}
   1835      1.1  nonaka 			iv[3] = k->wk_keyix << 6 | IEEE80211_WEP_EXTIV;
   1836      1.1  nonaka 			iv[4] = k->wk_keytsc >> 16;
   1837      1.1  nonaka 			iv[5] = k->wk_keytsc >> 24;
   1838      1.1  nonaka 			iv[6] = k->wk_keytsc >> 32;
   1839      1.1  nonaka 			iv[7] = k->wk_keytsc >> 40;
   1840      1.1  nonaka 		}
   1841      1.1  nonaka 		run_write_region_1(sc, RT2860_IVEIV(wcid), iv, 8);
   1842      1.1  nonaka 	}
   1843      1.1  nonaka 
   1844      1.1  nonaka 	if (k->wk_flags & IEEE80211_KEY_GROUP) {
   1845      1.1  nonaka 		/* install group key */
   1846      1.1  nonaka 		run_read(sc, RT2860_SKEY_MODE_0_7, &attr);
   1847      1.1  nonaka 		attr &= ~(0xf << (k->wk_keyix * 4));
   1848      1.1  nonaka 		attr |= mode << (k->wk_keyix * 4);
   1849      1.1  nonaka 		run_write(sc, RT2860_SKEY_MODE_0_7, attr);
   1850      1.1  nonaka 	} else {
   1851      1.1  nonaka 		/* install pairwise key */
   1852      1.1  nonaka 		run_read(sc, RT2860_WCID_ATTR(wcid), &attr);
   1853      1.1  nonaka 		attr = (attr & ~0xf) | (mode << 1) | RT2860_RX_PKEY_EN;
   1854      1.1  nonaka 		run_write(sc, RT2860_WCID_ATTR(wcid), attr);
   1855      1.1  nonaka 	}
   1856      1.1  nonaka }
   1857      1.1  nonaka 
   1858      1.1  nonaka static int
   1859      1.1  nonaka run_delete_key(struct ieee80211com *ic, const struct ieee80211_key *k)
   1860      1.1  nonaka {
   1861      1.1  nonaka 	struct run_softc *sc = ic->ic_ifp->if_softc;
   1862      1.1  nonaka 	struct ieee80211_node *ni = ic->ic_bss;
   1863      1.1  nonaka 	struct run_cmd_key cmd;
   1864      1.1  nonaka 
   1865      1.1  nonaka 	/* do it in a process context */
   1866      1.1  nonaka 	cmd.key = *k;
   1867      1.1  nonaka 	cmd.associd = (ni != NULL) ? ni->ni_associd : 0;
   1868      1.1  nonaka 	run_do_async(sc, run_delete_key_cb, &cmd, sizeof cmd);
   1869      1.1  nonaka 	return 1;
   1870      1.1  nonaka }
   1871      1.1  nonaka 
   1872      1.1  nonaka static void
   1873      1.1  nonaka run_delete_key_cb(struct run_softc *sc, void *arg)
   1874      1.1  nonaka {
   1875      1.1  nonaka 	struct run_cmd_key *cmd = arg;
   1876      1.1  nonaka 	struct ieee80211_key *k = &cmd->key;
   1877      1.1  nonaka 	uint32_t attr;
   1878      1.1  nonaka 	uint8_t wcid;
   1879      1.1  nonaka 
   1880      1.1  nonaka 	if (k->wk_cipher->ic_cipher == IEEE80211_CIPHER_WEP)
   1881      1.1  nonaka 		k->wk_flags |= IEEE80211_KEY_GROUP; /* XXX */
   1882      1.1  nonaka 
   1883      1.1  nonaka 	if (k->wk_flags & IEEE80211_KEY_GROUP) {
   1884      1.1  nonaka 		/* remove group key */
   1885      1.1  nonaka 		run_read(sc, RT2860_SKEY_MODE_0_7, &attr);
   1886      1.1  nonaka 		attr &= ~(0xf << (k->wk_keyix * 4));
   1887      1.1  nonaka 		run_write(sc, RT2860_SKEY_MODE_0_7, attr);
   1888      1.1  nonaka 
   1889      1.1  nonaka 	} else {
   1890      1.1  nonaka 		/* remove pairwise key */
   1891      1.1  nonaka 		wcid = RUN_AID2WCID(cmd->associd);
   1892      1.1  nonaka 		run_read(sc, RT2860_WCID_ATTR(wcid), &attr);
   1893      1.1  nonaka 		attr &= ~0xf;
   1894      1.1  nonaka 		run_write(sc, RT2860_WCID_ATTR(wcid), attr);
   1895      1.1  nonaka 	}
   1896      1.1  nonaka }
   1897      1.1  nonaka #endif
   1898      1.1  nonaka 
   1899      1.1  nonaka static void
   1900      1.1  nonaka run_calibrate_to(void *arg)
   1901      1.1  nonaka {
   1902      1.1  nonaka 
   1903      1.1  nonaka 	/* do it in a process context */
   1904      1.1  nonaka 	run_do_async(arg, run_calibrate_cb, NULL, 0);
   1905      1.1  nonaka 	/* next timeout will be rescheduled in the calibration task */
   1906      1.1  nonaka }
   1907      1.1  nonaka 
   1908      1.1  nonaka /* ARGSUSED */
   1909      1.1  nonaka static void
   1910      1.1  nonaka run_calibrate_cb(struct run_softc *sc, void *arg)
   1911      1.1  nonaka {
   1912      1.1  nonaka 	struct ifnet *ifp = &sc->sc_if;
   1913      1.1  nonaka 	uint32_t sta[3];
   1914      1.1  nonaka 	int s, error;
   1915      1.1  nonaka 
   1916      1.1  nonaka 	/* read statistic counters (clear on read) and update AMRR state */
   1917      1.1  nonaka 	error = run_read_region_1(sc, RT2860_TX_STA_CNT0, (uint8_t *)sta,
   1918      1.1  nonaka 	    sizeof sta);
   1919      1.1  nonaka 	if (error != 0)
   1920      1.1  nonaka 		goto skip;
   1921      1.1  nonaka 
   1922      1.1  nonaka 	DPRINTF(("retrycnt=%d txcnt=%d failcnt=%d\n",
   1923      1.1  nonaka 	    le32toh(sta[1]) >> 16, le32toh(sta[1]) & 0xffff,
   1924      1.1  nonaka 	    le32toh(sta[0]) & 0xffff));
   1925      1.1  nonaka 
   1926      1.1  nonaka 	s = splnet();
   1927      1.1  nonaka 	/* count failed TX as errors */
   1928      1.1  nonaka 	ifp->if_oerrors += le32toh(sta[0]) & 0xffff;
   1929      1.1  nonaka 
   1930      1.1  nonaka 	sc->amn.amn_retrycnt =
   1931      1.1  nonaka 	    (le32toh(sta[0]) & 0xffff) +	/* failed TX count */
   1932      1.1  nonaka 	    (le32toh(sta[1]) >> 16);		/* TX retransmission count */
   1933      1.1  nonaka 
   1934      1.1  nonaka 	sc->amn.amn_txcnt =
   1935      1.1  nonaka 	    sc->amn.amn_retrycnt +
   1936      1.1  nonaka 	    (le32toh(sta[1]) & 0xffff);		/* successful TX count */
   1937      1.1  nonaka 
   1938      1.1  nonaka 	ieee80211_amrr_choose(&sc->amrr, sc->sc_ic.ic_bss, &sc->amn);
   1939      1.1  nonaka 	splx(s);
   1940      1.1  nonaka 
   1941      1.1  nonaka skip:	callout_schedule(&sc->calib_to, hz);
   1942      1.1  nonaka }
   1943      1.1  nonaka 
   1944      1.1  nonaka static void
   1945      1.1  nonaka run_newassoc(struct ieee80211_node *ni, int isnew)
   1946      1.1  nonaka {
   1947      1.1  nonaka 	struct run_softc *sc = ni->ni_ic->ic_ifp->if_softc;
   1948      1.1  nonaka 	struct run_node *rn = (void *)ni;
   1949      1.1  nonaka 	struct ieee80211_rateset *rs = &ni->ni_rates;
   1950      1.1  nonaka 	uint8_t rate;
   1951      1.1  nonaka 	int ridx, i, j;
   1952      1.1  nonaka 
   1953      1.1  nonaka 	DPRINTF(("new assoc isnew=%d addr=%s\n",
   1954      1.1  nonaka 	    isnew, ether_sprintf(ni->ni_macaddr)));
   1955      1.1  nonaka 
   1956      1.1  nonaka 	ieee80211_amrr_node_init(&sc->amrr, &sc->amn);
   1957      1.1  nonaka 	/* start at lowest available bit-rate, AMRR will raise */
   1958      1.1  nonaka 	ni->ni_txrate = 0;
   1959      1.1  nonaka 
   1960      1.1  nonaka 	for (i = 0; i < rs->rs_nrates; i++) {
   1961      1.1  nonaka 		rate = rs->rs_rates[i] & IEEE80211_RATE_VAL;
   1962      1.1  nonaka 		/* convert 802.11 rate to hardware rate index */
   1963      1.1  nonaka 		for (ridx = 0; ridx < RT2860_RIDX_MAX; ridx++)
   1964      1.1  nonaka 			if (rt2860_rates[ridx].rate == rate)
   1965      1.1  nonaka 				break;
   1966      1.1  nonaka 		rn->ridx[i] = ridx;
   1967      1.1  nonaka 		/* determine rate of control response frames */
   1968      1.1  nonaka 		for (j = i; j >= 0; j--) {
   1969      1.1  nonaka 			if ((rs->rs_rates[j] & IEEE80211_RATE_BASIC) &&
   1970      1.1  nonaka 			    rt2860_rates[rn->ridx[i]].phy ==
   1971      1.1  nonaka 			    rt2860_rates[rn->ridx[j]].phy)
   1972      1.1  nonaka 				break;
   1973      1.1  nonaka 		}
   1974      1.1  nonaka 		if (j >= 0) {
   1975      1.1  nonaka 			rn->ctl_ridx[i] = rn->ridx[j];
   1976      1.1  nonaka 		} else {
   1977      1.1  nonaka 			/* no basic rate found, use mandatory one */
   1978      1.1  nonaka 			rn->ctl_ridx[i] = rt2860_rates[ridx].ctl_ridx;
   1979      1.1  nonaka 		}
   1980      1.1  nonaka 		DPRINTF(("rate=0x%02x ridx=%d ctl_ridx=%d\n",
   1981      1.1  nonaka 		    rs->rs_rates[i], rn->ridx[i], rn->ctl_ridx[i]));
   1982      1.1  nonaka 	}
   1983      1.1  nonaka }
   1984      1.1  nonaka 
   1985      1.1  nonaka /*
   1986      1.1  nonaka  * Return the Rx chain with the highest RSSI for a given frame.
   1987      1.1  nonaka  */
   1988      1.1  nonaka static __inline uint8_t
   1989      1.1  nonaka run_maxrssi_chain(struct run_softc *sc, const struct rt2860_rxwi *rxwi)
   1990      1.1  nonaka {
   1991      1.1  nonaka 	uint8_t rxchain = 0;
   1992      1.1  nonaka 
   1993      1.1  nonaka 	if (sc->nrxchains > 1) {
   1994      1.1  nonaka 		if (rxwi->rssi[1] > rxwi->rssi[rxchain])
   1995      1.1  nonaka 			rxchain = 1;
   1996      1.1  nonaka 		if (sc->nrxchains > 2)
   1997      1.1  nonaka 			if (rxwi->rssi[2] > rxwi->rssi[rxchain])
   1998      1.1  nonaka 				rxchain = 2;
   1999      1.1  nonaka 	}
   2000      1.1  nonaka 	return (rxchain);
   2001      1.1  nonaka }
   2002      1.1  nonaka 
   2003      1.1  nonaka static void
   2004      1.1  nonaka run_rx_frame(struct run_softc *sc, uint8_t *buf, int dmalen)
   2005      1.1  nonaka {
   2006      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2007      1.1  nonaka 	struct ifnet *ifp = &sc->sc_if;
   2008      1.1  nonaka 	struct ieee80211_frame *wh;
   2009      1.1  nonaka 	struct ieee80211_node *ni;
   2010      1.1  nonaka 	struct rt2870_rxd *rxd;
   2011      1.1  nonaka 	struct rt2860_rxwi *rxwi;
   2012      1.1  nonaka 	struct mbuf *m;
   2013      1.1  nonaka 	uint32_t flags;
   2014      1.1  nonaka 	uint16_t len, phy;
   2015      1.1  nonaka 	uint8_t ant, rssi;
   2016      1.1  nonaka 	int s;
   2017      1.1  nonaka #ifdef RUN_HWCRYPTO
   2018      1.1  nonaka 	int decrypted = 0;
   2019      1.1  nonaka #endif
   2020      1.1  nonaka 
   2021      1.1  nonaka 	rxwi = (struct rt2860_rxwi *)buf;
   2022      1.1  nonaka 	len = le16toh(rxwi->len) & 0xfff;
   2023      1.1  nonaka 	if (__predict_false(len > dmalen)) {
   2024      1.1  nonaka 		DPRINTF(("bad RXWI length %u > %u\n", len, dmalen));
   2025      1.1  nonaka 		return;
   2026      1.1  nonaka 	}
   2027      1.1  nonaka 	/* Rx descriptor is located at the end */
   2028      1.1  nonaka 	rxd = (struct rt2870_rxd *)(buf + dmalen);
   2029      1.1  nonaka 	flags = le32toh(rxd->flags);
   2030      1.1  nonaka 
   2031      1.1  nonaka 	if (__predict_false(flags & (RT2860_RX_CRCERR | RT2860_RX_ICVERR))) {
   2032      1.1  nonaka 		ifp->if_ierrors++;
   2033      1.1  nonaka 		return;
   2034      1.1  nonaka 	}
   2035      1.1  nonaka 
   2036      1.1  nonaka 	wh = (struct ieee80211_frame *)(rxwi + 1);
   2037      1.1  nonaka #ifdef RUN_HWCRYPTO
   2038      1.1  nonaka 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
   2039      1.1  nonaka 		wh->i_fc[1] &= ~IEEE80211_FC1_WEP;
   2040      1.1  nonaka 		decrypted = 1;
   2041      1.1  nonaka 	}
   2042      1.1  nonaka #endif
   2043      1.1  nonaka 
   2044      1.1  nonaka 	if (__predict_false((flags & RT2860_RX_MICERR))) {
   2045      1.1  nonaka 		/* report MIC failures to net80211 for TKIP */
   2046      1.1  nonaka 		ieee80211_notify_michael_failure(ic, wh, 0/* XXX */);
   2047      1.1  nonaka 		ifp->if_ierrors++;
   2048      1.1  nonaka 		return;
   2049      1.1  nonaka 	}
   2050      1.1  nonaka 
   2051      1.1  nonaka 	if (flags & RT2860_RX_L2PAD) {
   2052      1.1  nonaka 		u_int hdrlen = ieee80211_hdrspace(ic, wh);
   2053      1.1  nonaka 		ovbcopy(wh, (uint8_t *)wh + 2, hdrlen);
   2054      1.1  nonaka 		wh = (struct ieee80211_frame *)((uint8_t *)wh + 2);
   2055      1.1  nonaka 	}
   2056      1.1  nonaka 
   2057      1.1  nonaka 	/* could use m_devget but net80211 wants contig mgmt frames */
   2058      1.1  nonaka 	MGETHDR(m, M_DONTWAIT, MT_DATA);
   2059      1.1  nonaka 	if (__predict_false(m == NULL)) {
   2060      1.1  nonaka 		ifp->if_ierrors++;
   2061      1.1  nonaka 		return;
   2062      1.1  nonaka 	}
   2063      1.1  nonaka 	if (len > MHLEN) {
   2064      1.1  nonaka 		MCLGET(m, M_DONTWAIT);
   2065      1.1  nonaka 		if (__predict_false(!(m->m_flags & M_EXT))) {
   2066      1.1  nonaka 			ifp->if_ierrors++;
   2067      1.1  nonaka 			m_freem(m);
   2068      1.1  nonaka 			return;
   2069      1.1  nonaka 		}
   2070      1.1  nonaka 	}
   2071      1.1  nonaka 	/* finalize mbuf */
   2072      1.1  nonaka 	m->m_pkthdr.rcvif = ifp;
   2073      1.1  nonaka 	memcpy(mtod(m, void *), wh, len);
   2074      1.1  nonaka 	m->m_pkthdr.len = m->m_len = len;
   2075      1.1  nonaka 
   2076      1.1  nonaka 	ant = run_maxrssi_chain(sc, rxwi);
   2077      1.1  nonaka 	rssi = rxwi->rssi[ant];
   2078      1.1  nonaka 
   2079      1.1  nonaka 	if (__predict_false(sc->sc_drvbpf != NULL)) {
   2080      1.1  nonaka 		struct run_rx_radiotap_header *tap = &sc->sc_rxtap;
   2081      1.1  nonaka 
   2082      1.1  nonaka 		tap->wr_flags = 0;
   2083      1.1  nonaka 		tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq);
   2084      1.1  nonaka 		tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags);
   2085      1.1  nonaka 		tap->wr_antsignal = rssi;
   2086      1.1  nonaka 		tap->wr_antenna = ant;
   2087      1.1  nonaka 		tap->wr_dbm_antsignal = run_rssi2dbm(sc, rssi, ant);
   2088      1.1  nonaka 		tap->wr_rate = 2;	/* in case it can't be found below */
   2089      1.1  nonaka 		phy = le16toh(rxwi->phy);
   2090      1.1  nonaka 		switch (phy & RT2860_PHY_MODE) {
   2091      1.1  nonaka 		case RT2860_PHY_CCK:
   2092      1.1  nonaka 			switch ((phy & RT2860_PHY_MCS) & ~RT2860_PHY_SHPRE) {
   2093      1.1  nonaka 			case 0:	tap->wr_rate =   2; break;
   2094      1.1  nonaka 			case 1:	tap->wr_rate =   4; break;
   2095      1.1  nonaka 			case 2:	tap->wr_rate =  11; break;
   2096      1.1  nonaka 			case 3:	tap->wr_rate =  22; break;
   2097      1.1  nonaka 			}
   2098      1.1  nonaka 			if (phy & RT2860_PHY_SHPRE)
   2099      1.1  nonaka 				tap->wr_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
   2100      1.1  nonaka 			break;
   2101      1.1  nonaka 		case RT2860_PHY_OFDM:
   2102      1.1  nonaka 			switch (phy & RT2860_PHY_MCS) {
   2103      1.1  nonaka 			case 0:	tap->wr_rate =  12; break;
   2104      1.1  nonaka 			case 1:	tap->wr_rate =  18; break;
   2105      1.1  nonaka 			case 2:	tap->wr_rate =  24; break;
   2106      1.1  nonaka 			case 3:	tap->wr_rate =  36; break;
   2107      1.1  nonaka 			case 4:	tap->wr_rate =  48; break;
   2108      1.1  nonaka 			case 5:	tap->wr_rate =  72; break;
   2109      1.1  nonaka 			case 6:	tap->wr_rate =  96; break;
   2110      1.1  nonaka 			case 7:	tap->wr_rate = 108; break;
   2111      1.1  nonaka 			}
   2112      1.1  nonaka 			break;
   2113      1.1  nonaka 		}
   2114      1.1  nonaka 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m);
   2115      1.1  nonaka 	}
   2116      1.1  nonaka 
   2117      1.1  nonaka 	s = splnet();
   2118      1.1  nonaka 	ni = ieee80211_find_rxnode(ic, (struct ieee80211_frame_min *)wh);
   2119      1.1  nonaka #ifdef RUN_HWCRYPTO
   2120      1.1  nonaka 	if (decrypted) {
   2121      1.1  nonaka 		uint32_t icflags = ic->ic_flags;
   2122      1.1  nonaka 
   2123      1.1  nonaka 		ic->ic_flags &= ~IEEE80211_F_DROPUNENC; /* XXX */
   2124      1.1  nonaka 		ieee80211_input(ic, m, ni, rssi, 0);
   2125      1.1  nonaka 		ic->ic_flags = icflags;
   2126      1.1  nonaka 	} else
   2127      1.1  nonaka #endif
   2128      1.1  nonaka 	ieee80211_input(ic, m, ni, rssi, 0);
   2129      1.1  nonaka 
   2130      1.1  nonaka 	/* node is no longer needed */
   2131      1.1  nonaka 	ieee80211_free_node(ni);
   2132      1.1  nonaka 
   2133      1.1  nonaka 	/*
   2134      1.1  nonaka 	 * In HostAP mode, ieee80211_input() will enqueue packets in if_snd
   2135      1.1  nonaka 	 * without calling if_start().
   2136      1.1  nonaka 	 */
   2137      1.1  nonaka 	if (!IFQ_IS_EMPTY(&ifp->if_snd) && !(ifp->if_flags & IFF_OACTIVE))
   2138      1.1  nonaka 		run_start(ifp);
   2139      1.1  nonaka 
   2140      1.1  nonaka 	splx(s);
   2141      1.1  nonaka }
   2142      1.1  nonaka 
   2143      1.1  nonaka static void
   2144      1.1  nonaka run_rxeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
   2145      1.1  nonaka {
   2146      1.1  nonaka 	struct run_rx_data *data = priv;
   2147      1.1  nonaka 	struct run_softc *sc = data->sc;
   2148      1.1  nonaka 	uint8_t *buf;
   2149      1.1  nonaka 	uint32_t dmalen;
   2150      1.1  nonaka 	int xferlen;
   2151      1.1  nonaka 
   2152      1.1  nonaka 	if (__predict_false(status != USBD_NORMAL_COMPLETION)) {
   2153      1.1  nonaka 		DPRINTF(("RX status=%d\n", status));
   2154      1.1  nonaka 		if (status == USBD_STALLED)
   2155      1.1  nonaka 			usbd_clear_endpoint_stall_async(sc->rxq.pipeh);
   2156      1.1  nonaka 		if (status != USBD_CANCELLED)
   2157      1.1  nonaka 			goto skip;
   2158      1.1  nonaka 		return;
   2159      1.1  nonaka 	}
   2160      1.1  nonaka 	usbd_get_xfer_status(xfer, NULL, NULL, &xferlen, NULL);
   2161      1.1  nonaka 
   2162      1.1  nonaka 	if (__predict_false(xferlen < (int)(sizeof(uint32_t) +
   2163      1.1  nonaka 	    sizeof(struct rt2860_rxwi) + sizeof(struct rt2870_rxd)))) {
   2164      1.1  nonaka 		DPRINTF(("xfer too short %d\n", xferlen));
   2165      1.1  nonaka 		goto skip;
   2166      1.1  nonaka 	}
   2167      1.1  nonaka 
   2168      1.1  nonaka 	/* HW can aggregate multiple 802.11 frames in a single USB xfer */
   2169      1.1  nonaka 	buf = data->buf;
   2170      1.1  nonaka 	while (xferlen > 8) {
   2171      1.1  nonaka 		dmalen = le32toh(*(uint32_t *)buf) & 0xffff;
   2172      1.1  nonaka 
   2173      1.1  nonaka 		if (__predict_false(dmalen == 0 || (dmalen & 3) != 0)) {
   2174      1.1  nonaka 			DPRINTF(("bad DMA length %u (%x)\n", dmalen, dmalen));
   2175      1.1  nonaka 			break;
   2176      1.1  nonaka 		}
   2177      1.1  nonaka 		if (__predict_false(dmalen + 8 > (uint32_t)xferlen)) {
   2178      1.1  nonaka 			DPRINTF(("bad DMA length %u > %d\n",
   2179      1.1  nonaka 			    dmalen + 8, xferlen));
   2180      1.1  nonaka 			break;
   2181      1.1  nonaka 		}
   2182      1.1  nonaka 		run_rx_frame(sc, buf + sizeof (uint32_t), dmalen);
   2183      1.1  nonaka 		buf += dmalen + 8;
   2184      1.1  nonaka 		xferlen -= dmalen + 8;
   2185      1.1  nonaka 	}
   2186      1.1  nonaka 
   2187      1.1  nonaka skip:	/* setup a new transfer */
   2188      1.1  nonaka 	usbd_setup_xfer(xfer, sc->rxq.pipeh, data, data->buf, RUN_MAX_RXSZ,
   2189      1.1  nonaka 	    USBD_SHORT_XFER_OK | USBD_NO_COPY, USBD_NO_TIMEOUT, run_rxeof);
   2190      1.1  nonaka 	(void)usbd_transfer(data->xfer);
   2191      1.1  nonaka }
   2192      1.1  nonaka 
   2193      1.1  nonaka static void
   2194      1.1  nonaka run_txeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
   2195      1.1  nonaka {
   2196      1.1  nonaka 	struct run_tx_data *data = priv;
   2197      1.1  nonaka 	struct run_softc *sc = data->sc;
   2198      1.1  nonaka 	struct run_tx_ring *txq = &sc->txq[data->qid];
   2199      1.1  nonaka 	struct ifnet *ifp = &sc->sc_if;
   2200      1.1  nonaka 	int s;
   2201      1.1  nonaka 
   2202      1.1  nonaka 	if (__predict_false(status != USBD_NORMAL_COMPLETION)) {
   2203      1.1  nonaka 		DPRINTF(("TX status=%d\n", status));
   2204      1.1  nonaka 		if (status == USBD_STALLED)
   2205      1.1  nonaka 			usbd_clear_endpoint_stall_async(txq->pipeh);
   2206      1.1  nonaka 		ifp->if_oerrors++;
   2207      1.1  nonaka 		return;
   2208      1.1  nonaka 	}
   2209      1.1  nonaka 
   2210      1.1  nonaka 	s = splnet();
   2211      1.1  nonaka 	sc->sc_tx_timer = 0;
   2212      1.1  nonaka 	ifp->if_opackets++;
   2213      1.1  nonaka 	if (--txq->queued < RUN_TX_RING_COUNT) {
   2214      1.1  nonaka 		sc->qfullmsk &= ~(1 << data->qid);
   2215      1.1  nonaka 		ifp->if_flags &= ~IFF_OACTIVE;
   2216      1.1  nonaka 		run_start(ifp);
   2217      1.1  nonaka 	}
   2218      1.1  nonaka 	splx(s);
   2219      1.1  nonaka }
   2220      1.1  nonaka 
   2221      1.1  nonaka static int
   2222      1.1  nonaka run_tx(struct run_softc *sc, struct mbuf *m, struct ieee80211_node *ni)
   2223      1.1  nonaka {
   2224      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2225      1.1  nonaka 	struct run_node *rn = (void *)ni;
   2226      1.1  nonaka 	struct ieee80211_frame *wh;
   2227      1.1  nonaka #ifndef RUN_HWCRYPTO
   2228      1.1  nonaka 	struct ieee80211_key *k;
   2229      1.1  nonaka #endif
   2230      1.1  nonaka 	struct run_tx_ring *ring;
   2231      1.1  nonaka 	struct run_tx_data *data;
   2232      1.1  nonaka 	struct rt2870_txd *txd;
   2233      1.1  nonaka 	struct rt2860_txwi *txwi;
   2234      1.1  nonaka 	uint16_t dur;
   2235      1.1  nonaka 	uint8_t type, mcs, tid, qid, qos = 0;
   2236      1.1  nonaka 	int error, hasqos, ridx, ctl_ridx, xferlen;
   2237      1.1  nonaka 
   2238      1.1  nonaka 	wh = mtod(m, struct ieee80211_frame *);
   2239      1.1  nonaka 
   2240      1.1  nonaka #ifndef RUN_HWCRYPTO
   2241      1.1  nonaka 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
   2242      1.1  nonaka 		k = ieee80211_crypto_encap(ic, ni, m);
   2243      1.1  nonaka 		if (k == NULL) {
   2244      1.1  nonaka 			m_freem(m);
   2245      1.1  nonaka 			return (ENOBUFS);
   2246      1.1  nonaka 		}
   2247      1.1  nonaka 
   2248      1.1  nonaka 		/* packet header may have moved, reset our local pointer */
   2249      1.1  nonaka 		wh = mtod(m, struct ieee80211_frame *);
   2250      1.1  nonaka 	}
   2251      1.1  nonaka #endif
   2252      1.1  nonaka 	type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
   2253      1.1  nonaka 
   2254  1.4.2.2     tls 	if ((hasqos = ieee80211_has_qos(wh))) {
   2255      1.1  nonaka 		qos = ((struct ieee80211_qosframe *)wh)->i_qos[0];
   2256      1.1  nonaka 		tid = qos & IEEE80211_QOS_TID;
   2257      1.1  nonaka 		qid = TID_TO_WME_AC(tid);
   2258      1.1  nonaka 	} else {
   2259      1.1  nonaka 		tid = 0;
   2260      1.1  nonaka 		qid = WME_AC_BE;
   2261      1.1  nonaka 	}
   2262      1.1  nonaka 	ring = &sc->txq[qid];
   2263      1.1  nonaka 	data = &ring->data[ring->cur];
   2264      1.1  nonaka 
   2265      1.1  nonaka 	/* pickup a rate index */
   2266      1.1  nonaka 	if (IEEE80211_IS_MULTICAST(wh->i_addr1) ||
   2267      1.1  nonaka 	    type != IEEE80211_FC0_TYPE_DATA) {
   2268      1.1  nonaka 		ridx = (ic->ic_curmode == IEEE80211_MODE_11A) ?
   2269      1.1  nonaka 		    RT2860_RIDX_OFDM6 : RT2860_RIDX_CCK1;
   2270      1.1  nonaka 		ctl_ridx = rt2860_rates[ridx].ctl_ridx;
   2271      1.1  nonaka 	} else if (ic->ic_fixed_rate != IEEE80211_FIXED_RATE_NONE) {
   2272      1.1  nonaka 		ridx = sc->fixed_ridx;
   2273      1.1  nonaka 		ctl_ridx = rt2860_rates[ridx].ctl_ridx;
   2274      1.1  nonaka 	} else {
   2275      1.1  nonaka 		ridx = rn->ridx[ni->ni_txrate];
   2276      1.1  nonaka 		ctl_ridx = rn->ctl_ridx[ni->ni_txrate];
   2277      1.1  nonaka 	}
   2278      1.1  nonaka 
   2279      1.1  nonaka 	/* get MCS code from rate index */
   2280      1.1  nonaka 	mcs = rt2860_rates[ridx].mcs;
   2281      1.1  nonaka 
   2282      1.1  nonaka 	xferlen = sizeof (*txwi) + m->m_pkthdr.len;
   2283      1.1  nonaka 	/* roundup to 32-bit alignment */
   2284      1.1  nonaka 	xferlen = (xferlen + 3) & ~3;
   2285      1.1  nonaka 
   2286      1.1  nonaka 	txd = (struct rt2870_txd *)data->buf;
   2287      1.1  nonaka 	txd->flags = RT2860_TX_QSEL_EDCA;
   2288      1.1  nonaka 	txd->len = htole16(xferlen);
   2289      1.1  nonaka 
   2290      1.1  nonaka 	/* setup TX Wireless Information */
   2291      1.1  nonaka 	txwi = (struct rt2860_txwi *)(txd + 1);
   2292      1.1  nonaka 	txwi->flags = 0;
   2293      1.1  nonaka 	txwi->xflags = hasqos ? 0 : RT2860_TX_NSEQ;
   2294      1.1  nonaka 	txwi->wcid = (type == IEEE80211_FC0_TYPE_DATA) ?
   2295      1.1  nonaka 	    RUN_AID2WCID(ni->ni_associd) : 0xff;
   2296      1.1  nonaka 	txwi->len = htole16(m->m_pkthdr.len);
   2297      1.1  nonaka 	if (rt2860_rates[ridx].phy == IEEE80211_T_DS) {
   2298      1.1  nonaka 		txwi->phy = htole16(RT2860_PHY_CCK);
   2299      1.1  nonaka 		if (ridx != RT2860_RIDX_CCK1 &&
   2300      1.1  nonaka 		    (ic->ic_flags & IEEE80211_F_SHPREAMBLE))
   2301      1.1  nonaka 			mcs |= RT2860_PHY_SHPRE;
   2302      1.1  nonaka 	} else
   2303      1.1  nonaka 		txwi->phy = htole16(RT2860_PHY_OFDM);
   2304      1.1  nonaka 	txwi->phy |= htole16(mcs);
   2305      1.1  nonaka 
   2306      1.1  nonaka 	txwi->txop = RT2860_TX_TXOP_BACKOFF;
   2307      1.1  nonaka 
   2308      1.1  nonaka 	if (!IEEE80211_IS_MULTICAST(wh->i_addr1) &&
   2309      1.1  nonaka 	    (!hasqos || (qos & IEEE80211_QOS_ACKPOLICY) !=
   2310      1.1  nonaka 	    IEEE80211_QOS_ACKPOLICY_NOACK)) {
   2311      1.1  nonaka 		txwi->xflags |= RT2860_TX_ACK;
   2312      1.1  nonaka 		if (ic->ic_flags & IEEE80211_F_SHPREAMBLE)
   2313      1.1  nonaka 			dur = rt2860_rates[ctl_ridx].sp_ack_dur;
   2314      1.1  nonaka 		else
   2315      1.1  nonaka 			dur = rt2860_rates[ctl_ridx].lp_ack_dur;
   2316      1.1  nonaka 		*(uint16_t *)wh->i_dur = htole16(dur);
   2317      1.1  nonaka 	}
   2318      1.1  nonaka 
   2319      1.1  nonaka #ifndef IEEE80211_STA_ONLY
   2320      1.1  nonaka 	/* ask MAC to insert timestamp into probe responses */
   2321      1.1  nonaka 	if ((wh->i_fc[0] &
   2322      1.1  nonaka 	    (IEEE80211_FC0_TYPE_MASK | IEEE80211_FC0_SUBTYPE_MASK)) ==
   2323      1.1  nonaka 	    (IEEE80211_FC0_TYPE_MGT | IEEE80211_FC0_SUBTYPE_PROBE_RESP))
   2324      1.1  nonaka 	    /* NOTE: beacons do not pass through tx_data() */
   2325      1.1  nonaka 		txwi->flags |= RT2860_TX_TS;
   2326      1.1  nonaka #endif
   2327      1.1  nonaka 
   2328      1.1  nonaka 	if (__predict_false(sc->sc_drvbpf != NULL)) {
   2329      1.1  nonaka 		struct run_tx_radiotap_header *tap = &sc->sc_txtap;
   2330      1.1  nonaka 
   2331      1.1  nonaka 		tap->wt_flags = 0;
   2332      1.1  nonaka 		tap->wt_rate = rt2860_rates[ridx].rate;
   2333      1.1  nonaka 		tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
   2334      1.1  nonaka 		tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
   2335      1.1  nonaka 		tap->wt_hwqueue = qid;
   2336      1.1  nonaka 		if (mcs & RT2860_PHY_SHPRE)
   2337      1.1  nonaka 			tap->wt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
   2338      1.1  nonaka 
   2339      1.1  nonaka 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m);
   2340      1.1  nonaka 	}
   2341      1.1  nonaka 
   2342      1.1  nonaka 	m_copydata(m, 0, m->m_pkthdr.len, (void *)(txwi + 1));
   2343      1.1  nonaka 	m_freem(m);
   2344      1.1  nonaka 
   2345      1.1  nonaka 	xferlen += sizeof (*txd) + 4;
   2346      1.1  nonaka 
   2347      1.1  nonaka 	usbd_setup_xfer(data->xfer, ring->pipeh, data, data->buf, xferlen,
   2348      1.1  nonaka 	    USBD_FORCE_SHORT_XFER | USBD_NO_COPY, RUN_TX_TIMEOUT, run_txeof);
   2349      1.1  nonaka 	error = usbd_transfer(data->xfer);
   2350      1.1  nonaka 	if (__predict_false(error != USBD_IN_PROGRESS &&
   2351      1.1  nonaka 	    error != USBD_NORMAL_COMPLETION))
   2352      1.1  nonaka 		return (error);
   2353      1.1  nonaka 
   2354      1.1  nonaka 	ieee80211_free_node(ni);
   2355      1.1  nonaka 
   2356      1.1  nonaka 	ring->cur = (ring->cur + 1) % RUN_TX_RING_COUNT;
   2357      1.1  nonaka 	if (++ring->queued >= RUN_TX_RING_COUNT)
   2358      1.1  nonaka 		sc->qfullmsk |= 1 << qid;
   2359      1.1  nonaka 
   2360      1.1  nonaka 	return (0);
   2361      1.1  nonaka }
   2362      1.1  nonaka 
   2363      1.1  nonaka static void
   2364      1.1  nonaka run_start(struct ifnet *ifp)
   2365      1.1  nonaka {
   2366      1.1  nonaka 	struct run_softc *sc = ifp->if_softc;
   2367      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2368      1.1  nonaka 	struct ether_header *eh;
   2369      1.1  nonaka 	struct ieee80211_node *ni;
   2370      1.1  nonaka 	struct mbuf *m;
   2371      1.1  nonaka 
   2372      1.1  nonaka 	if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
   2373      1.1  nonaka 		return;
   2374      1.1  nonaka 
   2375      1.1  nonaka 	for (;;) {
   2376      1.1  nonaka 		if (sc->qfullmsk != 0) {
   2377      1.1  nonaka 			ifp->if_flags |= IFF_OACTIVE;
   2378      1.1  nonaka 			break;
   2379      1.1  nonaka 		}
   2380      1.1  nonaka 		/* send pending management frames first */
   2381      1.1  nonaka 		IF_DEQUEUE(&ic->ic_mgtq, m);
   2382      1.1  nonaka 		if (m != NULL) {
   2383      1.1  nonaka 			ni = (void *)m->m_pkthdr.rcvif;
   2384      1.1  nonaka 			m->m_pkthdr.rcvif = NULL;
   2385      1.1  nonaka 			goto sendit;
   2386      1.1  nonaka 		}
   2387      1.1  nonaka 		if (ic->ic_state != IEEE80211_S_RUN)
   2388      1.1  nonaka 			break;
   2389      1.1  nonaka 
   2390      1.1  nonaka 		/* encapsulate and send data frames */
   2391      1.1  nonaka 		IFQ_DEQUEUE(&ifp->if_snd, m);
   2392      1.1  nonaka 		if (m == NULL)
   2393      1.1  nonaka 			break;
   2394      1.1  nonaka 		if (m->m_len < (int)sizeof(*eh) &&
   2395      1.1  nonaka 		    (m = m_pullup(m, sizeof(*eh))) == NULL) {
   2396      1.1  nonaka 			ifp->if_oerrors++;
   2397      1.1  nonaka 			continue;
   2398      1.1  nonaka 		}
   2399      1.1  nonaka 
   2400      1.1  nonaka 		eh = mtod(m, struct ether_header *);
   2401      1.1  nonaka 		ni = ieee80211_find_txnode(ic, eh->ether_dhost);
   2402      1.1  nonaka 		if (ni == NULL) {
   2403      1.1  nonaka 			m_freem(m);
   2404      1.1  nonaka 			ifp->if_oerrors++;
   2405      1.1  nonaka 			continue;
   2406      1.1  nonaka 		}
   2407      1.1  nonaka 
   2408      1.1  nonaka 		bpf_mtap(ifp, m);
   2409      1.1  nonaka 
   2410      1.1  nonaka 		if ((m = ieee80211_encap(ic, m, ni)) == NULL) {
   2411      1.1  nonaka 			ieee80211_free_node(ni);
   2412      1.1  nonaka 			ifp->if_oerrors++;
   2413      1.1  nonaka 			continue;
   2414      1.1  nonaka 		}
   2415      1.1  nonaka sendit:
   2416      1.1  nonaka 		bpf_mtap3(ic->ic_rawbpf, m);
   2417      1.1  nonaka 
   2418      1.1  nonaka 		if (run_tx(sc, m, ni) != 0) {
   2419      1.1  nonaka 			ieee80211_free_node(ni);
   2420      1.1  nonaka 			ifp->if_oerrors++;
   2421      1.1  nonaka 			continue;
   2422      1.1  nonaka 		}
   2423      1.1  nonaka 
   2424      1.1  nonaka 		sc->sc_tx_timer = 5;
   2425      1.1  nonaka 		ifp->if_timer = 1;
   2426      1.1  nonaka 	}
   2427      1.1  nonaka }
   2428      1.1  nonaka 
   2429      1.1  nonaka static void
   2430      1.1  nonaka run_watchdog(struct ifnet *ifp)
   2431      1.1  nonaka {
   2432      1.1  nonaka 	struct run_softc *sc = ifp->if_softc;
   2433      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2434      1.1  nonaka 
   2435      1.1  nonaka 	ifp->if_timer = 0;
   2436      1.1  nonaka 
   2437      1.1  nonaka 	if (sc->sc_tx_timer > 0) {
   2438      1.1  nonaka 		if (--sc->sc_tx_timer == 0) {
   2439      1.1  nonaka 			aprint_error_dev(sc->sc_dev, "device timeout\n");
   2440      1.1  nonaka 			/* run_init(ifp); XXX needs a process context! */
   2441      1.1  nonaka 			ifp->if_oerrors++;
   2442      1.1  nonaka 			return;
   2443      1.1  nonaka 		}
   2444      1.1  nonaka 		ifp->if_timer = 1;
   2445      1.1  nonaka 	}
   2446      1.1  nonaka 
   2447      1.1  nonaka 	ieee80211_watchdog(ic);
   2448      1.1  nonaka }
   2449      1.1  nonaka 
   2450      1.1  nonaka static int
   2451      1.1  nonaka run_ioctl(struct ifnet *ifp, u_long cmd, void *data)
   2452      1.1  nonaka {
   2453      1.1  nonaka 	struct run_softc *sc = ifp->if_softc;
   2454      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2455      1.1  nonaka 	int s, error = 0;
   2456      1.1  nonaka 
   2457      1.1  nonaka 	s = splnet();
   2458      1.1  nonaka 
   2459      1.1  nonaka 	switch (cmd) {
   2460      1.1  nonaka 	case SIOCSIFFLAGS:
   2461      1.1  nonaka 		if ((error = ifioctl_common(ifp, cmd, data)) != 0)
   2462      1.1  nonaka 			break;
   2463      1.1  nonaka 		switch (ifp->if_flags & (IFF_UP|IFF_RUNNING)) {
   2464      1.1  nonaka 		case IFF_UP|IFF_RUNNING:
   2465      1.1  nonaka 			break;
   2466      1.1  nonaka 		case IFF_UP:
   2467      1.1  nonaka 			run_init(ifp);
   2468      1.1  nonaka 			break;
   2469      1.1  nonaka 		case IFF_RUNNING:
   2470      1.1  nonaka 			run_stop(ifp, 1);
   2471      1.1  nonaka 			break;
   2472      1.1  nonaka 		case 0:
   2473      1.1  nonaka 			break;
   2474      1.1  nonaka 		}
   2475      1.1  nonaka 		break;
   2476      1.1  nonaka 
   2477      1.1  nonaka 	case SIOCADDMULTI:
   2478      1.1  nonaka 	case SIOCDELMULTI:
   2479      1.1  nonaka 		if ((error = ether_ioctl(ifp, cmd, data)) == ENETRESET) {
   2480      1.1  nonaka 			/* setup multicast filter, etc */
   2481      1.1  nonaka 			error = 0;
   2482      1.1  nonaka 		}
   2483      1.1  nonaka 		break;
   2484      1.1  nonaka 
   2485      1.1  nonaka 	default:
   2486      1.1  nonaka 		error = ieee80211_ioctl(ic, cmd, data);
   2487      1.1  nonaka 		break;
   2488      1.1  nonaka 	}
   2489      1.1  nonaka 
   2490      1.1  nonaka 	if (error == ENETRESET) {
   2491      1.1  nonaka 		if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) ==
   2492      1.1  nonaka 		    (IFF_UP | IFF_RUNNING)) {
   2493      1.1  nonaka 			run_init(ifp);
   2494      1.1  nonaka 		}
   2495      1.1  nonaka 		error = 0;
   2496      1.1  nonaka 	}
   2497      1.1  nonaka 
   2498      1.1  nonaka 	splx(s);
   2499      1.1  nonaka 
   2500      1.1  nonaka 	return (error);
   2501      1.1  nonaka }
   2502      1.1  nonaka 
   2503      1.1  nonaka static void
   2504      1.1  nonaka run_select_chan_group(struct run_softc *sc, int group)
   2505      1.1  nonaka {
   2506      1.1  nonaka 	uint32_t tmp;
   2507      1.1  nonaka 	uint8_t agc;
   2508      1.1  nonaka 
   2509      1.1  nonaka 	run_bbp_write(sc, 62, 0x37 - sc->lna[group]);
   2510      1.1  nonaka 	run_bbp_write(sc, 63, 0x37 - sc->lna[group]);
   2511      1.1  nonaka 	run_bbp_write(sc, 64, 0x37 - sc->lna[group]);
   2512      1.1  nonaka 	run_bbp_write(sc, 86, 0x00);
   2513      1.1  nonaka 
   2514      1.1  nonaka 	if (group == 0) {
   2515      1.1  nonaka 		if (sc->ext_2ghz_lna) {
   2516      1.1  nonaka 			run_bbp_write(sc, 82, 0x62);
   2517      1.1  nonaka 			run_bbp_write(sc, 75, 0x46);
   2518      1.1  nonaka 		} else {
   2519      1.1  nonaka 			run_bbp_write(sc, 82, 0x84);
   2520      1.1  nonaka 			run_bbp_write(sc, 75, 0x50);
   2521      1.1  nonaka 		}
   2522      1.1  nonaka 	} else {
   2523      1.1  nonaka 		if (sc->mac_ver == 0x3572)
   2524      1.1  nonaka 			run_bbp_write(sc, 82, 0x94);
   2525      1.1  nonaka 		else
   2526      1.1  nonaka 			run_bbp_write(sc, 82, 0xf2);
   2527      1.1  nonaka 		if (sc->ext_5ghz_lna)
   2528      1.1  nonaka 			run_bbp_write(sc, 75, 0x46);
   2529      1.1  nonaka 		else
   2530      1.1  nonaka 			run_bbp_write(sc, 75, 0x50);
   2531      1.1  nonaka 	}
   2532      1.1  nonaka 
   2533      1.1  nonaka 	run_read(sc, RT2860_TX_BAND_CFG, &tmp);
   2534      1.1  nonaka 	tmp &= ~(RT2860_5G_BAND_SEL_N | RT2860_5G_BAND_SEL_P);
   2535      1.1  nonaka 	tmp |= (group == 0) ? RT2860_5G_BAND_SEL_N : RT2860_5G_BAND_SEL_P;
   2536      1.1  nonaka 	run_write(sc, RT2860_TX_BAND_CFG, tmp);
   2537      1.1  nonaka 
   2538      1.1  nonaka 	/* enable appropriate Power Amplifiers and Low Noise Amplifiers */
   2539      1.1  nonaka 	tmp = RT2860_RFTR_EN | RT2860_TRSW_EN | RT2860_LNA_PE0_EN;
   2540      1.1  nonaka 	if (sc->nrxchains > 1)
   2541      1.1  nonaka 		tmp |= RT2860_LNA_PE1_EN;
   2542      1.1  nonaka 	if (group == 0) {	/* 2GHz */
   2543      1.1  nonaka 		tmp |= RT2860_PA_PE_G0_EN;
   2544      1.1  nonaka 		if (sc->ntxchains > 1)
   2545      1.1  nonaka 			tmp |= RT2860_PA_PE_G1_EN;
   2546      1.1  nonaka 	} else {		/* 5GHz */
   2547      1.1  nonaka 		tmp |= RT2860_PA_PE_A0_EN;
   2548      1.1  nonaka 		if (sc->ntxchains > 1)
   2549      1.1  nonaka 			tmp |= RT2860_PA_PE_A1_EN;
   2550      1.1  nonaka 	}
   2551      1.1  nonaka 	if (sc->mac_ver == 0x3572) {
   2552      1.1  nonaka 		run_rt3070_rf_write(sc, 8, 0x00);
   2553      1.1  nonaka 		run_write(sc, RT2860_TX_PIN_CFG, tmp);
   2554      1.1  nonaka 		run_rt3070_rf_write(sc, 8, 0x80);
   2555      1.1  nonaka 	} else
   2556      1.1  nonaka 		run_write(sc, RT2860_TX_PIN_CFG, tmp);
   2557      1.1  nonaka 
   2558      1.1  nonaka 	/* set initial AGC value */
   2559      1.1  nonaka 	if (group == 0) {       /* 2GHz band */
   2560      1.1  nonaka 		if (sc->mac_ver >= 0x3070)
   2561      1.1  nonaka 			agc = 0x1c + sc->lna[0] * 2;
   2562      1.1  nonaka 		else
   2563      1.1  nonaka 			agc = 0x2e + sc->lna[0];
   2564      1.1  nonaka 	} else {		/* 5GHz band */
   2565      1.1  nonaka 		if (sc->mac_ver == 0x3572)
   2566      1.1  nonaka 			agc = 0x22 + (sc->lna[group] * 5) / 3;
   2567      1.1  nonaka 		else
   2568      1.1  nonaka 			agc = 0x32 + (sc->lna[group] * 5) / 3;
   2569      1.1  nonaka 	}
   2570      1.1  nonaka 	run_set_agc(sc, agc);
   2571      1.1  nonaka }
   2572      1.1  nonaka 
   2573      1.1  nonaka static void
   2574      1.1  nonaka run_rt2870_set_chan(struct run_softc *sc, u_int chan)
   2575      1.1  nonaka {
   2576      1.1  nonaka 	const struct rfprog *rfprog = rt2860_rf2850;
   2577      1.1  nonaka 	uint32_t r2, r3, r4;
   2578      1.1  nonaka 	int8_t txpow1, txpow2;
   2579      1.1  nonaka 	int i;
   2580      1.1  nonaka 
   2581      1.1  nonaka 	/* find the settings for this channel (we know it exists) */
   2582      1.1  nonaka 	for (i = 0; rfprog[i].chan != chan; i++);
   2583      1.1  nonaka 
   2584      1.1  nonaka 	r2 = rfprog[i].r2;
   2585      1.1  nonaka 	if (sc->ntxchains == 1)
   2586      1.1  nonaka 		r2 |= 1 << 12;		/* 1T: disable Tx chain 2 */
   2587      1.1  nonaka 	if (sc->nrxchains == 1)
   2588      1.1  nonaka 		r2 |= 1 << 15 | 1 << 4;	/* 1R: disable Rx chains 2 & 3 */
   2589      1.1  nonaka 	else if (sc->nrxchains == 2)
   2590      1.1  nonaka 		r2 |= 1 << 4;		/* 2R: disable Rx chain 3 */
   2591      1.1  nonaka 
   2592      1.1  nonaka 	/* use Tx power values from EEPROM */
   2593      1.1  nonaka 	txpow1 = sc->txpow1[i];
   2594      1.1  nonaka 	txpow2 = sc->txpow2[i];
   2595      1.1  nonaka 	if (chan > 14) {
   2596      1.1  nonaka 		if (txpow1 >= 0)
   2597      1.1  nonaka 			txpow1 = txpow1 << 1 | 1;
   2598      1.1  nonaka 		else
   2599      1.1  nonaka 			txpow1 = (7 + txpow1) << 1;
   2600      1.1  nonaka 		if (txpow2 >= 0)
   2601      1.1  nonaka 			txpow2 = txpow2 << 1 | 1;
   2602      1.1  nonaka 		else
   2603      1.1  nonaka 			txpow2 = (7 + txpow2) << 1;
   2604      1.1  nonaka 	}
   2605      1.1  nonaka 	r3 = rfprog[i].r3 | txpow1 << 7;
   2606      1.1  nonaka 	r4 = rfprog[i].r4 | sc->freq << 13 | txpow2 << 4;
   2607      1.1  nonaka 
   2608      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF1, rfprog[i].r1);
   2609      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF2, r2);
   2610      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF3, r3);
   2611      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF4, r4);
   2612      1.1  nonaka 
   2613      1.1  nonaka 	DELAY(200);
   2614      1.1  nonaka 
   2615      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF1, rfprog[i].r1);
   2616      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF2, r2);
   2617      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF3, r3 | 1);
   2618      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF4, r4);
   2619      1.1  nonaka 
   2620      1.1  nonaka 	DELAY(200);
   2621      1.1  nonaka 
   2622      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF1, rfprog[i].r1);
   2623      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF2, r2);
   2624      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF3, r3);
   2625      1.1  nonaka 	run_rt2870_rf_write(sc, RT2860_RF4, r4);
   2626      1.1  nonaka }
   2627      1.1  nonaka 
   2628      1.1  nonaka static void
   2629      1.1  nonaka run_rt3070_set_chan(struct run_softc *sc, u_int chan)
   2630      1.1  nonaka {
   2631      1.1  nonaka 	int8_t txpow1, txpow2;
   2632      1.1  nonaka 	uint8_t rf;
   2633      1.1  nonaka 	int i;
   2634      1.1  nonaka 
   2635      1.1  nonaka 	KASSERT(chan >= 1 && chan <= 14);	/* RT3070 is 2GHz only */
   2636      1.1  nonaka 
   2637      1.1  nonaka 	/* find the settings for this channel (we know it exists) */
   2638      1.1  nonaka 	for (i = 0; rt2860_rf2850[i].chan != chan; i++)
   2639      1.1  nonaka 		continue;
   2640      1.1  nonaka 
   2641      1.1  nonaka 	/* use Tx power values from EEPROM */
   2642      1.1  nonaka 	txpow1 = sc->txpow1[i];
   2643      1.1  nonaka 	txpow2 = sc->txpow2[i];
   2644      1.1  nonaka 
   2645      1.1  nonaka 	run_rt3070_rf_write(sc, 2, rt3070_freqs[i].n);
   2646      1.1  nonaka 	run_rt3070_rf_write(sc, 3, rt3070_freqs[i].k);
   2647      1.1  nonaka 	run_rt3070_rf_read(sc, 6, &rf);
   2648      1.1  nonaka 	rf = (rf & ~0x03) | rt3070_freqs[i].r;
   2649      1.1  nonaka 	run_rt3070_rf_write(sc, 6, rf);
   2650      1.1  nonaka 
   2651      1.1  nonaka 	/* set Tx0 power */
   2652      1.1  nonaka 	run_rt3070_rf_read(sc, 12, &rf);
   2653      1.1  nonaka 	rf = (rf & ~0x1f) | txpow1;
   2654      1.1  nonaka 	run_rt3070_rf_write(sc, 12, rf);
   2655      1.1  nonaka 
   2656      1.1  nonaka 	/* set Tx1 power */
   2657      1.1  nonaka 	run_rt3070_rf_read(sc, 13, &rf);
   2658      1.1  nonaka 	rf = (rf & ~0x1f) | txpow2;
   2659      1.1  nonaka 	run_rt3070_rf_write(sc, 13, rf);
   2660      1.1  nonaka 
   2661      1.1  nonaka 	run_rt3070_rf_read(sc, 1, &rf);
   2662      1.1  nonaka 	rf &= ~0xfc;
   2663      1.1  nonaka 	if (sc->ntxchains == 1)
   2664      1.1  nonaka 		rf |= 1 << 7 | 1 << 5;	/* 1T: disable Tx chains 2 & 3 */
   2665      1.1  nonaka 	else if (sc->ntxchains == 2)
   2666      1.1  nonaka 		rf |= 1 << 7;		/* 2T: disable Tx chain 3 */
   2667      1.1  nonaka 	if (sc->nrxchains == 1)
   2668      1.1  nonaka 		rf |= 1 << 6 | 1 << 4;	/* 1R: disable Rx chains 2 & 3 */
   2669      1.1  nonaka 	else if (sc->nrxchains == 2)
   2670      1.1  nonaka 		rf |= 1 << 6;		/* 2R: disable Rx chain 3 */
   2671      1.1  nonaka 	run_rt3070_rf_write(sc, 1, rf);
   2672      1.1  nonaka 
   2673      1.1  nonaka 	/* set RF offset */
   2674      1.1  nonaka 	run_rt3070_rf_read(sc, 23, &rf);
   2675      1.1  nonaka 	rf = (rf & ~0x7f) | sc->freq;
   2676      1.1  nonaka 	run_rt3070_rf_write(sc, 23, rf);
   2677      1.1  nonaka 
   2678      1.1  nonaka 	/* program RF filter */
   2679      1.1  nonaka 	run_rt3070_rf_read(sc, 24, &rf);        /* Tx */
   2680      1.1  nonaka 	rf = (rf & ~0x3f) | sc->rf24_20mhz;
   2681      1.1  nonaka 	run_rt3070_rf_write(sc, 24, rf);
   2682      1.1  nonaka 	run_rt3070_rf_read(sc, 31, &rf);        /* Rx */
   2683      1.1  nonaka 	rf = (rf & ~0x3f) | sc->rf24_20mhz;
   2684      1.1  nonaka 	run_rt3070_rf_write(sc, 31, rf);
   2685      1.1  nonaka 
   2686      1.1  nonaka 	/* enable RF tuning */
   2687      1.1  nonaka 	run_rt3070_rf_read(sc, 7, &rf);
   2688      1.1  nonaka 	run_rt3070_rf_write(sc, 7, rf | 0x01);
   2689      1.1  nonaka }
   2690      1.1  nonaka 
   2691      1.1  nonaka static void
   2692      1.1  nonaka run_rt3572_set_chan(struct run_softc *sc, u_int chan)
   2693      1.1  nonaka {
   2694      1.1  nonaka 	int8_t txpow1, txpow2;
   2695      1.1  nonaka 	uint32_t tmp;
   2696      1.1  nonaka 	uint8_t rf;
   2697      1.1  nonaka 	int i;
   2698      1.1  nonaka 
   2699      1.1  nonaka 	/* find the settings for this channel (we know it exists) */
   2700      1.1  nonaka 	for (i = 0; rt2860_rf2850[i].chan != chan; i++);
   2701      1.1  nonaka 
   2702      1.1  nonaka 	/* use Tx power values from EEPROM */
   2703      1.1  nonaka 	txpow1 = sc->txpow1[i];
   2704      1.1  nonaka 	txpow2 = sc->txpow2[i];
   2705      1.1  nonaka 
   2706      1.1  nonaka 	if (chan <= 14) {
   2707      1.1  nonaka 		run_bbp_write(sc, 25, sc->bbp25);
   2708      1.1  nonaka 		run_bbp_write(sc, 26, sc->bbp26);
   2709      1.1  nonaka 	} else {
   2710      1.1  nonaka 		/* enable IQ phase correction */
   2711      1.1  nonaka 		run_bbp_write(sc, 25, 0x09);
   2712      1.1  nonaka 		run_bbp_write(sc, 26, 0xff);
   2713      1.1  nonaka 	}
   2714      1.1  nonaka 
   2715      1.1  nonaka 	run_rt3070_rf_write(sc, 2, rt3070_freqs[i].n);
   2716      1.1  nonaka 	run_rt3070_rf_write(sc, 3, rt3070_freqs[i].k);
   2717      1.1  nonaka 	run_rt3070_rf_read(sc, 6, &rf);
   2718      1.1  nonaka 	rf  = (rf & ~0x0f) | rt3070_freqs[i].r;
   2719      1.1  nonaka 	rf |= (chan <= 14) ? 0x08 : 0x04;
   2720      1.1  nonaka 	run_rt3070_rf_write(sc, 6, rf);
   2721      1.1  nonaka 
   2722      1.1  nonaka 	/* set PLL mode */
   2723      1.1  nonaka 	run_rt3070_rf_read(sc, 5, &rf);
   2724      1.1  nonaka 	rf &= ~(0x08 | 0x04);
   2725      1.1  nonaka 	rf |= (chan <= 14) ? 0x04 : 0x08;
   2726      1.1  nonaka 	run_rt3070_rf_write(sc, 5, rf);
   2727      1.1  nonaka 
   2728      1.1  nonaka 	/* set Tx power for chain 0 */
   2729      1.1  nonaka 	if (chan <= 14)
   2730      1.1  nonaka 		rf = 0x60 | txpow1;
   2731      1.1  nonaka 	else
   2732      1.1  nonaka 		rf = 0xe0 | (txpow1 & 0xc) << 1 | (txpow1 & 0x3);
   2733      1.1  nonaka 	run_rt3070_rf_write(sc, 12, rf);
   2734      1.1  nonaka 
   2735      1.1  nonaka 	/* set Tx power for chain 1 */
   2736      1.1  nonaka 	if (chan <= 14)
   2737      1.1  nonaka 		rf = 0x60 | txpow2;
   2738      1.1  nonaka 	else
   2739      1.1  nonaka 		rf = 0xe0 | (txpow2 & 0xc) << 1 | (txpow2 & 0x3);
   2740      1.1  nonaka 	run_rt3070_rf_write(sc, 13, rf);
   2741      1.1  nonaka 
   2742      1.1  nonaka 	/* set Tx/Rx streams */
   2743      1.1  nonaka 	run_rt3070_rf_read(sc, 1, &rf);
   2744      1.1  nonaka 	rf &= ~0xfc;
   2745      1.1  nonaka 	if (sc->ntxchains == 1)
   2746      1.1  nonaka 		rf |= 1 << 7 | 1 << 5;	/* 1T: disable Tx chains 2 & 3 */
   2747      1.1  nonaka 	else if (sc->ntxchains == 2)
   2748      1.1  nonaka 		rf |= 1 << 7;		/* 2T: disable Tx chain 3 */
   2749      1.1  nonaka 	if (sc->nrxchains == 1)
   2750      1.1  nonaka 		rf |= 1 << 6 | 1 << 4;	/* 1R: disable Rx chains 2 & 3 */
   2751      1.1  nonaka 	else if (sc->nrxchains == 2)
   2752      1.1  nonaka 		rf |= 1 << 6;		/* 2R: disable Rx chain 3 */
   2753      1.1  nonaka 	run_rt3070_rf_write(sc, 1, rf);
   2754      1.1  nonaka 
   2755      1.1  nonaka 	/* set RF offset */
   2756      1.1  nonaka 	run_rt3070_rf_read(sc, 23, &rf);
   2757      1.1  nonaka 	rf = (rf & ~0x7f) | sc->freq;
   2758      1.1  nonaka 	run_rt3070_rf_write(sc, 23, rf);
   2759      1.1  nonaka 
   2760      1.1  nonaka 	/* program RF filter */
   2761      1.1  nonaka 	rf = sc->rf24_20mhz;
   2762      1.1  nonaka 	run_rt3070_rf_write(sc, 24, rf);	/* Tx */
   2763      1.1  nonaka 	run_rt3070_rf_write(sc, 31, rf);	/* Rx */
   2764      1.1  nonaka 
   2765      1.1  nonaka 	/* enable RF tuning */
   2766      1.1  nonaka 	run_rt3070_rf_read(sc, 7, &rf);
   2767      1.1  nonaka 	rf = (chan <= 14) ? 0xd8 : ((rf & ~0xc8) | 0x14);
   2768      1.1  nonaka 	run_rt3070_rf_write(sc, 7, rf);
   2769      1.1  nonaka 
   2770      1.1  nonaka 	/* TSSI */
   2771      1.1  nonaka 	rf = (chan <= 14) ? 0xc3 : 0xc0;
   2772      1.1  nonaka 	run_rt3070_rf_write(sc, 9, rf);
   2773      1.1  nonaka 
   2774      1.1  nonaka 	/* set loop filter 1 */
   2775      1.1  nonaka 	run_rt3070_rf_write(sc, 10, 0xf1);
   2776      1.1  nonaka 	/* set loop filter 2 */
   2777      1.1  nonaka 	run_rt3070_rf_write(sc, 11, (chan <= 14) ? 0xb9 : 0x00);
   2778      1.1  nonaka 
   2779      1.1  nonaka 	/* set tx_mx2_ic */
   2780      1.1  nonaka 	run_rt3070_rf_write(sc, 15, (chan <= 14) ? 0x53 : 0x43);
   2781      1.1  nonaka 	/* set tx_mx1_ic */
   2782      1.1  nonaka 	if (chan <= 14)
   2783      1.1  nonaka 		rf = 0x48 | sc->txmixgain_2ghz;
   2784      1.1  nonaka 	else
   2785      1.1  nonaka 		rf = 0x78 | sc->txmixgain_5ghz;
   2786      1.1  nonaka 	run_rt3070_rf_write(sc, 16, rf);
   2787      1.1  nonaka 
   2788      1.1  nonaka 	/* set tx_lo1 */
   2789      1.1  nonaka 	run_rt3070_rf_write(sc, 17, 0x23);
   2790      1.1  nonaka 	/* set tx_lo2 */
   2791      1.1  nonaka 	if (chan <= 14)
   2792      1.1  nonaka 		rf = 0x93;
   2793      1.1  nonaka 	else if (chan <= 64)
   2794      1.1  nonaka 		rf = 0xb7;
   2795      1.1  nonaka 	else if (chan <= 128)
   2796      1.1  nonaka 		rf = 0x74;
   2797      1.1  nonaka 	else
   2798      1.1  nonaka 		rf = 0x72;
   2799      1.1  nonaka 	run_rt3070_rf_write(sc, 19, rf);
   2800      1.1  nonaka 
   2801      1.1  nonaka 	/* set rx_lo1 */
   2802      1.1  nonaka 	if (chan <= 14)
   2803      1.1  nonaka 		rf = 0xb3;
   2804      1.1  nonaka 	else if (chan <= 64)
   2805      1.1  nonaka 		rf = 0xf6;
   2806      1.1  nonaka 	else if (chan <= 128)
   2807      1.1  nonaka 		rf = 0xf4;
   2808      1.1  nonaka 	else
   2809      1.1  nonaka 		rf = 0xf3;
   2810      1.1  nonaka 	run_rt3070_rf_write(sc, 20, rf);
   2811      1.1  nonaka 
   2812      1.1  nonaka 	/* set pfd_delay */
   2813      1.1  nonaka 	if (chan <= 14)
   2814      1.1  nonaka 		rf = 0x15;
   2815      1.1  nonaka 	else if (chan <= 64)
   2816      1.1  nonaka 		rf = 0x3d;
   2817      1.1  nonaka 	else
   2818      1.1  nonaka 		rf = 0x01;
   2819      1.1  nonaka 	run_rt3070_rf_write(sc, 25, rf);
   2820      1.1  nonaka 
   2821      1.1  nonaka 	/* set rx_lo2 */
   2822      1.1  nonaka 	run_rt3070_rf_write(sc, 26, (chan <= 14) ? 0x85 : 0x87);
   2823      1.1  nonaka 	/* set ldo_rf_vc */
   2824      1.1  nonaka 	run_rt3070_rf_write(sc, 27, (chan <= 14) ? 0x00 : 0x01);
   2825      1.1  nonaka 	/* set drv_cc */
   2826      1.1  nonaka 	run_rt3070_rf_write(sc, 29, (chan <= 14) ? 0x9b : 0x9f);
   2827      1.1  nonaka 
   2828      1.1  nonaka 	run_read(sc, RT2860_GPIO_CTRL, &tmp);
   2829      1.1  nonaka 	tmp &= ~0x8080;
   2830      1.1  nonaka 	if (chan <= 14)
   2831      1.1  nonaka 		tmp |= 0x80;
   2832      1.1  nonaka 	run_write(sc, RT2860_GPIO_CTRL, tmp);
   2833      1.1  nonaka 
   2834      1.1  nonaka 	/* enable RF tuning */
   2835      1.1  nonaka 	run_rt3070_rf_read(sc, 7, &rf);
   2836      1.1  nonaka 	run_rt3070_rf_write(sc, 7, rf | 0x01);
   2837      1.1  nonaka 
   2838      1.1  nonaka 	DELAY(2000);
   2839      1.1  nonaka }
   2840      1.1  nonaka 
   2841      1.1  nonaka static void
   2842      1.1  nonaka run_set_agc(struct run_softc *sc, uint8_t agc)
   2843      1.1  nonaka {
   2844      1.1  nonaka 	uint8_t bbp;
   2845      1.1  nonaka 
   2846      1.1  nonaka 	if (sc->mac_ver == 0x3572) {
   2847      1.1  nonaka 		run_bbp_read(sc, 27, &bbp);
   2848      1.1  nonaka 		bbp &= ~(0x3 << 5);
   2849      1.1  nonaka 		run_bbp_write(sc, 27, bbp | 0 << 5);	/* select Rx0 */
   2850      1.1  nonaka 		run_bbp_write(sc, 66, agc);
   2851      1.1  nonaka 		run_bbp_write(sc, 27, bbp | 1 << 5);	/* select Rx1 */
   2852      1.1  nonaka 		run_bbp_write(sc, 66, agc);
   2853      1.1  nonaka 	} else
   2854      1.1  nonaka 		run_bbp_write(sc, 66, agc);
   2855      1.1  nonaka }
   2856      1.1  nonaka 
   2857      1.1  nonaka static void
   2858      1.1  nonaka run_set_rx_antenna(struct run_softc *sc, int aux)
   2859      1.1  nonaka {
   2860      1.1  nonaka 	uint32_t tmp;
   2861      1.1  nonaka 
   2862      1.1  nonaka 	run_mcu_cmd(sc, RT2860_MCU_CMD_ANTSEL, !aux);
   2863      1.1  nonaka 	run_read(sc, RT2860_GPIO_CTRL, &tmp);
   2864      1.1  nonaka 	tmp &= ~0x0808;
   2865      1.1  nonaka 	if (aux)
   2866      1.1  nonaka 		tmp |= 0x08;
   2867      1.1  nonaka 	run_write(sc, RT2860_GPIO_CTRL, tmp);
   2868      1.1  nonaka }
   2869      1.1  nonaka 
   2870      1.1  nonaka static int
   2871      1.1  nonaka run_set_chan(struct run_softc *sc, struct ieee80211_channel *c)
   2872      1.1  nonaka {
   2873      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2874      1.1  nonaka 	u_int chan, group;
   2875      1.1  nonaka 
   2876      1.1  nonaka 	chan = ieee80211_chan2ieee(ic, c);
   2877      1.1  nonaka 	if (chan == 0 || chan == IEEE80211_CHAN_ANY)
   2878      1.1  nonaka 		return (EINVAL);
   2879      1.1  nonaka 
   2880      1.1  nonaka 	if (sc->mac_ver == 0x3572)
   2881      1.1  nonaka 		run_rt3572_set_chan(sc, chan);
   2882      1.1  nonaka 	else if (sc->mac_ver >= 0x3070)
   2883      1.1  nonaka 		run_rt3070_set_chan(sc, chan);
   2884      1.1  nonaka 	else
   2885      1.1  nonaka 		run_rt2870_set_chan(sc, chan);
   2886      1.1  nonaka 
   2887      1.1  nonaka 	/* determine channel group */
   2888      1.1  nonaka 	if (chan <= 14)
   2889      1.1  nonaka 		group = 0;
   2890      1.1  nonaka 	else if (chan <= 64)
   2891      1.1  nonaka 		group = 1;
   2892      1.1  nonaka 	else if (chan <= 128)
   2893      1.1  nonaka 		group = 2;
   2894      1.1  nonaka 	else
   2895      1.1  nonaka 		group = 3;
   2896      1.1  nonaka 
   2897      1.1  nonaka 	/* XXX necessary only when group has changed! */
   2898      1.1  nonaka 	run_select_chan_group(sc, group);
   2899      1.1  nonaka 
   2900      1.1  nonaka 	DELAY(1000);
   2901      1.1  nonaka 	return (0);
   2902      1.1  nonaka }
   2903      1.1  nonaka 
   2904      1.1  nonaka static void
   2905      1.1  nonaka run_enable_tsf_sync(struct run_softc *sc)
   2906      1.1  nonaka {
   2907      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2908      1.1  nonaka 	uint32_t tmp;
   2909      1.1  nonaka 
   2910      1.1  nonaka 	run_read(sc, RT2860_BCN_TIME_CFG, &tmp);
   2911      1.1  nonaka 	tmp &= ~0x1fffff;
   2912      1.1  nonaka 	tmp |= ic->ic_bss->ni_intval * 16;
   2913      1.1  nonaka 	tmp |= RT2860_TSF_TIMER_EN | RT2860_TBTT_TIMER_EN;
   2914      1.1  nonaka 	if (ic->ic_opmode == IEEE80211_M_STA) {
   2915      1.1  nonaka 		/*
   2916      1.1  nonaka 		 * Local TSF is always updated with remote TSF on beacon
   2917      1.1  nonaka 		 * reception.
   2918      1.1  nonaka 		 */
   2919      1.1  nonaka 		tmp |= 1 << RT2860_TSF_SYNC_MODE_SHIFT;
   2920      1.1  nonaka 	}
   2921      1.1  nonaka #ifndef IEEE80211_STA_ONLY
   2922      1.1  nonaka 	else if (ic->ic_opmode == IEEE80211_M_IBSS) {
   2923      1.1  nonaka 		tmp |= RT2860_BCN_TX_EN;
   2924      1.1  nonaka 		/*
   2925      1.1  nonaka 		 * Local TSF is updated with remote TSF on beacon reception
   2926      1.1  nonaka 		 * only if the remote TSF is greater than local TSF.
   2927      1.1  nonaka 		 */
   2928      1.1  nonaka 		tmp |= 2 << RT2860_TSF_SYNC_MODE_SHIFT;
   2929      1.1  nonaka 	} else if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
   2930      1.1  nonaka 		tmp |= RT2860_BCN_TX_EN;
   2931      1.1  nonaka 		/* SYNC with nobody */
   2932      1.1  nonaka 		tmp |= 3 << RT2860_TSF_SYNC_MODE_SHIFT;
   2933      1.1  nonaka 	}
   2934      1.1  nonaka #endif
   2935      1.1  nonaka 	run_write(sc, RT2860_BCN_TIME_CFG, tmp);
   2936      1.1  nonaka }
   2937      1.1  nonaka 
   2938      1.1  nonaka static void
   2939      1.1  nonaka run_enable_mrr(struct run_softc *sc)
   2940      1.1  nonaka {
   2941      1.1  nonaka #define CCK(mcs)	(mcs)
   2942      1.1  nonaka #define OFDM(mcs)	(1 << 3 | (mcs))
   2943      1.1  nonaka 	run_write(sc, RT2860_LG_FBK_CFG0,
   2944      1.1  nonaka 	    OFDM(6) << 28 |	/* 54->48 */
   2945      1.1  nonaka 	    OFDM(5) << 24 |	/* 48->36 */
   2946      1.1  nonaka 	    OFDM(4) << 20 |	/* 36->24 */
   2947      1.1  nonaka 	    OFDM(3) << 16 |	/* 24->18 */
   2948      1.1  nonaka 	    OFDM(2) << 12 |	/* 18->12 */
   2949      1.1  nonaka 	    OFDM(1) <<  8 |	/* 12-> 9 */
   2950      1.1  nonaka 	    OFDM(0) <<  4 |	/*  9-> 6 */
   2951      1.1  nonaka 	    OFDM(0));		/*  6-> 6 */
   2952      1.1  nonaka 
   2953      1.1  nonaka 	run_write(sc, RT2860_LG_FBK_CFG1,
   2954      1.1  nonaka 	    CCK(2) << 12 |	/* 11->5.5 */
   2955      1.1  nonaka 	    CCK(1) <<  8 |	/* 5.5-> 2 */
   2956      1.1  nonaka 	    CCK(0) <<  4 |	/*   2-> 1 */
   2957      1.1  nonaka 	    CCK(0));		/*   1-> 1 */
   2958      1.1  nonaka #undef OFDM
   2959      1.1  nonaka #undef CCK
   2960      1.1  nonaka }
   2961      1.1  nonaka 
   2962      1.1  nonaka static void
   2963      1.1  nonaka run_set_txpreamble(struct run_softc *sc)
   2964      1.1  nonaka {
   2965      1.1  nonaka 	uint32_t tmp;
   2966      1.1  nonaka 
   2967      1.1  nonaka 	run_read(sc, RT2860_AUTO_RSP_CFG, &tmp);
   2968      1.1  nonaka 	if (sc->sc_ic.ic_flags & IEEE80211_F_SHPREAMBLE)
   2969      1.1  nonaka 		tmp |= RT2860_CCK_SHORT_EN;
   2970      1.1  nonaka 	else
   2971      1.1  nonaka 		tmp &= ~RT2860_CCK_SHORT_EN;
   2972      1.1  nonaka 	run_write(sc, RT2860_AUTO_RSP_CFG, tmp);
   2973      1.1  nonaka }
   2974      1.1  nonaka 
   2975      1.1  nonaka static void
   2976      1.1  nonaka run_set_basicrates(struct run_softc *sc)
   2977      1.1  nonaka {
   2978      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   2979      1.1  nonaka 
   2980      1.1  nonaka 	/* set basic rates mask */
   2981      1.1  nonaka 	if (ic->ic_curmode == IEEE80211_MODE_11B)
   2982      1.1  nonaka 		run_write(sc, RT2860_LEGACY_BASIC_RATE, 0x003);
   2983      1.1  nonaka 	else if (ic->ic_curmode == IEEE80211_MODE_11A)
   2984      1.1  nonaka 		run_write(sc, RT2860_LEGACY_BASIC_RATE, 0x150);
   2985      1.1  nonaka 	else	/* 11g */
   2986      1.1  nonaka 		run_write(sc, RT2860_LEGACY_BASIC_RATE, 0x15f);
   2987      1.1  nonaka }
   2988      1.1  nonaka 
   2989      1.1  nonaka static void
   2990      1.1  nonaka run_set_leds(struct run_softc *sc, uint16_t which)
   2991      1.1  nonaka {
   2992      1.1  nonaka 
   2993      1.1  nonaka 	(void)run_mcu_cmd(sc, RT2860_MCU_CMD_LEDS,
   2994      1.1  nonaka 	    which | (sc->leds & 0x7f));
   2995      1.1  nonaka }
   2996      1.1  nonaka 
   2997      1.1  nonaka static void
   2998      1.1  nonaka run_set_bssid(struct run_softc *sc, const uint8_t *bssid)
   2999      1.1  nonaka {
   3000      1.1  nonaka 
   3001      1.1  nonaka 	run_write(sc, RT2860_MAC_BSSID_DW0,
   3002      1.1  nonaka 	    bssid[0] | bssid[1] << 8 | bssid[2] << 16 | bssid[3] << 24);
   3003      1.1  nonaka 	run_write(sc, RT2860_MAC_BSSID_DW1,
   3004      1.1  nonaka 	    bssid[4] | bssid[5] << 8);
   3005      1.1  nonaka }
   3006      1.1  nonaka 
   3007      1.1  nonaka static void
   3008      1.1  nonaka run_set_macaddr(struct run_softc *sc, const uint8_t *addr)
   3009      1.1  nonaka {
   3010      1.1  nonaka 
   3011      1.1  nonaka 	run_write(sc, RT2860_MAC_ADDR_DW0,
   3012      1.1  nonaka 	    addr[0] | addr[1] << 8 | addr[2] << 16 | addr[3] << 24);
   3013      1.1  nonaka 	run_write(sc, RT2860_MAC_ADDR_DW1,
   3014      1.1  nonaka 	    addr[4] | addr[5] << 8 | 0xff << 16);
   3015      1.1  nonaka }
   3016      1.1  nonaka 
   3017      1.1  nonaka static void
   3018      1.1  nonaka run_updateslot(struct ifnet *ifp)
   3019      1.1  nonaka {
   3020      1.1  nonaka 
   3021      1.1  nonaka 	/* do it in a process context */
   3022      1.1  nonaka 	run_do_async(ifp->if_softc, run_updateslot_cb, NULL, 0);
   3023      1.1  nonaka }
   3024      1.1  nonaka 
   3025      1.1  nonaka /* ARGSUSED */
   3026      1.1  nonaka static void
   3027      1.1  nonaka run_updateslot_cb(struct run_softc *sc, void *arg)
   3028      1.1  nonaka {
   3029      1.1  nonaka 	uint32_t tmp;
   3030      1.1  nonaka 
   3031      1.1  nonaka 	run_read(sc, RT2860_BKOFF_SLOT_CFG, &tmp);
   3032      1.1  nonaka 	tmp &= ~0xff;
   3033      1.1  nonaka 	tmp |= (sc->sc_ic.ic_flags & IEEE80211_F_SHSLOT) ? 9 : 20;
   3034      1.1  nonaka 	run_write(sc, RT2860_BKOFF_SLOT_CFG, tmp);
   3035      1.1  nonaka }
   3036      1.1  nonaka 
   3037      1.1  nonaka static int8_t
   3038      1.1  nonaka run_rssi2dbm(struct run_softc *sc, uint8_t rssi, uint8_t rxchain)
   3039      1.1  nonaka {
   3040      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   3041      1.1  nonaka 	struct ieee80211_channel *c = ic->ic_curchan;
   3042      1.1  nonaka 	int delta;
   3043      1.1  nonaka 
   3044      1.1  nonaka 	if (IEEE80211_IS_CHAN_5GHZ(c)) {
   3045      1.1  nonaka 		u_int chan = ieee80211_chan2ieee(ic, c);
   3046      1.1  nonaka 		delta = sc->rssi_5ghz[rxchain];
   3047      1.1  nonaka 
   3048      1.1  nonaka 		/* determine channel group */
   3049      1.1  nonaka 		if (chan <= 64)
   3050      1.1  nonaka 			delta -= sc->lna[1];
   3051      1.1  nonaka 		else if (chan <= 128)
   3052      1.1  nonaka 			delta -= sc->lna[2];
   3053      1.1  nonaka 		else
   3054      1.1  nonaka 			delta -= sc->lna[3];
   3055      1.1  nonaka 	} else
   3056      1.1  nonaka 		delta = sc->rssi_2ghz[rxchain] - sc->lna[0];
   3057      1.1  nonaka 
   3058      1.1  nonaka 	return (-12 - delta - rssi);
   3059      1.1  nonaka }
   3060      1.1  nonaka 
   3061      1.1  nonaka static int
   3062      1.1  nonaka run_bbp_init(struct run_softc *sc)
   3063      1.1  nonaka {
   3064      1.1  nonaka 	int i, error, ntries;
   3065      1.1  nonaka 	uint8_t bbp0;
   3066      1.1  nonaka 
   3067      1.1  nonaka 	/* wait for BBP to wake up */
   3068      1.1  nonaka 	for (ntries = 0; ntries < 20; ntries++) {
   3069      1.1  nonaka 		if ((error = run_bbp_read(sc, 0, &bbp0)) != 0)
   3070      1.1  nonaka 			return (error);
   3071      1.1  nonaka 		if (bbp0 != 0 && bbp0 != 0xff)
   3072      1.1  nonaka 			break;
   3073      1.1  nonaka 	}
   3074      1.1  nonaka 	if (ntries == 20)
   3075      1.1  nonaka 		return (ETIMEDOUT);
   3076      1.1  nonaka 
   3077      1.1  nonaka 	/* initialize BBP registers to default values */
   3078      1.1  nonaka 	for (i = 0; i < (int)__arraycount(rt2860_def_bbp); i++) {
   3079      1.1  nonaka 		run_bbp_write(sc, rt2860_def_bbp[i].reg,
   3080      1.1  nonaka 		    rt2860_def_bbp[i].val);
   3081      1.1  nonaka 	}
   3082      1.1  nonaka 
   3083      1.1  nonaka 	/* fix BBP84 for RT2860E */
   3084      1.1  nonaka 	if (sc->mac_ver == 0x2860 && sc->mac_rev != 0x0101)
   3085      1.1  nonaka 		run_bbp_write(sc, 84, 0x19);
   3086      1.1  nonaka 
   3087      1.1  nonaka 	if (sc->mac_ver >= 0x3070) {
   3088      1.1  nonaka 		run_bbp_write(sc, 79, 0x13);
   3089      1.1  nonaka 		run_bbp_write(sc, 80, 0x05);
   3090      1.1  nonaka 		run_bbp_write(sc, 81, 0x33);
   3091      1.1  nonaka 	} else if (sc->mac_ver == 0x2860 && sc->mac_rev == 0x0100) {
   3092      1.1  nonaka 		run_bbp_write(sc, 69, 0x16);
   3093      1.1  nonaka 		run_bbp_write(sc, 73, 0x12);
   3094      1.1  nonaka 	}
   3095      1.1  nonaka 	return (0);
   3096      1.1  nonaka }
   3097      1.1  nonaka 
   3098      1.1  nonaka static int
   3099      1.1  nonaka run_rt3070_rf_init(struct run_softc *sc)
   3100      1.1  nonaka {
   3101      1.1  nonaka 	uint32_t tmp;
   3102      1.1  nonaka 	uint8_t rf, target, bbp4;
   3103      1.1  nonaka 	int i;
   3104      1.1  nonaka 
   3105      1.1  nonaka 	run_rt3070_rf_read(sc, 30, &rf);
   3106      1.1  nonaka 	/* toggle RF R30 bit 7 */
   3107      1.1  nonaka 	run_rt3070_rf_write(sc, 30, rf | 0x80);
   3108      1.1  nonaka 	DELAY(1000);
   3109      1.1  nonaka 	run_rt3070_rf_write(sc, 30, rf & ~0x80);
   3110      1.1  nonaka 
   3111      1.1  nonaka 	/* initialize RF registers to default value */
   3112      1.1  nonaka 	if (sc->mac_ver == 0x3572) {
   3113      1.1  nonaka 		for (i = 0; i < (int)__arraycount(rt3572_def_rf); i++) {
   3114      1.1  nonaka 			run_rt3070_rf_write(sc, rt3572_def_rf[i].reg,
   3115      1.1  nonaka 			    rt3572_def_rf[i].val);
   3116      1.1  nonaka 		}
   3117      1.1  nonaka 	} else {
   3118      1.1  nonaka 		for (i = 0; i < (int)__arraycount(rt3070_def_rf); i++) {
   3119      1.1  nonaka 			run_rt3070_rf_write(sc, rt3070_def_rf[i].reg,
   3120      1.1  nonaka 			    rt3070_def_rf[i].val);
   3121      1.1  nonaka 		}
   3122      1.1  nonaka 	}
   3123      1.1  nonaka 	if (sc->mac_ver == 0x3572) {
   3124      1.1  nonaka 		run_rt3070_rf_read(sc, 6, &rf);
   3125      1.1  nonaka 		run_rt3070_rf_write(sc, 6, rf | 0x40);
   3126      1.1  nonaka 
   3127      1.1  nonaka 		/* increase voltage from 1.2V to 1.35V */
   3128      1.1  nonaka 		run_read(sc, RT3070_LDO_CFG0, &tmp);
   3129      1.1  nonaka 		tmp = (tmp & ~0x1f000000) | 0x0d000000;
   3130      1.1  nonaka 		run_write(sc, RT3070_LDO_CFG0, tmp);
   3131      1.1  nonaka 		if (sc->mac_rev >= 0x0211 || !sc->patch_dac) {
   3132      1.1  nonaka 			/* decrease voltage back to 1.2V */
   3133      1.1  nonaka 			DELAY(1000);
   3134      1.1  nonaka 			tmp = (tmp & ~0x1f000000) | 0x01000000;
   3135      1.1  nonaka 			run_write(sc, RT3070_LDO_CFG0, tmp);
   3136      1.1  nonaka 		}
   3137      1.1  nonaka 	} else if (sc->mac_ver == 0x3071) {
   3138      1.1  nonaka 		run_rt3070_rf_read(sc, 6, &rf);
   3139      1.1  nonaka 		run_rt3070_rf_write(sc, 6, rf | 0x40);
   3140      1.1  nonaka 		run_rt3070_rf_write(sc, 31, 0x14);
   3141      1.1  nonaka 
   3142      1.1  nonaka 		run_read(sc, RT3070_LDO_CFG0, &tmp);
   3143      1.1  nonaka 		tmp &= ~0x1f000000;
   3144      1.1  nonaka 		if (sc->mac_rev < 0x0211)
   3145      1.1  nonaka 			tmp |= 0x0d000000;	/* 1.35V */
   3146      1.1  nonaka 		else
   3147      1.1  nonaka 			tmp |= 0x01000000;	/* 1.2V */
   3148      1.1  nonaka 		run_write(sc, RT3070_LDO_CFG0, tmp);
   3149      1.1  nonaka 
   3150      1.1  nonaka 		/* patch LNA_PE_G1 */
   3151      1.1  nonaka 		run_read(sc, RT3070_GPIO_SWITCH, &tmp);
   3152      1.1  nonaka 		run_write(sc, RT3070_GPIO_SWITCH, tmp & ~0x20);
   3153      1.1  nonaka 	} else if (sc->mac_ver == 0x3070) {
   3154      1.1  nonaka 		/* increase voltage from 1.2V to 1.35V */
   3155      1.1  nonaka 		run_read(sc, RT3070_LDO_CFG0, &tmp);
   3156      1.1  nonaka 		tmp = (tmp & ~0x0f000000) | 0x0d000000;
   3157      1.1  nonaka 		run_write(sc, RT3070_LDO_CFG0, tmp);
   3158      1.1  nonaka 	}
   3159      1.1  nonaka 
   3160      1.1  nonaka 	/* select 20MHz bandwidth */
   3161      1.1  nonaka 	run_rt3070_rf_read(sc, 31, &rf);
   3162      1.1  nonaka 	run_rt3070_rf_write(sc, 31, rf & ~0x20);
   3163      1.1  nonaka 
   3164      1.1  nonaka 	/* calibrate filter for 20MHz bandwidth */
   3165      1.1  nonaka 	sc->rf24_20mhz = 0x1f;	/* default value */
   3166      1.1  nonaka 	target = (sc->mac_ver < 0x3071) ? 0x16 : 0x13;
   3167      1.1  nonaka 	run_rt3070_filter_calib(sc, 0x07, target, &sc->rf24_20mhz);
   3168      1.1  nonaka 
   3169      1.1  nonaka 	/* select 40MHz bandwidth */
   3170      1.1  nonaka 	run_bbp_read(sc, 4, &bbp4);
   3171      1.1  nonaka 	run_bbp_write(sc, 4, (bbp4 & ~0x08) | 0x10);
   3172      1.1  nonaka 	run_rt3070_rf_read(sc, 31, &rf);
   3173      1.1  nonaka 	run_rt3070_rf_write(sc, 31, rf | 0x20);
   3174      1.1  nonaka 
   3175      1.1  nonaka 	/* calibrate filter for 40MHz bandwidth */
   3176      1.1  nonaka 	sc->rf24_40mhz = 0x2f;	/* default value */
   3177      1.1  nonaka 	target = (sc->mac_ver < 0x3071) ? 0x19 : 0x15;
   3178      1.1  nonaka 	run_rt3070_filter_calib(sc, 0x27, target, &sc->rf24_40mhz);
   3179      1.1  nonaka 
   3180      1.1  nonaka 	/* go back to 20MHz bandwidth */
   3181      1.1  nonaka 	run_bbp_read(sc, 4, &bbp4);
   3182      1.1  nonaka 	run_bbp_write(sc, 4, bbp4 & ~0x18);
   3183      1.1  nonaka 
   3184      1.1  nonaka 	if (sc->mac_ver == 0x3572) {
   3185      1.1  nonaka 		/* save default BBP registers 25 and 26 values */
   3186      1.1  nonaka 		run_bbp_read(sc, 25, &sc->bbp25);
   3187      1.1  nonaka 		run_bbp_read(sc, 26, &sc->bbp26);
   3188      1.1  nonaka 	} else if (sc->mac_rev < 0x0211)
   3189      1.1  nonaka 		run_rt3070_rf_write(sc, 27, 0x03);
   3190      1.1  nonaka 
   3191      1.1  nonaka 	run_read(sc, RT3070_OPT_14, &tmp);
   3192      1.1  nonaka 	run_write(sc, RT3070_OPT_14, tmp | 1);
   3193      1.1  nonaka 
   3194      1.1  nonaka 	if (sc->mac_ver == 0x3070 || sc->mac_ver == 0x3071) {
   3195      1.1  nonaka 		run_rt3070_rf_read(sc, 17, &rf);
   3196      1.1  nonaka 		rf &= ~RT3070_TX_LO1;
   3197      1.1  nonaka 		if ((sc->mac_ver == 0x3070 ||
   3198      1.1  nonaka 		     (sc->mac_ver == 0x3071 && sc->mac_rev >= 0x0211)) &&
   3199      1.1  nonaka 		    !sc->ext_2ghz_lna)
   3200      1.1  nonaka 			rf |= 0x20;	/* fix for long range Rx issue */
   3201      1.1  nonaka 		if (sc->txmixgain_2ghz >= 1)
   3202      1.1  nonaka 			rf = (rf & ~0x7) | sc->txmixgain_2ghz;
   3203      1.1  nonaka 		run_rt3070_rf_write(sc, 17, rf);
   3204      1.1  nonaka 	}
   3205      1.1  nonaka 	if (sc->mac_ver == 0x3071) {
   3206      1.1  nonaka 		run_rt3070_rf_read(sc, 1, &rf);
   3207      1.1  nonaka 		rf &= ~(RT3070_RX0_PD | RT3070_TX0_PD);
   3208      1.1  nonaka 		rf |= RT3070_RF_BLOCK | RT3070_RX1_PD | RT3070_TX1_PD;
   3209      1.1  nonaka 		run_rt3070_rf_write(sc, 1, rf);
   3210      1.1  nonaka 
   3211      1.1  nonaka 		run_rt3070_rf_read(sc, 15, &rf);
   3212      1.1  nonaka 		run_rt3070_rf_write(sc, 15, rf & ~RT3070_TX_LO2);
   3213      1.1  nonaka 
   3214      1.1  nonaka 		run_rt3070_rf_read(sc, 20, &rf);
   3215      1.1  nonaka 		run_rt3070_rf_write(sc, 20, rf & ~RT3070_RX_LO1);
   3216      1.1  nonaka 
   3217      1.1  nonaka 		run_rt3070_rf_read(sc, 21, &rf);
   3218      1.1  nonaka 		run_rt3070_rf_write(sc, 21, rf & ~RT3070_RX_LO2);
   3219      1.1  nonaka 	}
   3220      1.1  nonaka 	if (sc->mac_ver == 0x3070 || sc->mac_ver == 0x3071) {
   3221      1.1  nonaka 		/* fix Tx to Rx IQ glitch by raising RF voltage */
   3222      1.1  nonaka 		run_rt3070_rf_read(sc, 27, &rf);
   3223      1.1  nonaka 		rf &= ~0x77;
   3224      1.1  nonaka 		if (sc->mac_rev < 0x0211)
   3225      1.1  nonaka 			rf |= 0x03;
   3226      1.1  nonaka 		run_rt3070_rf_write(sc, 27, rf);
   3227      1.1  nonaka 	}
   3228      1.1  nonaka 	return (0);
   3229      1.1  nonaka }
   3230      1.1  nonaka 
   3231      1.1  nonaka static int
   3232      1.1  nonaka run_rt3070_filter_calib(struct run_softc *sc, uint8_t init, uint8_t target,
   3233      1.1  nonaka     uint8_t *val)
   3234      1.1  nonaka {
   3235      1.1  nonaka 	uint8_t rf22, rf24;
   3236      1.1  nonaka 	uint8_t bbp55_pb, bbp55_sb, delta;
   3237      1.1  nonaka 	int ntries;
   3238      1.1  nonaka 
   3239      1.1  nonaka 	/* program filter */
   3240      1.1  nonaka 	run_rt3070_rf_read(sc, 24, &rf24);
   3241      1.1  nonaka 	rf24 = (rf24 & 0xc0) | init;    /* initial filter value */
   3242      1.1  nonaka 	run_rt3070_rf_write(sc, 24, rf24);
   3243      1.1  nonaka 
   3244      1.1  nonaka 	/* enable baseband loopback mode */
   3245      1.1  nonaka 	run_rt3070_rf_read(sc, 22, &rf22);
   3246      1.1  nonaka 	run_rt3070_rf_write(sc, 22, rf22 | 0x01);
   3247      1.1  nonaka 
   3248      1.1  nonaka 	/* set power and frequency of passband test tone */
   3249      1.1  nonaka 	run_bbp_write(sc, 24, 0x00);
   3250      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   3251      1.1  nonaka 		/* transmit test tone */
   3252      1.1  nonaka 		run_bbp_write(sc, 25, 0x90);
   3253      1.1  nonaka 		DELAY(1000);
   3254      1.1  nonaka 		/* read received power */
   3255      1.1  nonaka 		run_bbp_read(sc, 55, &bbp55_pb);
   3256      1.1  nonaka 		if (bbp55_pb != 0)
   3257      1.1  nonaka 			break;
   3258      1.1  nonaka 	}
   3259      1.1  nonaka 	if (ntries == 100)
   3260      1.1  nonaka 		return (ETIMEDOUT);
   3261      1.1  nonaka 
   3262      1.1  nonaka 	/* set power and frequency of stopband test tone */
   3263      1.1  nonaka 	run_bbp_write(sc, 24, 0x06);
   3264      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   3265      1.1  nonaka 		/* transmit test tone */
   3266      1.1  nonaka 		run_bbp_write(sc, 25, 0x90);
   3267      1.1  nonaka 		DELAY(1000);
   3268      1.1  nonaka 		/* read received power */
   3269      1.1  nonaka 		run_bbp_read(sc, 55, &bbp55_sb);
   3270      1.1  nonaka 
   3271      1.1  nonaka 		delta = bbp55_pb - bbp55_sb;
   3272      1.1  nonaka 		if (delta > target)
   3273      1.1  nonaka 			break;
   3274      1.1  nonaka 
   3275      1.1  nonaka 		/* reprogram filter */
   3276      1.1  nonaka 		rf24++;
   3277      1.1  nonaka 		run_rt3070_rf_write(sc, 24, rf24);
   3278      1.1  nonaka 	}
   3279      1.1  nonaka 	if (ntries < 100) {
   3280      1.1  nonaka 		if (rf24 != init)
   3281      1.1  nonaka 			rf24--;	/* backtrack */
   3282      1.1  nonaka 		*val = rf24;
   3283      1.1  nonaka 		run_rt3070_rf_write(sc, 24, rf24);
   3284      1.1  nonaka 	}
   3285      1.1  nonaka 
   3286      1.1  nonaka 	/* restore initial state */
   3287      1.1  nonaka 	run_bbp_write(sc, 24, 0x00);
   3288      1.1  nonaka 
   3289      1.1  nonaka 	/* disable baseband loopback mode */
   3290      1.1  nonaka 	run_rt3070_rf_read(sc, 22, &rf22);
   3291      1.1  nonaka 	run_rt3070_rf_write(sc, 22, rf22 & ~0x01);
   3292      1.1  nonaka 
   3293      1.1  nonaka 	return (0);
   3294      1.1  nonaka }
   3295      1.1  nonaka 
   3296      1.1  nonaka static void
   3297      1.1  nonaka run_rt3070_rf_setup(struct run_softc *sc)
   3298      1.1  nonaka {
   3299      1.1  nonaka 	uint8_t bbp, rf;
   3300      1.1  nonaka 	int i;
   3301      1.1  nonaka 
   3302      1.1  nonaka 	if (sc->mac_ver == 0x3572) {
   3303      1.1  nonaka 		/* enable DC filter */
   3304      1.1  nonaka 		if (sc->mac_rev >= 0x0201)
   3305      1.1  nonaka 			run_bbp_write(sc, 103, 0xc0);
   3306      1.1  nonaka 
   3307      1.1  nonaka 		run_bbp_read(sc, 138, &bbp);
   3308      1.1  nonaka 		if (sc->ntxchains == 1)
   3309      1.1  nonaka 			bbp |= 0x20;	/* turn off DAC1 */
   3310      1.1  nonaka 		if (sc->nrxchains == 1)
   3311      1.1  nonaka 			bbp &= ~0x02;	/* turn off ADC1 */
   3312      1.1  nonaka 		run_bbp_write(sc, 138, bbp);
   3313      1.1  nonaka 
   3314      1.1  nonaka 		if (sc->mac_rev >= 0x0211) {
   3315      1.1  nonaka 			/* improve power consumption */
   3316      1.1  nonaka 			run_bbp_read(sc, 31, &bbp);
   3317      1.1  nonaka 			run_bbp_write(sc, 31, bbp & ~0x03);
   3318      1.1  nonaka 		}
   3319      1.1  nonaka 
   3320      1.1  nonaka 		run_rt3070_rf_read(sc, 16, &rf);
   3321      1.1  nonaka 		rf = (rf & ~0x07) | sc->txmixgain_2ghz;
   3322      1.1  nonaka 		run_rt3070_rf_write(sc, 16, rf);
   3323      1.1  nonaka 	} else if (sc->mac_ver == 0x3071) {
   3324      1.1  nonaka 		/* enable DC filter */
   3325      1.1  nonaka 		if (sc->mac_rev >= 0x0201)
   3326      1.1  nonaka 			run_bbp_write(sc, 103, 0xc0);
   3327      1.1  nonaka 
   3328      1.1  nonaka 		run_bbp_read(sc, 138, &bbp);
   3329      1.1  nonaka 		if (sc->ntxchains == 1)
   3330      1.1  nonaka 			bbp |= 0x20;	/* turn off DAC1 */
   3331      1.1  nonaka 		if (sc->nrxchains == 1)
   3332      1.1  nonaka 			bbp &= ~0x02;	/* turn off ADC1 */
   3333      1.1  nonaka 		run_bbp_write(sc, 138, bbp);
   3334      1.1  nonaka 
   3335      1.1  nonaka 		if (sc->mac_rev >= 0x0211) {
   3336      1.1  nonaka 			/* improve power consumption */
   3337      1.1  nonaka 			run_bbp_read(sc, 31, &bbp);
   3338      1.1  nonaka 			run_bbp_write(sc, 31, bbp & ~0x03);
   3339      1.1  nonaka 		}
   3340      1.1  nonaka 
   3341      1.1  nonaka 		run_write(sc, RT2860_TX_SW_CFG1, 0);
   3342      1.1  nonaka 		if (sc->mac_rev < 0x0211) {
   3343      1.1  nonaka 			run_write(sc, RT2860_TX_SW_CFG2,
   3344      1.1  nonaka 			    sc->patch_dac ? 0x2c : 0x0f);
   3345      1.1  nonaka 		} else
   3346      1.1  nonaka 			run_write(sc, RT2860_TX_SW_CFG2, 0);
   3347      1.1  nonaka 	} else if (sc->mac_ver == 0x3070) {
   3348      1.1  nonaka 		if (sc->mac_rev >= 0x0201) {
   3349      1.1  nonaka 			/* enable DC filter */
   3350      1.1  nonaka 			run_bbp_write(sc, 103, 0xc0);
   3351      1.1  nonaka 
   3352      1.1  nonaka 			/* improve power consumption */
   3353      1.1  nonaka 			run_bbp_read(sc, 31, &bbp);
   3354      1.1  nonaka 			run_bbp_write(sc, 31, bbp & ~0x03);
   3355      1.1  nonaka 		}
   3356      1.1  nonaka 
   3357      1.1  nonaka 		if (sc->mac_rev < 0x0211) {
   3358      1.1  nonaka 			run_write(sc, RT2860_TX_SW_CFG1, 0);
   3359      1.1  nonaka 			run_write(sc, RT2860_TX_SW_CFG2, 0x2c);
   3360      1.1  nonaka 		} else
   3361      1.1  nonaka 			run_write(sc, RT2860_TX_SW_CFG2, 0);
   3362      1.1  nonaka 	}
   3363      1.1  nonaka 
   3364      1.1  nonaka 	/* initialize RF registers from ROM for >=RT3071*/
   3365      1.1  nonaka 	if (sc->mac_ver >= 0x3071) {
   3366      1.1  nonaka 		for (i = 0; i < 10; i++) {
   3367      1.1  nonaka 			if (sc->rf[i].reg == 0 || sc->rf[i].reg == 0xff)
   3368      1.1  nonaka 				continue;
   3369      1.1  nonaka 			run_rt3070_rf_write(sc, sc->rf[i].reg, sc->rf[i].val);
   3370      1.1  nonaka 		}
   3371      1.1  nonaka 	}
   3372      1.1  nonaka }
   3373      1.1  nonaka 
   3374      1.1  nonaka static int
   3375      1.1  nonaka run_txrx_enable(struct run_softc *sc)
   3376      1.1  nonaka {
   3377      1.1  nonaka 	uint32_t tmp;
   3378      1.1  nonaka 	int error, ntries;
   3379      1.1  nonaka 
   3380      1.1  nonaka 	run_write(sc, RT2860_MAC_SYS_CTRL, RT2860_MAC_TX_EN);
   3381      1.1  nonaka 	for (ntries = 0; ntries < 200; ntries++) {
   3382      1.1  nonaka 		if ((error = run_read(sc, RT2860_WPDMA_GLO_CFG, &tmp)) != 0)
   3383      1.1  nonaka 			return (error);
   3384      1.1  nonaka 		if ((tmp & (RT2860_TX_DMA_BUSY | RT2860_RX_DMA_BUSY)) == 0)
   3385      1.1  nonaka 			break;
   3386      1.1  nonaka 		DELAY(1000);
   3387      1.1  nonaka 	}
   3388      1.1  nonaka 	if (ntries == 200)
   3389      1.1  nonaka 		return (ETIMEDOUT);
   3390      1.1  nonaka 
   3391      1.1  nonaka 	DELAY(50);
   3392      1.1  nonaka 
   3393      1.1  nonaka 	tmp |= RT2860_RX_DMA_EN | RT2860_TX_DMA_EN | RT2860_TX_WB_DDONE;
   3394      1.1  nonaka 	run_write(sc, RT2860_WPDMA_GLO_CFG, tmp);
   3395      1.1  nonaka 
   3396      1.1  nonaka 	/* enable Rx bulk aggregation (set timeout and limit) */
   3397      1.1  nonaka 	tmp = RT2860_USB_TX_EN | RT2860_USB_RX_EN | RT2860_USB_RX_AGG_EN |
   3398      1.1  nonaka 	    RT2860_USB_RX_AGG_TO(128) | RT2860_USB_RX_AGG_LMT(2);
   3399      1.1  nonaka 	run_write(sc, RT2860_USB_DMA_CFG, tmp);
   3400      1.1  nonaka 
   3401      1.1  nonaka 	/* set Rx filter */
   3402      1.1  nonaka 	tmp = RT2860_DROP_CRC_ERR | RT2860_DROP_PHY_ERR;
   3403      1.1  nonaka 	if (sc->sc_ic.ic_opmode != IEEE80211_M_MONITOR) {
   3404      1.1  nonaka 		tmp |= RT2860_DROP_UC_NOME | RT2860_DROP_DUPL |
   3405      1.1  nonaka 		    RT2860_DROP_CTS | RT2860_DROP_BA | RT2860_DROP_ACK |
   3406      1.1  nonaka 		    RT2860_DROP_VER_ERR | RT2860_DROP_CTRL_RSV |
   3407      1.1  nonaka 		    RT2860_DROP_CFACK | RT2860_DROP_CFEND;
   3408      1.1  nonaka 		if (sc->sc_ic.ic_opmode == IEEE80211_M_STA)
   3409      1.1  nonaka 			tmp |= RT2860_DROP_RTS | RT2860_DROP_PSPOLL;
   3410      1.1  nonaka 	}
   3411      1.1  nonaka 	run_write(sc, RT2860_RX_FILTR_CFG, tmp);
   3412      1.1  nonaka 
   3413      1.1  nonaka 	run_write(sc, RT2860_MAC_SYS_CTRL,
   3414      1.1  nonaka 	    RT2860_MAC_RX_EN | RT2860_MAC_TX_EN);
   3415      1.1  nonaka 
   3416      1.1  nonaka 	return (0);
   3417      1.1  nonaka }
   3418      1.1  nonaka 
   3419      1.1  nonaka static int
   3420      1.1  nonaka run_init(struct ifnet *ifp)
   3421      1.1  nonaka {
   3422      1.1  nonaka 	struct run_softc *sc = ifp->if_softc;
   3423      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   3424      1.1  nonaka 	uint32_t tmp;
   3425      1.1  nonaka 	uint8_t bbp1, bbp3;
   3426      1.1  nonaka 	int i, error, qid, ridx, ntries;
   3427      1.1  nonaka 
   3428      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   3429      1.1  nonaka 		if ((error = run_read(sc, RT2860_ASIC_VER_ID, &tmp)) != 0)
   3430      1.1  nonaka 			goto fail;
   3431      1.1  nonaka 		if (tmp != 0 && tmp != 0xffffffff)
   3432      1.1  nonaka 			break;
   3433      1.1  nonaka 		DELAY(10);
   3434      1.1  nonaka 	}
   3435      1.1  nonaka 	if (ntries == 100) {
   3436      1.1  nonaka 		error = ETIMEDOUT;
   3437      1.1  nonaka 		goto fail;
   3438      1.1  nonaka 	}
   3439      1.1  nonaka 
   3440      1.1  nonaka 	if ((sc->sc_flags & RUN_FWLOADED) == 0 &&
   3441      1.1  nonaka 	    (error = run_load_microcode(sc)) != 0) {
   3442      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   3443      1.1  nonaka 		    "could not load 8051 microcode\n");
   3444      1.1  nonaka 		goto fail;
   3445      1.1  nonaka 	}
   3446      1.1  nonaka 
   3447      1.1  nonaka 	if (ifp->if_flags & IFF_RUNNING)
   3448      1.1  nonaka 		run_stop(ifp, 0);
   3449      1.1  nonaka 
   3450      1.1  nonaka 	/* init host command ring */
   3451      1.1  nonaka 	sc->cmdq.cur = sc->cmdq.next = sc->cmdq.queued = 0;
   3452      1.1  nonaka 
   3453      1.1  nonaka 	/* init Tx rings (4 EDCAs) */
   3454      1.1  nonaka 	for (qid = 0; qid < 4; qid++) {
   3455      1.1  nonaka 		if ((error = run_alloc_tx_ring(sc, qid)) != 0)
   3456      1.1  nonaka 			goto fail;
   3457      1.1  nonaka 	}
   3458      1.1  nonaka 	/* init Rx ring */
   3459      1.1  nonaka 	if ((error = run_alloc_rx_ring(sc)) != 0)
   3460      1.1  nonaka 		goto fail;
   3461      1.1  nonaka 
   3462      1.1  nonaka 	IEEE80211_ADDR_COPY(ic->ic_myaddr, CLLADDR(ifp->if_sadl));
   3463      1.1  nonaka 	run_set_macaddr(sc, ic->ic_myaddr);
   3464      1.1  nonaka 
   3465      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   3466      1.1  nonaka 		if ((error = run_read(sc, RT2860_WPDMA_GLO_CFG, &tmp)) != 0)
   3467      1.1  nonaka 			goto fail;
   3468      1.1  nonaka 		if ((tmp & (RT2860_TX_DMA_BUSY | RT2860_RX_DMA_BUSY)) == 0)
   3469      1.1  nonaka 			break;
   3470      1.1  nonaka 		DELAY(1000);
   3471      1.1  nonaka 	}
   3472      1.1  nonaka 	if (ntries == 100) {
   3473      1.1  nonaka 		aprint_error_dev(sc->sc_dev,
   3474      1.1  nonaka 		    "timeout waiting for DMA engine\n");
   3475      1.1  nonaka 		error = ETIMEDOUT;
   3476      1.1  nonaka 		goto fail;
   3477      1.1  nonaka 	}
   3478      1.1  nonaka 	tmp &= 0xff0;
   3479      1.1  nonaka 	tmp |= RT2860_TX_WB_DDONE;
   3480      1.1  nonaka 	run_write(sc, RT2860_WPDMA_GLO_CFG, tmp);
   3481      1.1  nonaka 
   3482      1.1  nonaka 	/* turn off PME_OEN to solve high-current issue */
   3483      1.1  nonaka 	run_read(sc, RT2860_SYS_CTRL, &tmp);
   3484      1.1  nonaka 	run_write(sc, RT2860_SYS_CTRL, tmp & ~RT2860_PME_OEN);
   3485      1.1  nonaka 
   3486      1.1  nonaka 	run_write(sc, RT2860_MAC_SYS_CTRL,
   3487      1.1  nonaka 	    RT2860_BBP_HRST | RT2860_MAC_SRST);
   3488      1.1  nonaka 	run_write(sc, RT2860_USB_DMA_CFG, 0);
   3489      1.1  nonaka 
   3490      1.1  nonaka 	if ((error = run_reset(sc)) != 0) {
   3491      1.1  nonaka 		aprint_error_dev(sc->sc_dev, "could not reset chipset\n");
   3492      1.1  nonaka 		goto fail;
   3493      1.1  nonaka 	}
   3494      1.1  nonaka 
   3495      1.1  nonaka 	run_write(sc, RT2860_MAC_SYS_CTRL, 0);
   3496      1.1  nonaka 
   3497      1.1  nonaka 	/* init Tx power for all Tx rates (from EEPROM) */
   3498      1.1  nonaka 	for (ridx = 0; ridx < 5; ridx++) {
   3499      1.1  nonaka 		if (sc->txpow20mhz[ridx] == 0xffffffff)
   3500      1.1  nonaka 			continue;
   3501      1.1  nonaka 		run_write(sc, RT2860_TX_PWR_CFG(ridx), sc->txpow20mhz[ridx]);
   3502      1.1  nonaka 	}
   3503      1.1  nonaka 
   3504      1.1  nonaka 	for (i = 0; i < (int)__arraycount(rt2870_def_mac); i++)
   3505      1.1  nonaka 		run_write(sc, rt2870_def_mac[i].reg, rt2870_def_mac[i].val);
   3506      1.1  nonaka 	run_write(sc, RT2860_WMM_AIFSN_CFG, 0x00002273);
   3507      1.1  nonaka 	run_write(sc, RT2860_WMM_CWMIN_CFG, 0x00002344);
   3508      1.1  nonaka 	run_write(sc, RT2860_WMM_CWMAX_CFG, 0x000034aa);
   3509      1.1  nonaka 
   3510      1.1  nonaka 	if (sc->mac_ver >= 0x3070) {
   3511      1.1  nonaka 		/* set delay of PA_PE assertion to 1us (unit of 0.25us) */
   3512      1.1  nonaka 		run_write(sc, RT2860_TX_SW_CFG0,
   3513      1.1  nonaka 		    4 << RT2860_DLY_PAPE_EN_SHIFT);
   3514      1.1  nonaka 	}
   3515      1.1  nonaka 
   3516      1.1  nonaka 	/* wait while MAC is busy */
   3517      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   3518      1.1  nonaka 		if ((error = run_read(sc, RT2860_MAC_STATUS_REG, &tmp)) != 0)
   3519      1.1  nonaka 			goto fail;
   3520      1.1  nonaka 		if (!(tmp & (RT2860_RX_STATUS_BUSY | RT2860_TX_STATUS_BUSY)))
   3521      1.1  nonaka 			break;
   3522      1.1  nonaka 		DELAY(1000);
   3523      1.1  nonaka 	}
   3524      1.1  nonaka 	if (ntries == 100) {
   3525      1.1  nonaka 		error = ETIMEDOUT;
   3526      1.1  nonaka 		goto fail;
   3527      1.1  nonaka 	}
   3528      1.1  nonaka 
   3529      1.1  nonaka 	/* clear Host to MCU mailbox */
   3530      1.1  nonaka 	run_write(sc, RT2860_H2M_BBPAGENT, 0);
   3531      1.1  nonaka 	run_write(sc, RT2860_H2M_MAILBOX, 0);
   3532      1.1  nonaka 	DELAY(1000);
   3533      1.1  nonaka 
   3534      1.1  nonaka 	if ((error = run_bbp_init(sc)) != 0) {
   3535      1.1  nonaka 		aprint_error_dev(sc->sc_dev, "could not initialize BBP\n");
   3536      1.1  nonaka 		goto fail;
   3537      1.1  nonaka 	}
   3538      1.1  nonaka 
   3539      1.1  nonaka 	run_read(sc, RT2860_BCN_TIME_CFG, &tmp);
   3540      1.1  nonaka 	tmp &= ~(RT2860_BCN_TX_EN | RT2860_TSF_TIMER_EN |
   3541      1.1  nonaka 	    RT2860_TBTT_TIMER_EN);
   3542      1.1  nonaka 	run_write(sc, RT2860_BCN_TIME_CFG, tmp);
   3543      1.1  nonaka 
   3544      1.1  nonaka 	/* clear RX WCID search table */
   3545      1.1  nonaka 	run_set_region_4(sc, RT2860_WCID_ENTRY(0), 0, 512);
   3546      1.1  nonaka 	/* clear Pair-wise key table */
   3547      1.1  nonaka 	run_set_region_4(sc, RT2860_PKEY(0), 0, 2048);
   3548      1.1  nonaka 	/* clear IV/EIV table */
   3549      1.1  nonaka 	run_set_region_4(sc, RT2860_IVEIV(0), 0, 512);
   3550      1.1  nonaka 	/* clear WCID attribute table */
   3551      1.1  nonaka 	run_set_region_4(sc, RT2860_WCID_ATTR(0), 0, 8 * 32);
   3552      1.1  nonaka 	/* clear shared key table */
   3553      1.1  nonaka 	run_set_region_4(sc, RT2860_SKEY(0, 0), 0, 8 * 32);
   3554      1.1  nonaka 	/* clear shared key mode */
   3555      1.1  nonaka 	run_set_region_4(sc, RT2860_SKEY_MODE_0_7, 0, 4);
   3556      1.1  nonaka 
   3557      1.1  nonaka 	run_read(sc, RT2860_US_CYC_CNT, &tmp);
   3558      1.1  nonaka 	tmp = (tmp & ~0xff) | 0x1e;
   3559      1.1  nonaka 	run_write(sc, RT2860_US_CYC_CNT, tmp);
   3560      1.1  nonaka 
   3561      1.1  nonaka 	if (sc->mac_rev != 0x0101)
   3562      1.1  nonaka 		run_write(sc, RT2860_TXOP_CTRL_CFG, 0x0000583f);
   3563      1.1  nonaka 
   3564      1.1  nonaka 	run_write(sc, RT2860_WMM_TXOP0_CFG, 0);
   3565      1.1  nonaka 	run_write(sc, RT2860_WMM_TXOP1_CFG, 48 << 16 | 96);
   3566      1.1  nonaka 
   3567      1.1  nonaka 	/* write vendor-specific BBP values (from EEPROM) */
   3568      1.1  nonaka 	for (i = 0; i < 8; i++) {
   3569      1.1  nonaka 		if (sc->bbp[i].reg == 0 || sc->bbp[i].reg == 0xff)
   3570      1.1  nonaka 			continue;
   3571      1.1  nonaka 		run_bbp_write(sc, sc->bbp[i].reg, sc->bbp[i].val);
   3572      1.1  nonaka 	}
   3573      1.1  nonaka 
   3574      1.1  nonaka 	/* select Main antenna for 1T1R devices */
   3575      1.1  nonaka 	if (sc->rf_rev == RT3070_RF_3020)
   3576      1.1  nonaka 		run_set_rx_antenna(sc, 0);
   3577      1.1  nonaka 
   3578      1.1  nonaka 	/* send LEDs operating mode to microcontroller */
   3579      1.1  nonaka 	(void)run_mcu_cmd(sc, RT2860_MCU_CMD_LED1, sc->led[0]);
   3580      1.1  nonaka 	(void)run_mcu_cmd(sc, RT2860_MCU_CMD_LED2, sc->led[1]);
   3581      1.1  nonaka 	(void)run_mcu_cmd(sc, RT2860_MCU_CMD_LED3, sc->led[2]);
   3582      1.1  nonaka 
   3583      1.1  nonaka 	if (sc->mac_ver >= 0x3070)
   3584      1.1  nonaka 		run_rt3070_rf_init(sc);
   3585      1.1  nonaka 
   3586      1.1  nonaka 	/* disable non-existing Rx chains */
   3587      1.1  nonaka 	run_bbp_read(sc, 3, &bbp3);
   3588      1.1  nonaka 	bbp3 &= ~(1 << 3 | 1 << 4);
   3589      1.1  nonaka 	if (sc->nrxchains == 2)
   3590      1.1  nonaka 		bbp3 |= 1 << 3;
   3591      1.1  nonaka 	else if (sc->nrxchains == 3)
   3592      1.1  nonaka 		bbp3 |= 1 << 4;
   3593      1.1  nonaka 	run_bbp_write(sc, 3, bbp3);
   3594      1.1  nonaka 
   3595      1.1  nonaka 	/* disable non-existing Tx chains */
   3596      1.1  nonaka 	run_bbp_read(sc, 1, &bbp1);
   3597      1.1  nonaka 	if (sc->ntxchains == 1)
   3598      1.1  nonaka 		bbp1 &= ~(1 << 3 | 1 << 4);
   3599      1.1  nonaka 	run_bbp_write(sc, 1, bbp1);
   3600      1.1  nonaka 
   3601      1.1  nonaka 	if (sc->mac_ver >= 0x3070)
   3602      1.1  nonaka 		run_rt3070_rf_setup(sc);
   3603      1.1  nonaka 
   3604      1.1  nonaka 	/* select default channel */
   3605      1.1  nonaka 	run_set_chan(sc, ic->ic_curchan);
   3606      1.1  nonaka 
   3607      1.1  nonaka 	/* turn radio LED on */
   3608      1.1  nonaka 	run_set_leds(sc, RT2860_LED_RADIO);
   3609      1.1  nonaka 
   3610      1.1  nonaka #ifdef RUN_HWCRYPTO
   3611      1.1  nonaka 	if (ic->ic_flags & IEEE80211_F_PRIVACY) {
   3612      1.1  nonaka 		/* install WEP keys */
   3613      1.1  nonaka 		for (i = 0; i < IEEE80211_WEP_NKID; i++)
   3614      1.1  nonaka 			(void)run_set_key(ic, &ic->ic_crypto.cs_nw_keys[i],
   3615      1.1  nonaka 			    NULL);
   3616      1.1  nonaka 	}
   3617      1.1  nonaka #endif
   3618      1.1  nonaka 
   3619      1.1  nonaka 	for (i = 0; i < RUN_RX_RING_COUNT; i++) {
   3620      1.1  nonaka 		struct run_rx_data *data = &sc->rxq.data[i];
   3621      1.1  nonaka 
   3622      1.1  nonaka 		usbd_setup_xfer(data->xfer, sc->rxq.pipeh, data, data->buf,
   3623      1.1  nonaka 		    RUN_MAX_RXSZ, USBD_SHORT_XFER_OK | USBD_NO_COPY,
   3624      1.1  nonaka 		    USBD_NO_TIMEOUT, run_rxeof);
   3625      1.1  nonaka 		error = usbd_transfer(data->xfer);
   3626      1.1  nonaka 		if (error != USBD_NORMAL_COMPLETION &&
   3627      1.1  nonaka 		    error != USBD_IN_PROGRESS)
   3628      1.1  nonaka 			goto fail;
   3629      1.1  nonaka 	}
   3630      1.1  nonaka 
   3631      1.1  nonaka 	if ((error = run_txrx_enable(sc)) != 0)
   3632      1.1  nonaka 		goto fail;
   3633      1.1  nonaka 
   3634      1.1  nonaka 	ifp->if_flags &= ~IFF_OACTIVE;
   3635      1.1  nonaka 	ifp->if_flags |= IFF_RUNNING;
   3636      1.1  nonaka 
   3637      1.1  nonaka 	if (ic->ic_opmode == IEEE80211_M_MONITOR)
   3638      1.1  nonaka 		ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
   3639      1.1  nonaka 	else
   3640      1.1  nonaka 		ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
   3641      1.1  nonaka 
   3642      1.1  nonaka 	if (error != 0)
   3643      1.1  nonaka fail:		run_stop(ifp, 1);
   3644      1.1  nonaka 	return (error);
   3645      1.1  nonaka }
   3646      1.1  nonaka 
   3647      1.1  nonaka static void
   3648      1.1  nonaka run_stop(struct ifnet *ifp, int disable)
   3649      1.1  nonaka {
   3650      1.1  nonaka 	struct run_softc *sc = ifp->if_softc;
   3651      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   3652      1.1  nonaka 	uint32_t tmp;
   3653      1.1  nonaka 	int ntries, qid;
   3654      1.1  nonaka 
   3655      1.1  nonaka 	if (ifp->if_flags & IFF_RUNNING)
   3656      1.1  nonaka 		run_set_leds(sc, 0);	/* turn all LEDs off */
   3657      1.1  nonaka 
   3658      1.1  nonaka 	sc->sc_tx_timer = 0;
   3659      1.1  nonaka 	ifp->if_timer = 0;
   3660      1.1  nonaka 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
   3661      1.1  nonaka 
   3662      1.1  nonaka 	callout_stop(&sc->scan_to);
   3663      1.1  nonaka 	callout_stop(&sc->calib_to);
   3664      1.1  nonaka 
   3665      1.1  nonaka 	ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
   3666      1.1  nonaka 	/* wait for all queued asynchronous commands to complete */
   3667      1.1  nonaka 	while (sc->cmdq.queued > 0)
   3668      1.1  nonaka 		tsleep(&sc->cmdq, 0, "cmdq", 0);
   3669      1.1  nonaka 
   3670      1.1  nonaka 	/* disable Tx/Rx */
   3671      1.1  nonaka 	run_read(sc, RT2860_MAC_SYS_CTRL, &tmp);
   3672      1.1  nonaka 	tmp &= ~(RT2860_MAC_RX_EN | RT2860_MAC_TX_EN);
   3673      1.1  nonaka 	run_write(sc, RT2860_MAC_SYS_CTRL, tmp);
   3674      1.1  nonaka 
   3675      1.1  nonaka 	/* wait for pending Tx to complete */
   3676      1.1  nonaka 	for (ntries = 0; ntries < 100; ntries++) {
   3677      1.1  nonaka 		if (run_read(sc, RT2860_TXRXQ_PCNT, &tmp) != 0)
   3678      1.1  nonaka 			break;
   3679      1.1  nonaka 		if ((tmp & RT2860_TX2Q_PCNT_MASK) == 0)
   3680      1.1  nonaka 			break;
   3681      1.1  nonaka 	}
   3682      1.1  nonaka 	DELAY(1000);
   3683      1.1  nonaka 	run_write(sc, RT2860_USB_DMA_CFG, 0);
   3684      1.1  nonaka 
   3685      1.1  nonaka 	/* reset adapter */
   3686      1.1  nonaka 	run_write(sc, RT2860_MAC_SYS_CTRL, RT2860_BBP_HRST | RT2860_MAC_SRST);
   3687      1.1  nonaka 	run_write(sc, RT2860_MAC_SYS_CTRL, 0);
   3688      1.1  nonaka 
   3689      1.1  nonaka 	/* reset Tx and Rx rings */
   3690      1.1  nonaka 	sc->qfullmsk = 0;
   3691      1.1  nonaka 	for (qid = 0; qid < 4; qid++)
   3692      1.1  nonaka 		run_free_tx_ring(sc, qid);
   3693      1.1  nonaka 	run_free_rx_ring(sc);
   3694      1.1  nonaka }
   3695      1.1  nonaka 
   3696      1.1  nonaka #ifndef IEEE80211_STA_ONLY
   3697      1.1  nonaka static int
   3698      1.1  nonaka run_setup_beacon(struct run_softc *sc)
   3699      1.1  nonaka {
   3700      1.1  nonaka 	struct ieee80211com *ic = &sc->sc_ic;
   3701      1.1  nonaka 	struct rt2860_txwi txwi;
   3702      1.1  nonaka 	struct mbuf *m;
   3703      1.1  nonaka 	int ridx;
   3704      1.1  nonaka 
   3705      1.1  nonaka 	if ((m = ieee80211_beacon_alloc(ic, ic->ic_bss, &sc->sc_bo)) == NULL)
   3706      1.1  nonaka 		return (ENOBUFS);
   3707      1.1  nonaka 
   3708      1.1  nonaka 	memset(&txwi, 0, sizeof txwi);
   3709      1.1  nonaka 	txwi.wcid = 0xff;
   3710      1.1  nonaka 	txwi.len = htole16(m->m_pkthdr.len);
   3711      1.1  nonaka 	/* send beacons at the lowest available rate */
   3712      1.1  nonaka 	ridx = (ic->ic_curmode == IEEE80211_MODE_11A) ?
   3713      1.1  nonaka 	    RT2860_RIDX_OFDM6 : RT2860_RIDX_CCK1;
   3714      1.1  nonaka 	txwi.phy = htole16(rt2860_rates[ridx].mcs);
   3715      1.1  nonaka 	if (rt2860_rates[ridx].phy == IEEE80211_T_OFDM)
   3716      1.1  nonaka 		txwi.phy |= htole16(RT2860_PHY_OFDM);
   3717      1.1  nonaka 	txwi.txop = RT2860_TX_TXOP_HT;
   3718      1.1  nonaka 	txwi.flags = RT2860_TX_TS;
   3719      1.1  nonaka 
   3720      1.1  nonaka 	run_write_region_1(sc, RT2860_BCN_BASE(0),
   3721      1.1  nonaka 	    (uint8_t *)&txwi, sizeof txwi);
   3722      1.1  nonaka 	run_write_region_1(sc, RT2860_BCN_BASE(0) + sizeof txwi,
   3723      1.1  nonaka 	    mtod(m, uint8_t *), m->m_pkthdr.len);
   3724      1.1  nonaka 
   3725      1.1  nonaka 	m_freem(m);
   3726      1.1  nonaka 
   3727      1.1  nonaka 	return (0);
   3728      1.1  nonaka }
   3729      1.1  nonaka #endif
   3730      1.1  nonaka 
   3731      1.2  nonaka MODULE(MODULE_CLASS_DRIVER, if_run, "bpf");
   3732      1.1  nonaka 
   3733      1.1  nonaka #ifdef _MODULE
   3734      1.1  nonaka #include "ioconf.c"
   3735      1.1  nonaka #endif
   3736      1.1  nonaka 
   3737      1.1  nonaka static int
   3738      1.1  nonaka if_run_modcmd(modcmd_t cmd, void *arg)
   3739      1.1  nonaka {
   3740      1.1  nonaka 	int error = 0;
   3741      1.1  nonaka 
   3742      1.1  nonaka 	switch (cmd) {
   3743      1.1  nonaka 	case MODULE_CMD_INIT:
   3744      1.1  nonaka #ifdef _MODULE
   3745      1.1  nonaka 		error = config_init_component(cfdriver_ioconf_run,
   3746      1.1  nonaka 		    cfattach_ioconf_run, cfdata_ioconf_run);
   3747      1.1  nonaka #endif
   3748      1.1  nonaka 		return (error);
   3749      1.1  nonaka 	case MODULE_CMD_FINI:
   3750      1.1  nonaka #ifdef _MODULE
   3751      1.1  nonaka 		error = config_fini_component(cfdriver_ioconf_run,
   3752      1.1  nonaka 		    cfattach_ioconf_run, cfdata_ioconf_run);
   3753      1.1  nonaka #endif
   3754      1.1  nonaka 		return (error);
   3755      1.1  nonaka 	default:
   3756      1.1  nonaka 		return (ENOTTY);
   3757      1.1  nonaka 	}
   3758      1.1  nonaka }
   3759