3 * Copyright (c) 2009-2010 Alexander Egorenkov <egorenar@gmail.com>
4 * Copyright (c) 2009 Damien Bergamini <damien.bergamini@free.fr>
6 * Permission to use, copy, modify, and distribute this software for any
7 * purpose with or without fee is hereby granted, provided that the above
8 * copyright notice and this permission notice appear in all copies.
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19 #include "rt2860_softc.h"
20 #include "rt2860_reg.h"
21 #include "rt2860_eeprom.h"
22 #include "rt2860_ucode.h"
23 #include "rt2860_txwi.h"
24 #include "rt2860_rxwi.h"
25 #include "rt2860_io.h"
26 #include "rt2860_read_eeprom.h"
27 #include "rt2860_led.h"
28 #include "rt2860_rf.h"
29 #include "rt2860_debug.h"
35 #define PCI_VENDOR_RALINK 0x1814
36 #define PCI_PRODUCT_RALINK_RT2860_PCI 0x0601
37 #define PCI_PRODUCT_RALINK_RT2860_PCIe 0x0681
38 #define PCI_PRODUCT_RALINK_RT2760_PCI 0x0701
39 #define PCI_PRODUCT_RALINK_RT2790_PCIe 0x0781
41 #define RT2860_MAX_AGG_SIZE 3840
43 #define RT2860_TX_DATA_SEG0_SIZE \
44 (sizeof(struct rt2860_txwi) + sizeof(struct ieee80211_qosframe_addr4))
46 #define RT2860_NOISE_FLOOR -95
48 #define RT2860_AID2WCID(aid) ((aid) & 0xff)
50 #define RT2860_RATE_IS_OFDM(rate) ((rate) >= 12 && (rate) != 22)
52 #define RT2860_ACK_SIZE 14
54 #define IEEE80211_HAS_ADDR4(wh) \
55 (((wh)->i_fc[1] & IEEE80211_FC1_DIR_MASK) == IEEE80211_FC1_DIR_DSTODS)
57 #define RT2860_MS(_v, _f) (((_v) & _f) >> _f##_S)
58 #define RT2860_SM(_v, _f) (((_v) << _f##_S) & _f)
60 #define RT2860_TX_WATCHDOG_TIMEOUT 5
63 * Data structures and types
66 struct rt2860_pci_ident
74 * Static function prototypes
77 static int rt2860_probe(device_t dev
);
79 static int rt2860_attach(device_t dev
);
81 static int rt2860_detach(device_t dev
);
83 static int rt2860_shutdown(device_t dev
);
85 static int rt2860_suspend(device_t dev
);
87 static int rt2860_resume(device_t dev
);
89 static void rt2860_init_channels(struct rt2860_softc
*sc
);
91 static void rt2860_init_channels_ht40(struct rt2860_softc
*sc
);
93 static void rt2860_init_locked(void *priv
);
95 static void rt2860_init(void *priv
);
97 static int rt2860_init_bbp(struct rt2860_softc
*sc
);
99 static void rt2860_stop_locked(void *priv
);
101 static void rt2860_stop(void *priv
);
103 static void rt2860_start(struct ifnet
*ifp
);
105 static int rt2860_ioctl(struct ifnet
*ifp
, u_long cmd
, caddr_t data
);
107 static int rt2860_reset(struct ifnet
*ifp
);
109 static int rt2860_newstate(struct ieee80211com
*ic
,
110 enum ieee80211_state nstate
, int arg
);
112 static void rt2860_scan_start(struct ieee80211com
*ic
);
114 static void rt2860_scan_end(struct ieee80211com
*ic
);
116 static void rt2860_set_channel(struct ieee80211com
*ic
);
118 static void rt2860_newassoc(struct ieee80211_node
*ni
, int isnew
);
120 static void rt2860_updateslot(struct ifnet
*ifp
);
122 static int rt2860_wme_update(struct ieee80211com
*ic
);
124 static void rt2860_update_beacon(struct ieee80211com
*ic
, int what
);
126 static void rt2860_key_update_begin(struct ieee80211com
*ic
);
128 static void rt2860_key_update_end(struct ieee80211com
*ic
);
130 static int rt2860_key_set(struct ieee80211com
*ic
,
131 const struct ieee80211_key
*k
, const uint8_t mac
[IEEE80211_ADDR_LEN
]);
133 static int rt2860_key_delete(struct ieee80211com
*ic
,
134 const struct ieee80211_key
*k
);
136 static int rt2860_raw_xmit(struct ieee80211_node
*ni
, struct mbuf
*m
,
137 const struct ieee80211_bpf_params
*params
);
139 static int rt2860_media_change(struct ifnet
*ifp
);
141 static void rt2860_recv_action(struct ieee80211_node
*ni
,
142 const uint8_t *frm
, const uint8_t *efrm
);
144 static int rt2860_send_action(struct ieee80211_node
*ni
,
145 int category
, int action
, uint16_t args
[4]);
147 static void rt2860_amrr_update_iter_func(void *arg
, struct ieee80211_node
*ni
);
149 static void rt2860_periodic(void *arg
);
151 static void rt2860_tx_watchdog(void *arg
);
153 static void rt2860_asic_set_bssid(struct rt2860_softc
*sc
,
154 const uint8_t *bssid
);
156 static void rt2860_asic_set_macaddr(struct rt2860_softc
*sc
,
157 const uint8_t *addr
);
159 static void rt2860_asic_enable_tsf_sync(struct rt2860_softc
*sc
);
161 static void rt2860_asic_disable_tsf_sync(struct rt2860_softc
*sc
);
163 static void rt2860_asic_enable_mrr(struct rt2860_softc
*sc
);
165 static void rt2860_asic_set_txpreamble(struct rt2860_softc
*sc
);
167 static void rt2860_asic_set_basicrates(struct rt2860_softc
*sc
);
169 static void rt2860_asic_update_rtsthreshold(struct rt2860_softc
*sc
);
171 static void rt2860_asic_update_txpower(struct rt2860_softc
*sc
);
173 static void rt2860_asic_update_promisc(struct rt2860_softc
*sc
);
175 static void rt2860_asic_updateprot(struct rt2860_softc
*sc
);
177 static void rt2860_asic_updateslot(struct rt2860_softc
*sc
);
179 static void rt2860_asic_wme_update(struct rt2860_softc
*sc
);
181 static int rt2860_asic_update_beacon(struct rt2860_softc
*sc
);
183 static void rt2860_asic_clear_keytables(struct rt2860_softc
*sc
);
185 static uint8_t rt2860_rxrate(struct rt2860_rxwi
*rxwi
);
187 static uint8_t rt2860_maxrssi_rxpath(struct rt2860_softc
*sc
,
188 const struct rt2860_rxwi
*rxwi
);
190 static int8_t rt2860_rssi2dbm(struct rt2860_softc
*sc
,
191 uint8_t rssi
, uint8_t rxpath
);
193 static uint8_t rt2860_rate2mcs(uint8_t rate
);
195 static int rt2860_ackrate(struct ieee80211com
*ic
, int rate
);
197 static uint16_t rt2860_txtime(int len
, int rate
, uint32_t flags
);
199 static int rt2860_tx_frame(struct rt2860_softc
*sc
,
200 struct mbuf
*m
, struct ieee80211_node
*ni
, int qid
);
202 static int rt2860_tx_raw(struct rt2860_softc
*sc
,
203 struct mbuf
*m
, struct ieee80211_node
*ni
,
204 const struct ieee80211_bpf_params
*params
);
206 static void rt2860_intr(void *arg
);
208 static void rt2860_tx_coherent_intr(struct rt2860_softc
*sc
);
210 static void rt2860_rx_coherent_intr(struct rt2860_softc
*sc
);
212 static void rt2860_txrx_coherent_intr(struct rt2860_softc
*sc
);
214 static void rt2860_fifo_sta_full_intr(struct rt2860_softc
*sc
);
216 static void rt2860_rx_intr(struct rt2860_softc
*sc
);
218 static void rt2860_rx_delay_intr(struct rt2860_softc
*sc
);
220 static void rt2860_tx_intr(struct rt2860_softc
*sc
, int qid
);
222 static void rt2860_tx_delay_intr(struct rt2860_softc
*sc
);
224 static void rt2860_pre_tbtt_intr(struct rt2860_softc
*sc
);
226 static void rt2860_tbtt_intr(struct rt2860_softc
*sc
);
228 static void rt2860_mcu_cmd_intr(struct rt2860_softc
*sc
);
230 static void rt2860_auto_wakeup_intr(struct rt2860_softc
*sc
);
232 static void rt2860_gp_timer_intr(struct rt2860_softc
*sc
);
234 static void rt2860_rx_done_task(void *context
, int pending
);
236 static void rt2860_tx_done_task(void *context
, int pending
);
238 static void rt2860_fifo_sta_full_task(void *context
, int pending
);
240 static void rt2860_periodic_task(void *context
, int pending
);
242 static int rt2860_rx_eof(struct rt2860_softc
*sc
, int limit
);
244 static void rt2860_tx_eof(struct rt2860_softc
*sc
,
245 struct rt2860_softc_tx_ring
*ring
);
247 static void rt2860_update_stats(struct rt2860_softc
*sc
);
249 static void rt2860_watchdog(struct rt2860_softc
*sc
);
251 static void rt2860_drain_fifo_stats(struct rt2860_softc
*sc
);
253 static void rt2860_update_raw_counters(struct rt2860_softc
*sc
);
255 static void rt2860_intr_enable(struct rt2860_softc
*sc
, uint32_t intr_mask
);
257 static void rt2860_intr_disable(struct rt2860_softc
*sc
, uint32_t intr_mask
);
259 static int rt2860_txrx_enable(struct rt2860_softc
*sc
);
261 static int rt2860_alloc_rx_ring(struct rt2860_softc
*sc
,
262 struct rt2860_softc_rx_ring
*ring
);
264 static void rt2860_reset_rx_ring(struct rt2860_softc
*sc
,
265 struct rt2860_softc_rx_ring
*ring
);
267 static void rt2860_free_rx_ring(struct rt2860_softc
*sc
,
268 struct rt2860_softc_rx_ring
*ring
);
270 static int rt2860_alloc_tx_ring(struct rt2860_softc
*sc
,
271 struct rt2860_softc_tx_ring
*ring
, int qid
);
273 static void rt2860_reset_tx_ring(struct rt2860_softc
*sc
,
274 struct rt2860_softc_tx_ring
*ring
);
276 static void rt2860_free_tx_ring(struct rt2860_softc
*sc
,
277 struct rt2860_softc_tx_ring
*ring
);
279 static void rt2860_dma_map_addr(void *arg
, bus_dma_segment_t
*segs
,
280 int nseg
, int error
);
282 static void rt2860_sysctl_attach(struct rt2860_softc
*sc
);
288 static const struct rt2860_pci_ident rt2860_pci_ids
[] =
290 { PCI_VENDOR_RALINK
, PCI_PRODUCT_RALINK_RT2860_PCI
, "Ralink RT2860 PCI" },
291 { PCI_VENDOR_RALINK
, PCI_PRODUCT_RALINK_RT2860_PCIe
, "Ralink RT2860 PCIe" },
292 { PCI_VENDOR_RALINK
, PCI_PRODUCT_RALINK_RT2760_PCI
, "Ralink RT2760 PCI" },
293 { PCI_VENDOR_RALINK
, PCI_PRODUCT_RALINK_RT2790_PCIe
, "Ralink RT2790 PCIe" },
303 { RT2860_REG_PBF_BCN_OFFSET0
, 0xf8f0e8e0 },
304 { RT2860_REG_PBF_BCN_OFFSET1
, 0x6f77d0c8 },
305 { RT2860_REG_LEGACY_BASIC_RATE
, 0x0000013f },
306 { RT2860_REG_HT_BASIC_RATE
, 0x00008003 },
307 { RT2860_REG_SYS_CTRL
, 0x00000000 },
308 { RT2860_REG_RX_FILTER_CFG
, 0x00017f97 },
309 { RT2860_REG_BKOFF_SLOT_CFG
, 0x00000209 },
310 { RT2860_REG_TX_SW_CFG0
, 0x00000000 },
311 { RT2860_REG_TX_SW_CFG1
, 0x00080606 },
312 { RT2860_REG_TX_LINK_CFG
, 0x00001020 },
313 { RT2860_REG_TX_TIMEOUT_CFG
, 0x000a2090 },
314 { RT2860_REG_MAX_LEN_CFG
, (1 << 12) | RT2860_MAX_AGG_SIZE
},
315 { RT2860_REG_LED_CFG
, 0x7f031e46 },
316 { RT2860_REG_PBF_MAX_PCNT
, 0x1f3fbf9f },
317 { RT2860_REG_TX_RTY_CFG
, 0x47d01f0f },
318 { RT2860_REG_AUTO_RSP_CFG
, 0x00000013 },
319 { RT2860_REG_TX_CCK_PROT_CFG
, 0x05740003 },
320 { RT2860_REG_TX_OFDM_PROT_CFG
, 0x05740003 },
321 { RT2860_REG_TX_MM40_PROT_CFG
, 0x03f44084 },
322 { RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, 0x00000030 },
323 { RT2860_REG_TX_GF20_PROT_CFG
, 0x01744004 },
324 { RT2860_REG_TX_GF40_PROT_CFG
, 0x03f44084 },
325 { RT2860_REG_TX_MM20_PROT_CFG
, 0x01744004 },
326 { RT2860_REG_TX_MM40_PROT_CFG
, 0x03f54084 },
327 { RT2860_REG_TX_TXOP_CTRL_CFG
, 0x0000583f },
328 { RT2860_REG_TX_RTS_CFG
, 0x00092b20 },
329 { RT2860_REG_TX_EXP_ACK_TIME
, 0x002400ca },
330 { RT2860_REG_HCCAPSMP_TXOP_HLDR_ET
, 0x00000002 },
331 { RT2860_REG_XIFS_TIME_CFG
, 0x33a41010 },
332 { RT2860_REG_PWR_PIN_CFG
, 0x00000003 },
333 { RT2860_REG_SCHDMA_WMM_AIFSN_CFG
, 0x00002273 },
334 { RT2860_REG_SCHDMA_WMM_CWMIN_CFG
, 0x00002344 },
335 { RT2860_REG_SCHDMA_WMM_CWMAX_CFG
, 0x000034aa },
338 #define RT2860_DEF_MAC_SIZE (sizeof(rt2860_def_mac) / sizeof(rt2860_def_mac[0]))
363 #define RT2860_DEF_BBP_SIZE (sizeof(rt2860_def_bbp) / sizeof(rt2860_def_bbp[0]))
365 SYSCTL_NODE(_hw
, OID_AUTO
, rt2860
, CTLFLAG_RD
, 0, "RT2860 driver parameters");
368 static int rt2860_debug
= 0;
369 SYSCTL_INT(_hw_rt2860
, OID_AUTO
, debug
, CTLFLAG_RW
, &rt2860_debug
, 0, "rt2860 debug level");
370 TUNABLE_INT("hw.rt2860.debug", &rt2860_debug
);
376 static int rt2860_probe(device_t dev
)
378 const struct rt2860_pci_ident
*ident
;
380 for (ident
= rt2860_pci_ids
; ident
->name
!= NULL
; ident
++)
382 if (pci_get_vendor(dev
) == ident
->vendor
&&
383 pci_get_device(dev
) == ident
->device
)
385 device_set_desc(dev
, ident
->name
);
396 static int rt2860_attach(device_t dev
)
398 struct rt2860_softc
*sc
;
400 struct ieee80211com
*ic
;
401 int error
, ntries
, i
;
403 sc
= device_get_softc(dev
);
405 if (pci_get_powerstate(dev
) != PCI_POWERSTATE_D0
)
407 printf("%s: chip is in D%d power mode, setting to D0\n",
408 device_get_nameunit(dev
), pci_get_powerstate(dev
));
409 pci_set_powerstate(dev
, PCI_POWERSTATE_D0
);
412 /* enable bus-mastering */
414 pci_enable_busmaster(dev
);
418 mtx_init(&sc
->lock
, device_get_nameunit(dev
),
419 MTX_NETWORK_LOCK
, MTX_DEF
| MTX_RECURSE
);
421 sc
->mem_rid
= PCIR_BAR(0);
422 sc
->mem
= bus_alloc_resource_any(dev
, SYS_RES_MEMORY
,
423 &sc
->mem_rid
, RF_ACTIVE
);
426 printf("%s: could not allocate memory resource\n",
427 device_get_nameunit(dev
));
432 sc
->bst
= rman_get_bustag(sc
->mem
);
433 sc
->bsh
= rman_get_bushandle(sc
->mem
);
436 sc
->irq
= bus_alloc_resource_any(dev
, SYS_RES_IRQ
,
437 &sc
->irq_rid
, RF_ACTIVE
| RF_SHAREABLE
);
440 printf("%s: could not allocate interrupt resource\n",
441 device_get_nameunit(dev
));
447 sc
->debug
= rt2860_debug
;
449 SYSCTL_ADD_INT(device_get_sysctl_ctx(dev
),
450 SYSCTL_CHILDREN(device_get_sysctl_tree(dev
)), OID_AUTO
,
451 "debug", CTLFLAG_RW
, &sc
->debug
, 0, "rt2860 debug level");
454 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
456 device_get_nameunit(sc
->dev
));
458 /* wait for NIC to initialize */
460 for (ntries
= 0; ntries
< 100; ntries
++)
462 sc
->mac_rev
= rt2860_io_mac_read(sc
, RT2860_REG_MAC_CSR0
);
463 if (sc
->mac_rev
!= 0x00000000 && sc
->mac_rev
!= 0xffffffff)
471 printf("%s: timeout waiting for NIC to initialize\n",
472 device_get_nameunit(dev
));
477 rt2860_read_eeprom(sc
);
479 printf("%s: MAC/BBP RT2860 (rev 0x%08x), RF %s\n",
480 device_get_nameunit(sc
->dev
), sc
->mac_rev
,
481 rt2860_rf_name(sc
->rf_rev
));
483 /* allocate Tx and Rx rings */
485 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
487 error
= rt2860_alloc_tx_ring(sc
, &sc
->tx_ring
[i
], i
);
490 printf("%s: could not allocate Tx ring #%d\n",
491 device_get_nameunit(sc
->dev
), i
);
496 sc
->tx_ring_mgtqid
= 5;
498 error
= rt2860_alloc_rx_ring(sc
, &sc
->rx_ring
);
501 printf("%s: could not allocate Rx ring\n",
502 device_get_nameunit(sc
->dev
));
506 callout_init(&sc
->periodic_ch
, 0);
507 callout_init_mtx(&sc
->tx_watchdog_ch
, &sc
->lock
, 0);
509 ifp
= sc
->ifp
= if_alloc(IFT_ETHER
);
512 printf("%s: could not if_alloc()\n",
513 device_get_nameunit(sc
->dev
));
520 if_initname(ifp
, "rt2860", device_get_unit(sc
->dev
));
522 ifp
->if_flags
= IFF_BROADCAST
| IFF_SIMPLEX
| IFF_MULTICAST
;
524 ifp
->if_init
= rt2860_init
;
525 ifp
->if_ioctl
= rt2860_ioctl
;
526 ifp
->if_start
= rt2860_start
;
528 IFQ_SET_MAXLEN(&ifp
->if_snd
, IFQ_MAXLEN
);
529 ifp
->if_snd
.ifq_drv_maxlen
= IFQ_MAXLEN
;
530 IFQ_SET_READY(&ifp
->if_snd
);
536 ic
->ic_phytype
= IEEE80211_T_HT
;
537 ic
->ic_opmode
= IEEE80211_M_STA
;
538 ic
->ic_state
= IEEE80211_S_INIT
;
540 ic
->ic_caps
= IEEE80211_C_MONITOR
|
545 /* IEEE80211_C_BGSCAN | */
547 IEEE80211_C_SHPREAMBLE
|
554 IEEE80211_C_AES_CCM
|
557 ic
->ic_htcaps
= IEEE80211_HTC_HT
|
558 IEEE80211_HTC_AMSDU
| /* A-MSDU Tx */
559 IEEE80211_HTCAP_MAXAMSDU_3839
| /* max. A-MSDU Rx length */
560 IEEE80211_HTCAP_CHWIDTH40
| /* HT 40MHz channel width */
561 IEEE80211_HTCAP_GREENFIELD
| /* HT greenfield */
562 IEEE80211_HTCAP_SHORTGI20
| /* HT 20MHz short GI */
563 IEEE80211_HTCAP_SHORTGI40
| /* HT 40MHz short GI */
564 IEEE80211_HTCAP_DSSSCCK40
; /* HT 40MHz DSSS/CCK modulation */
566 /* spatial streams */
568 if (sc
->nrxpath
== 2)
569 ic
->ic_htcaps
|= IEEE80211_HTCAP_RXSTBC_2STREAM
;
570 else if (sc
->nrxpath
== 3)
571 ic
->ic_htcaps
|= IEEE80211_HTCAP_RXSTBC_3STREAM
;
573 ic
->ic_htcaps
|= IEEE80211_HTCAP_RXSTBC_1STREAM
;
576 ic
->ic_htcaps
|= IEEE80211_HTCAP_TXSTBC
;
580 if (sc
->mac_rev
!= 0x28600100)
581 ic
->ic_htcaps
|= IEEE80211_HTCAP_DELBA
;
586 ic
->ic_regdomain
= 0;
587 ic
->ic_countrycode
= CTRY_DEFAULT
;
590 rt2860_init_channels(sc
);
592 rt2860_init_channels_ht40(sc
);
594 IEEE80211_ADDR_COPY(ic
->ic_myaddr
, sc
->mac_addr
);
596 ieee80211_ifattach(ic
);
598 sc
->newstate
= ic
->ic_newstate
;
599 ic
->ic_newstate
= rt2860_newstate
;
601 ic
->ic_reset
= rt2860_reset
;
602 ic
->ic_scan_start
= rt2860_scan_start
;
603 ic
->ic_scan_end
= rt2860_scan_end
;
604 ic
->ic_set_channel
= rt2860_set_channel
;
605 ic
->ic_newassoc
= rt2860_newassoc
;
606 ic
->ic_updateslot
= rt2860_updateslot
;
607 ic
->ic_wme
.wme_update
= rt2860_wme_update
;
608 ic
->ic_update_beacon
= rt2860_update_beacon
;
609 ic
->ic_crypto
.cs_key_update_begin
= rt2860_key_update_begin
;
610 ic
->ic_crypto
.cs_key_update_end
= rt2860_key_update_end
;
611 ic
->ic_crypto
.cs_key_set
= rt2860_key_set
;
612 ic
->ic_crypto
.cs_key_delete
= rt2860_key_delete
;
613 ic
->ic_raw_xmit
= rt2860_raw_xmit
;
615 sc
->recv_action
= ic
->ic_recv_action
;
616 ic
->ic_recv_action
= rt2860_recv_action
;
618 sc
->send_action
= ic
->ic_send_action
;
619 ic
->ic_send_action
= rt2860_send_action
;
621 /* hardware requires padding between 802.11 frame header and body */
623 ic
->ic_flags
|= IEEE80211_F_WME
| IEEE80211_F_DATAPAD
| IEEE80211_F_DOTH
;
625 ic
->ic_flags_ext
|= IEEE80211_FEXT_SWBMISS
;
627 ieee80211_media_init(ic
, rt2860_media_change
, ieee80211_media_status
);
629 rt2860_amrr_init(&sc
->amrr
, ic
,
630 RT2860_AMRR_MIN_SUCCESS_THRESHOLD
,
631 RT2860_AMRR_MAX_SUCCESS_THRESHOLD
,
634 bpfattach2(ifp
, DLT_IEEE802_11_RADIO
,
635 sizeof(struct ieee80211_frame
) + IEEE80211_RADIOTAP_HDRLEN
,
638 sc
->rxtap_len
= sizeof(sc
->rxtapu
);
639 sc
->rxtap
.ihdr
.it_len
= htole16(sc
->rxtap_len
);
640 sc
->rxtap
.ihdr
.it_present
= htole32(RT2860_SOFTC_RX_RADIOTAP_PRESENT
);
642 sc
->txtap_len
= sizeof(sc
->txtapu
);
643 sc
->txtap
.ihdr
.it_len
= htole16(sc
->txtap_len
);
644 sc
->txtap
.ihdr
.it_present
= htole32(RT2860_SOFTC_TX_RADIOTAP_PRESENT
);
646 /* init task queue */
648 TASK_INIT(&sc
->rx_done_task
, 0, rt2860_rx_done_task
, sc
);
649 TASK_INIT(&sc
->tx_done_task
, 0, rt2860_tx_done_task
, sc
);
650 TASK_INIT(&sc
->fifo_sta_full_task
, 0, rt2860_fifo_sta_full_task
, sc
);
651 TASK_INIT(&sc
->periodic_task
, 0, rt2860_periodic_task
, sc
);
653 sc
->rx_process_limit
= 100;
655 sc
->taskqueue
= taskqueue_create("rt2860_taskq", M_NOWAIT
,
656 taskqueue_thread_enqueue
, &sc
->taskqueue
);
658 taskqueue_start_threads(&sc
->taskqueue
, 1, PI_NET
, "%s taskq",
659 device_get_nameunit(sc
->dev
));
661 rt2860_sysctl_attach(sc
);
664 ieee80211_announce(ic
);
666 /* set up interrupt */
668 error
= bus_setup_intr(dev
, sc
->irq
, INTR_TYPE_NET
| INTR_MPSAFE
,
669 NULL
, rt2860_intr
, sc
, &sc
->irqh
);
672 printf("%s: could not set up interrupt\n",
673 device_get_nameunit(dev
));
681 /* free Tx and Rx rings */
683 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
684 rt2860_free_tx_ring(sc
, &sc
->tx_ring
[i
]);
686 rt2860_free_rx_ring(sc
, &sc
->rx_ring
);
688 mtx_destroy(&sc
->lock
);
691 bus_release_resource(dev
, SYS_RES_MEMORY
, sc
->mem_rid
, sc
->mem
);
694 bus_release_resource(dev
, SYS_RES_IRQ
, sc
->irq_rid
, sc
->irq
);
702 static int rt2860_detach(device_t dev
)
704 struct rt2860_softc
*sc
;
705 struct ieee80211com
*ic
;
709 sc
= device_get_softc(dev
);
713 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
715 device_get_nameunit(sc
->dev
));
717 RT2860_SOFTC_LOCK(sc
);
719 ifp
->if_drv_flags
&= ~(IFF_DRV_RUNNING
| IFF_DRV_OACTIVE
);
721 ieee80211_new_state(ic
, IEEE80211_S_INIT
, -1);
723 callout_stop(&sc
->periodic_ch
);
724 callout_stop(&sc
->tx_watchdog_ch
);
726 taskqueue_drain(sc
->taskqueue
, &sc
->rx_done_task
);
727 taskqueue_drain(sc
->taskqueue
, &sc
->tx_done_task
);
728 taskqueue_drain(sc
->taskqueue
, &sc
->fifo_sta_full_task
);
729 taskqueue_drain(sc
->taskqueue
, &sc
->periodic_task
);
731 /* free Tx and Rx rings */
733 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
734 rt2860_free_tx_ring(sc
, &sc
->tx_ring
[i
]);
736 rt2860_free_rx_ring(sc
, &sc
->rx_ring
);
738 RT2860_SOFTC_UNLOCK(sc
);
742 ieee80211_ifdetach(ic
);
746 taskqueue_free(sc
->taskqueue
);
748 mtx_destroy(&sc
->lock
);
750 bus_generic_detach(dev
);
752 bus_teardown_intr(dev
, sc
->irq
, sc
->irqh
);
754 bus_release_resource(dev
, SYS_RES_IRQ
, sc
->irq_rid
, sc
->irq
);
756 bus_release_resource(dev
, SYS_RES_MEMORY
, sc
->mem_rid
, sc
->mem
);
764 static int rt2860_shutdown(device_t dev
)
766 struct rt2860_softc
*sc
;
768 sc
= device_get_softc(dev
);
770 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
771 "%s: shutting down\n",
772 device_get_nameunit(sc
->dev
));
776 sc
->flags
&= ~RT2860_SOFTC_FLAGS_UCODE_LOADED
;
784 static int rt2860_suspend(device_t dev
)
786 struct rt2860_softc
*sc
;
788 sc
= device_get_softc(dev
);
790 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
792 device_get_nameunit(sc
->dev
));
796 sc
->flags
&= ~RT2860_SOFTC_FLAGS_UCODE_LOADED
;
804 static int rt2860_resume(device_t dev
)
806 struct rt2860_softc
*sc
;
809 sc
= device_get_softc(dev
);
812 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
814 device_get_nameunit(sc
->dev
));
816 if (ifp
->if_flags
& IFF_UP
)
823 * rt2860_init_channels
825 static void rt2860_init_channels(struct rt2860_softc
*sc
)
827 struct ieee80211com
*ic
;
828 struct ieee80211_channel
*c
;
833 /* set supported channels for 2GHz band */
835 for (i
= 1; i
<= 14; i
++)
837 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
838 flags
= IEEE80211_CHAN_B
;
840 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
844 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
845 flags
= IEEE80211_CHAN_B
| IEEE80211_CHAN_HT20
;
847 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
851 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
852 flags
= IEEE80211_CHAN_G
;
854 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
858 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
859 flags
= IEEE80211_CHAN_G
| IEEE80211_CHAN_HT20
;
861 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
866 /* set supported channels for 5GHz band */
868 if (sc
->rf_rev
== RT2860_EEPROM_RF_2850
||
869 sc
->rf_rev
== RT2860_EEPROM_RF_2750
)
871 for (i
= 36; i
<= 64; i
+= 4)
873 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
874 flags
= IEEE80211_CHAN_A
;
876 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
880 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
881 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT20
;
883 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
888 for (i
= 100; i
<= 140; i
+= 4)
890 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
891 flags
= IEEE80211_CHAN_A
;
893 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
897 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
898 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT20
;
900 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
905 for (i
= 149; i
<= 165; i
+= 4)
907 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
908 flags
= IEEE80211_CHAN_A
;
910 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
914 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
915 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT20
;
917 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
925 * rt2860_init_channels_ht40
927 static void rt2860_init_channels_ht40(struct rt2860_softc
*sc
)
929 struct ieee80211com
*ic
;
930 struct ieee80211_channel
*c
, *cent
, *ext
;
935 /* set supported channels for 2GHz band */
937 for (i
= 1; i
<= 14; i
++)
939 flags
= IEEE80211_CHAN_G
| IEEE80211_CHAN_HT40
;
941 /* find the center channel */
943 cent
= ieee80211_find_channel_byieee(ic
, i
,
944 flags
& ~IEEE80211_CHAN_HT
);
947 printf("%s: skip channel %d, could not find center channel\n",
948 device_get_nameunit(sc
->dev
), i
);
952 /* find the extension channel */
954 ext
= ieee80211_find_channel(ic
, cent
->ic_freq
+ 20,
955 flags
& ~IEEE80211_CHAN_HT
);
958 printf("%s: skip channel %d, could not find extension channel\n",
959 device_get_nameunit(sc
->dev
), i
);
963 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
966 c
->ic_extieee
= ext
->ic_ieee
;
967 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
968 c
->ic_flags
|= IEEE80211_CHAN_HT40U
;
970 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
973 c
->ic_extieee
= cent
->ic_ieee
;
974 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
975 c
->ic_flags
|= IEEE80211_CHAN_HT40D
;
978 /* set supported channels for 5GHz band */
980 if (sc
->rf_rev
== RT2860_EEPROM_RF_2850
||
981 sc
->rf_rev
== RT2860_EEPROM_RF_2750
)
983 for (i
= 36; i
<= 64; i
+= 4)
985 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT40
;
987 /* find the center channel */
989 cent
= ieee80211_find_channel_byieee(ic
, i
,
990 flags
& ~IEEE80211_CHAN_HT
);
993 printf("%s: skip channel %d, could not find center channel\n",
994 device_get_nameunit(sc
->dev
), i
);
998 /* find the extension channel */
1000 ext
= ieee80211_find_channel(ic
, cent
->ic_freq
+ 20,
1001 flags
& ~IEEE80211_CHAN_HT
);
1004 printf("%s: skip channel %d, could not find extension channel\n",
1005 device_get_nameunit(sc
->dev
), i
);
1009 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1012 c
->ic_extieee
= ext
->ic_ieee
;
1013 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1014 c
->ic_flags
|= IEEE80211_CHAN_HT40U
;
1016 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1019 c
->ic_extieee
= cent
->ic_ieee
;
1020 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1021 c
->ic_flags
|= IEEE80211_CHAN_HT40D
;
1024 for (i
= 100; i
<= 140; i
+= 4)
1026 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT40
;
1028 /* find the center channel */
1030 cent
= ieee80211_find_channel_byieee(ic
, i
,
1031 flags
& ~IEEE80211_CHAN_HT
);
1034 printf("%s: skip channel %d, could not find center channel\n",
1035 device_get_nameunit(sc
->dev
), i
);
1039 /* find the extension channel */
1041 ext
= ieee80211_find_channel(ic
, cent
->ic_freq
+ 20,
1042 flags
& ~IEEE80211_CHAN_HT
);
1045 printf("%s: skip channel %d, could not find extension channel\n",
1046 device_get_nameunit(sc
->dev
), i
);
1050 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1053 c
->ic_extieee
= ext
->ic_ieee
;
1054 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1055 c
->ic_flags
|= IEEE80211_CHAN_HT40U
;
1057 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1060 c
->ic_extieee
= cent
->ic_ieee
;
1061 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1062 c
->ic_flags
|= IEEE80211_CHAN_HT40D
;
1065 for (i
= 149; i
<= 165; i
+= 4)
1067 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT40
;
1069 /* find the center channel */
1071 cent
= ieee80211_find_channel_byieee(ic
, i
,
1072 flags
& ~IEEE80211_CHAN_HT
);
1075 printf("%s: skip channel %d, could not find center channel\n",
1076 device_get_nameunit(sc
->dev
), i
);
1080 /* find the extension channel */
1082 ext
= ieee80211_find_channel(ic
, cent
->ic_freq
+ 20,
1083 flags
& ~IEEE80211_CHAN_HT
);
1086 printf("%s: skip channel %d, could not find extension channel\n",
1087 device_get_nameunit(sc
->dev
), i
);
1091 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1094 c
->ic_extieee
= ext
->ic_ieee
;
1095 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1096 c
->ic_flags
|= IEEE80211_CHAN_HT40U
;
1098 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1101 c
->ic_extieee
= cent
->ic_ieee
;
1102 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1103 c
->ic_flags
|= IEEE80211_CHAN_HT40D
;
1109 * rt2860_init_locked
1111 static void rt2860_init_locked(void *priv
)
1113 struct rt2860_softc
*sc
;
1114 struct ieee80211com
*ic
;
1116 int error
, i
, ntries
;
1117 uint32_t tmp
, stacnt
[6];
1123 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
1124 "%s: initializing\n",
1125 device_get_nameunit(sc
->dev
));
1127 RT2860_SOFTC_ASSERT_LOCKED(sc
);
1129 if (!(sc
->flags
& RT2860_SOFTC_FLAGS_UCODE_LOADED
))
1131 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
1132 "%s: loading 8051 microcode\n",
1133 device_get_nameunit(sc
->dev
));
1135 error
= rt2860_io_mcu_load_ucode(sc
, rt2860_ucode
, sizeof(rt2860_ucode
));
1138 printf("%s: could not load 8051 microcode\n",
1139 device_get_nameunit(sc
->dev
));
1143 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
1144 "%s: 8051 microcode was successfully loaded\n",
1145 device_get_nameunit(sc
->dev
));
1147 sc
->flags
|= RT2860_SOFTC_FLAGS_UCODE_LOADED
;
1150 rt2860_io_mac_write(sc
, RT2860_REG_PWR_PIN_CFG
, 0x2);
1152 /* disable DMA engine */
1154 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
1157 tmp
|= RT2860_REG_TX_WB_DDONE
;
1159 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
1161 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_RST_IDX
, 0xffffffff);
1163 /* PBF hardware reset */
1165 rt2860_io_mac_write(sc
, RT2860_REG_PBF_SYS_CTRL
, 0xe1f);
1166 rt2860_io_mac_write(sc
, RT2860_REG_PBF_SYS_CTRL
, 0xe00);
1168 /* wait while DMA engine is busy */
1170 for (ntries
= 0; ntries
< 100; ntries
++)
1172 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
1173 if (!(tmp
& (RT2860_REG_TX_DMA_BUSY
| RT2860_REG_RX_DMA_BUSY
)))
1181 printf("%s: timeout waiting for DMA engine\n",
1182 device_get_nameunit(sc
->dev
));
1187 tmp
|= RT2860_REG_TX_WB_DDONE
;
1189 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
1191 /* reset Rx and Tx rings */
1193 tmp
= RT2860_REG_RST_IDX_RX
|
1194 RT2860_REG_RST_IDX_TX_MGMT
|
1195 RT2860_REG_RST_IDX_TX_HCCA
|
1196 RT2860_REG_RST_IDX_TX_AC3
|
1197 RT2860_REG_RST_IDX_TX_AC2
|
1198 RT2860_REG_RST_IDX_TX_AC1
|
1199 RT2860_REG_RST_IDX_TX_AC0
;
1201 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_RST_IDX
, tmp
);
1203 /* PBF hardware reset */
1205 rt2860_io_mac_write(sc
, RT2860_REG_PBF_SYS_CTRL
, 0xe1f);
1206 rt2860_io_mac_write(sc
, RT2860_REG_PBF_SYS_CTRL
, 0xe00);
1208 rt2860_io_mac_write(sc
, RT2860_REG_PWR_PIN_CFG
, 0x3);
1210 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
,
1211 RT2860_REG_MAC_SRST
| RT2860_REG_BBP_HRST
);
1212 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
, 0);
1214 /* init Tx power per rate */
1216 for (i
= 0; i
< RT2860_SOFTC_TXPOW_RATE_COUNT
; i
++)
1218 if (sc
->txpow_rate_20mhz
[i
] == 0xffffffff)
1221 rt2860_io_mac_write(sc
, RT2860_REG_TX_PWR_CFG(i
),
1222 sc
->txpow_rate_20mhz
[i
]);
1225 for (i
= 0; i
< RT2860_DEF_MAC_SIZE
; i
++)
1226 rt2860_io_mac_write(sc
, rt2860_def_mac
[i
].reg
,
1227 rt2860_def_mac
[i
].val
);
1229 /* wait while MAC is busy */
1231 for (ntries
= 0; ntries
< 100; ntries
++)
1233 if (!(rt2860_io_mac_read(sc
, RT2860_REG_STATUS_CFG
) &
1234 (RT2860_REG_STATUS_TX_BUSY
| RT2860_REG_STATUS_RX_BUSY
)))
1242 printf("%s: timeout waiting for MAC\n",
1243 device_get_nameunit(sc
->dev
));
1247 /* clear Host to MCU mailbox */
1249 rt2860_io_mac_write(sc
, RT2860_REG_H2M_MAILBOX_BBP_AGENT
, 0);
1250 rt2860_io_mac_write(sc
, RT2860_REG_H2M_MAILBOX
, 0);
1252 rt2860_io_mcu_cmd(sc
, RT2860_IO_MCU_CMD_BOOT
,
1253 RT2860_REG_H2M_TOKEN_NO_INTR
, 0);
1257 error
= rt2860_init_bbp(sc
);
1261 /* set up maximum buffer sizes */
1263 tmp
= (1 << 12) | RT2860_MAX_AGG_SIZE
;
1265 rt2860_io_mac_write(sc
, RT2860_REG_MAX_LEN_CFG
, tmp
);
1267 /* set mac address */
1269 IEEE80211_ADDR_COPY(ic
->ic_myaddr
, IF_LLADDR(ifp
));
1271 rt2860_asic_set_macaddr(sc
, ic
->ic_myaddr
);
1273 /* clear statistic registers */
1275 rt2860_io_mac_read_multi(sc
, RT2860_REG_RX_STA_CNT0
,
1276 stacnt
, sizeof(stacnt
));
1278 /* set RTS threshold */
1280 rt2860_asic_update_rtsthreshold(sc
);
1284 rt2860_asic_update_txpower(sc
);
1286 /* set up protection mode */
1288 rt2860_asic_updateprot(sc
);
1290 /* clear key tables */
1292 rt2860_asic_clear_keytables(sc
);
1294 /* init Tx rings (4 EDCAs + HCCA + MGMT) */
1296 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
1297 rt2860_reset_tx_ring(sc
, &sc
->tx_ring
[i
]);
1299 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
1301 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_BASE_PTR(i
),
1302 sc
->tx_ring
[i
].desc_phys_addr
);
1303 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_MAX_CNT(i
),
1304 RT2860_SOFTC_TX_RING_DESC_COUNT
);
1305 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_CTX_IDX(i
), 0);
1310 rt2860_reset_rx_ring(sc
, &sc
->rx_ring
);
1312 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_BASE_PTR
,
1313 sc
->rx_ring
.desc_phys_addr
);
1314 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_MAX_CNT
,
1315 RT2860_SOFTC_RX_RING_DATA_COUNT
);
1316 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
1317 RT2860_SOFTC_RX_RING_DATA_COUNT
- 1);
1319 /* wait while DMA engine is busy */
1321 for (ntries
= 0; ntries
< 100; ntries
++)
1323 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
1324 if (!(tmp
& (RT2860_REG_TX_DMA_BUSY
| RT2860_REG_RX_DMA_BUSY
)))
1332 printf("%s: timeout waiting for DMA engine\n",
1333 device_get_nameunit(sc
->dev
));
1338 tmp
|= RT2860_REG_TX_WB_DDONE
;
1340 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
1342 /* disable interrupts mitigation */
1344 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_DELAY_INT_CFG
, 0);
1346 /* send LEDs operating mode to microcontroller */
1348 rt2860_io_mcu_cmd(sc
, RT2860_IO_MCU_CMD_LED1
,
1349 RT2860_REG_H2M_TOKEN_NO_INTR
, sc
->led_off
[0]);
1350 rt2860_io_mcu_cmd(sc
, RT2860_IO_MCU_CMD_LED2
,
1351 RT2860_REG_H2M_TOKEN_NO_INTR
, sc
->led_off
[1]);
1352 rt2860_io_mcu_cmd(sc
, RT2860_IO_MCU_CMD_LED3
,
1353 RT2860_REG_H2M_TOKEN_NO_INTR
, sc
->led_off
[2]);
1355 /* turn radio LED on */
1357 rt2860_led_cmd(sc
, RT2860_LED_CMD_RADIO_ON
);
1359 /* write vendor-specific BBP values (from EEPROM) */
1361 for (i
= 0; i
< RT2860_SOFTC_BBP_EEPROM_COUNT
; i
++)
1363 if (sc
->bbp_eeprom
[i
].reg
== 0x00 ||
1364 sc
->bbp_eeprom
[i
].reg
== 0xff)
1367 rt2860_io_bbp_write(sc
, sc
->bbp_eeprom
[i
].reg
,
1368 sc
->bbp_eeprom
[i
].val
);
1372 tmp = rt2860_io_mac_read(sc, RT2860_REG_SCHDMA_GPIO_CTRL_CFG);
1375 rt2860_io_mcu_cmd(sc, RT2860_IO_MCU_CMD_SLEEP,
1376 RT2860_REG_H2M_TOKEN_RADIOOFF, 0x02ff);
1377 rt2860_io_mcu_cmd_check(sc, RT2860_REG_H2M_TOKEN_RADIOOFF);
1379 rt2860_io_mcu_cmd(sc, RT2860_IO_MCU_CMD_WAKEUP,
1380 RT2860_REG_H2M_TOKEN_WAKEUP, 0);
1381 rt2860_io_mcu_cmd_check(sc, RT2860_REG_H2M_TOKEN_WAKEUP);
1385 /* disable non-existing Rx chains */
1387 tmp
= rt2860_io_bbp_read(sc
, 3);
1389 tmp
&= ~((1 << 4) | (1 << 3));
1391 if (sc
->nrxpath
== 3)
1393 else if (sc
->nrxpath
== 2)
1396 rt2860_io_bbp_write(sc
, 3, tmp
);
1398 /* disable non-existing Tx chains */
1400 tmp
= rt2860_io_bbp_read(sc
, 1);
1402 tmp
&= ~((1 << 4) | (1 << 3));
1404 if (sc
->ntxpath
== 2)
1407 rt2860_io_bbp_write(sc
, 1, tmp
);
1409 /* set current channel */
1411 rt2860_rf_set_chan(sc
, ic
->ic_curchan
);
1413 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_TXOP0_CFG
, 0);
1414 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_TXOP1_CFG
,
1417 if ((sc
->mac_rev
& 0xffff) != 0x0101)
1418 rt2860_io_mac_write(sc
, RT2860_REG_TX_TXOP_CTRL_CFG
, 0x583f);
1420 /* clear pending interrupts */
1422 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_STATUS
, 0xffffffff);
1424 /* enable interrupts */
1426 tmp
= RT2860_REG_INT_TX_COHERENT
|
1427 RT2860_REG_INT_RX_COHERENT
|
1428 RT2860_REG_INT_GP_TIMER
|
1429 RT2860_REG_INT_AUTO_WAKEUP
|
1430 RT2860_REG_INT_FIFO_STA_FULL
|
1432 RT2860_REG_INT_PRE_TBTT |
1433 RT2860_REG_INT_TBTT |
1435 RT2860_REG_INT_TXRX_COHERENT
|
1436 RT2860_REG_INT_MCU_CMD
|
1437 RT2860_REG_INT_TX_MGMT_DONE
|
1438 RT2860_REG_INT_TX_HCCA_DONE
|
1439 RT2860_REG_INT_TX_AC3_DONE
|
1440 RT2860_REG_INT_TX_AC2_DONE
|
1441 RT2860_REG_INT_TX_AC1_DONE
|
1442 RT2860_REG_INT_TX_AC0_DONE
|
1443 RT2860_REG_INT_RX_DONE
;
1445 sc
->intr_enable_mask
= tmp
;
1447 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_MASK
, tmp
);
1449 if (rt2860_txrx_enable(sc
) != 0)
1452 /* clear garbage interrupts */
1454 tmp
= rt2860_io_mac_read(sc
, 0x1300);
1456 ifp
->if_drv_flags
&= ~IFF_DRV_OACTIVE
;
1457 ifp
->if_drv_flags
|= IFF_DRV_RUNNING
;
1459 if (ic
->ic_opmode
!= IEEE80211_M_MONITOR
)
1461 if (ic
->ic_roaming
!= IEEE80211_ROAMING_MANUAL
)
1462 ieee80211_new_state(ic
, IEEE80211_S_SCAN
, -1);
1466 ieee80211_new_state(ic
, IEEE80211_S_RUN
, -1);
1469 sc
->periodic_round
= 0;
1471 callout_reset(&sc
->periodic_ch
, hz
/ 10, rt2860_periodic
, sc
);
1477 rt2860_stop_locked(sc
);
1483 static void rt2860_init(void *priv
)
1485 struct rt2860_softc
*sc
;
1489 RT2860_SOFTC_LOCK(sc
);
1491 rt2860_init_locked(sc
);
1493 RT2860_SOFTC_UNLOCK(sc
);
1499 static int rt2860_init_bbp(struct rt2860_softc
*sc
)
1504 for (ntries
= 0; ntries
< 20; ntries
++)
1506 tmp
= rt2860_io_bbp_read(sc
, 0);
1507 if (tmp
!= 0x00 && tmp
!= 0xff)
1511 if (tmp
== 0x00 || tmp
== 0xff)
1513 printf("%s: timeout waiting for BBP to wakeup\n",
1514 device_get_nameunit(sc
->dev
));
1518 for (i
= 0; i
< RT2860_DEF_BBP_SIZE
; i
++)
1519 rt2860_io_bbp_write(sc
, rt2860_def_bbp
[i
].reg
,
1520 rt2860_def_bbp
[i
].val
);
1522 if ((sc
->mac_rev
& 0xffff) != 0x0101)
1523 rt2860_io_bbp_write(sc
, 84, 0x19);
1529 * rt2860_stop_locked
1531 static void rt2860_stop_locked(void *priv
)
1533 struct rt2860_softc
*sc
;
1534 struct ieee80211com
*ic
;
1542 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
1544 device_get_nameunit(sc
->dev
));
1546 RT2860_SOFTC_ASSERT_LOCKED(sc
);
1550 if (ifp
->if_drv_flags
& IFF_DRV_RUNNING
)
1551 rt2860_led_cmd(sc
, RT2860_LED_CMD_RADIO_OFF
);
1553 ifp
->if_drv_flags
&= ~(IFF_DRV_RUNNING
| IFF_DRV_OACTIVE
);
1555 ieee80211_new_state(ic
, IEEE80211_S_INIT
, -1);
1557 callout_stop(&sc
->periodic_ch
);
1558 callout_stop(&sc
->tx_watchdog_ch
);
1560 RT2860_SOFTC_UNLOCK(sc
);
1562 taskqueue_block(sc
->taskqueue
);
1564 taskqueue_drain(sc
->taskqueue
, &sc
->rx_done_task
);
1565 taskqueue_drain(sc
->taskqueue
, &sc
->tx_done_task
);
1566 taskqueue_drain(sc
->taskqueue
, &sc
->fifo_sta_full_task
);
1567 taskqueue_drain(sc
->taskqueue
, &sc
->periodic_task
);
1569 RT2860_SOFTC_LOCK(sc
);
1571 /* clear key tables */
1573 rt2860_asic_clear_keytables(sc
);
1575 /* disable interrupts */
1577 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_MASK
, 0);
1581 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SYS_CTRL
);
1583 tmp
&= ~(RT2860_REG_RX_ENABLE
| RT2860_REG_TX_ENABLE
);
1585 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
, tmp
);
1589 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
,
1590 RT2860_REG_MAC_SRST
| RT2860_REG_BBP_HRST
);
1591 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
, 0);
1597 static void rt2860_stop(void *priv
)
1599 struct rt2860_softc
*sc
;
1603 RT2860_SOFTC_LOCK(sc
);
1605 rt2860_stop_locked(sc
);
1607 RT2860_SOFTC_UNLOCK(sc
);
1613 static void rt2860_start(struct ifnet
*ifp
)
1615 struct rt2860_softc
*sc
;
1616 struct ieee80211com
*ic
;
1617 struct ieee80211_node
*ni
;
1618 struct ether_header
*eh
;
1625 RT2860_SOFTC_LOCK(sc
);
1627 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
1629 RT2860_SOFTC_UNLOCK(sc
);
1635 IF_POLL(&ic
->ic_mgtq
, m
);
1638 if (sc
->tx_ring
[sc
->tx_ring_mgtqid
].data_queued
>= RT2860_SOFTC_TX_RING_DATA_COUNT
)
1640 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
1641 "%s: if_start: Tx ring with qid=%d is full\n",
1642 device_get_nameunit(sc
->dev
), sc
->tx_ring_mgtqid
);
1644 ifp
->if_drv_flags
|= IFF_DRV_OACTIVE
;
1646 sc
->tx_data_queue_full
[sc
->tx_ring_mgtqid
]++;
1651 IF_DEQUEUE(&ic
->ic_mgtq
, m
);
1653 ni
= (struct ieee80211_node
*) m
->m_pkthdr
.rcvif
;
1654 m
->m_pkthdr
.rcvif
= NULL
;
1656 if (bpf_peers_present(ic
->ic_rawbpf
))
1657 bpf_mtap(ic
->ic_rawbpf
, m
);
1659 if (rt2860_tx_frame(sc
, m
, ni
, sc
->tx_ring_mgtqid
) != 0)
1662 rt2860_drain_fifo_stats(sc
);
1666 if (ic
->ic_state
!= IEEE80211_S_RUN
)
1669 IF_POLL(&ifp
->if_snd
, m
);
1673 IFQ_DRV_DEQUEUE(&ifp
->if_snd
, m
);
1675 if (ic
->ic_flags
& IEEE80211_F_SCAN
)
1676 ieee80211_cancel_scan(ic
);
1678 if (m
->m_len
< sizeof(struct ether_header
) &&
1679 !(m
= m_pullup(m
, sizeof (struct ether_header
))))
1682 eh
= mtod(m
, struct ether_header
*);
1684 ni
= ieee80211_find_txnode(ic
, eh
->ether_dhost
);
1687 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
1688 "%s: if_start: could not find Tx node\n",
1689 device_get_nameunit(sc
->dev
));
1695 ieee80211_classify(ic
, m
, ni
);
1697 qid
= M_WME_GETAC(m
);
1699 if (sc
->tx_ring
[qid
].data_queued
>= RT2860_SOFTC_TX_RING_DATA_COUNT
)
1701 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
1702 "%s: if_start: Tx ring with qid=%d is full\n",
1703 device_get_nameunit(sc
->dev
), qid
);
1706 ieee80211_free_node(ni
);
1708 ifp
->if_drv_flags
|= IFF_DRV_OACTIVE
;
1711 sc
->tx_data_queue_full
[qid
]++;
1718 m
= ieee80211_encap(ic
, m
, ni
);
1721 ieee80211_free_node(ni
);
1726 if (bpf_peers_present(ic
->ic_rawbpf
))
1727 bpf_mtap(ic
->ic_rawbpf
, m
);
1729 if (rt2860_tx_frame(sc
, m
, ni
, qid
) != 0)
1731 ieee80211_free_node(ni
);
1738 rt2860_drain_fifo_stats(sc
);
1741 sc
->tx_timer
= RT2860_TX_WATCHDOG_TIMEOUT
;
1743 ic
->ic_lastdata
= ticks
;
1745 callout_reset(&sc
->tx_watchdog_ch
, hz
, rt2860_tx_watchdog
, sc
);
1748 RT2860_SOFTC_UNLOCK(sc
);
1754 static int rt2860_ioctl(struct ifnet
*ifp
, u_long cmd
, caddr_t data
)
1756 struct rt2860_softc
*sc
;
1757 struct ieee80211com
*ic
;
1768 RT2860_SOFTC_LOCK(sc
);
1770 if (ifp
->if_flags
& IFF_UP
)
1772 if (ifp
->if_drv_flags
& IFF_DRV_RUNNING
)
1774 if ((ifp
->if_flags
^ sc
->if_flags
) & IFF_PROMISC
)
1775 rt2860_asic_update_promisc(sc
);
1779 rt2860_init_locked(sc
);
1784 if (ifp
->if_drv_flags
& IFF_DRV_RUNNING
)
1785 rt2860_stop_locked(sc
);
1788 sc
->if_flags
= ifp
->if_flags
;
1790 RT2860_SOFTC_UNLOCK(sc
);
1794 error
= ieee80211_ioctl(ic
, cmd
, data
);
1797 if (error
== ENETRESET
)
1799 RT2860_SOFTC_LOCK(sc
);
1801 if ((ifp
->if_flags
& IFF_UP
) &&
1802 (ifp
->if_drv_flags
& IFF_DRV_RUNNING
) &&
1803 (ic
->ic_roaming
!= IEEE80211_ROAMING_MANUAL
))
1805 rt2860_stop_locked(sc
);
1806 rt2860_init_locked(sc
);
1809 RT2860_SOFTC_UNLOCK(sc
);
1820 static int rt2860_reset(struct ifnet
*ifp
)
1822 struct rt2860_softc
*sc
;
1823 struct ieee80211com
*ic
;
1828 if (ic
->ic_opmode
!= IEEE80211_M_MONITOR
)
1831 rt2860_rf_set_chan(sc
, ic
->ic_curchan
);
1839 static int rt2860_newstate(struct ieee80211com
*ic
,
1840 enum ieee80211_state nstate
, int arg
)
1842 struct rt2860_softc
*sc
;
1844 struct ieee80211_node
*ni
;
1850 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
1851 "%s: newstate: %s -> %s\n",
1852 device_get_nameunit(sc
->dev
),
1853 ieee80211_state_name
[ic
->ic_state
], ieee80211_state_name
[nstate
]);
1855 error
= sc
->newstate(ic
, nstate
, arg
);
1859 RT2860_SOFTC_LOCK(sc
);
1861 /* turn link LED off */
1863 if (nstate
!= IEEE80211_S_RUN
)
1864 rt2860_led_cmd(sc
, RT2860_LED_CMD_RADIO_OFF
);
1868 case IEEE80211_S_INIT
:
1869 rt2860_asic_disable_tsf_sync(sc
);
1872 case IEEE80211_S_RUN
:
1875 rt2860_rf_set_chan(sc
, ni
->ni_chan
);
1877 if (ic
->ic_opmode
!= IEEE80211_M_MONITOR
)
1879 rt2860_asic_enable_mrr(sc
);
1880 rt2860_asic_set_txpreamble(sc
);
1881 rt2860_asic_set_basicrates(sc
);
1882 rt2860_asic_update_txpower(sc
);
1883 rt2860_asic_set_bssid(sc
, ni
->ni_bssid
);
1886 if (ic
->ic_opmode
== IEEE80211_M_STA
)
1887 rt2860_newassoc(ni
, 1);
1889 if (ic
->ic_opmode
== IEEE80211_M_HOSTAP
||
1890 ic
->ic_opmode
== IEEE80211_M_IBSS
)
1892 error
= rt2860_asic_update_beacon(sc
);
1897 if (ic
->ic_opmode
!= IEEE80211_M_MONITOR
)
1898 rt2860_asic_enable_tsf_sync(sc
);
1900 /* turn link LED on */
1902 if (ic
->ic_opmode
!= IEEE80211_M_MONITOR
)
1904 rt2860_led_cmd(sc
, RT2860_LED_CMD_RADIO_ON
|
1905 (IEEE80211_IS_CHAN_2GHZ(ni
->ni_chan
) ?
1906 RT2860_LED_CMD_LINK_2GHZ
: RT2860_LED_CMD_LINK_5GHZ
));
1914 RT2860_SOFTC_UNLOCK(sc
);
1922 static void rt2860_scan_start(struct ieee80211com
*ic
)
1924 struct rt2860_softc
*sc
;
1930 rt2860_asic_disable_tsf_sync(sc
);
1936 static void rt2860_scan_end(struct ieee80211com
*ic
)
1938 struct rt2860_softc
*sc
;
1944 rt2860_asic_enable_tsf_sync(sc
);
1948 * rt2860_set_channel
1950 static void rt2860_set_channel(struct ieee80211com
*ic
)
1952 struct rt2860_softc
*sc
;
1958 RT2860_DPRINTF(sc
, RT2860_DEBUG_CHAN
,
1959 "%s: set channel: channel=%u, HT%s%s\n",
1960 device_get_nameunit(sc
->dev
),
1961 ieee80211_chan2ieee(ic
, ic
->ic_curchan
),
1962 !IEEE80211_IS_CHAN_HT(ic
->ic_curchan
) ? " disabled" :
1963 IEEE80211_IS_CHAN_HT20(ic
->ic_curchan
) ? "20":
1964 IEEE80211_IS_CHAN_HT40U(ic
->ic_curchan
) ? "40U" : "40D",
1965 (ic
->ic_flags
& IEEE80211_F_SCAN
) ? ", scanning" : "");
1967 RT2860_SOFTC_LOCK(sc
);
1969 rt2860_rf_set_chan(sc
, ic
->ic_curchan
);
1971 RT2860_SOFTC_UNLOCK(sc
);
1977 static void rt2860_newassoc(struct ieee80211_node
*ni
, int isnew
)
1979 struct rt2860_softc
*sc
;
1980 struct ieee80211com
*ic
;
1989 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
1990 wcid
= RT2860_AID2WCID(associd
);
1992 RT2860_DPRINTF(sc
, RT2860_DEBUG_NODE
,
1993 "%s: new association: wcid=0x%02x, "
1994 "mac addr=%s, QoS %s, ERP %s, HT %s\n",
1995 device_get_nameunit(sc
->dev
), wcid
,
1996 ether_sprintf(ni
->ni_macaddr
),
1997 (ni
->ni_flags
& IEEE80211_NODE_QOS
) ? "enabled" : "disabled",
1998 (ni
->ni_flags
& IEEE80211_NODE_ERP
) ? "enabled" : "disabled",
1999 (ni
->ni_flags
& IEEE80211_NODE_HT
) ? "enabled" : "disabled");
2001 rt2860_io_mac_write_multi(sc
, RT2860_REG_WCID(wcid
),
2002 ni
->ni_macaddr
, IEEE80211_ADDR_LEN
);
2004 rt2860_amrr_node_init(&sc
->amrr
, &sc
->amrr_node
[wcid
], ni
);
2006 RT2860_DPRINTF(sc
, RT2860_DEBUG_RATE
,
2007 "%s: initial%s node Tx rate: associd=0x%04x, rate=0x%02x, max rate=0x%02x\n",
2008 device_get_nameunit(sc
->dev
),
2009 (ni
->ni_flags
& IEEE80211_NODE_HT
) ? " HT" : "",
2011 (ni
->ni_flags
& IEEE80211_NODE_HT
) ?
2012 (ni
->ni_htrates
.rs_rates
[ni
->ni_txrate
] | IEEE80211_RATE_MCS
) :
2013 (ni
->ni_rates
.rs_rates
[ni
->ni_txrate
] & IEEE80211_RATE_VAL
),
2014 (ni
->ni_flags
& IEEE80211_NODE_HT
) ?
2015 (ni
->ni_htrates
.rs_rates
[ni
->ni_htrates
.rs_nrates
- 1] | IEEE80211_RATE_MCS
) :
2016 (ni
->ni_rates
.rs_rates
[ni
->ni_rates
.rs_nrates
- 1] & IEEE80211_RATE_VAL
));
2018 rt2860_asic_updateprot(sc
);
2019 rt2860_asic_updateslot(sc
);
2020 rt2860_asic_set_txpreamble(sc
);
2026 static void rt2860_updateslot(struct ifnet
*ifp
)
2028 struct rt2860_softc
*sc
;
2032 rt2860_asic_updateslot(sc
);
2038 static int rt2860_wme_update(struct ieee80211com
*ic
)
2040 struct rt2860_softc
*sc
;
2046 rt2860_asic_wme_update(sc
);
2052 * rt2860_update_beacon
2054 static void rt2860_update_beacon(struct ieee80211com
*ic
, int what
)
2056 struct rt2860_softc
*sc
;
2062 rt2860_asic_update_beacon(sc
);
2066 * rt2860_key_update_begin
2068 static void rt2860_key_update_begin(struct ieee80211com
*ic
)
2070 struct rt2860_softc
*sc
;
2076 RT2860_DPRINTF(sc
, RT2860_DEBUG_KEY
,
2077 "%s: key update begin\n",
2078 device_get_nameunit(sc
->dev
));
2080 taskqueue_block(sc
->taskqueue
);
2082 IF_LOCK(&ifp
->if_snd
);
2086 * rt2860_key_update_end
2088 static void rt2860_key_update_end(struct ieee80211com
*ic
)
2090 struct rt2860_softc
*sc
;
2096 RT2860_DPRINTF(sc
, RT2860_DEBUG_KEY
,
2097 "%s: key update end\n",
2098 device_get_nameunit(sc
->dev
));
2100 IF_UNLOCK(&ifp
->if_snd
);
2102 taskqueue_unblock(sc
->taskqueue
);
2108 static int rt2860_key_set(struct ieee80211com
*ic
,
2109 const struct ieee80211_key
*k
, const uint8_t mac
[IEEE80211_ADDR_LEN
])
2111 struct rt2860_softc
*sc
;
2113 struct ieee80211_node
*ni
;
2114 uint16_t associd
, key_base
, keymode_base
;
2115 uint8_t mode
, vapid
, wcid
, iv
[8];
2118 if (k
->wk_cipher
->ic_cipher
!= IEEE80211_CIPHER_WEP
&&
2119 k
->wk_cipher
->ic_cipher
!= IEEE80211_CIPHER_TKIP
&&
2120 k
->wk_cipher
->ic_cipher
!= IEEE80211_CIPHER_AES_CCM
)
2126 if (ic
->ic_opmode
!= IEEE80211_M_HOSTAP
)
2129 ni
= ieee80211_find_node(&ic
->ic_sta
, mac
);
2131 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
2133 if ((ic
->ic_opmode
== IEEE80211_M_HOSTAP
) && (ni
!= NULL
))
2134 ieee80211_free_node(ni
);
2136 switch (k
->wk_cipher
->ic_cipher
)
2138 case IEEE80211_CIPHER_WEP
:
2139 if(k
->wk_keylen
< 8)
2140 mode
= RT2860_REG_CIPHER_MODE_WEP40
;
2142 mode
= RT2860_REG_CIPHER_MODE_WEP104
;
2145 case IEEE80211_CIPHER_TKIP
:
2146 mode
= RT2860_REG_CIPHER_MODE_TKIP
;
2149 case IEEE80211_CIPHER_AES_CCM
:
2150 mode
= RT2860_REG_CIPHER_MODE_AES_CCMP
;
2157 RT2860_DPRINTF(sc
, RT2860_DEBUG_KEY
,
2158 "%s: set key: keyix=%d, keylen=%d, associd=0x%04x, mode=%d, group=%d\n",
2159 device_get_nameunit(sc
->dev
), k
->wk_keyix
, k
->wk_keylen
, associd
, mode
,
2160 (k
->wk_flags
& IEEE80211_KEY_GROUP
) ? 1 : 0);
2162 if (!(k
->wk_flags
& IEEE80211_KEY_GROUP
))
2164 /* install pairwise key */
2167 wcid
= RT2860_AID2WCID(associd
);
2168 key_base
= RT2860_REG_PKEY(wcid
);
2170 if (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_WEP
)
2174 iv
[3] = (k
->wk_keyix
<< 6);
2178 if (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_TKIP
)
2180 iv
[0] = (k
->wk_keytsc
>> 8);
2181 iv
[1] = ((iv
[0] | 0x20) & 0x7f);
2182 iv
[2] = k
->wk_keytsc
;
2188 iv
[0] = k
->wk_keytsc
;
2189 iv
[1] = k
->wk_keytsc
>> 8;
2193 iv
[3] = ((k
->wk_keyix
<< 6) | IEEE80211_WEP_EXTIV
);
2194 iv
[4] = (k
->wk_keytsc
>> 16);
2195 iv
[5] = (k
->wk_keytsc
>> 24);
2196 iv
[6] = (k
->wk_keytsc
>> 32);
2197 iv
[7] = (k
->wk_keytsc
>> 40);
2199 RT2860_DPRINTF(sc
, RT2860_DEBUG_KEY
,
2200 "%s: set key: iv=%02x %02x %02x %02x %02x %02x %02x %02x\n",
2201 device_get_nameunit(sc
->dev
),
2202 iv
[0], iv
[1], iv
[2], iv
[3], iv
[4], iv
[5], iv
[6], iv
[7]);
2205 rt2860_io_mac_write_multi(sc
, RT2860_REG_IVEIV(wcid
), iv
, 8);
2207 if (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_TKIP
)
2209 rt2860_io_mac_write_multi(sc
, key_base
, k
->wk_key
, 16);
2211 if (ic
->ic_opmode
!= IEEE80211_M_HOSTAP
)
2213 rt2860_io_mac_write_multi(sc
, key_base
+ 16, &k
->wk_key
[16], 8);
2214 rt2860_io_mac_write_multi(sc
, key_base
+ 24, &k
->wk_key
[24], 8);
2218 rt2860_io_mac_write_multi(sc
, key_base
+ 16, &k
->wk_key
[24], 8);
2219 rt2860_io_mac_write_multi(sc
, key_base
+ 24, &k
->wk_key
[16], 8);
2224 rt2860_io_mac_write_multi(sc
, key_base
, k
->wk_key
, k
->wk_keylen
);
2227 tmp
= ((vapid
& RT2860_REG_VAP_MASK
) << RT2860_REG_VAP_SHIFT
) |
2228 (mode
<< RT2860_REG_CIPHER_MODE_SHIFT
) | RT2860_REG_PKEY_ENABLE
;
2230 rt2860_io_mac_write(sc
, RT2860_REG_WCID_ATTR(wcid
), tmp
);
2233 if ((k
->wk_flags
& IEEE80211_KEY_GROUP
) ||
2234 (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_WEP
))
2236 /* install group key */
2239 key_base
= RT2860_REG_SKEY(vapid
, k
->wk_keyix
);
2240 keymode_base
= RT2860_REG_SKEY_MODE(vapid
);
2242 if (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_TKIP
)
2244 rt2860_io_mac_write_multi(sc
, key_base
, k
->wk_key
, 16);
2246 if (ic
->ic_opmode
!= IEEE80211_M_HOSTAP
)
2248 rt2860_io_mac_write_multi(sc
, key_base
+ 16, &k
->wk_key
[16], 8);
2249 rt2860_io_mac_write_multi(sc
, key_base
+ 24, &k
->wk_key
[24], 8);
2253 rt2860_io_mac_write_multi(sc
, key_base
+ 16, &k
->wk_key
[24], 8);
2254 rt2860_io_mac_write_multi(sc
, key_base
+ 24, &k
->wk_key
[16], 8);
2259 rt2860_io_mac_write_multi(sc
, key_base
, k
->wk_key
, k
->wk_keylen
);
2262 tmp
= rt2860_io_mac_read(sc
, keymode_base
);
2264 tmp
&= ~(0xf << (k
->wk_keyix
* 4 + 16 * (vapid
% 2)));
2265 tmp
|= (mode
<< (k
->wk_keyix
* 4 + 16 * (vapid
% 2)));
2267 rt2860_io_mac_write(sc
, keymode_base
, tmp
);
2276 static int rt2860_key_delete(struct ieee80211com
*ic
,
2277 const struct ieee80211_key
*k
)
2279 struct rt2860_softc
*sc
;
2280 struct ieee80211_node
*ni
;
2282 uint8_t vapid
, wcid
;
2285 sc
= ic
->ic_ifp
->if_softc
;
2287 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
2289 RT2860_DPRINTF(sc
, RT2860_DEBUG_KEY
,
2290 "%s: delete key: keyix=%d, keylen=%d, associd=0x%04x, group=%d\n",
2291 device_get_nameunit(sc
->dev
), k
->wk_keyix
, k
->wk_keylen
, associd
,
2292 (k
->wk_flags
& IEEE80211_KEY_GROUP
) ? 1 : 0);
2294 if (!(k
->wk_flags
& IEEE80211_KEY_GROUP
))
2296 /* remove pairwise key */
2299 wcid
= RT2860_AID2WCID(associd
);
2301 tmp
= ((vapid
& RT2860_REG_VAP_MASK
) << RT2860_REG_VAP_SHIFT
) |
2302 (RT2860_REG_CIPHER_MODE_NONE
<< RT2860_REG_CIPHER_MODE_SHIFT
) | RT2860_REG_PKEY_ENABLE
;
2304 rt2860_io_mac_write(sc
, RT2860_REG_WCID_ATTR(wcid
), tmp
);
2308 /* remove group key */
2312 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SKEY_MODE(vapid
));
2314 tmp
&= ~(0xf << (k
->wk_keyix
* 4 + 16 * (vapid
% 2)));
2315 tmp
|= (RT2860_REG_CIPHER_MODE_NONE
<< (k
->wk_keyix
* 4 + 16 * (vapid
% 2)));
2317 rt2860_io_mac_write(sc
, RT2860_REG_SKEY_MODE(vapid
), tmp
);
2326 static int rt2860_raw_xmit(struct ieee80211_node
*ni
, struct mbuf
*m
,
2327 const struct ieee80211_bpf_params
*params
)
2333 * rt2860_media_change
2335 static int rt2860_media_change(struct ifnet
*ifp
)
2337 struct rt2860_softc
*sc
;
2342 error
= ieee80211_media_change(ifp
);
2343 if (error
!= ENETRESET
)
2346 RT2860_SOFTC_LOCK(sc
);
2348 if ((ifp
->if_flags
& IFF_UP
) && (ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
2350 rt2860_stop_locked(sc
);
2351 rt2860_init_locked(sc
);
2354 RT2860_SOFTC_UNLOCK(sc
);
2360 * rt2860_recv_action
2362 static void rt2860_recv_action(struct ieee80211_node
*ni
,
2363 const uint8_t *frm
, const uint8_t *efrm
)
2365 struct rt2860_softc
*sc
;
2366 struct ieee80211com
*ic
;
2368 const struct ieee80211_action
*ia
;
2369 uint16_t associd
, baparamset
;
2378 ia
= (const struct ieee80211_action
*) frm
;
2380 sc
->recv_action(ni
, frm
, efrm
);
2382 if (ia
->ia_category
!= IEEE80211_ACTION_CAT_BA
)
2385 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
2386 wcid
= RT2860_AID2WCID(associd
);
2388 switch (ia
->ia_action
)
2390 /* IEEE80211_ACTION_BA_ADDBA_REQUEST */
2391 case IEEE80211_ACTION_BA_ADDBA_REQUEST
:
2392 baparamset
= LE_READ_2(frm
+ 3);
2393 tid
= RT2860_MS(baparamset
, IEEE80211_BAPS_TID
);
2394 bufsize
= RT2860_MS(baparamset
, IEEE80211_BAPS_BUFSIZ
);
2396 RT2860_DPRINTF(sc
, RT2860_DEBUG_BA
,
2397 "%s: received ADDBA: associd=0x%04x, tid=%d, bufsize=%d\n",
2398 device_get_nameunit(sc
->dev
), associd
, tid
, bufsize
);
2400 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_WCID(wcid
) + 4);
2402 tmp
|= (0x10000 << tid
);
2404 rt2860_io_mac_write(sc
, RT2860_REG_WCID(wcid
) + 4, tmp
);
2407 /* IEEE80211_ACTION_BA_DELBA */
2408 case IEEE80211_ACTION_BA_DELBA
:
2409 baparamset
= LE_READ_2(frm
+ 2);
2410 tid
= RT2860_MS(baparamset
, IEEE80211_BAPS_TID
);
2412 RT2860_DPRINTF(sc
, RT2860_DEBUG_BA
,
2413 "%s: received DELBA: associd=0x%04x, tid=%d\n",
2414 device_get_nameunit(sc
->dev
), associd
, tid
);
2416 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_WCID(wcid
) + 4);
2418 tmp
&= ~(0x10000 << tid
);
2420 rt2860_io_mac_write(sc
, RT2860_REG_WCID(wcid
) + 4, tmp
);
2426 * rt2860_send_action
2428 static int rt2860_send_action(struct ieee80211_node
*ni
,
2429 int category
, int action
, uint16_t args
[4])
2431 struct rt2860_softc
*sc
;
2432 struct ieee80211com
*ic
;
2434 uint16_t associd
, baparamset
;
2443 ret
= sc
->send_action(ni
, category
, action
, args
);
2445 if (category
!= IEEE80211_ACTION_CAT_BA
)
2448 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
2449 wcid
= RT2860_AID2WCID(associd
);
2453 /* IEEE80211_ACTION_BA_DELBA */
2454 case IEEE80211_ACTION_BA_DELBA
:
2455 baparamset
= RT2860_SM(args
[0], IEEE80211_DELBAPS_TID
) |
2456 RT2860_SM(args
[1], IEEE80211_DELBAPS_INIT
);
2458 if (RT2860_MS(baparamset
, IEEE80211_DELBAPS_INIT
) == IEEE80211_DELBAPS_INIT
)
2461 tid
= RT2860_MS(baparamset
, IEEE80211_DELBAPS_TID
);
2463 RT2860_DPRINTF(sc
, RT2860_DEBUG_BA
,
2464 "%s: sending DELBA: associd=0x%04x, tid=%d\n",
2465 device_get_nameunit(sc
->dev
), associd
, tid
);
2467 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_WCID(wcid
) + 4);
2469 tmp
&= ~(0x10000 << tid
);
2471 rt2860_io_mac_write(sc
, RT2860_REG_WCID(wcid
) + 4, tmp
);
2479 * rt2860_amrr_update_iter_func
2481 static void rt2860_amrr_update_iter_func(void *arg
, struct ieee80211_node
*ni
)
2483 struct rt2860_softc
*sc
;
2484 struct ieee80211com
*ic
;
2490 /* only associated stations */
2492 if (ni
->ni_associd
!= 0)
2494 wcid
= RT2860_AID2WCID(ni
->ni_associd
);
2496 RT2860_DPRINTF(sc
, RT2860_DEBUG_RATE
,
2497 "%s: AMRR node: wcid=0x%02x, txcnt=%d, success=%d, retrycnt=%d\n",
2498 device_get_nameunit(sc
->dev
),
2499 wcid
, sc
->amrr_node
[wcid
].txcnt
, sc
->amrr_node
[wcid
].success
, sc
->amrr_node
[wcid
].retrycnt
);
2501 rt2860_amrr_choose(ni
, &sc
->amrr_node
[wcid
]);
2503 RT2860_DPRINTF(sc
, RT2860_DEBUG_RATE
,
2504 "%s:%s node Tx rate: associd=0x%04x, rate=0x%02x, max rate=0x%02x\n",
2505 device_get_nameunit(sc
->dev
),
2506 (ni
->ni_flags
& IEEE80211_NODE_HT
) ? " HT" : "",
2508 (ni
->ni_flags
& IEEE80211_NODE_HT
) ?
2509 (ni
->ni_htrates
.rs_rates
[ni
->ni_txrate
] | IEEE80211_RATE_MCS
) :
2510 (ni
->ni_rates
.rs_rates
[ni
->ni_txrate
] & IEEE80211_RATE_VAL
),
2511 (ni
->ni_flags
& IEEE80211_NODE_HT
) ?
2512 (ni
->ni_htrates
.rs_rates
[ni
->ni_htrates
.rs_nrates
- 1] | IEEE80211_RATE_MCS
) :
2513 (ni
->ni_rates
.rs_rates
[ni
->ni_rates
.rs_nrates
- 1] & IEEE80211_RATE_VAL
));
2520 static void rt2860_periodic(void *arg
)
2522 struct rt2860_softc
*sc
;
2526 RT2860_DPRINTF(sc
, RT2860_DEBUG_PERIODIC
,
2528 device_get_nameunit(sc
->dev
));
2530 taskqueue_enqueue(sc
->taskqueue
, &sc
->periodic_task
);
2534 * rt2860_tx_watchdog
2536 static void rt2860_tx_watchdog(void *arg
)
2538 struct rt2860_softc
*sc
;
2544 if (sc
->tx_timer
== 0)
2547 if (--sc
->tx_timer
== 0)
2549 printf("%s: Tx watchdog timeout: resetting\n",
2550 device_get_nameunit(sc
->dev
));
2552 rt2860_stop_locked(sc
);
2553 rt2860_init_locked(sc
);
2557 sc
->tx_watchdog_timeouts
++;
2560 callout_reset(&sc
->tx_watchdog_ch
, hz
, rt2860_tx_watchdog
, sc
);
2564 * rt2860_asic_set_bssid
2566 static void rt2860_asic_set_bssid(struct rt2860_softc
*sc
,
2567 const uint8_t *bssid
)
2571 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
2572 "%s: set bssid: bssid=%s\n",
2573 device_get_nameunit(sc
->dev
), ether_sprintf(bssid
));
2575 tmp
= bssid
[0] | (bssid
[1]) << 8 | (bssid
[2] << 16) | (bssid
[3] << 24);
2577 rt2860_io_mac_write(sc
, RT2860_REG_BSSID_DW0
, tmp
);
2579 tmp
= bssid
[4] | (bssid
[5] << 8);
2581 rt2860_io_mac_write(sc
, RT2860_REG_BSSID_DW1
, tmp
);
2585 * rt2860_asic_set_macaddr
2587 static void rt2860_asic_set_macaddr(struct rt2860_softc
*sc
,
2588 const uint8_t *addr
)
2592 tmp
= addr
[0] | (addr
[1] << 8) | (addr
[2] << 16) | (addr
[3] << 24);
2594 rt2860_io_mac_write(sc
, RT2860_REG_ADDR_DW0
, tmp
);
2596 tmp
= addr
[4] | (addr
[5] << 8);
2598 rt2860_io_mac_write(sc
, RT2860_REG_ADDR_DW1
, tmp
);
2602 * rt2860_asic_enable_tsf_sync
2604 static void rt2860_asic_enable_tsf_sync(struct rt2860_softc
*sc
)
2606 struct ieee80211com
*ic
;
2611 RT2860_DPRINTF(sc
, RT2860_DEBUG_BEACON
,
2612 "%s: enabling TSF\n",
2613 device_get_nameunit(sc
->dev
));
2615 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_BCN_TIME_CFG
);
2618 tmp
|= ic
->ic_bss
->ni_intval
* 16;
2619 tmp
|= (RT2860_REG_TSF_TIMER_ENABLE
| RT2860_REG_TBTT_TIMER_ENABLE
);
2621 if (ic
->ic_opmode
== IEEE80211_M_STA
)
2623 tmp
|= (RT2860_REG_TSF_SYNC_MODE_STA
<< RT2860_REG_TSF_SYNC_MODE_SHIFT
);
2625 else if (ic
->ic_opmode
== IEEE80211_M_IBSS
)
2627 tmp
|= RT2860_REG_BCN_TX_ENABLE
;
2628 tmp
|= (RT2860_REG_TSF_SYNC_MODE_IBSS
<< RT2860_REG_TSF_SYNC_MODE_SHIFT
);
2630 else if (ic
->ic_opmode
== IEEE80211_M_HOSTAP
)
2632 tmp
|= RT2860_REG_BCN_TX_ENABLE
;
2633 tmp
|= (RT2860_REG_TSF_SYNC_MODE_HOSTAP
<< RT2860_REG_TSF_SYNC_MODE_SHIFT
);
2636 rt2860_io_mac_write(sc
, RT2860_REG_BCN_TIME_CFG
, tmp
);
2640 * rt2860_asic_disable_tsf_sync
2642 static void rt2860_asic_disable_tsf_sync(struct rt2860_softc
*sc
)
2646 RT2860_DPRINTF(sc
, RT2860_DEBUG_BEACON
,
2647 "%s: disabling TSF\n",
2648 device_get_nameunit(sc
->dev
));
2650 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_BCN_TIME_CFG
);
2652 tmp
&= ~(RT2860_REG_BCN_TX_ENABLE
|
2653 RT2860_REG_TSF_TIMER_ENABLE
|
2654 RT2860_REG_TBTT_TIMER_ENABLE
);
2656 tmp
&= ~(RT2860_REG_TSF_SYNC_MODE_MASK
<< RT2860_REG_TSF_SYNC_MODE_SHIFT
);
2657 tmp
|= (RT2860_REG_TSF_SYNC_MODE_DISABLE
<< RT2860_REG_TSF_SYNC_MODE_SHIFT
);
2659 rt2860_io_mac_write(sc
, RT2860_REG_BCN_TIME_CFG
, tmp
);
2663 * rt2860_asic_enable_mrr
2665 static void rt2860_asic_enable_mrr(struct rt2860_softc
*sc
)
2667 #define CCK(mcs) (mcs)
2668 #define OFDM(mcs) ((1 << 3) | (mcs))
2669 #define HT(mcs) (mcs)
2671 rt2860_io_mac_write(sc
, RT2860_REG_TX_LG_FBK_CFG0
,
2672 (OFDM(6) << 28) | /* 54 -> 48 */
2673 (OFDM(5) << 24) | /* 48 -> 36 */
2674 (OFDM(4) << 20) | /* 36 -> 24 */
2675 (OFDM(3) << 16) | /* 24 -> 18 */
2676 (OFDM(2) << 12) | /* 18 -> 12 */
2677 (OFDM(1) << 8) | /* 12 -> 9 */
2678 (OFDM(0) << 4) | /* 9 -> 6 */
2679 OFDM(0)); /* 6 -> 6 */
2681 rt2860_io_mac_write(sc
, RT2860_REG_TX_LG_FBK_CFG1
,
2682 (CCK(2) << 12) | /* 11 -> 5.5 */
2683 (CCK(1) << 8) | /* 5.5 -> 2 */
2684 (CCK(0) << 4) | /* 2 -> 1 */
2685 CCK(0)); /* 1 -> 1 */
2687 rt2860_io_mac_write(sc
, RT2860_REG_TX_HT_FBK_CFG0
,
2697 rt2860_io_mac_write(sc
, RT2860_REG_TX_HT_FBK_CFG1
,
2713 * rt2860_asic_set_txpreamble
2715 static void rt2860_asic_set_txpreamble(struct rt2860_softc
*sc
)
2717 struct ieee80211com
*ic
;
2722 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
2723 "%s: %s short Tx preamble\n",
2724 device_get_nameunit(sc
->dev
),
2725 (ic
->ic_flags
& IEEE80211_F_SHPREAMBLE
) ? "enabling" : "disabling");
2727 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_AUTO_RSP_CFG
);
2729 tmp
&= ~RT2860_REG_CCK_SHORT_ENABLE
;
2731 if (sc
->ic
.ic_flags
& IEEE80211_F_SHPREAMBLE
)
2732 tmp
|= RT2860_REG_CCK_SHORT_ENABLE
;
2734 rt2860_io_mac_write(sc
, RT2860_REG_AUTO_RSP_CFG
, tmp
);
2738 * rt2860_asic_set_basicrates
2740 static void rt2860_asic_set_basicrates(struct rt2860_softc
*sc
)
2742 struct ieee80211com
*ic
;
2746 if (ic
->ic_curmode
== IEEE80211_MODE_11B
)
2747 rt2860_io_mac_write(sc
, RT2860_REG_LEGACY_BASIC_RATE
, 0x3);
2748 else if (ic
->ic_curmode
== IEEE80211_MODE_11A
)
2749 rt2860_io_mac_write(sc
, RT2860_REG_LEGACY_BASIC_RATE
, 0x150);
2751 rt2860_io_mac_write(sc
, RT2860_REG_LEGACY_BASIC_RATE
, 0x15f);
2755 * rt2860_asic_update_rtsthreshold
2757 static void rt2860_asic_update_rtsthreshold(struct rt2860_softc
*sc
)
2759 struct ieee80211com
*ic
;
2765 RT2860_DPRINTF(sc
, RT2860_DEBUG_PROT
,
2766 "%s: updating RTS threshold: %d\n",
2767 device_get_nameunit(sc
->dev
), ic
->ic_rtsthreshold
);
2769 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TX_RTS_CFG
);
2771 tmp
&= ~(RT2860_REG_TX_RTS_THRESHOLD_MASK
<< RT2860_REG_TX_RTS_THRESHOLD_SHIFT
);
2773 threshold
= (ic
->ic_rtsthreshold
< IEEE80211_RTS_MAX
) ?
2774 ic
->ic_rtsthreshold
: 0x1000;
2776 tmp
|= ((threshold
& RT2860_REG_TX_RTS_THRESHOLD_MASK
) <<
2777 RT2860_REG_TX_RTS_THRESHOLD_SHIFT
);
2779 rt2860_io_mac_write(sc
, RT2860_REG_TX_RTS_CFG
, tmp
);
2783 * rt2860_asic_update_txpower
2785 static void rt2860_asic_update_txpower(struct rt2860_softc
*sc
)
2787 struct ieee80211com
*ic
;
2788 uint32_t *txpow_rate
;
2796 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
2797 "%s: updating Tx power: %d\n",
2798 device_get_nameunit(sc
->dev
), ic
->ic_txpowlimit
);
2800 if (!IEEE80211_IS_CHAN_HT40(ic
->ic_curchan
))
2802 txpow_rate
= sc
->txpow_rate_20mhz
;
2806 if (IEEE80211_IS_CHAN_2GHZ(ic
->ic_curchan
))
2807 txpow_rate
= sc
->txpow_rate_40mhz_2ghz
;
2809 txpow_rate
= sc
->txpow_rate_40mhz_5ghz
;
2814 val
= rt2860_io_bbp_read(sc
, 1);
2817 if (ic
->ic_txpowlimit
> 90)
2821 else if (ic
->ic_txpowlimit
> 60)
2825 else if (ic
->ic_txpowlimit
> 30)
2829 else if (ic
->ic_txpowlimit
> 15)
2833 else if (ic
->ic_txpowlimit
> 9)
2843 rt2860_io_bbp_write(sc
, 1, val
);
2845 for (i
= 0; i
< RT2860_SOFTC_TXPOW_RATE_COUNT
; i
++)
2847 if (txpow_rate
[i
] == 0xffffffff)
2850 tmp
= rt2860_read_eeprom_txpow_rate_add_delta(txpow_rate
[i
], delta
);
2852 rt2860_io_mac_write(sc
, RT2860_REG_TX_PWR_CFG(i
), tmp
);
2857 * rt2860_asic_update_promisc
2859 static void rt2860_asic_update_promisc(struct rt2860_softc
*sc
)
2864 ifp
= sc
->ic
.ic_ifp
;
2866 printf("%s: %s promiscuous mode\n",
2867 device_get_nameunit(sc
->dev
),
2868 (ifp
->if_flags
& IFF_PROMISC
) ? "entering" : "leaving");
2870 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_RX_FILTER_CFG
);
2872 tmp
&= ~RT2860_REG_RX_FILTER_DROP_UC_NOME
;
2874 if (!(ifp
->if_flags
& IFF_PROMISC
))
2875 tmp
|= RT2860_REG_RX_FILTER_DROP_UC_NOME
;
2877 rt2860_io_mac_write(sc
, RT2860_REG_RX_FILTER_CFG
, tmp
);
2881 * rt2860_asic_updateprot
2883 static void rt2860_asic_updateprot(struct rt2860_softc
*sc
)
2885 struct ieee80211com
*ic
;
2886 uint32_t cck_prot
, ofdm_prot
, mm20_prot
, mm40_prot
, gf20_prot
, gf40_prot
;
2891 /* CCK frame protection */
2893 cck_prot
= RT2860_REG_RTSTH_ENABLE
| RT2860_REG_PROT_NAV_SHORT
|
2894 RT2860_REG_TXOP_ALLOW_ALL
| RT2860_REG_PROT_CTRL_NONE
;
2896 /* set up protection frame phy mode and rate (MCS code) */
2898 if (ic
->ic_curmode
== IEEE80211_MODE_11A
)
2899 cck_prot
|= (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
2900 (0 << RT2860_REG_PROT_MCS_SHIFT
);
2902 cck_prot
|= ((RT2860_REG_PROT_PHYMODE_CCK
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
2903 (3 << RT2860_REG_PROT_MCS_SHIFT
));
2905 rt2860_io_mac_write(sc
, RT2860_REG_TX_CCK_PROT_CFG
, cck_prot
);
2907 /* OFDM frame protection */
2909 ofdm_prot
= RT2860_REG_RTSTH_ENABLE
| RT2860_REG_PROT_NAV_SHORT
|
2910 RT2860_REG_TXOP_ALLOW_ALL
;
2912 if (ic
->ic_flags
& IEEE80211_F_USEPROT
)
2914 RT2860_DPRINTF(sc
, RT2860_DEBUG_PROT
,
2915 "%s: updating protection mode: b/g protection mode=%s\n",
2916 device_get_nameunit(sc
->dev
),
2917 (ic
->ic_protmode
== IEEE80211_PROT_RTSCTS
) ? "RTS/CTS" :
2918 ((ic
->ic_protmode
== IEEE80211_PROT_CTSONLY
) ? "CTS-to-self" : "none"));
2920 if (ic
->ic_protmode
== IEEE80211_PROT_RTSCTS
)
2921 ofdm_prot
|= RT2860_REG_PROT_CTRL_RTS_CTS
;
2922 else if (ic
->ic_protmode
== IEEE80211_PROT_CTSONLY
)
2923 ofdm_prot
|= RT2860_REG_PROT_CTRL_CTS
;
2925 ofdm_prot
|= RT2860_REG_PROT_CTRL_NONE
;
2929 RT2860_DPRINTF(sc
, RT2860_DEBUG_PROT
,
2930 "%s: updating protection mode: b/g protection mode=%s\n",
2931 device_get_nameunit(sc
->dev
), "none");
2933 ofdm_prot
|= RT2860_REG_PROT_CTRL_NONE
;
2936 rt2860_io_mac_write(sc
, RT2860_REG_TX_OFDM_PROT_CFG
, ofdm_prot
);
2938 /* HT frame protection */
2940 if ((ic
->ic_opmode
== IEEE80211_M_STA
) && (ic
->ic_state
== IEEE80211_S_RUN
))
2941 htopmode
= ic
->ic_bss
->ni_htopmode
;
2943 htopmode
= ic
->ic_curhtprotmode
;
2945 RT2860_DPRINTF(sc
, RT2860_DEBUG_PROT
,
2946 "%s: updating protection mode: HT operation mode=0x%02x, protection mode=%s\n",
2947 device_get_nameunit(sc
->dev
),
2948 htopmode
& IEEE80211_HTINFO_OPMODE
,
2949 (ic
->ic_htprotmode
== IEEE80211_PROT_RTSCTS
) ? "RTS/CTS" :
2950 ((ic
->ic_htprotmode
== IEEE80211_PROT_CTSONLY
) ? "CTS-to-self" : "none"));
2952 switch (htopmode
& IEEE80211_HTINFO_OPMODE
)
2954 /* IEEE80211_HTINFO_OPMODE_HT20PR */
2955 case IEEE80211_HTINFO_OPMODE_HT20PR
:
2956 mm20_prot
= RT2860_REG_PROT_NAV_SHORT
| RT2860_REG_PROT_CTRL_NONE
|
2957 RT2860_REG_TXOP_ALLOW_CCK
| RT2860_REG_TXOP_ALLOW_OFDM
|
2958 RT2860_REG_TXOP_ALLOW_MM20
| RT2860_REG_TXOP_ALLOW_GF20
|
2959 (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
2960 (4 << RT2860_REG_PROT_MCS_SHIFT
);
2962 gf20_prot
= mm20_prot
;
2964 mm40_prot
= RT2860_REG_PROT_NAV_SHORT
| RT2860_REG_TXOP_ALLOW_ALL
|
2965 (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
2966 (0x84 << RT2860_REG_PROT_MCS_SHIFT
);
2968 if (ic
->ic_htprotmode
== IEEE80211_PROT_RTSCTS
)
2969 mm40_prot
|= RT2860_REG_PROT_CTRL_RTS_CTS
;
2970 else if (ic
->ic_htprotmode
== IEEE80211_PROT_CTSONLY
)
2971 mm40_prot
|= RT2860_REG_PROT_CTRL_CTS
;
2973 mm40_prot
|= RT2860_REG_PROT_CTRL_NONE
;
2975 gf40_prot
= mm40_prot
;
2978 /* IEEE80211_HTINFO_OPMODE_MIXED */
2979 case IEEE80211_HTINFO_OPMODE_MIXED
:
2980 mm20_prot
= RT2860_REG_PROT_NAV_SHORT
|
2981 RT2860_REG_TXOP_ALLOW_CCK
| RT2860_REG_TXOP_ALLOW_OFDM
|
2982 RT2860_REG_TXOP_ALLOW_MM20
| RT2860_REG_TXOP_ALLOW_GF20
;
2984 if (ic
->ic_flags
& IEEE80211_F_USEPROT
)
2985 mm20_prot
|= (RT2860_REG_PROT_PHYMODE_CCK
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
2986 (3 << RT2860_REG_PROT_MCS_SHIFT
);
2988 mm20_prot
|= (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
2989 (4 << RT2860_REG_PROT_MCS_SHIFT
);
2991 if (ic
->ic_htprotmode
== IEEE80211_PROT_RTSCTS
)
2992 mm20_prot
|= RT2860_REG_PROT_CTRL_RTS_CTS
;
2993 else if (ic
->ic_htprotmode
== IEEE80211_PROT_CTSONLY
)
2994 mm20_prot
|= RT2860_REG_PROT_CTRL_CTS
;
2996 mm20_prot
|= RT2860_REG_PROT_CTRL_NONE
;
2998 gf20_prot
= mm20_prot
;
3000 mm40_prot
= RT2860_REG_PROT_NAV_SHORT
| RT2860_REG_TXOP_ALLOW_ALL
;
3002 if (ic
->ic_flags
& IEEE80211_F_USEPROT
)
3003 mm40_prot
|= (RT2860_REG_PROT_PHYMODE_CCK
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3004 (3 << RT2860_REG_PROT_MCS_SHIFT
);
3006 mm40_prot
|= (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3007 (0x84 << RT2860_REG_PROT_MCS_SHIFT
);
3009 if (ic
->ic_htprotmode
== IEEE80211_PROT_RTSCTS
)
3010 mm40_prot
|= RT2860_REG_PROT_CTRL_RTS_CTS
;
3011 else if (ic
->ic_htprotmode
== IEEE80211_PROT_CTSONLY
)
3012 mm40_prot
|= RT2860_REG_PROT_CTRL_CTS
;
3014 mm40_prot
|= RT2860_REG_PROT_CTRL_NONE
;
3016 gf40_prot
= mm40_prot
;
3020 * IEEE80211_HTINFO_OPMODE_PURE
3021 * IEEE80211_HTINFO_OPMODE_PROTOPT
3023 case IEEE80211_HTINFO_OPMODE_PURE
:
3024 case IEEE80211_HTINFO_OPMODE_PROTOPT
:
3026 mm20_prot
= RT2860_REG_PROT_NAV_SHORT
| RT2860_REG_PROT_CTRL_NONE
|
3027 RT2860_REG_TXOP_ALLOW_CCK
| RT2860_REG_TXOP_ALLOW_OFDM
|
3028 RT2860_REG_TXOP_ALLOW_MM20
| RT2860_REG_TXOP_ALLOW_GF20
|
3029 (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3030 (4 << RT2860_REG_PROT_MCS_SHIFT
);
3032 gf20_prot
= mm20_prot
;
3034 mm40_prot
= RT2860_REG_PROT_NAV_SHORT
| RT2860_REG_PROT_CTRL_NONE
|
3035 RT2860_REG_TXOP_ALLOW_ALL
|
3036 (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3037 (0x84 << RT2860_REG_PROT_MCS_SHIFT
);
3039 gf40_prot
= mm40_prot
;
3043 rt2860_io_mac_write(sc
, RT2860_REG_TX_MM20_PROT_CFG
, mm20_prot
);
3044 rt2860_io_mac_write(sc
, RT2860_REG_TX_MM40_PROT_CFG
, mm40_prot
);
3045 rt2860_io_mac_write(sc
, RT2860_REG_TX_GF20_PROT_CFG
, gf20_prot
);
3046 rt2860_io_mac_write(sc
, RT2860_REG_TX_GF40_PROT_CFG
, gf40_prot
);
3050 * rt2860_asic_updateslot
3052 static void rt2860_asic_updateslot(struct rt2860_softc
*sc
)
3054 struct ieee80211com
*ic
;
3059 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
3060 "%s: %s short slot time\n",
3061 device_get_nameunit(sc
->dev
),
3062 (ic
->ic_flags
& IEEE80211_F_SHSLOT
) ? "enabling" : "disabling");
3064 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_BKOFF_SLOT_CFG
);
3067 tmp
|= (ic
->ic_flags
& IEEE80211_F_SHSLOT
) ? 9 : 20;
3069 rt2860_io_mac_write(sc
, RT2860_REG_BKOFF_SLOT_CFG
, tmp
);
3073 * rt2860_asic_wme_update
3075 static void rt2860_asic_wme_update(struct rt2860_softc
*sc
)
3077 struct ieee80211com
*ic
;
3078 struct ieee80211_wme_state
*wme
;
3079 const struct wmeParams
*wmep
;
3084 wmep
= wme
->wme_chanParams
.cap_wmeParams
;
3086 RT2860_DPRINTF(sc
, RT2860_DEBUG_WME
,
3087 "%s: wme update: WME_AC_VO=%d/%d/%d/%d, WME_AC_VI=%d/%d/%d/%d, "
3088 "WME_AC_BK=%d/%d/%d/%d, WME_AC_BE=%d/%d/%d/%d\n",
3089 device_get_nameunit(sc
->dev
),
3090 wmep
[WME_AC_VO
].wmep_aifsn
,
3091 wmep
[WME_AC_VO
].wmep_logcwmin
, wmep
[WME_AC_VO
].wmep_logcwmax
,
3092 wmep
[WME_AC_VO
].wmep_txopLimit
,
3093 wmep
[WME_AC_VI
].wmep_aifsn
,
3094 wmep
[WME_AC_VI
].wmep_logcwmin
, wmep
[WME_AC_VI
].wmep_logcwmax
,
3095 wmep
[WME_AC_VI
].wmep_txopLimit
,
3096 wmep
[WME_AC_BK
].wmep_aifsn
,
3097 wmep
[WME_AC_BK
].wmep_logcwmin
, wmep
[WME_AC_BK
].wmep_logcwmax
,
3098 wmep
[WME_AC_BK
].wmep_txopLimit
,
3099 wmep
[WME_AC_BE
].wmep_aifsn
,
3100 wmep
[WME_AC_BE
].wmep_logcwmin
, wmep
[WME_AC_BE
].wmep_logcwmax
,
3101 wmep
[WME_AC_BE
].wmep_txopLimit
);
3103 for (i
= 0; i
< WME_NUM_AC
; i
++)
3104 rt2860_io_mac_write(sc
, RT2860_REG_TX_EDCA_AC_CFG(i
),
3105 (wmep
[i
].wmep_logcwmax
<< 16) | (wmep
[i
].wmep_logcwmin
<< 12) |
3106 (wmep
[i
].wmep_aifsn
<< 8) | wmep
[i
].wmep_txopLimit
);
3108 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_AIFSN_CFG
,
3109 (wmep
[WME_AC_VO
].wmep_aifsn
<< 12) | (wmep
[WME_AC_VI
].wmep_aifsn
<< 8) |
3110 (wmep
[WME_AC_BK
].wmep_aifsn
<< 4) | wmep
[WME_AC_BE
].wmep_aifsn
);
3112 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_CWMIN_CFG
,
3113 (wmep
[WME_AC_VO
].wmep_logcwmin
<< 12) | (wmep
[WME_AC_VI
].wmep_logcwmin
<< 8) |
3114 (wmep
[WME_AC_BK
].wmep_logcwmin
<< 4) | wmep
[WME_AC_BE
].wmep_logcwmin
);
3116 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_CWMAX_CFG
,
3117 (wmep
[WME_AC_VO
].wmep_logcwmax
<< 12) | (wmep
[WME_AC_VI
].wmep_logcwmax
<< 8) |
3118 (wmep
[WME_AC_BK
].wmep_logcwmax
<< 4) | wmep
[WME_AC_BE
].wmep_logcwmax
);
3120 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_TXOP0_CFG
,
3121 (wmep
[WME_AC_BK
].wmep_txopLimit
<< 16) | wmep
[WME_AC_BE
].wmep_txopLimit
);
3123 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_TXOP1_CFG
,
3124 (wmep
[WME_AC_VO
].wmep_txopLimit
<< 16) | wmep
[WME_AC_VI
].wmep_txopLimit
);
3128 * rt2860_asic_update_beacon
3130 static int rt2860_asic_update_beacon(struct rt2860_softc
*sc
)
3132 struct ieee80211com
*ic
;
3134 struct rt2860_txwi txwi
;
3140 m
= ieee80211_beacon_alloc(ic
->ic_bss
, &sc
->beacon_offsets
);
3144 rate
= IEEE80211_IS_CHAN_5GHZ(ic
->ic_curchan
) ? 12 : 2;
3145 mcs
= rt2860_rate2mcs(rate
);
3147 memset(&txwi
, 0, sizeof(struct rt2860_txwi
));
3150 txwi
.pid_mpdu_len
= ((htole16(m
->m_pkthdr
.len
) & RT2860_TXWI_MPDU_LEN_MASK
) <<
3151 RT2860_TXWI_MPDU_LEN_SHIFT
);
3152 txwi
.txop
= (RT2860_TXWI_TXOP_HT
<< RT2860_TXWI_TXOP_SHIFT
);
3153 txwi
.mpdu_density_flags
|=
3154 (RT2860_TXWI_FLAGS_TS
<< RT2860_TXWI_FLAGS_SHIFT
);
3155 txwi
.bawin_size_xflags
|=
3156 (RT2860_TXWI_XFLAGS_NSEQ
<< RT2860_TXWI_XFLAGS_SHIFT
);
3160 txwi
.phymode_ifs_stbc_shortgi
=
3161 (RT2860_TXWI_PHYMODE_CCK
<< RT2860_TXWI_PHYMODE_SHIFT
);
3163 if (rate
!= 2 && (ic
->ic_flags
& IEEE80211_F_SHPREAMBLE
))
3164 mcs
|= RT2860_TXWI_MCS_SHOTPRE
;
3168 txwi
.phymode_ifs_stbc_shortgi
=
3169 (RT2860_TXWI_PHYMODE_OFDM
<< RT2860_TXWI_PHYMODE_SHIFT
);
3172 txwi
.bw_mcs
= (RT2860_TXWI_BW_20
<< RT2860_TXWI_BW_SHIFT
) |
3173 ((mcs
& RT2860_TXWI_MCS_MASK
) << RT2860_TXWI_MCS_SHIFT
);
3175 /* disable temporarily TSF sync */
3177 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_BCN_TIME_CFG
);
3179 tmp
&= ~(RT2860_REG_BCN_TX_ENABLE
|
3180 RT2860_REG_TSF_TIMER_ENABLE
|
3181 RT2860_REG_TBTT_TIMER_ENABLE
);
3183 rt2860_io_mac_write(sc
, RT2860_REG_BCN_TIME_CFG
, tmp
);
3185 /* write Tx wireless info and beacon frame to on-chip memory */
3187 rt2860_io_mac_write_multi(sc
, RT2860_REG_BEACON_BASE(0),
3188 &txwi
, sizeof(struct rt2860_txwi
));
3190 rt2860_io_mac_write_multi(sc
, RT2860_REG_BEACON_BASE(0) + sizeof(struct rt2860_txwi
),
3191 mtod(m
, uint8_t *), m
->m_pkthdr
.len
);
3193 /* enable again TSF sync */
3195 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_BCN_TIME_CFG
);
3197 tmp
|= (RT2860_REG_BCN_TX_ENABLE
|
3198 RT2860_REG_TSF_TIMER_ENABLE
|
3199 RT2860_REG_TBTT_TIMER_ENABLE
);
3201 rt2860_io_mac_write(sc
, RT2860_REG_BCN_TIME_CFG
, tmp
);
3209 * rt2860_asic_clear_keytables
3211 static void rt2860_asic_clear_keytables(struct rt2860_softc
*sc
)
3215 /* clear Rx WCID search table (entries = 256, entry size = 8) */
3217 for (i
= 0; i
< 256; i
++)
3219 rt2860_io_mac_write(sc
, RT2860_REG_WCID(i
), 0xffffffff);
3220 rt2860_io_mac_write(sc
, RT2860_REG_WCID(i
) + 4, 0x0000ffff);
3223 /* clear WCID attribute table (entries = 256, entry size = 4) */
3225 rt2860_io_mac_set_region_4(sc
, RT2860_REG_WCID_ATTR(0), 0, 256);
3227 /* clear IV/EIV table (entries = 256, entry size = 8) */
3229 rt2860_io_mac_set_region_4(sc
, RT2860_REG_IVEIV(0), 0, 2 * 256);
3231 /* clear pairwise key table (entries = 256, entry size = 32) */
3233 rt2860_io_mac_set_region_4(sc
, RT2860_REG_PKEY(0), 0, 8 * 256);
3235 /* clear shared key table (entries = 32, entry size = 32) */
3237 rt2860_io_mac_set_region_4(sc
, RT2860_REG_SKEY(0, 0), 0, 8 * 32);
3239 /* clear shared key mode (entries = 32, entry size = 2) */
3241 rt2860_io_mac_set_region_4(sc
, RT2860_REG_SKEY_MODE(0), 0, 16);
3247 static uint8_t rt2860_rxrate(struct rt2860_rxwi
*rxwi
)
3249 uint8_t mcs
, phymode
;
3252 mcs
= (rxwi
->bw_mcs
>> RT2860_RXWI_MCS_SHIFT
) & RT2860_RXWI_MCS_MASK
;
3253 phymode
= (rxwi
->phymode_stbc_shortgi
>> RT2860_RXWI_PHYMODE_SHIFT
) &
3254 RT2860_RXWI_PHYMODE_MASK
;
3260 case RT2860_RXWI_PHYMODE_CCK
:
3261 switch (mcs
& ~RT2860_RXWI_MCS_SHOTPRE
)
3263 case 0: rate
= 2; break; /* 1 Mbps */
3264 case 1: rate
= 4; break; /* 2 MBps */
3265 case 2: rate
= 11; break; /* 5.5 Mbps */
3266 case 3: rate
= 22; break; /* 11 Mbps */
3270 case RT2860_RXWI_PHYMODE_OFDM
:
3273 case 0: rate
= 12; break; /* 6 Mbps */
3274 case 1: rate
= 18; break; /* 9 Mbps */
3275 case 2: rate
= 24; break; /* 12 Mbps */
3276 case 3: rate
= 36; break; /* 18 Mbps */
3277 case 4: rate
= 48; break; /* 24 Mbps */
3278 case 5: rate
= 72; break; /* 36 Mbps */
3279 case 6: rate
= 96; break; /* 48 Mbps */
3280 case 7: rate
= 108; break; /* 54 Mbps */
3284 case RT2860_RXWI_PHYMODE_HT_MIXED
:
3285 case RT2860_RXWI_PHYMODE_HT_GF
:
3293 * rt2860_maxrssi_rxpath
3295 static uint8_t rt2860_maxrssi_rxpath(struct rt2860_softc
*sc
,
3296 const struct rt2860_rxwi
*rxwi
)
3302 if (sc
->nrxpath
> 1)
3303 if (rxwi
->rssi
[1] > rxwi
->rssi
[rxpath
])
3306 if (sc
->nrxpath
> 2)
3307 if (rxwi
->rssi
[2] > rxwi
->rssi
[rxpath
])
3316 static int8_t rt2860_rssi2dbm(struct rt2860_softc
*sc
,
3317 uint8_t rssi
, uint8_t rxpath
)
3319 struct ieee80211com
*ic
;
3320 struct ieee80211_channel
*c
;
3322 int8_t rssi_off
, lna_gain
;
3329 chan
= ieee80211_chan2ieee(ic
, c
);
3331 if (IEEE80211_IS_CHAN_5GHZ(c
))
3333 rssi_off
= sc
->rssi_off_5ghz
[rxpath
];
3336 lna_gain
= sc
->lna_gain
[1];
3337 else if (chan
<= 128)
3338 lna_gain
= sc
->lna_gain
[2];
3340 lna_gain
= sc
->lna_gain
[3];
3344 rssi_off
= sc
->rssi_off_2ghz
[rxpath
];
3345 lna_gain
= sc
->lna_gain
[0];
3348 return (-12 - rssi_off
- lna_gain
- rssi
);
3354 static uint8_t rt2860_rate2mcs(uint8_t rate
)
3381 static int rt2860_ackrate(struct ieee80211com
*ic
, int rate
)
3393 return (ic
->ic_curmode
== IEEE80211_MODE_11B
) ? 4 : rate
;
3412 /* default to 1Mbps */
3419 static uint16_t rt2860_txtime(int len
, int rate
, uint32_t flags
)
3423 if (RT2860_RATE_IS_OFDM(rate
))
3425 txtime
= (8 + 4 * len
+ 3 + rate
- 1) / rate
;
3426 txtime
= 16 + 4 + 4 * txtime
+ 6;
3430 txtime
= (16 * len
+ rate
- 1) / rate
;
3432 if (rate
!= 2 && (flags
& IEEE80211_F_SHPREAMBLE
))
3444 static int rt2860_tx_frame(struct rt2860_softc
*sc
,
3445 struct mbuf
*m
, struct ieee80211_node
*ni
, int qid
)
3447 struct ieee80211com
*ic
;
3448 struct rt2860_softc_tx_ring
*ring
;
3449 struct rt2860_softc_tx_data
*data
;
3450 struct rt2860_txdesc
*desc
;
3451 struct rt2860_txwi
*txwi
;
3452 struct ieee80211_frame
*wh
;
3453 struct rt2860_softc_tx_radiotap_header
*tap
;
3454 bus_dma_segment_t dma_seg
[RT2860_SOFTC_MAX_SCATTER
];
3455 u_int hdrsize
, hdrspace
;
3456 uint8_t type
, rate
, bw
, stbc
, shortgi
, mcs
, pid
, wcid
, qsel
;
3457 uint16_t qos
, len
, dmalen
, mpdu_len
, dur
;
3458 int error
, hasqos
, ackrate
, ndmasegs
, ndescs
, i
, j
;
3460 KASSERT(qid
>= 0 && qid
< RT2860_SOFTC_TX_RING_COUNT
,
3461 ("%s: Tx frame: invalid qid=%d\n",
3462 device_get_nameunit(sc
->dev
), qid
));
3466 ring
= &sc
->tx_ring
[qid
];
3467 desc
= &ring
->desc
[ring
->desc_cur
];
3468 data
= &ring
->data
[ring
->data_cur
];
3469 txwi
= (struct rt2860_txwi
*) (ring
->seg0
+ ring
->data_cur
* RT2860_TX_DATA_SEG0_SIZE
);
3471 wh
= mtod(m
, struct ieee80211_frame
*);
3473 type
= wh
->i_fc
[0] & IEEE80211_FC0_TYPE_MASK
;
3475 hasqos
= IEEE80211_QOS_HAS_SEQ(wh
);
3478 if (IEEE80211_HAS_ADDR4(wh
))
3479 qos
= le16toh(*(const uint16_t *)
3480 (((struct ieee80211_qosframe_addr4
*) wh
)->i_qos
));
3482 qos
= le16toh(*(const uint16_t *)
3483 (((struct ieee80211_qosframe
*) wh
)->i_qos
));
3490 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
3492 if (IEEE80211_IS_MULTICAST(wh
->i_addr1
) || type
!= IEEE80211_FC0_TYPE_DATA
)
3494 else if (ic
->ic_fixed_rate
!= IEEE80211_FIXED_RATE_NONE
)
3495 rate
= ic
->ic_fixed_rate
;
3497 rate
= ni
->ni_htrates
.rs_rates
[ni
->ni_txrate
];
3501 if (IEEE80211_IS_MULTICAST(wh
->i_addr1
) || type
!= IEEE80211_FC0_TYPE_DATA
)
3502 rate
= IEEE80211_IS_CHAN_5GHZ(ic
->ic_curchan
) ? 12 : 2;
3503 else if (ic
->ic_fixed_rate
!= IEEE80211_FIXED_RATE_NONE
)
3504 rate
= ic
->ic_fixed_rate
;
3506 rate
= ni
->ni_rates
.rs_rates
[ni
->ni_txrate
];
3509 rate
&= IEEE80211_RATE_VAL
;
3511 /* fill Tx wireless info */
3513 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
3516 mcs
= rt2860_rate2mcs(rate
);
3520 /* management frames do not need encryption */
3522 wcid
= (type
== IEEE80211_FC0_TYPE_DATA
) ?
3523 RT2860_AID2WCID(ni
->ni_associd
) : 0xff;
3525 /* calculate MPDU length without padding */
3527 hdrsize
= ieee80211_hdrsize(wh
);
3528 hdrspace
= ieee80211_hdrspace(ic
, wh
);
3529 mpdu_len
= m
->m_pkthdr
.len
- hdrspace
+ hdrsize
;
3531 memset(txwi
, 0, sizeof(struct rt2860_txwi
));
3535 txwi
->pid_mpdu_len
= ((htole16(pid
) & RT2860_TXWI_PID_MASK
) <<
3536 RT2860_TXWI_PID_SHIFT
) | ((htole16(mpdu_len
) & RT2860_TXWI_MPDU_LEN_MASK
) <<
3537 RT2860_TXWI_MPDU_LEN_SHIFT
);
3539 stbc
= (ni
->ni_htcap
& IEEE80211_HTCAP_RXSTBC
) ? 1 : 0;
3541 shortgi
= (ic
->ic_flags_ext
& (IEEE80211_FEXT_SHORTGI20
| IEEE80211_FEXT_SHORTGI40
)) &&
3542 (ni
->ni_flags
& IEEE80211_NODE_HT
);
3544 txwi
->phymode_ifs_stbc_shortgi
|=
3545 ((stbc
& RT2860_TXWI_STBC_MASK
) << RT2860_TXWI_STBC_SHIFT
) |
3546 ((shortgi
& RT2860_TXWI_SHORTGI_MASK
) << RT2860_TXWI_SHORTGI_SHIFT
);
3548 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
3550 txwi
->phymode_ifs_stbc_shortgi
|=
3551 (RT2860_TXWI_PHYMODE_HT_MIXED
<< RT2860_TXWI_PHYMODE_SHIFT
);
3555 if (!RT2860_RATE_IS_OFDM(rate
))
3557 txwi
->phymode_ifs_stbc_shortgi
|=
3558 (RT2860_TXWI_PHYMODE_CCK
<< RT2860_TXWI_PHYMODE_SHIFT
);
3560 if (rate
!= 2 && (ic
->ic_flags
& IEEE80211_F_SHPREAMBLE
))
3561 mcs
|= RT2860_TXWI_MCS_SHOTPRE
;
3565 txwi
->phymode_ifs_stbc_shortgi
|=
3566 (RT2860_TXWI_PHYMODE_OFDM
<< RT2860_TXWI_PHYMODE_SHIFT
);
3570 if ((ni
->ni_flags
& IEEE80211_NODE_HT
) &&
3571 (ni
->ni_htcap
& IEEE80211_HTCAP_CHWIDTH40
))
3572 bw
= RT2860_TXWI_BW_40
;
3574 bw
= RT2860_TXWI_BW_20
;
3576 txwi
->bw_mcs
= ((bw
& RT2860_TXWI_BW_MASK
) << RT2860_TXWI_BW_SHIFT
) |
3577 ((mcs
& RT2860_TXWI_MCS_MASK
) << RT2860_TXWI_MCS_SHIFT
);
3579 if (type
!= IEEE80211_FC0_TYPE_DATA
)
3580 txwi
->txop
= (RT2860_TXWI_TXOP_BACKOFF
<< RT2860_TXWI_TXOP_SHIFT
);
3582 txwi
->txop
= (RT2860_TXWI_TXOP_HT
<< RT2860_TXWI_TXOP_SHIFT
);
3584 /* skip ACKs for multicast frames and probe responses */
3586 if (!IEEE80211_IS_MULTICAST(wh
->i_addr1
) &&
3587 ((wh
->i_fc
[0] & (IEEE80211_FC0_TYPE_MASK
| IEEE80211_FC0_SUBTYPE_MASK
)) !=
3588 (IEEE80211_FC0_TYPE_MGT
| IEEE80211_FC0_SUBTYPE_PROBE_RESP
)) &&
3589 (!hasqos
|| (qos
& IEEE80211_QOS_ACKPOLICY
) != IEEE80211_QOS_ACKPOLICY_NOACK
))
3591 txwi
->bawin_size_xflags
|=
3592 (RT2860_TXWI_XFLAGS_ACK
<< RT2860_TXWI_XFLAGS_SHIFT
);
3594 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
3596 /* preamble + plcp + signal extension */
3602 ackrate
= rt2860_ackrate(ic
, rate
);
3604 dur
= rt2860_txtime(RT2860_ACK_SIZE
, ackrate
, ic
->ic_flags
) +
3608 *(uint16_t *) wh
->i_dur
= htole16(dur
);
3611 /* ask MAC to insert timestamp into probe responses */
3613 if ((wh
->i_fc
[0] & (IEEE80211_FC0_TYPE_MASK
| IEEE80211_FC0_SUBTYPE_MASK
)) ==
3614 (IEEE80211_FC0_TYPE_MGT
| IEEE80211_FC0_SUBTYPE_PROBE_RESP
))
3615 txwi
->mpdu_density_flags
|=
3616 (RT2860_TXWI_FLAGS_TS
<< RT2860_TXWI_FLAGS_SHIFT
);
3618 if (bpf_peers_present(sc
->drvbpf
))
3622 tap
->flags
= IEEE80211_RADIOTAP_F_DATAPAD
;
3623 tap
->chan_flags
= htole32(ic
->ic_curchan
->ic_flags
);
3624 tap
->chan_freq
= htole16(ic
->ic_curchan
->ic_freq
);
3625 tap
->chan_ieee
= ic
->ic_curchan
->ic_ieee
;
3626 tap
->chan_maxpow
= 0;
3628 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
3629 tap
->rate
= mcs
| IEEE80211_RATE_MCS
;
3633 if (mcs
& RT2860_TXWI_MCS_SHOTPRE
)
3634 tap
->flags
|= IEEE80211_RADIOTAP_F_SHORTPRE
;
3637 tap
->flags
|= IEEE80211_RADIOTAP_F_SHORTGI
;
3639 if (wh
->i_fc
[1] & IEEE80211_FC1_WEP
)
3640 tap
->flags
|= IEEE80211_RADIOTAP_F_WEP
;
3642 if (wh
->i_fc
[1] & IEEE80211_FC1_WEP
)
3644 wh
->i_fc
[1] &= ~IEEE80211_FC1_WEP
;
3646 bpf_mtap2(sc
->drvbpf
, tap
, sc
->txtap_len
, m
);
3648 wh
->i_fc
[1] |= IEEE80211_FC1_WEP
;
3652 bpf_mtap2(sc
->drvbpf
, tap
, sc
->txtap_len
, m
);
3656 /* copy and trim 802.11 header */
3658 m_copydata(m
, 0, hdrsize
, (caddr_t
) (txwi
+ 1));
3661 error
= bus_dmamap_load_mbuf_sg(ring
->data_dma_tag
, data
->dma_map
, m
,
3662 dma_seg
, &ndmasegs
, 0);
3665 /* too many fragments, linearize */
3667 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
3668 "%s: could not load mbuf DMA map, trying to linearize mbuf\n",
3669 device_get_nameunit(sc
->dev
));
3671 m
= m_defrag(m
, M_DONTWAIT
);
3675 sc
->tx_defrag_packets
++;
3677 error
= bus_dmamap_load_mbuf_sg(ring
->data_dma_tag
, data
->dma_map
, m
,
3678 dma_seg
, &ndmasegs
, 0);
3681 printf("%s: could not load mbuf DMA map: error=%d\n",
3682 device_get_nameunit(sc
->dev
), error
);
3688 /* determine how many Tx descs are required */
3690 ndescs
= 1 + ndmasegs
/ 2;
3691 if ((ring
->desc_queued
+ ndescs
) > (RT2860_SOFTC_TX_RING_DESC_COUNT
- 2))
3693 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
3694 "%s: there are not enough Tx descs\n",
3695 device_get_nameunit(sc
->dev
));
3697 sc
->no_tx_desc_avail
++;
3699 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
3707 /* set up Tx descs */
3709 /* first segment is Tx wireless info and 802.11 header */
3711 len
= sizeof(struct rt2860_txwi
) + hdrsize
;
3713 /* align end on a 4-bytes boundary */
3715 dmalen
= (len
+ 3) & ~ 3;
3717 memset((caddr_t
) txwi
+ len
, 0, dmalen
- len
);
3719 qsel
= RT2860_TXDESC_QSEL_EDCA
;
3721 desc
->sdp0
= htole32(ring
->seg0_phys_addr
+ ring
->data_cur
* RT2860_TX_DATA_SEG0_SIZE
);
3722 desc
->sdl0
= htole16(dmalen
);
3723 desc
->qsel_flags
= (qsel
<< RT2860_TXDESC_QSEL_SHIFT
);
3725 /* set up payload segments */
3727 for (i
= ndmasegs
, j
= 0; i
>= 2; i
-= 2)
3729 desc
->sdp1
= htole32(dma_seg
[j
].ds_addr
);
3730 desc
->sdl1
= htole16(dma_seg
[j
].ds_len
);
3732 ring
->desc_queued
++;
3733 ring
->desc_cur
= (ring
->desc_cur
+ 1) % RT2860_SOFTC_TX_RING_DESC_COUNT
;
3737 desc
= &ring
->desc
[ring
->desc_cur
];
3739 desc
->sdp0
= htole32(dma_seg
[j
].ds_addr
);
3740 desc
->sdl0
= htole16(dma_seg
[j
].ds_len
);
3741 desc
->qsel_flags
= (qsel
<< RT2860_TXDESC_QSEL_SHIFT
);
3746 /* finalize last payload segment */
3748 if (i
> 0 && dma_seg
[j
].ds_len
> 0)
3750 desc
->sdp1
= htole32(dma_seg
[j
].ds_addr
);
3751 desc
->sdl1
= htole16(dma_seg
[j
].ds_len
| RT2860_TXDESC_SDL1_LASTSEG
);
3755 desc
->sdl0
|= htole16(RT2860_TXDESC_SDL0_LASTSEG
);
3759 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
3760 "%s: sending frame: qid=%d, hdrsize=%d, hdrspace=%d, len=%d, "
3761 "bw=%d, stbc=%d, shortgi=%d, mcs=%d, DMA len=%d, ndmasegs=%d, DMA ds_len=%d/%d/%d/%d/%d\n",
3762 device_get_nameunit(sc
->dev
),
3763 qid
, hdrsize
, hdrspace
, m
->m_pkthdr
.len
+ hdrsize
,
3764 bw
, stbc
, shortgi
, mcs
, dmalen
, ndmasegs
,
3765 dma_seg
[0].ds_len
, dma_seg
[1].ds_len
, dma_seg
[2].ds_len
, dma_seg
[3].ds_len
, dma_seg
[4].ds_len
);
3767 bus_dmamap_sync(ring
->seg0_dma_tag
, ring
->seg0_dma_map
,
3768 BUS_DMASYNC_PREWRITE
);
3769 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
3770 BUS_DMASYNC_PREWRITE
);
3771 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
3772 BUS_DMASYNC_PREWRITE
);
3774 ring
->desc_queued
++;
3775 ring
->desc_cur
= (ring
->desc_cur
+ 1) % RT2860_SOFTC_TX_RING_DESC_COUNT
;
3777 ring
->data_queued
++;
3778 ring
->data_cur
= (ring
->data_cur
+ 1) % RT2860_SOFTC_TX_RING_DATA_COUNT
;
3782 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_CTX_IDX(qid
), ring
->desc_cur
);
3790 static int rt2860_tx_raw(struct rt2860_softc
*sc
,
3791 struct mbuf
*m
, struct ieee80211_node
*ni
,
3792 const struct ieee80211_bpf_params
*params
)
3794 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
3796 device_get_nameunit(sc
->dev
));
3804 static void rt2860_intr(void *arg
)
3806 struct rt2860_softc
*sc
;
3813 /* acknowledge interrupts */
3815 status
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_INT_STATUS
);
3816 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_STATUS
, status
);
3818 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
3819 "%s: interrupt: status = 0x%08x\n",
3820 device_get_nameunit(sc
->dev
), status
);
3822 if (status
== 0xffffffff || /* device likely went away */
3823 status
== 0) /* not for us */
3828 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
3831 if (status
& RT2860_REG_INT_TX_COHERENT
)
3832 rt2860_tx_coherent_intr(sc
);
3834 if (status
& RT2860_REG_INT_RX_COHERENT
)
3835 rt2860_rx_coherent_intr(sc
);
3837 if (status
& RT2860_REG_INT_TXRX_COHERENT
)
3838 rt2860_txrx_coherent_intr(sc
);
3840 if (status
& RT2860_REG_INT_FIFO_STA_FULL
)
3841 rt2860_fifo_sta_full_intr(sc
);
3843 if (status
& RT2860_REG_INT_TX_MGMT_DONE
)
3844 rt2860_tx_intr(sc
, 5);
3846 if (status
& RT2860_REG_INT_RX_DONE
)
3849 if (status
& RT2860_REG_INT_RX_DELAY_DONE
)
3850 rt2860_rx_delay_intr(sc
);
3852 if (status
& RT2860_REG_INT_TX_HCCA_DONE
)
3853 rt2860_tx_intr(sc
, 4);
3855 if (status
& RT2860_REG_INT_TX_AC3_DONE
)
3856 rt2860_tx_intr(sc
, 3);
3858 if (status
& RT2860_REG_INT_TX_AC2_DONE
)
3859 rt2860_tx_intr(sc
, 2);
3861 if (status
& RT2860_REG_INT_TX_AC1_DONE
)
3862 rt2860_tx_intr(sc
, 1);
3864 if (status
& RT2860_REG_INT_TX_AC0_DONE
)
3865 rt2860_tx_intr(sc
, 0);
3867 if (status
& RT2860_REG_INT_TX_DELAY_DONE
)
3868 rt2860_tx_delay_intr(sc
);
3870 if (status
& RT2860_REG_INT_PRE_TBTT
)
3871 rt2860_pre_tbtt_intr(sc
);
3873 if (status
& RT2860_REG_INT_TBTT
)
3874 rt2860_tbtt_intr(sc
);
3876 if (status
& RT2860_REG_INT_MCU_CMD
)
3877 rt2860_mcu_cmd_intr(sc
);
3879 if (status
& RT2860_REG_INT_AUTO_WAKEUP
)
3880 rt2860_auto_wakeup_intr(sc
);
3882 if (status
& RT2860_REG_INT_GP_TIMER
)
3883 rt2860_gp_timer_intr(sc
);
3887 * rt2860_tx_coherent_intr
3889 static void rt2860_tx_coherent_intr(struct rt2860_softc
*sc
)
3894 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
3895 "%s: Tx coherent interrupt\n",
3896 device_get_nameunit(sc
->dev
));
3898 sc
->tx_coherent_interrupts
++;
3900 /* restart DMA engine */
3902 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
3904 tmp
&= ~(RT2860_REG_TX_WB_DDONE
|
3905 RT2860_REG_RX_DMA_ENABLE
|
3906 RT2860_REG_TX_DMA_ENABLE
);
3908 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
3910 /* init Tx rings (4 EDCAs + HCCA + MGMT) */
3912 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
3913 rt2860_reset_tx_ring(sc
, &sc
->tx_ring
[i
]);
3915 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
3917 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_BASE_PTR(i
),
3918 sc
->tx_ring
[i
].desc_phys_addr
);
3919 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_MAX_CNT(i
),
3920 RT2860_SOFTC_TX_RING_DESC_COUNT
);
3921 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_CTX_IDX(i
), 0);
3926 rt2860_reset_rx_ring(sc
, &sc
->rx_ring
);
3928 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_BASE_PTR
,
3929 sc
->rx_ring
.desc_phys_addr
);
3930 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_MAX_CNT
,
3931 RT2860_SOFTC_RX_RING_DATA_COUNT
);
3932 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
3933 RT2860_SOFTC_RX_RING_DATA_COUNT
- 1);
3935 rt2860_txrx_enable(sc
);
3939 * rt2860_rx_coherent_intr
3941 static void rt2860_rx_coherent_intr(struct rt2860_softc
*sc
)
3946 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
3947 "%s: Rx coherent interrupt\n",
3948 device_get_nameunit(sc
->dev
));
3950 sc
->rx_coherent_interrupts
++;
3952 /* restart DMA engine */
3954 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
3956 tmp
&= ~(RT2860_REG_TX_WB_DDONE
|
3957 RT2860_REG_RX_DMA_ENABLE
|
3958 RT2860_REG_TX_DMA_ENABLE
);
3960 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
3962 /* init Tx rings (4 EDCAs + HCCA + MGMT) */
3964 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
3965 rt2860_reset_tx_ring(sc
, &sc
->tx_ring
[i
]);
3967 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
3969 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_BASE_PTR(i
),
3970 sc
->tx_ring
[i
].desc_phys_addr
);
3971 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_MAX_CNT(i
),
3972 RT2860_SOFTC_TX_RING_DESC_COUNT
);
3973 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_CTX_IDX(i
), 0);
3978 rt2860_reset_rx_ring(sc
, &sc
->rx_ring
);
3980 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_BASE_PTR
,
3981 sc
->rx_ring
.desc_phys_addr
);
3982 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_MAX_CNT
,
3983 RT2860_SOFTC_RX_RING_DATA_COUNT
);
3984 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
3985 RT2860_SOFTC_RX_RING_DATA_COUNT
- 1);
3987 rt2860_txrx_enable(sc
);
3991 * rt2860_txrx_coherent_intr
3993 static void rt2860_txrx_coherent_intr(struct rt2860_softc
*sc
)
3998 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
3999 "%s: Tx/Rx coherent interrupt\n",
4000 device_get_nameunit(sc
->dev
));
4002 sc
->txrx_coherent_interrupts
++;
4004 /* restart DMA engine */
4006 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
4008 tmp
&= ~(RT2860_REG_TX_WB_DDONE
|
4009 RT2860_REG_RX_DMA_ENABLE
|
4010 RT2860_REG_TX_DMA_ENABLE
);
4012 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
4014 /* init Tx rings (4 EDCAs + HCCA + MGMT) */
4016 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
4017 rt2860_reset_tx_ring(sc
, &sc
->tx_ring
[i
]);
4019 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
4021 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_BASE_PTR(i
),
4022 sc
->tx_ring
[i
].desc_phys_addr
);
4023 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_MAX_CNT(i
),
4024 RT2860_SOFTC_TX_RING_DESC_COUNT
);
4025 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_CTX_IDX(i
), 0);
4030 rt2860_reset_rx_ring(sc
, &sc
->rx_ring
);
4032 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_BASE_PTR
,
4033 sc
->rx_ring
.desc_phys_addr
);
4034 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_MAX_CNT
,
4035 RT2860_SOFTC_RX_RING_DATA_COUNT
);
4036 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
4037 RT2860_SOFTC_RX_RING_DATA_COUNT
- 1);
4039 rt2860_txrx_enable(sc
);
4043 * rt2860_fifo_sta_full_intr
4045 static void rt2860_fifo_sta_full_intr(struct rt2860_softc
*sc
)
4047 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4048 "%s: FIFO statistic full interrupt\n",
4049 device_get_nameunit(sc
->dev
));
4051 sc
->fifo_sta_full_interrupts
++;
4053 RT2860_SOFTC_LOCK(sc
);
4055 if (!(sc
->intr_disable_mask
& RT2860_REG_INT_FIFO_STA_FULL
))
4057 rt2860_intr_disable(sc
, RT2860_REG_INT_FIFO_STA_FULL
);
4059 taskqueue_enqueue(sc
->taskqueue
, &sc
->fifo_sta_full_task
);
4062 sc
->intr_pending_mask
|= RT2860_REG_INT_FIFO_STA_FULL
;
4064 RT2860_SOFTC_UNLOCK(sc
);
4070 static void rt2860_rx_intr(struct rt2860_softc
*sc
)
4072 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4073 "%s: Rx interrupt\n",
4074 device_get_nameunit(sc
->dev
));
4076 sc
->rx_interrupts
++;
4078 RT2860_SOFTC_LOCK(sc
);
4080 if (!(sc
->intr_disable_mask
& RT2860_REG_INT_RX_DONE
))
4082 rt2860_intr_disable(sc
, RT2860_REG_INT_RX_DONE
);
4084 taskqueue_enqueue(sc
->taskqueue
, &sc
->rx_done_task
);
4087 sc
->intr_pending_mask
|= RT2860_REG_INT_RX_DONE
;
4089 RT2860_SOFTC_UNLOCK(sc
);
4093 * rt2860_rx_delay_intr
4095 static void rt2860_rx_delay_intr(struct rt2860_softc
*sc
)
4097 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4098 "%s: Rx delay interrupt\n",
4099 device_get_nameunit(sc
->dev
));
4101 sc
->rx_delay_interrupts
++;
4107 static void rt2860_tx_intr(struct rt2860_softc
*sc
, int qid
)
4109 KASSERT(qid
>= 0 && qid
< RT2860_SOFTC_TX_RING_COUNT
,
4110 ("%s: Tx interrupt: invalid qid=%d\n",
4111 device_get_nameunit(sc
->dev
), qid
));
4113 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4114 "%s: Tx interrupt: qid=%d\n",
4115 device_get_nameunit(sc
->dev
), qid
);
4117 sc
->tx_interrupts
[qid
]++;
4119 RT2860_SOFTC_LOCK(sc
);
4121 if (!(sc
->intr_disable_mask
& (RT2860_REG_INT_TX_AC0_DONE
<< qid
)))
4123 rt2860_intr_disable(sc
, (RT2860_REG_INT_TX_AC0_DONE
<< qid
));
4125 taskqueue_enqueue(sc
->taskqueue
, &sc
->tx_done_task
);
4128 sc
->intr_pending_mask
|= (RT2860_REG_INT_TX_AC0_DONE
<< qid
);
4130 RT2860_SOFTC_UNLOCK(sc
);
4134 * rt2860_tx_delay_intr
4136 static void rt2860_tx_delay_intr(struct rt2860_softc
*sc
)
4138 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4139 "%s: Tx delay interrupt\n",
4140 device_get_nameunit(sc
->dev
));
4142 sc
->tx_delay_interrupts
++;
4146 * rt2860_pre_tbtt_intr
4148 static void rt2860_pre_tbtt_intr(struct rt2860_softc
*sc
)
4150 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4151 "%s: Pre-TBTT interrupt\n",
4152 device_get_nameunit(sc
->dev
));
4154 sc
->pre_tbtt_interrupts
++;
4160 static void rt2860_tbtt_intr(struct rt2860_softc
*sc
)
4162 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4163 "%s: TBTT interrupt\n",
4164 device_get_nameunit(sc
->dev
));
4166 sc
->tbtt_interrupts
++;
4170 * rt2860_mcu_cmd_intr
4172 static void rt2860_mcu_cmd_intr(struct rt2860_softc
*sc
)
4174 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4175 "%s: MCU command interrupt\n",
4176 device_get_nameunit(sc
->dev
));
4178 sc
->mcu_cmd_interrupts
++;
4182 * rt2860_auto_wakeup_intr
4184 static void rt2860_auto_wakeup_intr(struct rt2860_softc
*sc
)
4186 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4187 "%s: auto wakeup interrupt\n",
4188 device_get_nameunit(sc
->dev
));
4190 sc
->auto_wakeup_interrupts
++;
4194 * rt2860_gp_timer_intr
4196 static void rt2860_gp_timer_intr(struct rt2860_softc
*sc
)
4198 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4199 "%s: GP timer interrupt\n",
4200 device_get_nameunit(sc
->dev
));
4202 sc
->gp_timer_interrupts
++;
4206 * rt2860_rx_done_task
4208 static void rt2860_rx_done_task(void *context
, int pending
)
4210 struct rt2860_softc
*sc
;
4217 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
4218 "%s: Rx done task\n",
4219 device_get_nameunit(sc
->dev
));
4221 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
4224 sc
->intr_pending_mask
&= ~RT2860_REG_INT_RX_DONE
;
4226 again
= rt2860_rx_eof(sc
, sc
->rx_process_limit
);
4228 RT2860_SOFTC_LOCK(sc
);
4230 if ((sc
->intr_pending_mask
& RT2860_REG_INT_RX_DONE
) || again
)
4232 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
4233 "%s: Rx done task: scheduling again\n",
4234 device_get_nameunit(sc
->dev
));
4236 taskqueue_enqueue(sc
->taskqueue
, &sc
->rx_done_task
);
4240 rt2860_intr_enable(sc
, RT2860_REG_INT_RX_DONE
);
4243 RT2860_SOFTC_UNLOCK(sc
);
4247 * rt2860_tx_done_task
4249 static void rt2860_tx_done_task(void *context
, int pending
)
4251 struct rt2860_softc
*sc
;
4259 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
4260 "%s: Tx done task\n",
4261 device_get_nameunit(sc
->dev
));
4263 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
4266 intr_mask
= (RT2860_REG_INT_TX_MGMT_DONE
|
4267 RT2860_REG_INT_TX_HCCA_DONE
|
4268 RT2860_REG_INT_TX_AC3_DONE
|
4269 RT2860_REG_INT_TX_AC2_DONE
|
4270 RT2860_REG_INT_TX_AC1_DONE
|
4271 RT2860_REG_INT_TX_AC0_DONE
);
4273 sc
->intr_pending_mask
&= ~intr_mask
;
4275 for (i
= RT2860_SOFTC_TX_RING_COUNT
- 1; i
>= 0; i
--)
4276 rt2860_tx_eof(sc
, &sc
->tx_ring
[i
]);
4280 ifp
->if_drv_flags
&= ~IFF_DRV_OACTIVE
;
4282 RT2860_SOFTC_LOCK(sc
);
4284 rt2860_intr_enable(sc
, ~sc
->intr_pending_mask
&
4285 (sc
->intr_disable_mask
& intr_mask
));
4287 if (sc
->intr_pending_mask
& intr_mask
)
4289 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
4290 "%s: Tx done task: scheduling again\n",
4291 device_get_nameunit(sc
->dev
));
4293 taskqueue_enqueue(sc
->taskqueue
, &sc
->tx_done_task
);
4296 RT2860_SOFTC_UNLOCK(sc
);
4300 * rt2860_fifo_sta_full_task
4302 static void rt2860_fifo_sta_full_task(void *context
, int pending
)
4304 struct rt2860_softc
*sc
;
4310 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATS
,
4311 "%s: FIFO statistic full task\n",
4312 device_get_nameunit(sc
->dev
));
4314 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
4317 sc
->intr_pending_mask
&= ~RT2860_REG_INT_FIFO_STA_FULL
;
4319 rt2860_drain_fifo_stats(sc
);
4321 RT2860_SOFTC_LOCK(sc
);
4323 if (sc
->intr_pending_mask
& RT2860_REG_INT_FIFO_STA_FULL
)
4325 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATS
,
4326 "%s: FIFO statistic full task: scheduling again\n",
4327 device_get_nameunit(sc
->dev
));
4329 taskqueue_enqueue(sc
->taskqueue
, &sc
->fifo_sta_full_task
);
4333 rt2860_intr_enable(sc
, RT2860_REG_INT_FIFO_STA_FULL
);
4336 RT2860_SOFTC_UNLOCK(sc
);
4340 * rt2860_periodic_task
4342 static void rt2860_periodic_task(void *context
, int pending
)
4344 struct rt2860_softc
*sc
;
4346 struct ieee80211com
*ic
;
4352 RT2860_DPRINTF(sc
, RT2860_DEBUG_PERIODIC
,
4353 "%s: periodic task: round=%lu\n",
4354 device_get_nameunit(sc
->dev
), sc
->periodic_round
);
4356 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
4359 RT2860_SOFTC_LOCK(sc
);
4361 sc
->periodic_round
++;
4363 rt2860_update_stats(sc
);
4365 if ((sc
->periodic_round
% 10) == 0)
4367 rt2860_update_raw_counters(sc
);
4369 rt2860_watchdog(sc
);
4371 if (ic
->ic_opmode
== IEEE80211_M_STA
)
4372 rt2860_amrr_update_iter_func(sc
, ic
->ic_bss
);
4374 ieee80211_iterate_nodes(&ic
->ic_sta
, rt2860_amrr_update_iter_func
, sc
);
4377 RT2860_SOFTC_UNLOCK(sc
);
4379 callout_reset(&sc
->periodic_ch
, hz
/ 10, rt2860_periodic
, sc
);
4385 static int rt2860_rx_eof(struct rt2860_softc
*sc
, int limit
)
4387 struct ieee80211com
*ic
;
4389 struct ieee80211_frame
*wh
;
4390 struct ieee80211_node
*ni
;
4391 struct rt2860_softc_rx_radiotap_header
*tap
;
4392 struct rt2860_softc_rx_ring
*ring
;
4393 struct rt2860_rxdesc
*desc
;
4394 struct rt2860_softc_rx_data
*data
;
4395 struct rt2860_rxwi
*rxwi
;
4396 struct mbuf
*m
, *mnew
;
4397 bus_dma_segment_t segs
[1];
4398 bus_dmamap_t dma_map
;
4399 uint32_t index
, desc_flags
;
4400 uint8_t cipher_err
, rssi
, ant
, phymode
, bw
, shortgi
, mcs
;
4402 int error
, nsegs
, len
, ampdu
, amsdu
, nframes
;
4406 ring
= &sc
->rx_ring
;
4412 index
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_RX_DRX_IDX
);
4413 if (ring
->cur
== index
)
4416 desc
= &ring
->desc
[ring
->cur
];
4417 desc_flags
= le32toh(desc
->flags
);
4418 data
= &ring
->data
[ring
->cur
];
4420 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
4421 BUS_DMASYNC_POSTREAD
);
4423 if (!(desc
->sdl0
& htole16(RT2860_RXDESC_SDL0_DDONE
)))
4428 mnew
= m_getjcl(M_DONTWAIT
, MT_DATA
, M_PKTHDR
, MJUMPAGESIZE
);
4431 sc
->rx_mbuf_alloc_errors
++;
4436 mnew
->m_len
= mnew
->m_pkthdr
.len
= MJUMPAGESIZE
;
4438 error
= bus_dmamap_load_mbuf_sg(ring
->data_dma_tag
, ring
->spare_dma_map
,
4439 mnew
, segs
, &nsegs
, BUS_DMA_NOWAIT
);
4444 sc
->rx_mbuf_dmamap_errors
++;
4450 KASSERT(nsegs
== 1, ("%s: too many DMA segments",
4451 device_get_name(sc
->dev
)));
4453 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
4454 BUS_DMASYNC_POSTREAD
);
4455 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
4457 dma_map
= data
->dma_map
;
4458 data
->dma_map
= ring
->spare_dma_map
;
4459 ring
->spare_dma_map
= dma_map
;
4461 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
4462 BUS_DMASYNC_PREREAD
);
4467 desc
->sdp0
= htole32(segs
[0].ds_addr
);
4469 /* get Rx wireless info */
4471 rxwi
= mtod(m
, struct rt2860_rxwi
*);
4472 len
= (le16toh(rxwi
->tid_size
) >> RT2860_RXWI_SIZE_SHIFT
) &
4473 RT2860_RXWI_SIZE_MASK
;
4475 /* check for L2 padding between IEEE 802.11 frame header and body */
4477 if (desc_flags
& RT2860_RXDESC_FLAGS_L2PAD
)
4479 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
4480 "%s: L2 padding: len=%d\n",
4481 device_get_nameunit(sc
->dev
), len
);
4486 m
->m_pkthdr
.rcvif
= ifp
;
4487 m
->m_data
= (caddr_t
) (rxwi
+ 1);
4488 m
->m_pkthdr
.len
= m
->m_len
= len
;
4490 /* check for crc errors */
4492 if (desc_flags
& RT2860_RXDESC_FLAGS_CRC_ERR
)
4494 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
4495 "%s: rxdesc: crc error\n",
4496 device_get_nameunit(sc
->dev
));
4500 if (!(ifp
->if_flags
& IFF_PROMISC
))
4507 wh
= (struct ieee80211_frame
*) (rxwi
+ 1);
4509 /* check for cipher errors */
4511 if (desc_flags
& RT2860_RXDESC_FLAGS_DECRYPTED
)
4513 cipher_err
= ((desc_flags
>> RT2860_RXDESC_FLAGS_CIPHER_ERR_SHIFT
) &
4514 RT2860_RXDESC_FLAGS_CIPHER_ERR_MASK
);
4515 if (cipher_err
== RT2860_RXDESC_FLAGS_CIPHER_ERR_NONE
)
4517 if (wh
->i_fc
[1] & IEEE80211_FC1_WEP
)
4518 wh
->i_fc
[1] &= ~IEEE80211_FC1_WEP
;
4520 m
->m_flags
|= M_WEP
;
4524 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
4525 "%s: rxdesc: cipher error=0x%02x\n",
4526 device_get_nameunit(sc
->dev
), cipher_err
);
4530 if (!(ifp
->if_flags
& IFF_PROMISC
))
4539 if (wh
->i_fc
[1] & IEEE80211_FC1_WEP
)
4543 if (!(ifp
->if_flags
& IFF_PROMISC
))
4551 /* check for A-MPDU */
4553 if (desc_flags
& RT2860_RXDESC_FLAGS_AMPDU
)
4555 m
->m_flags
|= M_AMPDU
;
4566 /* check for A-MSDU */
4568 if (desc_flags
& RT2860_RXDESC_FLAGS_AMSDU
)
4579 ant
= rt2860_maxrssi_rxpath(sc
, rxwi
);
4580 rssi
= rxwi
->rssi
[ant
];
4581 rssi_dbm
= rt2860_rssi2dbm(sc
, rssi
, ant
);
4582 phymode
= ((rxwi
->phymode_stbc_shortgi
>> RT2860_RXWI_PHYMODE_SHIFT
) &
4583 RT2860_RXWI_PHYMODE_MASK
);
4584 bw
= ((rxwi
->bw_mcs
>> RT2860_RXWI_BW_SHIFT
) & RT2860_RXWI_BW_MASK
);
4585 shortgi
= ((rxwi
->phymode_stbc_shortgi
>> RT2860_RXWI_SHORTGI_SHIFT
) &
4586 RT2860_RXWI_SHORTGI_MASK
);
4587 mcs
= ((rxwi
->bw_mcs
>> RT2860_RXWI_MCS_SHIFT
) & RT2860_RXWI_MCS_MASK
);
4589 if (bpf_peers_present(sc
->drvbpf
))
4593 tap
->flags
= IEEE80211_RADIOTAP_F_DATAPAD
;
4594 tap
->dbm_antsignal
= rssi_dbm
;
4595 tap
->dbm_antnoise
= RT2860_NOISE_FLOOR
;
4597 tap
->antsignal
= rssi
;
4598 tap
->chan_flags
= htole32(ic
->ic_curchan
->ic_flags
);
4599 tap
->chan_freq
= htole16(ic
->ic_curchan
->ic_freq
);
4600 tap
->chan_ieee
= ic
->ic_curchan
->ic_ieee
;
4601 tap
->chan_maxpow
= 0;
4603 if (phymode
== RT2860_TXWI_PHYMODE_HT_MIXED
|| phymode
== RT2860_TXWI_PHYMODE_HT_GF
)
4604 tap
->rate
= mcs
| IEEE80211_RATE_MCS
;
4606 tap
->rate
= rt2860_rxrate(rxwi
);
4608 if (rxwi
->bw_mcs
& RT2860_RXWI_MCS_SHOTPRE
)
4609 tap
->flags
|= IEEE80211_RADIOTAP_F_SHORTPRE
;
4612 tap
->flags
|= IEEE80211_RADIOTAP_F_SHORTGI
;
4614 bpf_mtap2(sc
->drvbpf
, tap
, sc
->rxtap_len
, m
);
4617 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
4618 "%s: received frame: len=%d, phymode=%d, bw=%d, shortgi=%d, mcs=%d, "
4619 "ant=%d, rssi=%d/%d/%d, snr=%d/%d, wcid=0x%02x, ampdu=%d, amsdu=%d\n",
4620 device_get_nameunit(sc
->dev
),
4621 len
, phymode
, bw
, shortgi
, mcs
,
4622 ant
, rxwi
->rssi
[0], rxwi
->rssi
[1], rxwi
->rssi
[2],
4623 rxwi
->snr
[0], rxwi
->snr
[1],
4624 rxwi
->wcid
, ampdu
, amsdu
);
4626 ni
= ieee80211_find_rxnode(ic
, (struct ieee80211_frame_min
*) wh
);
4628 ieee80211_input(ic
, m
, ni
, rssi_dbm
- RT2860_NOISE_FLOOR
, RT2860_NOISE_FLOOR
, 0);
4630 ieee80211_free_node(ni
);
4634 desc
->sdl0
&= ~htole16(RT2860_RXDESC_SDL0_DDONE
);
4636 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
4637 BUS_DMASYNC_PREREAD
| BUS_DMASYNC_PREWRITE
);
4639 ring
->cur
= (ring
->cur
+ 1) % RT2860_SOFTC_RX_RING_DATA_COUNT
;
4645 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
4646 RT2860_SOFTC_RX_RING_DATA_COUNT
- 1);
4648 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
4651 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
4652 "%s: Rx eof: nframes=%d\n",
4653 device_get_nameunit(sc
->dev
), nframes
);
4655 sc
->rx_packets
+= nframes
;
4657 return (limit
== 0);
4663 static void rt2860_tx_eof(struct rt2860_softc
*sc
,
4664 struct rt2860_softc_tx_ring
*ring
)
4667 struct rt2860_txdesc
*desc
;
4668 struct rt2860_softc_tx_data
*data
;
4670 int ndescs
, nframes
;
4679 index
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_TX_DTX_IDX(ring
->qid
));
4680 if (ring
->desc_next
== index
)
4685 rt2860_drain_fifo_stats(sc
);
4687 desc
= &ring
->desc
[ring
->desc_next
];
4689 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
4690 BUS_DMASYNC_POSTREAD
);
4692 if (desc
->sdl0
& htole16(RT2860_TXDESC_SDL0_LASTSEG
) ||
4693 desc
->sdl1
& htole16(RT2860_TXDESC_SDL1_LASTSEG
))
4697 data
= &ring
->data
[ring
->data_next
];
4699 if (data
->m
->m_flags
& M_TXCB
)
4700 ieee80211_process_callback(data
->ni
, data
->m
, 0);
4702 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
4703 BUS_DMASYNC_POSTWRITE
);
4704 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
4708 ieee80211_free_node(data
->ni
);
4715 RT2860_SOFTC_LOCK(sc
);
4717 ring
->data_queued
--;
4718 ring
->data_next
= (ring
->data_next
+ 1) % RT2860_SOFTC_TX_RING_DATA_COUNT
;
4720 RT2860_SOFTC_UNLOCK(sc
);
4723 desc
->sdl0
&= ~htole16(RT2860_TXDESC_SDL0_DDONE
);
4725 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
4726 BUS_DMASYNC_PREREAD
| BUS_DMASYNC_PREWRITE
);
4728 RT2860_SOFTC_LOCK(sc
);
4730 ring
->desc_queued
--;
4731 ring
->desc_next
= (ring
->desc_next
+ 1) % RT2860_SOFTC_TX_RING_DESC_COUNT
;
4733 RT2860_SOFTC_UNLOCK(sc
);
4736 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
4737 "%s: Tx eof: qid=%d, ndescs=%d, nframes=%d\n",
4738 device_get_nameunit(sc
->dev
), ring
->qid
, ndescs
, nframes
);
4742 * rt2860_update_stats
4744 static void rt2860_update_stats(struct rt2860_softc
*sc
)
4747 struct ieee80211com
*ic
;
4748 struct ieee80211_node
*ni
;
4750 int beacons
, noretryok
, retryok
, failed
;
4757 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATS
,
4758 "%s: update statistic\n",
4759 device_get_nameunit(sc
->dev
));
4761 rt2860_drain_fifo_stats(sc
);
4763 /* read and clear Tx statistic registers */
4765 rt2860_io_mac_read_multi(sc
, RT2860_REG_TX_STA_CNT0
,
4766 stacnt
, sizeof(stacnt
));
4768 stacnt
[0] = le32toh(stacnt
[0]);
4769 stacnt
[1] = le32toh(stacnt
[1]);
4770 stacnt
[2] = le32toh(stacnt
[2]);
4772 beacons
= stacnt
[0] >> 16;
4773 noretryok
= stacnt
[1] & 0xffff;
4774 retryok
= stacnt
[1] >> 16;
4775 failed
= stacnt
[0] & 0xffff;
4777 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATS
,
4778 "%s: update statistic: beacons=%d, noretryok=%d, retryok=%d, failed=%d\n",
4779 device_get_nameunit(sc
->dev
),
4780 beacons
, noretryok
, retryok
, failed
);
4782 ifp
->if_oerrors
+= failed
;
4784 sc
->tx_beacons
+= beacons
;
4785 sc
->tx_noretryok
+= noretryok
;
4786 sc
->tx_retryok
+= retryok
;
4787 sc
->tx_failed
+= failed
;
4789 if (ic
->ic_opmode
== IEEE80211_M_STA
&& ic
->ic_state
== IEEE80211_S_RUN
)
4793 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
4794 wcid
= RT2860_AID2WCID(associd
);
4796 rt2860_amrr_tx_update(&sc
->amrr_node
[wcid
],
4797 noretryok
+ retryok
+ failed
, noretryok
+ retryok
, retryok
+ failed
);
4804 static void rt2860_watchdog(struct rt2860_softc
*sc
)
4809 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_PBF_TXRXQ_PCNT
);
4811 RT2860_DPRINTF(sc
, RT2860_DEBUG_WATCHDOG
,
4812 "%s: watchdog: TXRXQ_PCNT=0x%08x\n",
4813 device_get_nameunit(sc
->dev
), tmp
);
4815 if (((tmp
>> RT2860_REG_TX0Q_PCNT_SHIFT
) & RT2860_REG_TX0Q_PCNT_MASK
) != 0)
4817 sc
->tx_queue_not_empty
[0]++;
4819 rt2860_io_mac_write(sc
, RT2860_REG_PBF_CFG
, 0xf40012);
4821 for (ntries
= 0; ntries
< 10; ntries
++)
4823 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_PBF_TXRXQ_PCNT
);
4824 if (((tmp
>> RT2860_REG_TX0Q_PCNT_SHIFT
) & RT2860_REG_TX0Q_PCNT_MASK
) == 0)
4830 rt2860_io_mac_write(sc
, RT2860_REG_PBF_CFG
, 0xf40006);
4833 if (((tmp
>> RT2860_REG_TX1Q_PCNT_SHIFT
) & RT2860_REG_TX1Q_PCNT_MASK
) != 0)
4835 sc
->tx_queue_not_empty
[1]++;
4837 rt2860_io_mac_write(sc
, RT2860_REG_PBF_CFG
, 0xf4000a);
4839 for (ntries
= 0; ntries
< 10; ntries
++)
4841 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_PBF_TXRXQ_PCNT
);
4842 if (((tmp
>> RT2860_REG_TX1Q_PCNT_SHIFT
) & RT2860_REG_TX1Q_PCNT_MASK
) == 0)
4848 rt2860_io_mac_write(sc
, RT2860_REG_PBF_CFG
, 0xf40006);
4853 * rt2860_drain_fifo_stats
4855 static void rt2860_drain_fifo_stats(struct rt2860_softc
*sc
)
4859 uint8_t wcid
, mcs
, pid
;
4860 int ok
, agg
, retrycnt
;
4862 ifp
= sc
->ic
.ic_ifp
;
4864 /* drain Tx status FIFO (maxsize = 16) */
4866 while ((stats
= rt2860_io_mac_read(sc
, RT2860_REG_TX_STA_FIFO
)) &
4867 RT2860_REG_TX_STA_FIFO_VALID
)
4869 wcid
= (stats
>> RT2860_REG_TX_STA_FIFO_WCID_SHIFT
) &
4870 RT2860_REG_TX_STA_FIFO_WCID_MASK
;
4872 /* if no ACK was requested, no feedback is available */
4874 if (!(stats
& RT2860_REG_TX_STA_FIFO_ACK_REQ
) || wcid
== 0xff)
4877 /* update AMRR statistic */
4879 ok
= (stats
& RT2860_REG_TX_STA_FIFO_TX_OK
) ? 1 : 0;
4880 agg
= (stats
& RT2860_REG_TX_STA_FIFO_AGG
) ? 1 : 0;
4881 mcs
= (stats
>> RT2860_REG_TX_STA_FIFO_MCS_SHIFT
) &
4882 RT2860_REG_TX_STA_FIFO_MCS_MASK
;
4883 pid
= (stats
>> RT2860_REG_TX_STA_FIFO_PID_SHIFT
) &
4884 RT2860_REG_TX_STA_FIFO_PID_MASK
;
4885 retrycnt
= pid
- mcs
;
4887 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATS
,
4888 "%s: FIFO statistic: wcid=0x%02x, ok=%d, mcs=0x%02x, pid=0x%02x, retrycnt=%d\n",
4889 device_get_nameunit(sc
->dev
),
4890 wcid
, ok
, mcs
, pid
, retrycnt
);
4892 rt2860_amrr_tx_complete(&sc
->amrr_node
[wcid
], ok
, retrycnt
);
4900 * rt2860_update_raw_counters
4902 static void rt2860_update_raw_counters(struct rt2860_softc
*sc
)
4906 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_RX_STA_CNT0
);
4908 sc
->rx_crc_errors
+= tmp
& 0xffff;
4909 sc
->rx_phy_errors
+= tmp
>> 16;
4911 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_RX_STA_CNT1
);
4913 sc
->rx_false_ccas
+= tmp
& 0xffff;
4914 sc
->rx_plcp_errors
+= tmp
>> 16;
4916 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_RX_STA_CNT2
);
4918 sc
->rx_dup_packets
+= tmp
& 0xffff;
4919 sc
->rx_fifo_overflows
+= tmp
>> 16;
4923 * rt2860_intr_enable
4925 static void rt2860_intr_enable(struct rt2860_softc
*sc
, uint32_t intr_mask
)
4929 sc
->intr_disable_mask
&= ~intr_mask
;
4931 tmp
= sc
->intr_enable_mask
& ~sc
->intr_disable_mask
;
4933 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_MASK
, tmp
);
4937 * rt2860_intr_disable
4939 static void rt2860_intr_disable(struct rt2860_softc
*sc
, uint32_t intr_mask
)
4943 sc
->intr_disable_mask
|= intr_mask
;
4945 tmp
= sc
->intr_enable_mask
& ~sc
->intr_disable_mask
;
4947 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_MASK
, tmp
);
4951 * rt2860_txrx_enable
4953 static int rt2860_txrx_enable(struct rt2860_softc
*sc
)
4955 struct ieee80211com
*ic
;
4963 /* enable Tx/Rx DMA engine */
4965 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
, RT2860_REG_TX_ENABLE
);
4967 for (ntries
= 0; ntries
< 200; ntries
++)
4969 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
4970 if (!(tmp
& (RT2860_REG_TX_DMA_BUSY
| RT2860_REG_RX_DMA_BUSY
)))
4978 printf("%s: timeout waiting for DMA engine\n",
4979 device_get_nameunit(sc
->dev
));
4985 tmp
|= RT2860_REG_TX_WB_DDONE
|
4986 RT2860_REG_RX_DMA_ENABLE
|
4987 RT2860_REG_TX_DMA_ENABLE
|
4988 (RT2860_REG_WPDMA_BT_SIZE64
<< RT2860_REG_WPDMA_BT_SIZE_SHIFT
);
4990 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
4994 tmp
= RT2860_REG_RX_FILTER_DROP_CRC_ERR
|
4995 RT2860_REG_RX_FILTER_DROP_PHY_ERR
;
4997 if (ic
->ic_opmode
!= IEEE80211_M_MONITOR
)
4999 tmp
|= RT2860_REG_RX_FILTER_DROP_DUPL
|
5000 RT2860_REG_RX_FILTER_DROP_CTS
|
5001 RT2860_REG_RX_FILTER_DROP_BA
|
5002 RT2860_REG_RX_FILTER_DROP_ACK
|
5003 RT2860_REG_RX_FILTER_DROP_VER_ERR
|
5004 RT2860_REG_RX_FILTER_DROP_CTRL_RSV
|
5005 RT2860_REG_RX_FILTER_DROP_CFACK
|
5006 RT2860_REG_RX_FILTER_DROP_CFEND
;
5008 if (ic
->ic_opmode
== IEEE80211_M_STA
)
5009 tmp
|= RT2860_REG_RX_FILTER_DROP_RTS
|
5010 RT2860_REG_RX_FILTER_DROP_PSPOLL
;
5012 if (!(ifp
->if_flags
& IFF_PROMISC
))
5013 tmp
|= RT2860_REG_RX_FILTER_DROP_UC_NOME
;
5016 rt2860_io_mac_write(sc
, RT2860_REG_RX_FILTER_CFG
, tmp
);
5018 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
,
5019 RT2860_REG_RX_ENABLE
| RT2860_REG_TX_ENABLE
);
5025 * rt2860_alloc_rx_ring
5027 static int rt2860_alloc_rx_ring(struct rt2860_softc
*sc
,
5028 struct rt2860_softc_rx_ring
*ring
)
5030 struct rt2860_rxdesc
*desc
;
5031 struct rt2860_softc_rx_data
*data
;
5032 bus_dma_segment_t segs
[1];
5033 int i
, nsegs
, error
;
5035 error
= bus_dma_tag_create(bus_get_dma_tag(sc
->dev
), PAGE_SIZE
, 0,
5036 BUS_SPACE_MAXADDR_32BIT
, BUS_SPACE_MAXADDR
, NULL
, NULL
,
5037 RT2860_SOFTC_RX_RING_DATA_COUNT
* sizeof(struct rt2860_rxdesc
), 1,
5038 RT2860_SOFTC_RX_RING_DATA_COUNT
* sizeof(struct rt2860_rxdesc
),
5039 0, NULL
, NULL
, &ring
->desc_dma_tag
);
5042 printf("%s: could not create Rx desc DMA tag\n",
5043 device_get_nameunit(sc
->dev
));
5047 error
= bus_dmamem_alloc(ring
->desc_dma_tag
, (void **) &ring
->desc
,
5048 BUS_DMA_NOWAIT
| BUS_DMA_ZERO
, &ring
->desc_dma_map
);
5051 printf("%s: could not allocate Rx desc DMA memory\n",
5052 device_get_nameunit(sc
->dev
));
5056 error
= bus_dmamap_load(ring
->desc_dma_tag
, ring
->desc_dma_map
,
5058 RT2860_SOFTC_RX_RING_DATA_COUNT
* sizeof(struct rt2860_rxdesc
),
5059 rt2860_dma_map_addr
, &ring
->desc_phys_addr
, 0);
5062 printf("%s: could not load Rx desc DMA map\n",
5063 device_get_nameunit(sc
->dev
));
5067 error
= bus_dma_tag_create(bus_get_dma_tag(sc
->dev
), PAGE_SIZE
, 0,
5068 BUS_SPACE_MAXADDR_32BIT
, BUS_SPACE_MAXADDR
, NULL
, NULL
,
5069 MJUMPAGESIZE
, 1, MJUMPAGESIZE
, 0, NULL
, NULL
,
5070 &ring
->data_dma_tag
);
5073 printf("%s: could not create Rx data DMA tag\n",
5074 device_get_nameunit(sc
->dev
));
5078 for (i
= 0; i
< RT2860_SOFTC_RX_RING_DATA_COUNT
; i
++)
5080 desc
= &ring
->desc
[i
];
5081 data
= &ring
->data
[i
];
5083 error
= bus_dmamap_create(ring
->data_dma_tag
, 0, &data
->dma_map
);
5086 printf("%s: could not create Rx data DMA map\n",
5087 device_get_nameunit(sc
->dev
));
5091 data
->m
= m_getjcl(M_DONTWAIT
, MT_DATA
, M_PKTHDR
, MJUMPAGESIZE
);
5092 if (data
->m
== NULL
)
5094 printf("%s: could not allocate Rx mbuf\n",
5095 device_get_nameunit(sc
->dev
));
5100 data
->m
->m_len
= data
->m
->m_pkthdr
.len
= MJUMPAGESIZE
;
5102 error
= bus_dmamap_load_mbuf_sg(ring
->data_dma_tag
, data
->dma_map
,
5103 data
->m
, segs
, &nsegs
, BUS_DMA_NOWAIT
);
5106 printf("%s: could not load Rx mbuf DMA map\n",
5107 device_get_nameunit(sc
->dev
));
5111 KASSERT(nsegs
== 1, ("%s: too many DMA segments",
5112 device_get_name(sc
->dev
)));
5114 desc
->sdp0
= htole32(segs
[0].ds_addr
);
5115 desc
->sdl0
= htole16(MJUMPAGESIZE
);
5118 error
= bus_dmamap_create(ring
->data_dma_tag
, 0, &ring
->spare_dma_map
);
5121 printf("%s: could not create Rx spare DMA map\n",
5122 device_get_nameunit(sc
->dev
));
5126 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
5127 BUS_DMASYNC_PREWRITE
);
5133 rt2860_free_rx_ring(sc
, ring
);
5139 * rt2860_reset_rx_ring
5141 static void rt2860_reset_rx_ring(struct rt2860_softc
*sc
,
5142 struct rt2860_softc_rx_ring
*ring
)
5144 struct rt2860_rxdesc
*desc
;
5147 for (i
= 0; i
< RT2860_SOFTC_RX_RING_DATA_COUNT
; i
++)
5149 desc
= &ring
->desc
[i
];
5151 desc
->sdl0
&= ~htole16(RT2860_RXDESC_SDL0_DDONE
);
5154 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
5155 BUS_DMASYNC_PREWRITE
);
5161 * rt2860_free_rx_ring
5163 static void rt2860_free_rx_ring(struct rt2860_softc
*sc
,
5164 struct rt2860_softc_rx_ring
*ring
)
5166 struct rt2860_softc_rx_data
*data
;
5169 if (ring
->desc
!= NULL
)
5171 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
5172 BUS_DMASYNC_POSTWRITE
);
5173 bus_dmamap_unload(ring
->desc_dma_tag
, ring
->desc_dma_map
);
5174 bus_dmamem_free(ring
->desc_dma_tag
, ring
->desc
,
5175 ring
->desc_dma_map
);
5178 if (ring
->desc_dma_tag
!= NULL
)
5179 bus_dma_tag_destroy(ring
->desc_dma_tag
);
5181 for (i
= 0; i
< RT2860_SOFTC_RX_RING_DATA_COUNT
; i
++)
5183 data
= &ring
->data
[i
];
5185 if (data
->m
!= NULL
)
5187 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
5188 BUS_DMASYNC_POSTREAD
);
5189 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
5193 if (data
->dma_map
!= NULL
)
5194 bus_dmamap_destroy(ring
->data_dma_tag
, data
->dma_map
);
5197 if (ring
->spare_dma_map
!= NULL
)
5198 bus_dmamap_destroy(ring
->data_dma_tag
, ring
->spare_dma_map
);
5200 if (ring
->data_dma_tag
!= NULL
)
5201 bus_dma_tag_destroy(ring
->data_dma_tag
);
5205 * rt2860_alloc_tx_ring
5207 static int rt2860_alloc_tx_ring(struct rt2860_softc
*sc
,
5208 struct rt2860_softc_tx_ring
*ring
, int qid
)
5210 struct rt2860_softc_tx_data
*data
;
5213 error
= bus_dma_tag_create(bus_get_dma_tag(sc
->dev
), PAGE_SIZE
, 0,
5214 BUS_SPACE_MAXADDR_32BIT
, BUS_SPACE_MAXADDR
, NULL
, NULL
,
5215 RT2860_SOFTC_TX_RING_DESC_COUNT
* sizeof(struct rt2860_txdesc
), 1,
5216 RT2860_SOFTC_TX_RING_DESC_COUNT
* sizeof(struct rt2860_txdesc
),
5217 0, NULL
, NULL
, &ring
->desc_dma_tag
);
5220 printf("%s: could not create Tx desc DMA tag\n",
5221 device_get_nameunit(sc
->dev
));
5225 error
= bus_dmamem_alloc(ring
->desc_dma_tag
, (void **) &ring
->desc
,
5226 BUS_DMA_NOWAIT
| BUS_DMA_ZERO
, &ring
->desc_dma_map
);
5229 printf("%s: could not allocate Tx desc DMA memory\n",
5230 device_get_nameunit(sc
->dev
));
5234 error
= bus_dmamap_load(ring
->desc_dma_tag
, ring
->desc_dma_map
,
5236 RT2860_SOFTC_TX_RING_DESC_COUNT
* sizeof(struct rt2860_txdesc
),
5237 rt2860_dma_map_addr
, &ring
->desc_phys_addr
, 0);
5240 printf("%s: could not load Tx desc DMA map\n",
5241 device_get_nameunit(sc
->dev
));
5245 ring
->desc_queued
= 0;
5247 ring
->desc_next
= 0;
5249 error
= bus_dma_tag_create(bus_get_dma_tag(sc
->dev
), PAGE_SIZE
, 0,
5250 BUS_SPACE_MAXADDR_32BIT
, BUS_SPACE_MAXADDR
, NULL
, NULL
,
5251 RT2860_SOFTC_TX_RING_DATA_COUNT
* RT2860_TX_DATA_SEG0_SIZE
, 1,
5252 RT2860_SOFTC_TX_RING_DATA_COUNT
* RT2860_TX_DATA_SEG0_SIZE
,
5253 0, NULL
, NULL
, &ring
->seg0_dma_tag
);
5256 printf("%s: could not create Tx seg0 DMA tag\n",
5257 device_get_nameunit(sc
->dev
));
5261 error
= bus_dmamem_alloc(ring
->seg0_dma_tag
, (void **) &ring
->seg0
,
5262 BUS_DMA_NOWAIT
| BUS_DMA_ZERO
, &ring
->seg0_dma_map
);
5265 printf("%s: could not allocate Tx seg0 DMA memory\n",
5266 device_get_nameunit(sc
->dev
));
5270 error
= bus_dmamap_load(ring
->seg0_dma_tag
, ring
->seg0_dma_map
,
5272 RT2860_SOFTC_TX_RING_DATA_COUNT
* RT2860_TX_DATA_SEG0_SIZE
,
5273 rt2860_dma_map_addr
, &ring
->seg0_phys_addr
, 0);
5276 printf("%s: could not load Tx seg0 DMA map\n",
5277 device_get_nameunit(sc
->dev
));
5281 error
= bus_dma_tag_create(bus_get_dma_tag(sc
->dev
), PAGE_SIZE
, 0,
5282 BUS_SPACE_MAXADDR_32BIT
, BUS_SPACE_MAXADDR
, NULL
, NULL
,
5283 MJUMPAGESIZE
, RT2860_SOFTC_MAX_SCATTER
, MJUMPAGESIZE
, 0, NULL
, NULL
,
5284 &ring
->data_dma_tag
);
5287 printf("%s: could not create Tx data DMA tag\n",
5288 device_get_nameunit(sc
->dev
));
5292 for (i
= 0; i
< RT2860_SOFTC_TX_RING_DATA_COUNT
; i
++)
5294 data
= &ring
->data
[i
];
5296 error
= bus_dmamap_create(ring
->data_dma_tag
, 0, &data
->dma_map
);
5299 printf("%s: could not create Tx data DMA map\n",
5300 device_get_nameunit(sc
->dev
));
5305 ring
->data_queued
= 0;
5307 ring
->data_next
= 0;
5315 rt2860_free_tx_ring(sc
, ring
);
5321 * rt2860_reset_tx_ring
5323 static void rt2860_reset_tx_ring(struct rt2860_softc
*sc
,
5324 struct rt2860_softc_tx_ring
*ring
)
5326 struct rt2860_softc_tx_data
*data
;
5327 struct rt2860_txdesc
*desc
;
5330 for (i
= 0; i
< RT2860_SOFTC_TX_RING_DESC_COUNT
; i
++)
5332 desc
= &ring
->desc
[i
];
5338 ring
->desc_queued
= 0;
5340 ring
->desc_next
= 0;
5342 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
5343 BUS_DMASYNC_PREWRITE
);
5345 bus_dmamap_sync(ring
->seg0_dma_tag
, ring
->seg0_dma_map
,
5346 BUS_DMASYNC_PREWRITE
);
5348 for (i
= 0; i
< RT2860_SOFTC_TX_RING_DATA_COUNT
; i
++)
5350 data
= &ring
->data
[i
];
5352 if (data
->m
!= NULL
)
5354 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
5355 BUS_DMASYNC_POSTWRITE
);
5356 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
5361 if (data
->ni
!= NULL
)
5363 ieee80211_free_node(data
->ni
);
5368 ring
->data_queued
= 0;
5370 ring
->data_next
= 0;
5374 * rt2860_free_tx_ring
5376 static void rt2860_free_tx_ring(struct rt2860_softc
*sc
,
5377 struct rt2860_softc_tx_ring
*ring
)
5379 struct rt2860_softc_tx_data
*data
;
5382 if (ring
->desc
!= NULL
)
5384 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
5385 BUS_DMASYNC_POSTWRITE
);
5386 bus_dmamap_unload(ring
->desc_dma_tag
, ring
->desc_dma_map
);
5387 bus_dmamem_free(ring
->desc_dma_tag
, ring
->desc
,
5388 ring
->desc_dma_map
);
5391 if (ring
->desc_dma_tag
!= NULL
)
5392 bus_dma_tag_destroy(ring
->desc_dma_tag
);
5394 if (ring
->seg0
!= NULL
)
5396 bus_dmamap_sync(ring
->seg0_dma_tag
, ring
->seg0_dma_map
,
5397 BUS_DMASYNC_POSTWRITE
);
5398 bus_dmamap_unload(ring
->seg0_dma_tag
, ring
->seg0_dma_map
);
5399 bus_dmamem_free(ring
->seg0_dma_tag
, ring
->seg0
,
5400 ring
->seg0_dma_map
);
5403 if (ring
->seg0_dma_tag
!= NULL
)
5404 bus_dma_tag_destroy(ring
->seg0_dma_tag
);
5406 for (i
= 0; i
< RT2860_SOFTC_TX_RING_DATA_COUNT
; i
++)
5408 data
= &ring
->data
[i
];
5410 if (data
->m
!= NULL
)
5412 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
5413 BUS_DMASYNC_POSTWRITE
);
5414 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
5418 if (data
->ni
!= NULL
)
5419 ieee80211_free_node(data
->ni
);
5421 if (data
->dma_map
!= NULL
)
5422 bus_dmamap_destroy(ring
->data_dma_tag
, data
->dma_map
);
5425 if (ring
->data_dma_tag
!= NULL
)
5426 bus_dma_tag_destroy(ring
->data_dma_tag
);
5430 * rt2860_dma_map_addr
5432 static void rt2860_dma_map_addr(void *arg
, bus_dma_segment_t
*segs
,
5433 int nseg
, int error
)
5438 KASSERT(nseg
== 1, ("too many DMA segments, %d should be 1", nseg
));
5440 *(bus_addr_t
*) arg
= segs
[0].ds_addr
;
5444 * rt2860_sysctl_attach
5446 static void rt2860_sysctl_attach(struct rt2860_softc
*sc
)
5448 struct sysctl_ctx_list
*ctx
;
5449 struct sysctl_oid
*tree
;
5450 struct sysctl_oid
*stats
;
5452 ctx
= device_get_sysctl_ctx(sc
->dev
);
5453 tree
= device_get_sysctl_tree(sc
->dev
);
5455 stats
= SYSCTL_ADD_NODE(ctx
, SYSCTL_CHILDREN(tree
), OID_AUTO
,
5456 "stats", CTLFLAG_RD
, 0, "statistic");
5458 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5459 "interrupts", CTLFLAG_RD
, &sc
->interrupts
, 0,
5462 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5463 "tx_coherent_interrupts", CTLFLAG_RD
, &sc
->tx_coherent_interrupts
, 0,
5464 "Tx coherent interrupts");
5466 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5467 "rx_coherent_interrupts", CTLFLAG_RD
, &sc
->rx_coherent_interrupts
, 0,
5468 "Rx coherent interrupts");
5470 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5471 "txrx_coherent_interrupts", CTLFLAG_RD
, &sc
->txrx_coherent_interrupts
, 0,
5472 "Tx/Rx coherent interrupts");
5474 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5475 "fifo_sta_full_interrupts", CTLFLAG_RD
, &sc
->fifo_sta_full_interrupts
, 0,
5476 "FIFO statistic full interrupts");
5478 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5479 "rx_interrupts", CTLFLAG_RD
, &sc
->rx_interrupts
, 0,
5482 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5483 "rx_delay_interrupts", CTLFLAG_RD
, &sc
->rx_delay_interrupts
, 0,
5484 "Rx delay interrupts");
5486 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5487 "tx_mgmt_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[5], 0,
5488 "Tx MGMT interrupts");
5490 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5491 "tx_hcca_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[4], 0,
5492 "Tx HCCA interrupts");
5494 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5495 "tx_ac3_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[3], 0,
5496 "Tx AC3 interrupts");
5498 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5499 "tx_ac2_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[2], 0,
5500 "Tx AC2 interrupts");
5502 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5503 "tx_ac1_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[1], 0,
5504 "Tx AC1 interrupts");
5506 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5507 "tx_ac0_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[0], 0,
5508 "Tx AC0 interrupts");
5510 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5511 "tx_delay_interrupts", CTLFLAG_RD
, &sc
->tx_delay_interrupts
, 0,
5512 "Tx delay interrupts");
5514 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5515 "pre_tbtt_interrupts", CTLFLAG_RD
, &sc
->pre_tbtt_interrupts
, 0,
5516 "Pre-TBTT interrupts");
5518 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5519 "tbtt_interrupts", CTLFLAG_RD
, &sc
->tbtt_interrupts
, 0,
5522 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5523 "mcu_cmd_interrupts", CTLFLAG_RD
, &sc
->mcu_cmd_interrupts
, 0,
5524 "MCU command interrupts");
5526 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5527 "auto_wakeup_interrupts", CTLFLAG_RD
, &sc
->auto_wakeup_interrupts
, 0,
5528 "auto wakeup interrupts");
5530 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5531 "gp_timer_interrupts", CTLFLAG_RD
, &sc
->gp_timer_interrupts
, 0,
5532 "GP timer interrupts");
5534 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5535 "tx_mgmt_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[5].desc_queued
, 0,
5536 "Tx MGMT descriptors queued");
5538 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5539 "tx_mgmt_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[5].data_queued
, 0,
5540 "Tx MGMT data queued");
5542 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5543 "tx_hcca_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[4].desc_queued
, 0,
5544 "Tx HCCA descriptors queued");
5546 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5547 "tx_hcca_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[4].data_queued
, 0,
5548 "Tx HCCA data queued");
5550 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5551 "tx_ac3_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[3].desc_queued
, 0,
5552 "Tx AC3 descriptors queued");
5554 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5555 "tx_ac3_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[3].data_queued
, 0,
5556 "Tx AC3 data queued");
5558 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5559 "tx_ac2_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[2].desc_queued
, 0,
5560 "Tx AC2 descriptors queued");
5562 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5563 "tx_ac2_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[2].data_queued
, 0,
5564 "Tx AC2 data queued");
5566 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5567 "tx_ac1_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[1].desc_queued
, 0,
5568 "Tx AC1 descriptors queued");
5570 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5571 "tx_ac1_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[1].data_queued
, 0,
5572 "Tx AC1 data queued");
5574 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5575 "tx_ac0_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[0].desc_queued
, 0,
5576 "Tx AC0 descriptors queued");
5578 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5579 "tx_ac0_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[0].data_queued
, 0,
5580 "Tx AC0 data queued");
5582 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5583 "tx_mgmt_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[5], 0,
5584 "Tx MGMT data queue full");
5586 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5587 "tx_hcca_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[4], 0,
5588 "Tx HCCA data queue full");
5590 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5591 "tx_ac3_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[3], 0,
5592 "Tx AC3 data queue full");
5594 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5595 "tx_ac2_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[2], 0,
5596 "Tx AC2 data queue full");
5598 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5599 "tx_ac1_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[1], 0,
5600 "Tx AC1 data queue full");
5602 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5603 "tx_ac0_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[0], 0,
5604 "Tx AC0 data queue full");
5606 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5607 "tx_watchdog_timeouts", CTLFLAG_RD
, &sc
->tx_watchdog_timeouts
, 0,
5608 "Tx watchdog timeouts");
5610 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5611 "tx_defrag_packets", CTLFLAG_RD
, &sc
->tx_defrag_packets
, 0,
5612 "Tx defragmented packets");
5614 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5615 "no_tx_desc_avail", CTLFLAG_RD
, &sc
->no_tx_desc_avail
, 0,
5616 "no Tx descriptors available");
5618 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5619 "rx_mbuf_alloc_errors", CTLFLAG_RD
, &sc
->rx_mbuf_alloc_errors
, 0,
5620 "Rx mbuf allocation errors");
5622 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5623 "rx_mbuf_dmamap_errors", CTLFLAG_RD
, &sc
->rx_mbuf_dmamap_errors
, 0,
5624 "Rx mbuf DMA mapping errors");
5626 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5627 "tx_queue_0_not_empty", CTLFLAG_RD
, &sc
->tx_queue_not_empty
[0], 0,
5628 "Tx queue 0 not empty");
5630 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5631 "tx_queue_1_not_empty", CTLFLAG_RD
, &sc
->tx_queue_not_empty
[1], 0,
5632 "Tx queue 1 not empty");
5634 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5635 "tx_beacons", CTLFLAG_RD
, &sc
->tx_beacons
, 0,
5638 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5639 "tx_noretryok", CTLFLAG_RD
, &sc
->tx_noretryok
, 0,
5640 "Tx successfull without retries");
5642 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5643 "tx_retryok", CTLFLAG_RD
, &sc
->tx_retryok
, 0,
5644 "Tx successfull with retries");
5646 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5647 "tx_failed", CTLFLAG_RD
, &sc
->tx_failed
, 0,
5650 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5651 "tx_nonagg", CTLFLAG_RD
, &sc
->tx_nonagg
, 0,
5652 "Tx non-aggregated");
5654 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5655 "tx_agg", CTLFLAG_RD
, &sc
->tx_agg
, 0,
5658 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5659 "tx_ampdu", CTLFLAG_RD
, &sc
->tx_ampdu
, 0,
5662 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5663 "rx_packets", CTLFLAG_RD
, &sc
->rx_packets
, 0,
5666 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5667 "rx_ampdu", CTLFLAG_RD
, &sc
->rx_ampdu
, 0,
5670 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5671 "rx_amsdu", CTLFLAG_RD
, &sc
->rx_amsdu
, 0,
5674 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5675 "rx_crc_errors", CTLFLAG_RD
, &sc
->rx_crc_errors
, 0,
5678 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5679 "rx_phy_errors", CTLFLAG_RD
, &sc
->rx_phy_errors
, 0,
5682 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5683 "rx_false_ccas", CTLFLAG_RD
, &sc
->rx_false_ccas
, 0,
5686 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5687 "rx_plcp_errors", CTLFLAG_RD
, &sc
->rx_plcp_errors
, 0,
5690 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5691 "rx_dup_packets", CTLFLAG_RD
, &sc
->rx_dup_packets
, 0,
5692 "Rx duplicate packets");
5694 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
5695 "rx_fifo_overflows", CTLFLAG_RD
, &sc
->rx_fifo_overflows
, 0,
5696 "Rx FIFO overflows");
5699 static device_method_t rt2860_dev_methods
[] =
5701 DEVMETHOD(device_probe
, rt2860_probe
),
5702 DEVMETHOD(device_attach
, rt2860_attach
),
5703 DEVMETHOD(device_detach
, rt2860_detach
),
5704 DEVMETHOD(device_shutdown
, rt2860_shutdown
),
5705 DEVMETHOD(device_suspend
, rt2860_suspend
),
5706 DEVMETHOD(device_resume
, rt2860_resume
),
5710 static driver_t rt2860_driver
=
5714 sizeof(struct rt2860_softc
)
5717 static devclass_t rt2860_dev_class
;
5719 DRIVER_MODULE(rt2860
, pci
, rt2860_driver
, rt2860_dev_class
, 0, 0);
5721 MODULE_DEPEND(rt2860
, pci
, 1, 1, 1);
5722 MODULE_DEPEND(rt2860
, wlan
, 1, 1, 1);