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