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_ACK_SIZE 14
52 #define IEEE80211_HAS_ADDR4(wh) \
53 (((wh)->i_fc[1] & IEEE80211_FC1_DIR_MASK) == IEEE80211_FC1_DIR_DSTODS)
55 #define RT2860_MS(_v, _f) (((_v) & _f) >> _f##_S)
56 #define RT2860_SM(_v, _f) (((_v) << _f##_S) & _f)
58 #define RT2860_TX_WATCHDOG_TIMEOUT 5
61 * Data structures and types
64 struct rt2860_pci_ident
72 * Static function prototypes
75 static int rt2860_probe(device_t dev
);
77 static int rt2860_attach(device_t dev
);
79 static int rt2860_detach(device_t dev
);
81 static int rt2860_shutdown(device_t dev
);
83 static int rt2860_suspend(device_t dev
);
85 static int rt2860_resume(device_t dev
);
87 static void rt2860_init_channels(struct rt2860_softc
*sc
);
89 static void rt2860_init_channels_ht40(struct rt2860_softc
*sc
);
91 static void rt2860_init_locked(void *priv
);
93 static void rt2860_init(void *priv
);
95 static int rt2860_init_bbp(struct rt2860_softc
*sc
);
97 static void rt2860_stop_locked(void *priv
);
99 static void rt2860_stop(void *priv
);
101 static void rt2860_start(struct ifnet
*ifp
);
103 static int rt2860_ioctl(struct ifnet
*ifp
, u_long cmd
, caddr_t data
);
105 static struct ieee80211vap
*rt2860_vap_create(struct ieee80211com
*ic
,
106 const char name
[IFNAMSIZ
], int unit
, int opmode
, int flags
,
107 const uint8_t bssid
[IEEE80211_ADDR_LEN
],
108 const uint8_t mac
[IEEE80211_ADDR_LEN
]);
110 static void rt2860_vap_delete(struct ieee80211vap
*vap
);
112 static int rt2860_vap_reset(struct ieee80211vap
*vap
, u_long cmd
);
114 static int rt2860_vap_newstate(struct ieee80211vap
*vap
,
115 enum ieee80211_state nstate
, int arg
);
117 static void rt2860_vap_key_update_begin(struct ieee80211vap
*vap
);
119 static void rt2860_vap_key_update_end(struct ieee80211vap
*vap
);
121 static int rt2860_vap_key_set(struct ieee80211vap
*vap
,
122 const struct ieee80211_key
*k
, const uint8_t mac
[IEEE80211_ADDR_LEN
]);
124 static int rt2860_vap_key_delete(struct ieee80211vap
*vap
,
125 const struct ieee80211_key
*k
);
127 static void rt2860_vap_update_beacon(struct ieee80211vap
*vap
, int what
);
129 static int rt2860_media_change(struct ifnet
*ifp
);
131 static struct ieee80211_node
*rt2860_node_alloc(struct ieee80211vap
*vap
,
132 const uint8_t mac
[IEEE80211_ADDR_LEN
]);
134 static void rt2860_node_getmimoinfo(const struct ieee80211_node
*ni
,
135 struct ieee80211_mimo_info
*mi
);
137 static int rt2860_setregdomain(struct ieee80211com
*ic
,
138 struct ieee80211_regdomain
*reg
,
139 int nchans
, struct ieee80211_channel chans
[]);
141 static void rt2860_getradiocaps(struct ieee80211com
*ic
,
142 int maxchans
, int *nchans
, struct ieee80211_channel chans
[]);
144 static void rt2860_scan_start(struct ieee80211com
*ic
);
146 static void rt2860_scan_end(struct ieee80211com
*ic
);
148 static void rt2860_set_channel(struct ieee80211com
*ic
);
150 static void rt2860_newassoc(struct ieee80211_node
*ni
, int isnew
);
152 static void rt2860_updateslot(struct ifnet
*ifp
);
154 static void rt2860_update_promisc(struct ifnet
*ifp
);
156 static void rt2860_update_mcast(struct ifnet
*ifp
);
158 static int rt2860_wme_update(struct ieee80211com
*ic
);
160 static int rt2860_raw_xmit(struct ieee80211_node
*ni
, struct mbuf
*m
,
161 const struct ieee80211_bpf_params
*params
);
163 static int rt2860_recv_action(struct ieee80211_node
*ni
,
164 const struct ieee80211_frame
*wh
,
165 const uint8_t *frm
, const uint8_t *efrm
);
167 static int rt2860_send_action(struct ieee80211_node
*ni
,
168 int cat
, int act
, void *sa
);
170 static void rt2860_amrr_update_iter_func(void *arg
, struct ieee80211_node
*ni
);
172 static void rt2860_periodic(void *arg
);
174 static void rt2860_tx_watchdog(void *arg
);
176 static void rt2860_asic_set_bssid(struct rt2860_softc
*sc
,
177 const uint8_t *bssid
);
179 static void rt2860_asic_set_macaddr(struct rt2860_softc
*sc
,
180 const uint8_t *addr
);
182 static void rt2860_asic_enable_tsf_sync(struct rt2860_softc
*sc
);
184 static void rt2860_asic_disable_tsf_sync(struct rt2860_softc
*sc
);
186 static void rt2860_asic_enable_mrr(struct rt2860_softc
*sc
);
188 static void rt2860_asic_set_txpreamble(struct rt2860_softc
*sc
);
190 static void rt2860_asic_set_basicrates(struct rt2860_softc
*sc
);
192 static void rt2860_asic_update_rtsthreshold(struct rt2860_softc
*sc
);
194 static void rt2860_asic_update_txpower(struct rt2860_softc
*sc
);
196 static void rt2860_asic_update_promisc(struct rt2860_softc
*sc
);
198 static void rt2860_asic_updateprot(struct rt2860_softc
*sc
);
200 static void rt2860_asic_updateslot(struct rt2860_softc
*sc
);
202 static void rt2860_asic_wme_update(struct rt2860_softc
*sc
);
204 static void rt2860_asic_update_beacon(struct rt2860_softc
*sc
,
205 struct ieee80211vap
*vap
);
207 static void rt2860_asic_clear_keytables(struct rt2860_softc
*sc
);
209 static int rt2860_beacon_alloc(struct rt2860_softc
*sc
,
210 struct ieee80211vap
*vap
);
212 static uint8_t rt2860_rxrate(struct rt2860_rxwi
*rxwi
);
214 static uint8_t rt2860_maxrssi_rxpath(struct rt2860_softc
*sc
,
215 const struct rt2860_rxwi
*rxwi
);
217 static int8_t rt2860_rssi2dbm(struct rt2860_softc
*sc
,
218 uint8_t rssi
, uint8_t rxpath
);
220 static uint8_t rt2860_rate2mcs(uint8_t rate
);
222 static int rt2860_tx_mgmt(struct rt2860_softc
*sc
,
223 struct mbuf
*m
, struct ieee80211_node
*ni
, int qid
);
225 static int rt2860_tx_data(struct rt2860_softc
*sc
,
226 struct mbuf
*m
, struct ieee80211_node
*ni
, int qid
);
228 static int rt2860_tx_raw(struct rt2860_softc
*sc
,
229 struct mbuf
*m
, struct ieee80211_node
*ni
,
230 const struct ieee80211_bpf_params
*params
);
232 static void rt2860_intr(void *arg
);
234 static void rt2860_tx_coherent_intr(struct rt2860_softc
*sc
);
236 static void rt2860_rx_coherent_intr(struct rt2860_softc
*sc
);
238 static void rt2860_txrx_coherent_intr(struct rt2860_softc
*sc
);
240 static void rt2860_fifo_sta_full_intr(struct rt2860_softc
*sc
);
242 static void rt2860_rx_intr(struct rt2860_softc
*sc
);
244 static void rt2860_rx_delay_intr(struct rt2860_softc
*sc
);
246 static void rt2860_tx_intr(struct rt2860_softc
*sc
, int qid
);
248 static void rt2860_tx_delay_intr(struct rt2860_softc
*sc
);
250 static void rt2860_pre_tbtt_intr(struct rt2860_softc
*sc
);
252 static void rt2860_tbtt_intr(struct rt2860_softc
*sc
);
254 static void rt2860_mcu_cmd_intr(struct rt2860_softc
*sc
);
256 static void rt2860_auto_wakeup_intr(struct rt2860_softc
*sc
);
258 static void rt2860_gp_timer_intr(struct rt2860_softc
*sc
);
260 static void rt2860_rx_done_task(void *context
, int pending
);
262 static void rt2860_tx_done_task(void *context
, int pending
);
264 static void rt2860_fifo_sta_full_task(void *context
, int pending
);
266 static void rt2860_periodic_task(void *context
, int pending
);
268 static int rt2860_rx_eof(struct rt2860_softc
*sc
, int limit
);
270 static void rt2860_tx_eof(struct rt2860_softc
*sc
,
271 struct rt2860_softc_tx_ring
*ring
);
273 static void rt2860_update_stats(struct rt2860_softc
*sc
);
275 static void rt2860_bbp_tuning(struct rt2860_softc
*sc
);
277 static void rt2860_watchdog(struct rt2860_softc
*sc
);
279 static void rt2860_drain_fifo_stats(struct rt2860_softc
*sc
);
281 static void rt2860_update_raw_counters(struct rt2860_softc
*sc
);
283 static void rt2860_intr_enable(struct rt2860_softc
*sc
, uint32_t intr_mask
);
285 static void rt2860_intr_disable(struct rt2860_softc
*sc
, uint32_t intr_mask
);
287 static int rt2860_txrx_enable(struct rt2860_softc
*sc
);
289 static int rt2860_alloc_rx_ring(struct rt2860_softc
*sc
,
290 struct rt2860_softc_rx_ring
*ring
);
292 static void rt2860_reset_rx_ring(struct rt2860_softc
*sc
,
293 struct rt2860_softc_rx_ring
*ring
);
295 static void rt2860_free_rx_ring(struct rt2860_softc
*sc
,
296 struct rt2860_softc_rx_ring
*ring
);
298 static int rt2860_alloc_tx_ring(struct rt2860_softc
*sc
,
299 struct rt2860_softc_tx_ring
*ring
, int qid
);
301 static void rt2860_reset_tx_ring(struct rt2860_softc
*sc
,
302 struct rt2860_softc_tx_ring
*ring
);
304 static void rt2860_free_tx_ring(struct rt2860_softc
*sc
,
305 struct rt2860_softc_tx_ring
*ring
);
307 static void rt2860_dma_map_addr(void *arg
, bus_dma_segment_t
*segs
,
308 int nseg
, int error
);
310 static void rt2860_sysctl_attach(struct rt2860_softc
*sc
);
316 static const struct rt2860_pci_ident rt2860_pci_ids
[] =
318 { PCI_VENDOR_RALINK
, PCI_PRODUCT_RALINK_RT2860_PCI
, "Ralink RT2860 PCI" },
319 { PCI_VENDOR_RALINK
, PCI_PRODUCT_RALINK_RT2860_PCIe
, "Ralink RT2860 PCIe" },
320 { PCI_VENDOR_RALINK
, PCI_PRODUCT_RALINK_RT2760_PCI
, "Ralink RT2760 PCI" },
321 { PCI_VENDOR_RALINK
, PCI_PRODUCT_RALINK_RT2790_PCIe
, "Ralink RT2790 PCIe" },
331 { RT2860_REG_PBF_BCN_OFFSET0
, 0xf8f0e8e0 },
332 { RT2860_REG_PBF_BCN_OFFSET1
, 0x6f77d0c8 },
333 { RT2860_REG_LEGACY_BASIC_RATE
, 0x0000013f },
334 { RT2860_REG_HT_BASIC_RATE
, 0x00008003 },
335 { RT2860_REG_SYS_CTRL
, 0x00000000 },
336 { RT2860_REG_RX_FILTER_CFG
, 0x00017f97 },
337 { RT2860_REG_BKOFF_SLOT_CFG
, 0x00000209 },
338 { RT2860_REG_TX_SW_CFG0
, 0x00000000 },
339 { RT2860_REG_TX_SW_CFG1
, 0x00080606 },
340 { RT2860_REG_TX_LINK_CFG
, 0x00001020 },
341 { RT2860_REG_TX_TIMEOUT_CFG
, 0x000a2090 },
342 { RT2860_REG_MAX_LEN_CFG
, (1 << 12) | RT2860_MAX_AGG_SIZE
},
343 { RT2860_REG_LED_CFG
, 0x7f031e46 },
344 { RT2860_REG_PBF_MAX_PCNT
, 0x1f3fbf9f },
345 { RT2860_REG_TX_RTY_CFG
, 0x47d01f0f },
346 { RT2860_REG_AUTO_RSP_CFG
, 0x00000013 },
347 { RT2860_REG_TX_CCK_PROT_CFG
, 0x05740003 },
348 { RT2860_REG_TX_OFDM_PROT_CFG
, 0x05740003 },
349 { RT2860_REG_TX_GF20_PROT_CFG
, 0x01744004 },
350 { RT2860_REG_TX_GF40_PROT_CFG
, 0x03f44084 },
351 { RT2860_REG_TX_MM20_PROT_CFG
, 0x01744004 },
352 { RT2860_REG_TX_MM40_PROT_CFG
, 0x03f54084 },
353 { RT2860_REG_TX_TXOP_CTRL_CFG
, 0x0000583f },
354 { RT2860_REG_TX_RTS_CFG
, 0x00092b20 },
355 { RT2860_REG_TX_EXP_ACK_TIME
, 0x002400ca },
356 { RT2860_REG_HCCAPSMP_TXOP_HLDR_ET
, 0x00000002 },
357 { RT2860_REG_XIFS_TIME_CFG
, 0x33a41010 },
358 { RT2860_REG_PWR_PIN_CFG
, 0x00000003 },
359 { RT2860_REG_SCHDMA_WMM_AIFSN_CFG
, 0x00002273 },
360 { RT2860_REG_SCHDMA_WMM_CWMIN_CFG
, 0x00002344 },
361 { RT2860_REG_SCHDMA_WMM_CWMAX_CFG
, 0x000034aa },
364 #define RT2860_DEF_MAC_SIZE (sizeof(rt2860_def_mac) / sizeof(rt2860_def_mac[0]))
389 #define RT2860_DEF_BBP_SIZE (sizeof(rt2860_def_bbp) / sizeof(rt2860_def_bbp[0]))
391 SYSCTL_NODE(_hw
, OID_AUTO
, rt2860
, CTLFLAG_RD
, 0, "RT2860 driver parameters");
394 static int rt2860_debug
= 0;
395 SYSCTL_INT(_hw_rt2860
, OID_AUTO
, debug
, CTLFLAG_RW
, &rt2860_debug
, 0, "rt2860 debug level");
396 TUNABLE_INT("hw.rt2860.debug", &rt2860_debug
);
402 static int rt2860_probe(device_t dev
)
404 const struct rt2860_pci_ident
*ident
;
406 for (ident
= rt2860_pci_ids
; ident
->name
!= NULL
; ident
++)
408 if (pci_get_vendor(dev
) == ident
->vendor
&&
409 pci_get_device(dev
) == ident
->device
)
411 device_set_desc(dev
, ident
->name
);
422 static int rt2860_attach(device_t dev
)
424 struct rt2860_softc
*sc
;
426 struct ieee80211com
*ic
;
427 int error
, ntries
, i
;
429 sc
= device_get_softc(dev
);
431 if (pci_get_powerstate(dev
) != PCI_POWERSTATE_D0
)
433 printf("%s: chip is in D%d power mode, setting to D0\n",
434 device_get_nameunit(dev
), pci_get_powerstate(dev
));
435 pci_set_powerstate(dev
, PCI_POWERSTATE_D0
);
438 /* enable bus-mastering */
440 pci_enable_busmaster(dev
);
444 mtx_init(&sc
->lock
, device_get_nameunit(dev
),
445 MTX_NETWORK_LOCK
, MTX_DEF
| MTX_RECURSE
);
447 sc
->mem_rid
= PCIR_BAR(0);
448 sc
->mem
= bus_alloc_resource_any(dev
, SYS_RES_MEMORY
,
449 &sc
->mem_rid
, RF_ACTIVE
);
452 printf("%s: could not allocate memory resource\n",
453 device_get_nameunit(dev
));
458 sc
->bst
= rman_get_bustag(sc
->mem
);
459 sc
->bsh
= rman_get_bushandle(sc
->mem
);
462 sc
->irq
= bus_alloc_resource_any(dev
, SYS_RES_IRQ
,
463 &sc
->irq_rid
, RF_ACTIVE
| RF_SHAREABLE
);
466 printf("%s: could not allocate interrupt resource\n",
467 device_get_nameunit(dev
));
473 sc
->debug
= rt2860_debug
;
475 SYSCTL_ADD_INT(device_get_sysctl_ctx(dev
),
476 SYSCTL_CHILDREN(device_get_sysctl_tree(dev
)), OID_AUTO
,
477 "debug", CTLFLAG_RW
, &sc
->debug
, 0, "rt2860 debug level");
480 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
482 device_get_nameunit(sc
->dev
));
484 /* wait for NIC to initialize */
486 for (ntries
= 0; ntries
< 100; ntries
++)
488 sc
->mac_rev
= rt2860_io_mac_read(sc
, RT2860_REG_MAC_CSR0
);
489 if (sc
->mac_rev
!= 0x00000000 && sc
->mac_rev
!= 0xffffffff)
497 printf("%s: timeout waiting for NIC to initialize\n",
498 device_get_nameunit(dev
));
503 rt2860_read_eeprom(sc
);
505 printf("%s: MAC/BBP RT2860 (rev 0x%08x), RF %s\n",
506 device_get_nameunit(sc
->dev
), sc
->mac_rev
,
507 rt2860_rf_name(sc
->rf_rev
));
509 /* allocate Tx and Rx rings */
511 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
513 error
= rt2860_alloc_tx_ring(sc
, &sc
->tx_ring
[i
], i
);
516 printf("%s: could not allocate Tx ring #%d\n",
517 device_get_nameunit(sc
->dev
), i
);
522 sc
->tx_ring_mgtqid
= 5;
524 error
= rt2860_alloc_rx_ring(sc
, &sc
->rx_ring
);
527 printf("%s: could not allocate Rx ring\n",
528 device_get_nameunit(sc
->dev
));
532 callout_init(&sc
->periodic_ch
, 0);
533 callout_init_mtx(&sc
->tx_watchdog_ch
, &sc
->lock
, 0);
535 ifp
= sc
->ifp
= if_alloc(IFT_IEEE80211
);
538 printf("%s: could not if_alloc()\n",
539 device_get_nameunit(sc
->dev
));
546 if_initname(ifp
, "rt2860", device_get_unit(sc
->dev
));
548 ifp
->if_flags
= IFF_BROADCAST
| IFF_SIMPLEX
| IFF_MULTICAST
;
550 ifp
->if_init
= rt2860_init
;
551 ifp
->if_ioctl
= rt2860_ioctl
;
552 ifp
->if_start
= rt2860_start
;
554 IFQ_SET_MAXLEN(&ifp
->if_snd
, IFQ_MAXLEN
);
555 ifp
->if_snd
.ifq_drv_maxlen
= IFQ_MAXLEN
;
556 IFQ_SET_READY(&ifp
->if_snd
);
562 ic
->ic_phytype
= IEEE80211_T_HT
;
563 ic
->ic_opmode
= IEEE80211_M_STA
;
565 ic
->ic_caps
= IEEE80211_C_MONITOR
|
574 IEEE80211_C_SHPREAMBLE
|
581 ic
->ic_cryptocaps
|= IEEE80211_CRYPTO_WEP
|
582 IEEE80211_CRYPTO_TKIP
|
583 IEEE80211_CRYPTO_TKIPMIC
|
584 IEEE80211_CRYPTO_AES_CCM
;
586 ic
->ic_htcaps
= IEEE80211_HTC_HT
|
587 IEEE80211_HTC_AMSDU
| /* A-MSDU Tx */
588 IEEE80211_HTC_AMPDU
| /* A-MPDU Tx */
589 IEEE80211_HTC_SMPS
| /* MIMO power save */
590 IEEE80211_HTCAP_MAXAMSDU_3839
| /* max. A-MSDU Rx length */
591 IEEE80211_HTCAP_CHWIDTH40
| /* HT 40MHz channel width */
592 IEEE80211_HTCAP_GREENFIELD
| /* HT greenfield */
593 IEEE80211_HTCAP_SHORTGI20
| /* HT 20MHz short GI */
594 IEEE80211_HTCAP_SHORTGI40
| /* HT 40MHz short GI */
595 IEEE80211_HTCAP_SMPS_OFF
; /* MIMO power save disabled */
597 /* spatial streams */
599 if (sc
->nrxpath
== 2)
600 ic
->ic_htcaps
|= IEEE80211_HTCAP_RXSTBC_2STREAM
;
601 else if (sc
->nrxpath
== 3)
602 ic
->ic_htcaps
|= IEEE80211_HTCAP_RXSTBC_3STREAM
;
604 ic
->ic_htcaps
|= IEEE80211_HTCAP_RXSTBC_1STREAM
;
607 ic
->ic_htcaps
|= IEEE80211_HTCAP_TXSTBC
;
611 if (sc
->mac_rev
!= 0x28600100)
612 ic
->ic_htcaps
|= IEEE80211_HTCAP_DELBA
;
618 rt2860_init_channels(sc
);
620 rt2860_init_channels_ht40(sc
);
622 ieee80211_ifattach(ic
, sc
->mac_addr
);
624 ic
->ic_vap_create
= rt2860_vap_create
;
625 ic
->ic_vap_delete
= rt2860_vap_delete
;
627 ic
->ic_node_alloc
= rt2860_node_alloc
;
628 ic
->ic_node_getmimoinfo
= rt2860_node_getmimoinfo
;
629 ic
->ic_setregdomain
= rt2860_setregdomain
;
630 ic
->ic_getradiocaps
= rt2860_getradiocaps
;
631 ic
->ic_scan_start
= rt2860_scan_start
;
632 ic
->ic_scan_end
= rt2860_scan_end
;
633 ic
->ic_set_channel
= rt2860_set_channel
;
634 ic
->ic_newassoc
= rt2860_newassoc
;
635 ic
->ic_updateslot
= rt2860_updateslot
;
636 ic
->ic_update_promisc
= rt2860_update_promisc
;
637 ic
->ic_update_mcast
= rt2860_update_mcast
;
638 ic
->ic_wme
.wme_update
= rt2860_wme_update
;
639 ic
->ic_raw_xmit
= rt2860_raw_xmit
;
641 sc
->recv_action
= ic
->ic_recv_action
;
642 ic
->ic_recv_action
= rt2860_recv_action
;
644 sc
->send_action
= ic
->ic_send_action
;
645 ic
->ic_send_action
= rt2860_send_action
;
647 /* hardware requires padding between 802.11 frame header and body */
649 ic
->ic_flags
|= IEEE80211_F_DATAPAD
| IEEE80211_F_DOTH
;
651 ic
->ic_flags_ext
|= IEEE80211_FEXT_SWBMISS
;
653 ieee80211_radiotap_attach(ic
,
654 &sc
->txtap
.ihdr
, sizeof(sc
->txtap
),
655 RT2860_SOFTC_TX_RADIOTAP_PRESENT
,
656 &sc
->rxtap
.ihdr
, sizeof(sc
->rxtap
),
657 RT2860_SOFTC_RX_RADIOTAP_PRESENT
);
659 /* init task queue */
661 TASK_INIT(&sc
->rx_done_task
, 0, rt2860_rx_done_task
, sc
);
662 TASK_INIT(&sc
->tx_done_task
, 0, rt2860_tx_done_task
, sc
);
663 TASK_INIT(&sc
->fifo_sta_full_task
, 0, rt2860_fifo_sta_full_task
, sc
);
664 TASK_INIT(&sc
->periodic_task
, 0, rt2860_periodic_task
, sc
);
666 sc
->rx_process_limit
= 100;
668 sc
->taskqueue
= taskqueue_create("rt2860_taskq", M_NOWAIT
,
669 taskqueue_thread_enqueue
, &sc
->taskqueue
);
671 taskqueue_start_threads(&sc
->taskqueue
, 1, PI_NET
, "%s taskq",
672 device_get_nameunit(sc
->dev
));
674 rt2860_sysctl_attach(sc
);
677 ieee80211_announce(ic
);
679 /* set up interrupt */
681 error
= bus_setup_intr(dev
, sc
->irq
, INTR_TYPE_NET
| INTR_MPSAFE
,
682 NULL
, rt2860_intr
, sc
, &sc
->irqh
);
685 printf("%s: could not set up interrupt\n",
686 device_get_nameunit(dev
));
694 /* free Tx and Rx rings */
696 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
697 rt2860_free_tx_ring(sc
, &sc
->tx_ring
[i
]);
699 rt2860_free_rx_ring(sc
, &sc
->rx_ring
);
701 mtx_destroy(&sc
->lock
);
704 bus_release_resource(dev
, SYS_RES_MEMORY
, sc
->mem_rid
, sc
->mem
);
707 bus_release_resource(dev
, SYS_RES_IRQ
, sc
->irq_rid
, sc
->irq
);
715 static int rt2860_detach(device_t dev
)
717 struct rt2860_softc
*sc
;
719 struct ieee80211com
*ic
;
722 sc
= device_get_softc(dev
);
726 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
728 device_get_nameunit(sc
->dev
));
730 RT2860_SOFTC_LOCK(sc
);
732 ifp
->if_drv_flags
&= ~(IFF_DRV_RUNNING
| IFF_DRV_OACTIVE
);
734 callout_stop(&sc
->periodic_ch
);
735 callout_stop(&sc
->tx_watchdog_ch
);
737 taskqueue_drain(sc
->taskqueue
, &sc
->rx_done_task
);
738 taskqueue_drain(sc
->taskqueue
, &sc
->tx_done_task
);
739 taskqueue_drain(sc
->taskqueue
, &sc
->fifo_sta_full_task
);
740 taskqueue_drain(sc
->taskqueue
, &sc
->periodic_task
);
742 /* free Tx and Rx rings */
744 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
745 rt2860_free_tx_ring(sc
, &sc
->tx_ring
[i
]);
747 rt2860_free_rx_ring(sc
, &sc
->rx_ring
);
749 RT2860_SOFTC_UNLOCK(sc
);
751 ieee80211_ifdetach(ic
);
755 taskqueue_free(sc
->taskqueue
);
757 mtx_destroy(&sc
->lock
);
759 bus_generic_detach(dev
);
761 bus_teardown_intr(dev
, sc
->irq
, sc
->irqh
);
763 bus_release_resource(dev
, SYS_RES_IRQ
, sc
->irq_rid
, sc
->irq
);
765 bus_release_resource(dev
, SYS_RES_MEMORY
, sc
->mem_rid
, sc
->mem
);
773 static int rt2860_shutdown(device_t dev
)
775 struct rt2860_softc
*sc
;
777 sc
= device_get_softc(dev
);
779 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
780 "%s: shutting down\n",
781 device_get_nameunit(sc
->dev
));
785 sc
->flags
&= ~RT2860_SOFTC_FLAGS_UCODE_LOADED
;
793 static int rt2860_suspend(device_t dev
)
795 struct rt2860_softc
*sc
;
797 sc
= device_get_softc(dev
);
799 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
801 device_get_nameunit(sc
->dev
));
805 sc
->flags
&= ~RT2860_SOFTC_FLAGS_UCODE_LOADED
;
813 static int rt2860_resume(device_t dev
)
815 struct rt2860_softc
*sc
;
818 sc
= device_get_softc(dev
);
821 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
823 device_get_nameunit(sc
->dev
));
825 if (ifp
->if_flags
& IFF_UP
)
832 * rt2860_init_channels
834 static void rt2860_init_channels(struct rt2860_softc
*sc
)
837 struct ieee80211com
*ic
;
838 struct ieee80211_channel
*c
;
844 /* set supported channels for 2GHz band */
846 for (i
= 1; i
<= 14; i
++)
848 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
849 flags
= IEEE80211_CHAN_B
;
851 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
855 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
856 flags
= IEEE80211_CHAN_B
| IEEE80211_CHAN_HT20
;
858 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
862 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
863 flags
= IEEE80211_CHAN_G
;
865 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
869 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
870 flags
= IEEE80211_CHAN_G
| IEEE80211_CHAN_HT20
;
872 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
877 /* set supported channels for 5GHz band */
879 if (sc
->rf_rev
== RT2860_EEPROM_RF_2850
||
880 sc
->rf_rev
== RT2860_EEPROM_RF_2750
)
882 for (i
= 36; i
<= 64; i
+= 4)
884 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
885 flags
= IEEE80211_CHAN_A
;
887 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
891 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
892 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT20
;
894 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
899 for (i
= 100; i
<= 140; i
+= 4)
901 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
902 flags
= IEEE80211_CHAN_A
;
904 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
908 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
909 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT20
;
911 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
916 for (i
= 149; i
<= 165; i
+= 4)
918 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
919 flags
= IEEE80211_CHAN_A
;
921 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
925 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
926 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT20
;
928 c
->ic_freq
= ieee80211_ieee2mhz(i
, flags
);
936 * rt2860_init_channels_ht40
938 static void rt2860_init_channels_ht40(struct rt2860_softc
*sc
)
941 struct ieee80211com
*ic
;
942 struct ieee80211_channel
*c
, *cent
, *ext
;
948 /* set supported channels for 2GHz band */
950 for (i
= 1; i
<= 14; i
++)
952 flags
= IEEE80211_CHAN_G
| IEEE80211_CHAN_HT40
;
954 /* find the center channel */
956 cent
= ieee80211_find_channel_byieee(ic
, i
,
957 flags
& ~IEEE80211_CHAN_HT
);
960 printf("%s: skip channel %d, could not find center channel\n",
961 device_get_nameunit(sc
->dev
), i
);
965 /* find the extension channel */
967 ext
= ieee80211_find_channel(ic
, cent
->ic_freq
+ 20,
968 flags
& ~IEEE80211_CHAN_HT
);
971 printf("%s: skip channel %d, could not find extension channel\n",
972 device_get_nameunit(sc
->dev
), i
);
976 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
979 c
->ic_extieee
= ext
->ic_ieee
;
980 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
981 c
->ic_flags
|= IEEE80211_CHAN_HT40U
;
983 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
986 c
->ic_extieee
= cent
->ic_ieee
;
987 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
988 c
->ic_flags
|= IEEE80211_CHAN_HT40D
;
991 /* set supported channels for 5GHz band */
993 if (sc
->rf_rev
== RT2860_EEPROM_RF_2850
||
994 sc
->rf_rev
== RT2860_EEPROM_RF_2750
)
996 for (i
= 36; i
<= 64; i
+= 4)
998 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT40
;
1000 /* find the center channel */
1002 cent
= ieee80211_find_channel_byieee(ic
, i
,
1003 flags
& ~IEEE80211_CHAN_HT
);
1006 printf("%s: skip channel %d, could not find center channel\n",
1007 device_get_nameunit(sc
->dev
), i
);
1011 /* find the extension channel */
1013 ext
= ieee80211_find_channel(ic
, cent
->ic_freq
+ 20,
1014 flags
& ~IEEE80211_CHAN_HT
);
1017 printf("%s: skip channel %d, could not find extension channel\n",
1018 device_get_nameunit(sc
->dev
), i
);
1022 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1025 c
->ic_extieee
= ext
->ic_ieee
;
1026 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1027 c
->ic_flags
|= IEEE80211_CHAN_HT40U
;
1029 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1032 c
->ic_extieee
= cent
->ic_ieee
;
1033 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1034 c
->ic_flags
|= IEEE80211_CHAN_HT40D
;
1037 for (i
= 100; i
<= 140; i
+= 4)
1039 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT40
;
1041 /* find the center channel */
1043 cent
= ieee80211_find_channel_byieee(ic
, i
,
1044 flags
& ~IEEE80211_CHAN_HT
);
1047 printf("%s: skip channel %d, could not find center channel\n",
1048 device_get_nameunit(sc
->dev
), i
);
1052 /* find the extension channel */
1054 ext
= ieee80211_find_channel(ic
, cent
->ic_freq
+ 20,
1055 flags
& ~IEEE80211_CHAN_HT
);
1058 printf("%s: skip channel %d, could not find extension channel\n",
1059 device_get_nameunit(sc
->dev
), i
);
1063 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1066 c
->ic_extieee
= ext
->ic_ieee
;
1067 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1068 c
->ic_flags
|= IEEE80211_CHAN_HT40U
;
1070 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1073 c
->ic_extieee
= cent
->ic_ieee
;
1074 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1075 c
->ic_flags
|= IEEE80211_CHAN_HT40D
;
1078 for (i
= 149; i
<= 165; i
+= 4)
1080 flags
= IEEE80211_CHAN_A
| IEEE80211_CHAN_HT40
;
1082 /* find the center channel */
1084 cent
= ieee80211_find_channel_byieee(ic
, i
,
1085 flags
& ~IEEE80211_CHAN_HT
);
1088 printf("%s: skip channel %d, could not find center channel\n",
1089 device_get_nameunit(sc
->dev
), i
);
1093 /* find the extension channel */
1095 ext
= ieee80211_find_channel(ic
, cent
->ic_freq
+ 20,
1096 flags
& ~IEEE80211_CHAN_HT
);
1099 printf("%s: skip channel %d, could not find extension channel\n",
1100 device_get_nameunit(sc
->dev
), i
);
1104 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1107 c
->ic_extieee
= ext
->ic_ieee
;
1108 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1109 c
->ic_flags
|= IEEE80211_CHAN_HT40U
;
1111 c
= &ic
->ic_channels
[ic
->ic_nchans
++];
1114 c
->ic_extieee
= cent
->ic_ieee
;
1115 c
->ic_flags
&= ~IEEE80211_CHAN_HT
;
1116 c
->ic_flags
|= IEEE80211_CHAN_HT40D
;
1122 * rt2860_init_locked
1124 static void rt2860_init_locked(void *priv
)
1126 struct rt2860_softc
*sc
;
1128 struct ieee80211com
*ic
;
1129 int error
, i
, ntries
;
1130 uint32_t tmp
, stacnt
[6];
1136 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
1137 "%s: initializing\n",
1138 device_get_nameunit(sc
->dev
));
1140 RT2860_SOFTC_ASSERT_LOCKED(sc
);
1142 if (!(sc
->flags
& RT2860_SOFTC_FLAGS_UCODE_LOADED
))
1144 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
1145 "%s: loading 8051 microcode\n",
1146 device_get_nameunit(sc
->dev
));
1148 error
= rt2860_io_mcu_load_ucode(sc
, rt2860_ucode
, sizeof(rt2860_ucode
));
1151 printf("%s: could not load 8051 microcode\n",
1152 device_get_nameunit(sc
->dev
));
1156 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
1157 "%s: 8051 microcode was successfully loaded\n",
1158 device_get_nameunit(sc
->dev
));
1160 sc
->flags
|= RT2860_SOFTC_FLAGS_UCODE_LOADED
;
1163 rt2860_io_mac_write(sc
, RT2860_REG_PWR_PIN_CFG
, 0x2);
1165 /* disable DMA engine */
1167 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
1170 tmp
|= RT2860_REG_TX_WB_DDONE
;
1172 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
1174 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_RST_IDX
, 0xffffffff);
1176 /* PBF hardware reset */
1178 rt2860_io_mac_write(sc
, RT2860_REG_PBF_SYS_CTRL
, 0xe1f);
1179 rt2860_io_mac_write(sc
, RT2860_REG_PBF_SYS_CTRL
, 0xe00);
1181 /* wait while DMA engine is busy */
1183 for (ntries
= 0; ntries
< 100; ntries
++)
1185 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
1186 if (!(tmp
& (RT2860_REG_TX_DMA_BUSY
| RT2860_REG_RX_DMA_BUSY
)))
1194 printf("%s: timeout waiting for DMA engine\n",
1195 device_get_nameunit(sc
->dev
));
1200 tmp
|= RT2860_REG_TX_WB_DDONE
;
1202 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
1204 /* reset Rx and Tx rings */
1206 tmp
= RT2860_REG_RST_IDX_RX
|
1207 RT2860_REG_RST_IDX_TX_MGMT
|
1208 RT2860_REG_RST_IDX_TX_HCCA
|
1209 RT2860_REG_RST_IDX_TX_AC3
|
1210 RT2860_REG_RST_IDX_TX_AC2
|
1211 RT2860_REG_RST_IDX_TX_AC1
|
1212 RT2860_REG_RST_IDX_TX_AC0
;
1214 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_RST_IDX
, tmp
);
1216 /* PBF hardware reset */
1218 rt2860_io_mac_write(sc
, RT2860_REG_PBF_SYS_CTRL
, 0xe1f);
1219 rt2860_io_mac_write(sc
, RT2860_REG_PBF_SYS_CTRL
, 0xe00);
1221 rt2860_io_mac_write(sc
, RT2860_REG_PWR_PIN_CFG
, 0x3);
1223 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
,
1224 RT2860_REG_MAC_SRST
| RT2860_REG_BBP_HRST
);
1225 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
, 0);
1227 /* init Tx power per rate */
1229 for (i
= 0; i
< RT2860_SOFTC_TXPOW_RATE_COUNT
; i
++)
1231 if (sc
->txpow_rate_20mhz
[i
] == 0xffffffff)
1234 rt2860_io_mac_write(sc
, RT2860_REG_TX_PWR_CFG(i
),
1235 sc
->txpow_rate_20mhz
[i
]);
1238 for (i
= 0; i
< RT2860_DEF_MAC_SIZE
; i
++)
1239 rt2860_io_mac_write(sc
, rt2860_def_mac
[i
].reg
,
1240 rt2860_def_mac
[i
].val
);
1242 /* wait while MAC is busy */
1244 for (ntries
= 0; ntries
< 100; ntries
++)
1246 if (!(rt2860_io_mac_read(sc
, RT2860_REG_STATUS_CFG
) &
1247 (RT2860_REG_STATUS_TX_BUSY
| RT2860_REG_STATUS_RX_BUSY
)))
1255 printf("%s: timeout waiting for MAC\n",
1256 device_get_nameunit(sc
->dev
));
1260 /* clear Host to MCU mailbox */
1262 rt2860_io_mac_write(sc
, RT2860_REG_H2M_MAILBOX_BBP_AGENT
, 0);
1263 rt2860_io_mac_write(sc
, RT2860_REG_H2M_MAILBOX
, 0);
1265 rt2860_io_mcu_cmd(sc
, RT2860_IO_MCU_CMD_BOOT
,
1266 RT2860_REG_H2M_TOKEN_NO_INTR
, 0);
1270 error
= rt2860_init_bbp(sc
);
1274 /* set up maximum buffer sizes */
1276 tmp
= (1 << 12) | RT2860_MAX_AGG_SIZE
;
1278 rt2860_io_mac_write(sc
, RT2860_REG_MAX_LEN_CFG
, tmp
);
1280 if (sc
->mac_rev
== 0x28720200)
1282 /* set max. PSDU length from 16K to 32K bytes */
1284 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_MAX_LEN_CFG
);
1289 rt2860_io_mac_write(sc
, RT2860_REG_MAX_LEN_CFG
, tmp
);
1292 if (sc
->mac_rev
>= 0x28720200 && sc
->mac_rev
< 0x30700200)
1294 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_MAX_LEN_CFG
);
1299 rt2860_io_mac_write(sc
, RT2860_REG_MAX_LEN_CFG
, tmp
);
1302 /* set mac address */
1304 rt2860_asic_set_macaddr(sc
, IF_LLADDR(ifp
));
1306 /* clear statistic registers */
1308 rt2860_io_mac_read_multi(sc
, RT2860_REG_RX_STA_CNT0
,
1309 stacnt
, sizeof(stacnt
));
1311 /* set RTS threshold */
1313 rt2860_asic_update_rtsthreshold(sc
);
1317 rt2860_asic_update_txpower(sc
);
1319 /* set up protection mode */
1321 sc
->tx_ampdu_sessions
= 0;
1323 rt2860_asic_updateprot(sc
);
1325 /* clear beacon frame space (entries = 8, entry size = 512) */
1327 rt2860_io_mac_set_region_4(sc
, RT2860_REG_BEACON_BASE(0), 0, 1024);
1329 taskqueue_unblock(sc
->taskqueue
);
1331 /* init Tx rings (4 EDCAs + HCCA + MGMT) */
1333 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
1334 rt2860_reset_tx_ring(sc
, &sc
->tx_ring
[i
]);
1336 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
1338 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_BASE_PTR(i
),
1339 sc
->tx_ring
[i
].desc_phys_addr
);
1340 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_MAX_CNT(i
),
1341 RT2860_SOFTC_TX_RING_DESC_COUNT
);
1342 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_CTX_IDX(i
), 0);
1347 rt2860_reset_rx_ring(sc
, &sc
->rx_ring
);
1349 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_BASE_PTR
,
1350 sc
->rx_ring
.desc_phys_addr
);
1351 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_MAX_CNT
,
1352 RT2860_SOFTC_RX_RING_DATA_COUNT
);
1353 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
1354 RT2860_SOFTC_RX_RING_DATA_COUNT
- 1);
1356 /* wait while DMA engine is busy */
1358 for (ntries
= 0; ntries
< 100; ntries
++)
1360 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
1361 if (!(tmp
& (RT2860_REG_TX_DMA_BUSY
| RT2860_REG_RX_DMA_BUSY
)))
1369 printf("%s: timeout waiting for DMA engine\n",
1370 device_get_nameunit(sc
->dev
));
1375 tmp
|= RT2860_REG_TX_WB_DDONE
;
1377 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
1379 /* disable interrupts mitigation */
1381 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_DELAY_INT_CFG
, 0);
1383 /* send LEDs operating mode to microcontroller */
1385 rt2860_io_mcu_cmd(sc
, RT2860_IO_MCU_CMD_LED1
,
1386 RT2860_REG_H2M_TOKEN_NO_INTR
, sc
->led_off
[0]);
1387 rt2860_io_mcu_cmd(sc
, RT2860_IO_MCU_CMD_LED2
,
1388 RT2860_REG_H2M_TOKEN_NO_INTR
, sc
->led_off
[1]);
1389 rt2860_io_mcu_cmd(sc
, RT2860_IO_MCU_CMD_LED3
,
1390 RT2860_REG_H2M_TOKEN_NO_INTR
, sc
->led_off
[2]);
1392 /* turn radio LED on */
1394 rt2860_led_cmd(sc
, RT2860_LED_CMD_RADIO_ON
);
1396 /* write vendor-specific BBP values (from EEPROM) */
1398 for (i
= 0; i
< RT2860_SOFTC_BBP_EEPROM_COUNT
; i
++)
1400 if (sc
->bbp_eeprom
[i
].reg
== 0x00 ||
1401 sc
->bbp_eeprom
[i
].reg
== 0xff)
1404 rt2860_io_bbp_write(sc
, sc
->bbp_eeprom
[i
].reg
,
1405 sc
->bbp_eeprom
[i
].val
);
1409 tmp = rt2860_io_mac_read(sc, RT2860_REG_SCHDMA_GPIO_CTRL_CFG);
1412 rt2860_io_mcu_cmd(sc, RT2860_IO_MCU_CMD_SLEEP,
1413 RT2860_REG_H2M_TOKEN_RADIOOFF, 0x02ff);
1414 rt2860_io_mcu_cmd_check(sc, RT2860_REG_H2M_TOKEN_RADIOOFF);
1416 rt2860_io_mcu_cmd(sc, RT2860_IO_MCU_CMD_WAKEUP,
1417 RT2860_REG_H2M_TOKEN_WAKEUP, 0);
1418 rt2860_io_mcu_cmd_check(sc, RT2860_REG_H2M_TOKEN_WAKEUP);
1422 /* disable non-existing Rx chains */
1424 tmp
= rt2860_io_bbp_read(sc
, 3);
1426 tmp
&= ~((1 << 4) | (1 << 3));
1428 if (sc
->nrxpath
== 3)
1430 else if (sc
->nrxpath
== 2)
1433 rt2860_io_bbp_write(sc
, 3, tmp
);
1435 /* disable non-existing Tx chains */
1437 tmp
= rt2860_io_bbp_read(sc
, 1);
1439 tmp
&= ~((1 << 4) | (1 << 3));
1441 if (sc
->ntxpath
== 2)
1444 rt2860_io_bbp_write(sc
, 1, tmp
);
1446 /* set current channel */
1448 rt2860_rf_set_chan(sc
, ic
->ic_curchan
);
1450 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_TXOP0_CFG
, 0);
1451 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_TXOP1_CFG
,
1454 if ((sc
->mac_rev
& 0xffff) != 0x0101)
1455 rt2860_io_mac_write(sc
, RT2860_REG_TX_TXOP_CTRL_CFG
, 0x583f);
1457 /* clear pending interrupts */
1459 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_STATUS
, 0xffffffff);
1461 /* enable interrupts */
1463 tmp
= RT2860_REG_INT_TX_COHERENT
|
1464 RT2860_REG_INT_RX_COHERENT
|
1465 RT2860_REG_INT_GP_TIMER
|
1466 RT2860_REG_INT_AUTO_WAKEUP
|
1467 RT2860_REG_INT_FIFO_STA_FULL
|
1469 RT2860_REG_INT_PRE_TBTT |
1470 RT2860_REG_INT_TBTT |
1472 RT2860_REG_INT_TXRX_COHERENT
|
1473 RT2860_REG_INT_MCU_CMD
|
1474 RT2860_REG_INT_TX_MGMT_DONE
|
1475 RT2860_REG_INT_TX_HCCA_DONE
|
1476 RT2860_REG_INT_TX_AC3_DONE
|
1477 RT2860_REG_INT_TX_AC2_DONE
|
1478 RT2860_REG_INT_TX_AC1_DONE
|
1479 RT2860_REG_INT_TX_AC0_DONE
|
1480 RT2860_REG_INT_RX_DONE
;
1482 sc
->intr_enable_mask
= tmp
;
1484 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_MASK
, tmp
);
1486 if (rt2860_txrx_enable(sc
) != 0)
1489 /* clear garbage interrupts */
1491 tmp
= rt2860_io_mac_read(sc
, 0x1300);
1493 ifp
->if_drv_flags
&= ~IFF_DRV_OACTIVE
;
1494 ifp
->if_drv_flags
|= IFF_DRV_RUNNING
;
1496 sc
->periodic_round
= 0;
1498 callout_reset(&sc
->periodic_ch
, hz
/ 10, rt2860_periodic
, sc
);
1504 rt2860_stop_locked(sc
);
1510 static void rt2860_init(void *priv
)
1512 struct rt2860_softc
*sc
;
1516 RT2860_SOFTC_LOCK(sc
);
1518 rt2860_init_locked(sc
);
1520 RT2860_SOFTC_UNLOCK(sc
);
1526 static int rt2860_init_bbp(struct rt2860_softc
*sc
)
1531 for (ntries
= 0; ntries
< 20; ntries
++)
1533 tmp
= rt2860_io_bbp_read(sc
, 0);
1534 if (tmp
!= 0x00 && tmp
!= 0xff)
1538 if (tmp
== 0x00 || tmp
== 0xff)
1540 printf("%s: timeout waiting for BBP to wakeup\n",
1541 device_get_nameunit(sc
->dev
));
1545 for (i
= 0; i
< RT2860_DEF_BBP_SIZE
; i
++)
1546 rt2860_io_bbp_write(sc
, rt2860_def_bbp
[i
].reg
,
1547 rt2860_def_bbp
[i
].val
);
1549 if ((sc
->mac_rev
& 0xffff) != 0x0101)
1550 rt2860_io_bbp_write(sc
, 84, 0x19);
1552 if (sc
->mac_rev
== 0x28600100)
1554 rt2860_io_bbp_write(sc
, 69, 0x16);
1555 rt2860_io_bbp_write(sc
, 73, 0x12);
1562 * rt2860_stop_locked
1564 static void rt2860_stop_locked(void *priv
)
1566 struct rt2860_softc
*sc
;
1568 struct ieee80211com
*ic
;
1575 RT2860_DPRINTF(sc
, RT2860_DEBUG_ANY
,
1577 device_get_nameunit(sc
->dev
));
1579 RT2860_SOFTC_ASSERT_LOCKED(sc
);
1583 if (ifp
->if_drv_flags
& IFF_DRV_RUNNING
)
1584 rt2860_led_cmd(sc
, RT2860_LED_CMD_RADIO_OFF
);
1586 ifp
->if_drv_flags
&= ~(IFF_DRV_RUNNING
| IFF_DRV_OACTIVE
);
1588 callout_stop(&sc
->periodic_ch
);
1589 callout_stop(&sc
->tx_watchdog_ch
);
1591 RT2860_SOFTC_UNLOCK(sc
);
1593 taskqueue_block(sc
->taskqueue
);
1595 taskqueue_drain(sc
->taskqueue
, &sc
->rx_done_task
);
1596 taskqueue_drain(sc
->taskqueue
, &sc
->tx_done_task
);
1597 taskqueue_drain(sc
->taskqueue
, &sc
->fifo_sta_full_task
);
1598 taskqueue_drain(sc
->taskqueue
, &sc
->periodic_task
);
1600 RT2860_SOFTC_LOCK(sc
);
1602 /* clear key tables */
1604 rt2860_asic_clear_keytables(sc
);
1606 /* disable interrupts */
1608 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_MASK
, 0);
1612 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SYS_CTRL
);
1614 tmp
&= ~(RT2860_REG_RX_ENABLE
| RT2860_REG_TX_ENABLE
);
1616 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
, tmp
);
1620 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
,
1621 RT2860_REG_MAC_SRST
| RT2860_REG_BBP_HRST
);
1622 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
, 0);
1628 static void rt2860_stop(void *priv
)
1630 struct rt2860_softc
*sc
;
1634 RT2860_SOFTC_LOCK(sc
);
1636 rt2860_stop_locked(sc
);
1638 RT2860_SOFTC_UNLOCK(sc
);
1644 static void rt2860_start(struct ifnet
*ifp
)
1646 struct rt2860_softc
*sc
;
1647 struct ieee80211_node
*ni
;
1653 RT2860_SOFTC_LOCK(sc
);
1655 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
1657 RT2860_SOFTC_UNLOCK(sc
);
1663 IF_POLL(&ifp
->if_snd
, m
);
1667 IFQ_DRV_DEQUEUE(&ifp
->if_snd
, m
);
1669 ni
= (struct ieee80211_node
*) m
->m_pkthdr
.rcvif
;
1671 qid
= M_WME_GETAC(m
);
1673 if (sc
->tx_ring
[qid
].data_queued
>= RT2860_SOFTC_TX_RING_DATA_COUNT
)
1675 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
1676 "%s: if_start: Tx ring with qid=%d is full\n",
1677 device_get_nameunit(sc
->dev
), qid
);
1680 ieee80211_free_node(ni
);
1682 ifp
->if_drv_flags
|= IFF_DRV_OACTIVE
;
1685 sc
->tx_data_queue_full
[qid
]++;
1690 if (rt2860_tx_data(sc
, m
, ni
, qid
) != 0)
1692 ieee80211_free_node(ni
);
1699 rt2860_drain_fifo_stats(sc
);
1701 sc
->tx_timer
= RT2860_TX_WATCHDOG_TIMEOUT
;
1703 callout_reset(&sc
->tx_watchdog_ch
, hz
, rt2860_tx_watchdog
, sc
);
1706 RT2860_SOFTC_UNLOCK(sc
);
1712 static int rt2860_ioctl(struct ifnet
*ifp
, u_long cmd
, caddr_t data
)
1714 struct rt2860_softc
*sc
;
1715 struct ieee80211com
*ic
;
1717 int error
, startall
;
1721 ifr
= (struct ifreq
*) data
;
1730 RT2860_SOFTC_LOCK(sc
);
1732 if (ifp
->if_flags
& IFF_UP
)
1734 if (ifp
->if_drv_flags
& IFF_DRV_RUNNING
)
1736 if ((ifp
->if_flags
^ sc
->if_flags
) & IFF_PROMISC
)
1737 rt2860_asic_update_promisc(sc
);
1741 rt2860_init_locked(sc
);
1747 if (ifp
->if_drv_flags
& IFF_DRV_RUNNING
)
1748 rt2860_stop_locked(sc
);
1751 sc
->if_flags
= ifp
->if_flags
;
1753 RT2860_SOFTC_UNLOCK(sc
);
1756 ieee80211_start_all(ic
);
1761 error
= ifmedia_ioctl(ifp
, ifr
, &ic
->ic_media
, cmd
);
1765 error
= ether_ioctl(ifp
, cmd
, data
);
1779 static struct ieee80211vap
*rt2860_vap_create(struct ieee80211com
*ic
,
1780 const char name
[IFNAMSIZ
], int unit
, int opmode
, int flags
,
1781 const uint8_t bssid
[IEEE80211_ADDR_LEN
],
1782 const uint8_t mac
[IEEE80211_ADDR_LEN
])
1784 struct rt2860_softc
*sc
;
1786 struct rt2860_softc_vap
*rvap
;
1787 struct ieee80211vap
*vap
;
1792 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
1793 "%s: VAP create: opmode=%s\n",
1794 device_get_nameunit(sc
->dev
),
1795 ieee80211_opmode_name
[opmode
]);
1799 case IEEE80211_M_MONITOR
:
1800 case IEEE80211_M_IBSS
:
1801 case IEEE80211_M_STA
:
1802 case IEEE80211_M_AHDEMO
:
1803 case IEEE80211_M_HOSTAP
:
1804 case IEEE80211_M_MBSS
:
1805 if (!TAILQ_EMPTY(&ic
->ic_vaps
))
1807 if_printf(ifp
, "only 1 VAP supported\n");
1811 if (opmode
== IEEE80211_M_STA
)
1812 flags
|= IEEE80211_CLONE_NOBEACONS
;
1815 case IEEE80211_M_WDS
:
1816 if (TAILQ_EMPTY(&ic
->ic_vaps
) || ic
->ic_opmode
!= IEEE80211_M_HOSTAP
)
1818 if_printf(ifp
, "WDS only supported in AP mode\n");
1822 flags
&= ~IEEE80211_CLONE_BSSID
;
1826 if_printf(ifp
, "unknown opmode %d\n", opmode
);
1830 rvap
= (struct rt2860_softc_vap
*) malloc(sizeof(struct rt2860_softc_vap
),
1831 M_80211_VAP
, M_NOWAIT
| M_ZERO
);
1837 ieee80211_vap_setup(ic
, vap
, name
, unit
, opmode
, flags
, bssid
, mac
);
1839 rvap
->newstate
= vap
->iv_newstate
;
1840 vap
->iv_newstate
= rt2860_vap_newstate
;
1842 vap
->iv_reset
= rt2860_vap_reset
;
1843 vap
->iv_key_update_begin
= rt2860_vap_key_update_begin
;
1844 vap
->iv_key_update_end
= rt2860_vap_key_update_end
;
1845 vap
->iv_key_set
= rt2860_vap_key_set
;
1846 vap
->iv_key_delete
= rt2860_vap_key_delete
;
1847 vap
->iv_update_beacon
= rt2860_vap_update_beacon
;
1849 rt2860_amrr_init(&rvap
->amrr
, vap
,
1851 RT2860_AMRR_MIN_SUCCESS_THRESHOLD
,
1852 RT2860_AMRR_MAX_SUCCESS_THRESHOLD
,
1855 ieee80211_vap_attach(vap
, rt2860_media_change
, ieee80211_media_status
);
1857 /* override default Rx A-MPDU factor */
1859 vap
->iv_ampdu_rxmax
= IEEE80211_HTCAP_MAXRXAMPDU_32K
;
1860 vap
->iv_ampdu_density
= IEEE80211_HTCAP_MPDUDENSITY_NA
;
1861 vap
->iv_ampdu_limit
= vap
->iv_ampdu_rxmax
;
1863 ic
->ic_opmode
= opmode
;
1871 static void rt2860_vap_delete(struct ieee80211vap
*vap
)
1873 struct rt2860_softc
*sc
;
1874 struct ieee80211com
*ic
;
1876 struct rt2860_softc_vap
*rvap
;
1881 rvap
= (struct rt2860_softc_vap
*) vap
;
1883 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
1884 "%s: VAP delete: opmode=%s\n",
1885 device_get_nameunit(sc
->dev
),
1886 ieee80211_opmode_name
[vap
->iv_opmode
]);
1888 rt2860_amrr_cleanup(&rvap
->amrr
);
1890 ieee80211_vap_detach(vap
);
1892 if (rvap
->beacon_mbuf
!= NULL
)
1894 m_free(rvap
->beacon_mbuf
);
1895 rvap
->beacon_mbuf
= NULL
;
1898 free(rvap
, M_80211_VAP
);
1904 static int rt2860_vap_reset(struct ieee80211vap
*vap
, u_long cmd
)
1906 struct rt2860_softc
*sc
;
1907 struct ieee80211com
*ic
;
1909 struct rt2860_softc_vap
*rvap
;
1915 rvap
= (struct rt2860_softc_vap
*) vap
;
1917 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
1918 "%s: VAP reset: cmd=%lu\n",
1919 device_get_nameunit(sc
->dev
), cmd
);
1925 case IEEE80211_IOC_RTSTHRESHOLD
:
1926 case IEEE80211_IOC_AMSDU
:
1927 rt2860_asic_update_rtsthreshold(sc
);
1930 case IEEE80211_IOC_PROTMODE
:
1931 case IEEE80211_IOC_HTPROTMODE
:
1932 rt2860_asic_updateprot(sc
);
1935 case IEEE80211_IOC_TXPOWER
:
1936 rt2860_asic_update_txpower(sc
);
1939 case IEEE80211_IOC_BURST
:
1940 rt2860_asic_updateslot(sc
);
1943 case IEEE80211_IOC_SHORTGI
:
1944 case IEEE80211_IOC_AMPDU_DENSITY
:
1945 case IEEE80211_IOC_SMPS
:
1957 * rt2860_vap_newstate
1959 static int rt2860_vap_newstate(struct ieee80211vap
*vap
,
1960 enum ieee80211_state nstate
, int arg
)
1962 struct rt2860_softc
*sc
;
1963 struct ieee80211com
*ic
;
1965 struct rt2860_softc_vap
*rvap
;
1966 struct ieee80211_node
*ni
;
1967 enum ieee80211_state ostate
;
1973 rvap
= (struct rt2860_softc_vap
*) vap
;
1975 ostate
= vap
->iv_state
;
1977 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
1978 "%s: VAP newstate: %s -> %s\n",
1979 device_get_nameunit(sc
->dev
),
1980 ieee80211_state_name
[ostate
], ieee80211_state_name
[nstate
]);
1982 error
= rvap
->newstate(vap
, nstate
, arg
);
1986 IEEE80211_UNLOCK(ic
);
1988 RT2860_SOFTC_LOCK(sc
);
1990 /* turn link LED off */
1992 if (nstate
!= IEEE80211_S_RUN
)
1993 rt2860_led_cmd(sc
, RT2860_LED_CMD_RADIO_OFF
);
1997 case IEEE80211_S_INIT
:
1998 rt2860_asic_disable_tsf_sync(sc
);
2001 case IEEE80211_S_RUN
:
2004 rt2860_rf_set_chan(sc
, ni
->ni_chan
);
2006 if (vap
->iv_opmode
!= IEEE80211_M_MONITOR
)
2008 rt2860_asic_enable_mrr(sc
);
2009 rt2860_asic_set_txpreamble(sc
);
2010 rt2860_asic_set_basicrates(sc
);
2011 rt2860_asic_update_txpower(sc
);
2012 rt2860_asic_set_bssid(sc
, ni
->ni_bssid
);
2015 if (vap
->iv_opmode
== IEEE80211_M_HOSTAP
||
2016 vap
->iv_opmode
== IEEE80211_M_IBSS
||
2017 vap
->iv_opmode
== IEEE80211_M_MBSS
)
2019 error
= rt2860_beacon_alloc(sc
, vap
);
2023 rt2860_asic_update_beacon(sc
, vap
);
2026 if (vap
->iv_opmode
!= IEEE80211_M_MONITOR
)
2027 rt2860_asic_enable_tsf_sync(sc
);
2029 /* turn link LED on */
2031 if (vap
->iv_opmode
!= IEEE80211_M_MONITOR
)
2033 rt2860_led_cmd(sc
, RT2860_LED_CMD_RADIO_ON
|
2034 (IEEE80211_IS_CHAN_2GHZ(ni
->ni_chan
) ?
2035 RT2860_LED_CMD_LINK_2GHZ
: RT2860_LED_CMD_LINK_5GHZ
));
2043 RT2860_SOFTC_UNLOCK(sc
);
2051 * rt2860_vap_key_update_begin
2053 static void rt2860_vap_key_update_begin(struct ieee80211vap
*vap
)
2055 struct rt2860_softc
*sc
;
2056 struct ieee80211com
*ic
;
2063 RT2860_DPRINTF(sc
, RT2860_DEBUG_KEY
,
2064 "%s: VAP key update begin\n",
2065 device_get_nameunit(sc
->dev
));
2067 taskqueue_block(sc
->taskqueue
);
2069 IF_LOCK(&ifp
->if_snd
);
2073 * rt2860_vap_key_update_end
2075 static void rt2860_vap_key_update_end(struct ieee80211vap
*vap
)
2077 struct rt2860_softc
*sc
;
2078 struct ieee80211com
*ic
;
2085 RT2860_DPRINTF(sc
, RT2860_DEBUG_KEY
,
2086 "%s: VAP key update end\n",
2087 device_get_nameunit(sc
->dev
));
2089 IF_UNLOCK(&ifp
->if_snd
);
2091 taskqueue_unblock(sc
->taskqueue
);
2095 * rt2860_vap_key_set
2097 static int rt2860_vap_key_set(struct ieee80211vap
*vap
,
2098 const struct ieee80211_key
*k
, const uint8_t mac
[IEEE80211_ADDR_LEN
])
2100 struct rt2860_softc
*sc
;
2101 struct ieee80211com
*ic
;
2103 struct ieee80211_node
*ni
;
2104 uint16_t associd
, key_base
, keymode_base
;
2105 uint8_t mode
, vapid
, wcid
, iv
[8];
2108 if (k
->wk_cipher
->ic_cipher
!= IEEE80211_CIPHER_WEP
&&
2109 k
->wk_cipher
->ic_cipher
!= IEEE80211_CIPHER_TKIP
&&
2110 k
->wk_cipher
->ic_cipher
!= IEEE80211_CIPHER_AES_CCM
)
2116 ni
= ieee80211_find_vap_node(&ic
->ic_sta
, vap
, k
->wk_macaddr
);
2117 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
2120 ieee80211_free_node(ni
);
2122 switch (k
->wk_cipher
->ic_cipher
)
2124 case IEEE80211_CIPHER_WEP
:
2125 if(k
->wk_keylen
< 8)
2126 mode
= RT2860_REG_CIPHER_MODE_WEP40
;
2128 mode
= RT2860_REG_CIPHER_MODE_WEP104
;
2131 case IEEE80211_CIPHER_TKIP
:
2132 mode
= RT2860_REG_CIPHER_MODE_TKIP
;
2135 case IEEE80211_CIPHER_AES_CCM
:
2136 mode
= RT2860_REG_CIPHER_MODE_AES_CCMP
;
2143 RT2860_DPRINTF(sc
, RT2860_DEBUG_KEY
,
2144 "%s: VAP key set: keyix=%d, keylen=%d, macaddr=%s, associd=0x%04x, mode=%d, group=%d\n",
2145 device_get_nameunit(sc
->dev
), k
->wk_keyix
, k
->wk_keylen
, ether_sprintf(k
->wk_macaddr
),
2146 associd
, mode
, (k
->wk_flags
& IEEE80211_KEY_GROUP
) ? 1 : 0);
2148 if (!(k
->wk_flags
& IEEE80211_KEY_GROUP
))
2150 /* install pairwise key */
2153 wcid
= RT2860_AID2WCID(associd
);
2154 key_base
= RT2860_REG_PKEY(wcid
);
2156 if (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_WEP
)
2160 iv
[3] = (k
->wk_keyix
<< 6);
2164 if (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_TKIP
)
2166 iv
[0] = (k
->wk_keytsc
>> 8);
2167 iv
[1] = ((iv
[0] | 0x20) & 0x7f);
2168 iv
[2] = k
->wk_keytsc
;
2174 iv
[0] = k
->wk_keytsc
;
2175 iv
[1] = k
->wk_keytsc
>> 8;
2179 iv
[3] = ((k
->wk_keyix
<< 6) | IEEE80211_WEP_EXTIV
);
2180 iv
[4] = (k
->wk_keytsc
>> 16);
2181 iv
[5] = (k
->wk_keytsc
>> 24);
2182 iv
[6] = (k
->wk_keytsc
>> 32);
2183 iv
[7] = (k
->wk_keytsc
>> 40);
2185 RT2860_DPRINTF(sc
, RT2860_DEBUG_KEY
,
2186 "%s: VAP key set: iv=%02x %02x %02x %02x %02x %02x %02x %02x\n",
2187 device_get_nameunit(sc
->dev
),
2188 iv
[0], iv
[1], iv
[2], iv
[3], iv
[4], iv
[5], iv
[6], iv
[7]);
2191 rt2860_io_mac_write_multi(sc
, RT2860_REG_IVEIV(wcid
), iv
, 8);
2193 if (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_TKIP
)
2195 rt2860_io_mac_write_multi(sc
, key_base
, k
->wk_key
, 16);
2197 if (vap
->iv_opmode
!= IEEE80211_M_HOSTAP
)
2199 rt2860_io_mac_write_multi(sc
, key_base
+ 16, &k
->wk_key
[16], 8);
2200 rt2860_io_mac_write_multi(sc
, key_base
+ 24, &k
->wk_key
[24], 8);
2204 rt2860_io_mac_write_multi(sc
, key_base
+ 16, &k
->wk_key
[24], 8);
2205 rt2860_io_mac_write_multi(sc
, key_base
+ 24, &k
->wk_key
[16], 8);
2210 rt2860_io_mac_write_multi(sc
, key_base
, k
->wk_key
, k
->wk_keylen
);
2213 tmp
= ((vapid
& RT2860_REG_VAP_MASK
) << RT2860_REG_VAP_SHIFT
) |
2214 (mode
<< RT2860_REG_CIPHER_MODE_SHIFT
) | RT2860_REG_PKEY_ENABLE
;
2216 rt2860_io_mac_write(sc
, RT2860_REG_WCID_ATTR(wcid
), tmp
);
2219 if ((k
->wk_flags
& IEEE80211_KEY_GROUP
) ||
2220 (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_WEP
))
2222 /* install group key */
2225 wcid
= 0; /* mcast/bcast WCID */
2226 key_base
= RT2860_REG_SKEY(vapid
, k
->wk_keyix
);
2227 keymode_base
= RT2860_REG_SKEY_MODE(vapid
);
2229 if (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_TKIP
)
2231 rt2860_io_mac_write_multi(sc
, key_base
, k
->wk_key
, 16);
2233 if (vap
->iv_opmode
!= IEEE80211_M_HOSTAP
)
2235 rt2860_io_mac_write_multi(sc
, key_base
+ 16, &k
->wk_key
[16], 8);
2236 rt2860_io_mac_write_multi(sc
, key_base
+ 24, &k
->wk_key
[24], 8);
2240 rt2860_io_mac_write_multi(sc
, key_base
+ 16, &k
->wk_key
[24], 8);
2241 rt2860_io_mac_write_multi(sc
, key_base
+ 24, &k
->wk_key
[16], 8);
2246 rt2860_io_mac_write_multi(sc
, key_base
, k
->wk_key
, k
->wk_keylen
);
2249 tmp
= rt2860_io_mac_read(sc
, keymode_base
);
2251 tmp
&= ~(0xf << (k
->wk_keyix
* 4 + 16 * (vapid
% 2)));
2252 tmp
|= (mode
<< (k
->wk_keyix
* 4 + 16 * (vapid
% 2)));
2254 rt2860_io_mac_write(sc
, keymode_base
, tmp
);
2256 if (vap
->iv_opmode
== IEEE80211_M_HOSTAP
)
2258 if (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_WEP
)
2262 iv
[3] = (k
->wk_keyix
<< 6);
2266 if (k
->wk_cipher
->ic_cipher
== IEEE80211_CIPHER_TKIP
)
2268 iv
[0] = (k
->wk_keytsc
>> 8);
2269 iv
[1] = ((iv
[0] | 0x20) & 0x7f);
2270 iv
[2] = k
->wk_keytsc
;
2276 iv
[0] = k
->wk_keytsc
;
2277 iv
[1] = k
->wk_keytsc
>> 8;
2281 iv
[3] = ((k
->wk_keyix
<< 6) | IEEE80211_WEP_EXTIV
);
2282 iv
[4] = (k
->wk_keytsc
>> 16);
2283 iv
[5] = (k
->wk_keytsc
>> 24);
2284 iv
[6] = (k
->wk_keytsc
>> 32);
2285 iv
[7] = (k
->wk_keytsc
>> 40);
2287 RT2860_DPRINTF(sc
, RT2860_DEBUG_KEY
,
2288 "%s: VAP key set: iv=%02x %02x %02x %02x %02x %02x %02x %02x\n",
2289 device_get_nameunit(sc
->dev
),
2290 iv
[0], iv
[1], iv
[2], iv
[3], iv
[4], iv
[5], iv
[6], iv
[7]);
2293 rt2860_io_mac_write_multi(sc
, RT2860_REG_IVEIV(wcid
), iv
, 8);
2295 tmp
= ((vapid
& RT2860_REG_VAP_MASK
) << RT2860_REG_VAP_SHIFT
) |
2296 (mode
<< RT2860_REG_CIPHER_MODE_SHIFT
);
2298 rt2860_io_mac_write(sc
, RT2860_REG_WCID_ATTR(wcid
), tmp
);
2306 * rt2860_vap_key_delete
2308 static int rt2860_vap_key_delete(struct ieee80211vap
*vap
,
2309 const struct ieee80211_key
*k
)
2311 struct rt2860_softc
*sc
;
2312 struct ieee80211com
*ic
;
2314 struct ieee80211_node
*ni
;
2316 uint8_t vapid
, wcid
;
2322 ni
= ieee80211_find_vap_node(&ic
->ic_sta
, vap
, k
->wk_macaddr
);
2323 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
2326 ieee80211_free_node(ni
);
2328 RT2860_DPRINTF(sc
, RT2860_DEBUG_KEY
,
2329 "%s: VAP key delete: keyix=%d, keylen=%d, macaddr=%s, associd=0x%04x, group=%d\n",
2330 device_get_nameunit(sc
->dev
), k
->wk_keyix
, k
->wk_keylen
, ether_sprintf(k
->wk_macaddr
),
2331 associd
, (k
->wk_flags
& IEEE80211_KEY_GROUP
) ? 1 : 0);
2333 if (!(k
->wk_flags
& IEEE80211_KEY_GROUP
))
2335 /* remove pairwise key */
2338 wcid
= RT2860_AID2WCID(associd
);
2340 tmp
= ((vapid
& RT2860_REG_VAP_MASK
) << RT2860_REG_VAP_SHIFT
) |
2341 (RT2860_REG_CIPHER_MODE_NONE
<< RT2860_REG_CIPHER_MODE_SHIFT
) | RT2860_REG_PKEY_ENABLE
;
2343 rt2860_io_mac_write(sc
, RT2860_REG_WCID_ATTR(wcid
), tmp
);
2347 /* remove group key */
2351 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SKEY_MODE(vapid
));
2353 tmp
&= ~(0xf << (k
->wk_keyix
* 4 + 16 * (vapid
% 2)));
2354 tmp
|= (RT2860_REG_CIPHER_MODE_NONE
<< (k
->wk_keyix
* 4 + 16 * (vapid
% 2)));
2356 rt2860_io_mac_write(sc
, RT2860_REG_SKEY_MODE(vapid
), tmp
);
2363 * rt2860_vap_update_beacon
2365 static void rt2860_vap_update_beacon(struct ieee80211vap
*vap
, int what
)
2367 struct rt2860_softc
*sc
;
2368 struct ieee80211com
*ic
;
2370 struct rt2860_softc_vap
*rvap
;
2372 struct ieee80211_beacon_offsets
*bo
;
2377 rvap
= (struct rt2860_softc_vap
*) vap
;
2378 m
= rvap
->beacon_mbuf
;
2379 bo
= &rvap
->beacon_offsets
;
2381 RT2860_DPRINTF(sc
, RT2860_DEBUG_BEACON
,
2382 "%s: VAP update beacon: what=%d\n",
2383 device_get_nameunit(sc
->dev
), what
);
2385 setbit(bo
->bo_flags
, what
);
2387 ieee80211_beacon_update(vap
->iv_bss
, bo
, m
, 0);
2389 rt2860_asic_update_beacon(sc
, vap
);
2393 * rt2860_media_change
2395 static int rt2860_media_change(struct ifnet
*ifp
)
2399 error
= ieee80211_media_change(ifp
);
2401 return (error
== ENETRESET
? 0 : error
);
2407 static struct ieee80211_node
*rt2860_node_alloc(struct ieee80211vap
*vap
,
2408 const uint8_t mac
[IEEE80211_ADDR_LEN
])
2410 return malloc(sizeof(struct rt2860_softc_node
),
2411 M_80211_NODE
, M_NOWAIT
| M_ZERO
);
2415 * rt2860_node_getmimoinfo
2417 static void rt2860_node_getmimoinfo(const struct ieee80211_node
*ni
,
2418 struct ieee80211_mimo_info
*mi
)
2420 const struct rt2860_softc_node
*rni
;
2423 rni
= (const struct rt2860_softc_node
*) ni
;
2425 for (i
= 0; i
< RT2860_SOFTC_RSSI_COUNT
; i
++)
2427 mi
->rssi
[i
] = rni
->last_rssi_dbm
[i
];
2428 mi
->noise
[i
] = RT2860_NOISE_FLOOR
;
2433 * rt2860_setregdomain
2435 static int rt2860_setregdomain(struct ieee80211com
*ic
,
2436 struct ieee80211_regdomain
*reg
,
2437 int nchans
, struct ieee80211_channel chans
[])
2439 struct rt2860_softc
*sc
;
2445 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
2446 "%s: set regulatory domain: country=%d, country code string=%c%c, location=%c\n",
2447 device_get_nameunit(sc
->dev
),
2448 reg
->country
, reg
->isocc
[0], reg
->isocc
[1], reg
->location
);
2454 * rt2860_getradiocaps
2456 static void rt2860_getradiocaps(struct ieee80211com
*ic
,
2457 int maxchans
, int *nchans
, struct ieee80211_channel chans
[])
2459 *nchans
= (ic
->ic_nchans
>= maxchans
) ? maxchans
: ic
->ic_nchans
;
2461 memcpy(chans
, ic
->ic_channels
, (*nchans
) * sizeof(struct ieee80211_channel
));
2467 static void rt2860_scan_start(struct ieee80211com
*ic
)
2469 struct rt2860_softc
*sc
;
2475 rt2860_asic_disable_tsf_sync(sc
);
2481 static void rt2860_scan_end(struct ieee80211com
*ic
)
2483 struct rt2860_softc
*sc
;
2489 rt2860_asic_enable_tsf_sync(sc
);
2493 * rt2860_set_channel
2495 static void rt2860_set_channel(struct ieee80211com
*ic
)
2497 struct rt2860_softc
*sc
;
2503 RT2860_DPRINTF(sc
, RT2860_DEBUG_CHAN
,
2504 "%s: set channel: channel=%u, HT%s%s\n",
2505 device_get_nameunit(sc
->dev
),
2506 ieee80211_chan2ieee(ic
, ic
->ic_curchan
),
2507 !IEEE80211_IS_CHAN_HT(ic
->ic_curchan
) ? " disabled" :
2508 IEEE80211_IS_CHAN_HT20(ic
->ic_curchan
) ? "20":
2509 IEEE80211_IS_CHAN_HT40U(ic
->ic_curchan
) ? "40U" : "40D",
2510 (ic
->ic_flags
& IEEE80211_F_SCAN
) ? ", scanning" : "");
2512 RT2860_SOFTC_LOCK(sc
);
2514 rt2860_rf_set_chan(sc
, ic
->ic_curchan
);
2516 RT2860_SOFTC_UNLOCK(sc
);
2522 static void rt2860_newassoc(struct ieee80211_node
*ni
, int isnew
)
2524 struct rt2860_softc
*sc
;
2525 struct ieee80211com
*ic
;
2527 struct ieee80211vap
*vap
;
2528 struct rt2860_softc_vap
*rvap
;
2536 rvap
= (struct rt2860_softc_vap
*) vap
;
2538 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
2539 wcid
= RT2860_AID2WCID(associd
);
2541 RT2860_DPRINTF(sc
, RT2860_DEBUG_NODE
,
2542 "%s: new association: wcid=0x%02x, "
2543 "mac addr=%s, QoS %s, ERP %s, HT %s\n",
2544 device_get_nameunit(sc
->dev
), wcid
,
2545 ether_sprintf(ni
->ni_macaddr
),
2546 (ni
->ni_flags
& IEEE80211_NODE_QOS
) ? "enabled" : "disabled",
2547 (ni
->ni_flags
& IEEE80211_NODE_ERP
) ? "enabled" : "disabled",
2548 (ni
->ni_flags
& IEEE80211_NODE_HT
) ? "enabled" : "disabled");
2550 rt2860_io_mac_write_multi(sc
, RT2860_REG_WCID(wcid
),
2551 ni
->ni_macaddr
, IEEE80211_ADDR_LEN
);
2553 rt2860_amrr_node_init(&rvap
->amrr
, &sc
->amrr_node
[wcid
], ni
);
2555 RT2860_DPRINTF(sc
, RT2860_DEBUG_RATE
,
2556 "%s: initial%s node Tx rate: associd=0x%04x, rate=0x%02x, max rate=0x%02x\n",
2557 device_get_nameunit(sc
->dev
),
2558 (ni
->ni_flags
& IEEE80211_NODE_HT
) ? " HT" : "",
2559 ni
->ni_associd
, ni
->ni_txrate
,
2560 (ni
->ni_flags
& IEEE80211_NODE_HT
) ?
2561 (ni
->ni_htrates
.rs_rates
[ni
->ni_htrates
.rs_nrates
- 1] | IEEE80211_RATE_MCS
) :
2562 (ni
->ni_rates
.rs_rates
[ni
->ni_rates
.rs_nrates
- 1] & IEEE80211_RATE_VAL
));
2564 rt2860_asic_updateprot(sc
);
2565 rt2860_asic_updateslot(sc
);
2566 rt2860_asic_set_txpreamble(sc
);
2572 static void rt2860_updateslot(struct ifnet
*ifp
)
2574 struct rt2860_softc
*sc
;
2578 rt2860_asic_updateslot(sc
);
2582 * rt2860_update_promisc
2584 static void rt2860_update_promisc(struct ifnet
*ifp
)
2586 struct rt2860_softc
*sc
;
2590 rt2860_asic_update_promisc(sc
);
2594 * rt2860_update_mcast
2596 static void rt2860_update_mcast(struct ifnet
*ifp
)
2598 struct rt2860_softc
*sc
;
2606 static int rt2860_wme_update(struct ieee80211com
*ic
)
2608 struct rt2860_softc
*sc
;
2614 rt2860_asic_wme_update(sc
);
2622 static int rt2860_raw_xmit(struct ieee80211_node
*ni
, struct mbuf
*m
,
2623 const struct ieee80211_bpf_params
*params
)
2625 struct rt2860_softc
*sc
;
2626 struct ieee80211com
*ic
;
2633 RT2860_SOFTC_LOCK(sc
);
2635 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
2637 RT2860_SOFTC_UNLOCK(sc
);
2640 ieee80211_free_node(ni
);
2645 if (sc
->tx_ring
[sc
->tx_ring_mgtqid
].data_queued
>= RT2860_SOFTC_TX_RING_DATA_COUNT
)
2647 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
2648 "%s: raw xmit: Tx ring with qid=%d is full\n",
2649 device_get_nameunit(sc
->dev
), sc
->tx_ring_mgtqid
);
2651 ifp
->if_drv_flags
|= IFF_DRV_OACTIVE
;
2653 RT2860_SOFTC_UNLOCK(sc
);
2656 ieee80211_free_node(ni
);
2658 sc
->tx_data_queue_full
[sc
->tx_ring_mgtqid
]++;
2663 if (rt2860_tx_mgmt(sc
, m
, ni
, sc
->tx_ring_mgtqid
) != 0)
2667 RT2860_SOFTC_UNLOCK(sc
);
2669 ieee80211_free_node(ni
);
2674 sc
->tx_timer
= RT2860_TX_WATCHDOG_TIMEOUT
;
2676 RT2860_SOFTC_UNLOCK(sc
);
2682 * rt2860_recv_action
2684 static int rt2860_recv_action(struct ieee80211_node
*ni
,
2685 const struct ieee80211_frame
*wh
,
2686 const uint8_t *frm
, const uint8_t *efrm
)
2688 struct rt2860_softc
*sc
;
2689 struct ieee80211com
*ic
;
2691 const struct ieee80211_action
*ia
;
2692 struct ieee80211_tx_ampdu
*tx_ampdu
;
2693 uint16_t associd
, status
, baparamset
;
2695 int ret
, tid
, bufsize
, ac
;
2702 ia
= (const struct ieee80211_action
*) frm
;
2704 ret
= sc
->recv_action(ni
, wh
, frm
, efrm
);
2706 if (ia
->ia_category
!= IEEE80211_ACTION_CAT_BA
)
2709 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
2710 wcid
= RT2860_AID2WCID(associd
);
2712 switch (ia
->ia_action
)
2714 /* IEEE80211_ACTION_BA_ADDBA_REQUEST */
2715 case IEEE80211_ACTION_BA_ADDBA_REQUEST
:
2716 baparamset
= LE_READ_2(frm
+ 3);
2717 tid
= RT2860_MS(baparamset
, IEEE80211_BAPS_TID
);
2718 bufsize
= RT2860_MS(baparamset
, IEEE80211_BAPS_BUFSIZ
);
2720 RT2860_DPRINTF(sc
, RT2860_DEBUG_BA
,
2721 "%s: received ADDBA request: associd=0x%04x, tid=%d, bufsize=%d\n",
2722 device_get_nameunit(sc
->dev
), associd
, tid
, bufsize
);
2724 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_WCID(wcid
) + 4);
2726 tmp
|= (0x10000 << tid
);
2728 rt2860_io_mac_write(sc
, RT2860_REG_WCID(wcid
) + 4, tmp
);
2731 /* IEEE80211_ACTION_BA_ADDBA_RESPONSE */
2732 case IEEE80211_ACTION_BA_ADDBA_RESPONSE
:
2733 status
= LE_READ_2(frm
+ 3);
2734 baparamset
= LE_READ_2(frm
+ 4);
2735 tid
= RT2860_MS(baparamset
, IEEE80211_BAPS_TID
);
2736 bufsize
= RT2860_MS(baparamset
, IEEE80211_BAPS_BUFSIZ
);
2737 ac
= TID_TO_WME_AC(tid
);
2738 tx_ampdu
= &ni
->ni_tx_ampdu
[ac
];
2740 RT2860_DPRINTF(sc
, RT2860_DEBUG_BA
,
2741 "%s: received ADDBA response: associd=0x%04x, status=%d, tid=%d, bufsize=%d\n",
2742 device_get_nameunit(sc
->dev
), associd
, status
, tid
, bufsize
);
2744 if (sc
->mac_rev
>= 0x28720200)
2746 if (tx_ampdu
->txa_wnd
> 13)
2747 tx_ampdu
->txa_wnd
= 13;
2751 if (tx_ampdu
->txa_wnd
> 7)
2752 tx_ampdu
->txa_wnd
= 7;
2755 if (status
== IEEE80211_STATUS_SUCCESS
)
2757 sc
->tx_ampdu_sessions
++;
2759 rt2860_asic_updateprot(sc
);
2763 /* IEEE80211_ACTION_BA_DELBA */
2764 case IEEE80211_ACTION_BA_DELBA
:
2765 baparamset
= LE_READ_2(frm
+ 2);
2766 tid
= RT2860_MS(baparamset
, IEEE80211_BAPS_TID
);
2768 RT2860_DPRINTF(sc
, RT2860_DEBUG_BA
,
2769 "%s: received DELBA request: associd=0x%04x, tid=%d\n",
2770 device_get_nameunit(sc
->dev
), associd
, tid
);
2772 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_WCID(wcid
) + 4);
2774 tmp
&= ~(0x10000 << tid
);
2776 rt2860_io_mac_write(sc
, RT2860_REG_WCID(wcid
) + 4, tmp
);
2784 * rt2860_send_action
2786 static int rt2860_send_action(struct ieee80211_node
*ni
,
2787 int cat
, int act
, void *sa
)
2789 struct rt2860_softc
*sc
;
2790 struct ieee80211com
*ic
;
2792 uint16_t associd
, *args
, baparamset
;
2801 ret
= sc
->send_action(ni
, cat
, act
, sa
);
2803 if (cat
!= IEEE80211_ACTION_CAT_BA
)
2806 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
2807 wcid
= RT2860_AID2WCID(associd
);
2812 /* IEEE80211_ACTION_BA_DELBA */
2813 case IEEE80211_ACTION_BA_DELBA
:
2814 baparamset
= RT2860_SM(args
[0], IEEE80211_DELBAPS_TID
) | args
[1];
2816 tid
= RT2860_MS(baparamset
, IEEE80211_DELBAPS_TID
);
2818 RT2860_DPRINTF(sc
, RT2860_DEBUG_BA
,
2819 "%s: sending DELBA request: associd=0x%04x, tid=%d\n",
2820 device_get_nameunit(sc
->dev
), associd
, tid
);
2822 if (RT2860_MS(baparamset
, IEEE80211_DELBAPS_INIT
) != IEEE80211_DELBAPS_INIT
)
2824 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_WCID(wcid
) + 4);
2826 tmp
&= ~(0x10000 << tid
);
2828 rt2860_io_mac_write(sc
, RT2860_REG_WCID(wcid
) + 4, tmp
);
2832 sc
->tx_ampdu_sessions
--;
2834 rt2860_asic_updateprot(sc
);
2843 * rt2860_amrr_update_iter_func
2845 static void rt2860_amrr_update_iter_func(void *arg
, struct ieee80211_node
*ni
)
2847 struct rt2860_softc
*sc
;
2848 struct ieee80211com
*ic
;
2850 struct ieee80211vap
*vap
;
2851 struct rt2860_softc_vap
*rvap
;
2858 rvap
= (struct rt2860_softc_vap
*) vap
;
2860 /* only associated stations */
2862 if ((ni
->ni_vap
== vap
) && (ni
->ni_associd
!= 0))
2864 wcid
= RT2860_AID2WCID(ni
->ni_associd
);
2866 RT2860_DPRINTF(sc
, RT2860_DEBUG_RATE
,
2867 "%s: AMRR node: wcid=0x%02x, txcnt=%d, success=%d, retrycnt=%d\n",
2868 device_get_nameunit(sc
->dev
),
2869 wcid
, sc
->amrr_node
[wcid
].txcnt
, sc
->amrr_node
[wcid
].success
, sc
->amrr_node
[wcid
].retrycnt
);
2871 rt2860_amrr_choose(ni
, &sc
->amrr_node
[wcid
]);
2873 RT2860_DPRINTF(sc
, RT2860_DEBUG_RATE
,
2874 "%s:%s node Tx rate: associd=0x%04x, rate=0x%02x, max rate=0x%02x\n",
2875 device_get_nameunit(sc
->dev
),
2876 (ni
->ni_flags
& IEEE80211_NODE_HT
) ? " HT" : "",
2877 ni
->ni_associd
, ni
->ni_txrate
,
2878 (ni
->ni_flags
& IEEE80211_NODE_HT
) ?
2879 (ni
->ni_htrates
.rs_rates
[ni
->ni_htrates
.rs_nrates
- 1] | IEEE80211_RATE_MCS
) :
2880 (ni
->ni_rates
.rs_rates
[ni
->ni_rates
.rs_nrates
- 1] & IEEE80211_RATE_VAL
));
2887 static void rt2860_periodic(void *arg
)
2889 struct rt2860_softc
*sc
;
2893 RT2860_DPRINTF(sc
, RT2860_DEBUG_PERIODIC
,
2895 device_get_nameunit(sc
->dev
));
2897 taskqueue_enqueue(sc
->taskqueue
, &sc
->periodic_task
);
2901 * rt2860_tx_watchdog
2903 static void rt2860_tx_watchdog(void *arg
)
2905 struct rt2860_softc
*sc
;
2911 if (sc
->tx_timer
== 0)
2914 if (--sc
->tx_timer
== 0)
2916 printf("%s: Tx watchdog timeout: resetting\n",
2917 device_get_nameunit(sc
->dev
));
2919 rt2860_stop_locked(sc
);
2920 rt2860_init_locked(sc
);
2924 sc
->tx_watchdog_timeouts
++;
2927 callout_reset(&sc
->tx_watchdog_ch
, hz
, rt2860_tx_watchdog
, sc
);
2931 * rt2860_asic_set_bssid
2933 static void rt2860_asic_set_bssid(struct rt2860_softc
*sc
,
2934 const uint8_t *bssid
)
2938 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
2939 "%s: set bssid: bssid=%s\n",
2940 device_get_nameunit(sc
->dev
),
2941 ether_sprintf(bssid
));
2943 tmp
= bssid
[0] | (bssid
[1]) << 8 | (bssid
[2] << 16) | (bssid
[3] << 24);
2945 rt2860_io_mac_write(sc
, RT2860_REG_BSSID_DW0
, tmp
);
2947 tmp
= bssid
[4] | (bssid
[5] << 8);
2949 rt2860_io_mac_write(sc
, RT2860_REG_BSSID_DW1
, tmp
);
2953 * rt2860_asic_set_macaddr
2955 static void rt2860_asic_set_macaddr(struct rt2860_softc
*sc
,
2956 const uint8_t *addr
)
2960 tmp
= addr
[0] | (addr
[1] << 8) | (addr
[2] << 16) | (addr
[3] << 24);
2962 rt2860_io_mac_write(sc
, RT2860_REG_ADDR_DW0
, tmp
);
2964 tmp
= addr
[4] | (addr
[5] << 8);
2966 rt2860_io_mac_write(sc
, RT2860_REG_ADDR_DW1
, tmp
);
2970 * rt2860_asic_enable_tsf_sync
2972 static void rt2860_asic_enable_tsf_sync(struct rt2860_softc
*sc
)
2975 struct ieee80211com
*ic
;
2976 struct ieee80211vap
*vap
;
2981 vap
= TAILQ_FIRST(&ic
->ic_vaps
);
2983 RT2860_DPRINTF(sc
, RT2860_DEBUG_BEACON
,
2984 "%s: enabling TSF\n",
2985 device_get_nameunit(sc
->dev
));
2987 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_BCN_TIME_CFG
);
2990 tmp
|= vap
->iv_bss
->ni_intval
* 16;
2991 tmp
|= (RT2860_REG_TSF_TIMER_ENABLE
| RT2860_REG_TBTT_TIMER_ENABLE
);
2993 if (vap
->iv_opmode
== IEEE80211_M_STA
)
2995 tmp
|= (RT2860_REG_TSF_SYNC_MODE_STA
<< RT2860_REG_TSF_SYNC_MODE_SHIFT
);
2997 else if (vap
->iv_opmode
== IEEE80211_M_IBSS
)
2999 tmp
|= RT2860_REG_BCN_TX_ENABLE
;
3000 tmp
|= (RT2860_REG_TSF_SYNC_MODE_IBSS
<< RT2860_REG_TSF_SYNC_MODE_SHIFT
);
3002 else if (vap
->iv_opmode
== IEEE80211_M_HOSTAP
)
3004 tmp
|= RT2860_REG_BCN_TX_ENABLE
;
3005 tmp
|= (RT2860_REG_TSF_SYNC_MODE_HOSTAP
<< RT2860_REG_TSF_SYNC_MODE_SHIFT
);
3008 rt2860_io_mac_write(sc
, RT2860_REG_BCN_TIME_CFG
, tmp
);
3012 * rt2860_asic_disable_tsf_sync
3014 static void rt2860_asic_disable_tsf_sync(struct rt2860_softc
*sc
)
3018 RT2860_DPRINTF(sc
, RT2860_DEBUG_BEACON
,
3019 "%s: disabling TSF\n",
3020 device_get_nameunit(sc
->dev
));
3022 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_BCN_TIME_CFG
);
3024 tmp
&= ~(RT2860_REG_BCN_TX_ENABLE
|
3025 RT2860_REG_TSF_TIMER_ENABLE
|
3026 RT2860_REG_TBTT_TIMER_ENABLE
);
3028 tmp
&= ~(RT2860_REG_TSF_SYNC_MODE_MASK
<< RT2860_REG_TSF_SYNC_MODE_SHIFT
);
3029 tmp
|= (RT2860_REG_TSF_SYNC_MODE_DISABLE
<< RT2860_REG_TSF_SYNC_MODE_SHIFT
);
3031 rt2860_io_mac_write(sc
, RT2860_REG_BCN_TIME_CFG
, tmp
);
3035 * rt2860_asic_enable_mrr
3037 static void rt2860_asic_enable_mrr(struct rt2860_softc
*sc
)
3039 #define CCK(mcs) (mcs)
3040 #define OFDM(mcs) ((1 << 3) | (mcs))
3041 #define HT(mcs) (mcs)
3043 rt2860_io_mac_write(sc
, RT2860_REG_TX_LG_FBK_CFG0
,
3044 (OFDM(6) << 28) | /* 54 -> 48 */
3045 (OFDM(5) << 24) | /* 48 -> 36 */
3046 (OFDM(4) << 20) | /* 36 -> 24 */
3047 (OFDM(3) << 16) | /* 24 -> 18 */
3048 (OFDM(2) << 12) | /* 18 -> 12 */
3049 (OFDM(1) << 8) | /* 12 -> 9 */
3050 (OFDM(0) << 4) | /* 9 -> 6 */
3051 OFDM(0)); /* 6 -> 6 */
3053 rt2860_io_mac_write(sc
, RT2860_REG_TX_LG_FBK_CFG1
,
3054 (CCK(2) << 12) | /* 11 -> 5.5 */
3055 (CCK(1) << 8) | /* 5.5 -> 2 */
3056 (CCK(0) << 4) | /* 2 -> 1 */
3057 CCK(0)); /* 1 -> 1 */
3059 rt2860_io_mac_write(sc
, RT2860_REG_TX_HT_FBK_CFG0
,
3069 rt2860_io_mac_write(sc
, RT2860_REG_TX_HT_FBK_CFG1
,
3085 * rt2860_asic_set_txpreamble
3087 static void rt2860_asic_set_txpreamble(struct rt2860_softc
*sc
)
3090 struct ieee80211com
*ic
;
3096 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
3097 "%s: %s short Tx preamble\n",
3098 device_get_nameunit(sc
->dev
),
3099 (ic
->ic_flags
& IEEE80211_F_SHPREAMBLE
) ? "enabling" : "disabling");
3101 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_AUTO_RSP_CFG
);
3103 tmp
&= ~RT2860_REG_CCK_SHORT_ENABLE
;
3105 if (ic
->ic_flags
& IEEE80211_F_SHPREAMBLE
)
3106 tmp
|= RT2860_REG_CCK_SHORT_ENABLE
;
3108 rt2860_io_mac_write(sc
, RT2860_REG_AUTO_RSP_CFG
, tmp
);
3112 * rt2860_asic_set_basicrates
3114 static void rt2860_asic_set_basicrates(struct rt2860_softc
*sc
)
3117 struct ieee80211com
*ic
;
3122 if (ic
->ic_curmode
== IEEE80211_MODE_11B
)
3123 rt2860_io_mac_write(sc
, RT2860_REG_LEGACY_BASIC_RATE
, 0x3);
3124 else if (ic
->ic_curmode
== IEEE80211_MODE_11A
)
3125 rt2860_io_mac_write(sc
, RT2860_REG_LEGACY_BASIC_RATE
, 0x150);
3127 rt2860_io_mac_write(sc
, RT2860_REG_LEGACY_BASIC_RATE
, 0x15f);
3131 * rt2860_asic_update_rtsthreshold
3133 static void rt2860_asic_update_rtsthreshold(struct rt2860_softc
*sc
)
3136 struct ieee80211com
*ic
;
3137 struct ieee80211vap
*vap
;
3143 vap
= TAILQ_FIRST(&ic
->ic_vaps
);
3146 threshold
= IEEE80211_RTS_MAX
;
3147 else if (vap
->iv_flags_ht
& IEEE80211_FHT_AMSDU_TX
)
3150 threshold
= vap
->iv_rtsthreshold
;
3152 RT2860_DPRINTF(sc
, RT2860_DEBUG_PROT
,
3153 "%s: updating RTS threshold: %d\n",
3154 device_get_nameunit(sc
->dev
), threshold
);
3156 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TX_RTS_CFG
);
3158 tmp
&= ~(RT2860_REG_TX_RTS_THRESHOLD_MASK
<< RT2860_REG_TX_RTS_THRESHOLD_SHIFT
);
3160 tmp
|= ((threshold
& RT2860_REG_TX_RTS_THRESHOLD_MASK
) <<
3161 RT2860_REG_TX_RTS_THRESHOLD_SHIFT
);
3163 rt2860_io_mac_write(sc
, RT2860_REG_TX_RTS_CFG
, tmp
);
3167 * rt2860_asic_update_txpower
3169 static void rt2860_asic_update_txpower(struct rt2860_softc
*sc
)
3172 struct ieee80211com
*ic
;
3173 uint32_t *txpow_rate
;
3182 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
3183 "%s: updating Tx power: %d\n",
3184 device_get_nameunit(sc
->dev
), ic
->ic_txpowlimit
);
3186 if (!IEEE80211_IS_CHAN_HT40(ic
->ic_curchan
))
3188 txpow_rate
= sc
->txpow_rate_20mhz
;
3192 if (IEEE80211_IS_CHAN_2GHZ(ic
->ic_curchan
))
3193 txpow_rate
= sc
->txpow_rate_40mhz_2ghz
;
3195 txpow_rate
= sc
->txpow_rate_40mhz_5ghz
;
3200 val
= rt2860_io_bbp_read(sc
, 1);
3203 if (ic
->ic_txpowlimit
> 90)
3207 else if (ic
->ic_txpowlimit
> 60)
3211 else if (ic
->ic_txpowlimit
> 30)
3215 else if (ic
->ic_txpowlimit
> 15)
3219 else if (ic
->ic_txpowlimit
> 9)
3229 rt2860_io_bbp_write(sc
, 1, val
);
3231 for (i
= 0; i
< RT2860_SOFTC_TXPOW_RATE_COUNT
; i
++)
3233 if (txpow_rate
[i
] == 0xffffffff)
3236 tmp
= rt2860_read_eeprom_txpow_rate_add_delta(txpow_rate
[i
], delta
);
3238 rt2860_io_mac_write(sc
, RT2860_REG_TX_PWR_CFG(i
), tmp
);
3243 * rt2860_asic_update_promisc
3245 static void rt2860_asic_update_promisc(struct rt2860_softc
*sc
)
3252 printf("%s: %s promiscuous mode\n",
3253 device_get_nameunit(sc
->dev
),
3254 (ifp
->if_flags
& IFF_PROMISC
) ? "entering" : "leaving");
3256 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_RX_FILTER_CFG
);
3258 tmp
&= ~RT2860_REG_RX_FILTER_DROP_UC_NOME
;
3260 if (!(ifp
->if_flags
& IFF_PROMISC
))
3261 tmp
|= RT2860_REG_RX_FILTER_DROP_UC_NOME
;
3263 rt2860_io_mac_write(sc
, RT2860_REG_RX_FILTER_CFG
, tmp
);
3267 * rt2860_asic_updateprot
3269 static void rt2860_asic_updateprot(struct rt2860_softc
*sc
)
3272 struct ieee80211com
*ic
;
3273 struct ieee80211vap
*vap
;
3274 uint32_t cck_prot
, ofdm_prot
, mm20_prot
, mm40_prot
, gf20_prot
, gf40_prot
;
3276 enum ieee80211_protmode htprotmode
;
3280 vap
= TAILQ_FIRST(&ic
->ic_vaps
);
3282 /* CCK frame protection */
3284 cck_prot
= RT2860_REG_RTSTH_ENABLE
| RT2860_REG_PROT_NAV_SHORT
|
3285 RT2860_REG_TXOP_ALLOW_ALL
| RT2860_REG_PROT_CTRL_NONE
;
3287 /* set up protection frame phy mode and rate (MCS code) */
3289 if (ic
->ic_curmode
== IEEE80211_MODE_11A
)
3290 cck_prot
|= (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3291 (0 << RT2860_REG_PROT_MCS_SHIFT
);
3293 cck_prot
|= ((RT2860_REG_PROT_PHYMODE_CCK
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3294 (3 << RT2860_REG_PROT_MCS_SHIFT
));
3296 rt2860_io_mac_write(sc
, RT2860_REG_TX_CCK_PROT_CFG
, cck_prot
);
3298 /* OFDM frame protection */
3300 ofdm_prot
= RT2860_REG_RTSTH_ENABLE
| RT2860_REG_PROT_NAV_SHORT
|
3301 RT2860_REG_TXOP_ALLOW_ALL
;
3303 if (ic
->ic_flags
& IEEE80211_F_USEPROT
)
3305 RT2860_DPRINTF(sc
, RT2860_DEBUG_PROT
,
3306 "%s: updating protection mode: b/g protection mode=%s\n",
3307 device_get_nameunit(sc
->dev
),
3308 (ic
->ic_protmode
== IEEE80211_PROT_RTSCTS
) ? "RTS/CTS" :
3309 ((ic
->ic_protmode
== IEEE80211_PROT_CTSONLY
) ? "CTS-to-self" : "none"));
3311 if (ic
->ic_protmode
== IEEE80211_PROT_RTSCTS
)
3312 ofdm_prot
|= RT2860_REG_PROT_CTRL_RTS_CTS
;
3313 else if (ic
->ic_protmode
== IEEE80211_PROT_CTSONLY
)
3314 ofdm_prot
|= RT2860_REG_PROT_CTRL_CTS
;
3316 ofdm_prot
|= RT2860_REG_PROT_CTRL_NONE
;
3320 RT2860_DPRINTF(sc
, RT2860_DEBUG_PROT
,
3321 "%s: updating protection mode: b/g protection mode=%s\n",
3322 device_get_nameunit(sc
->dev
), "none");
3324 ofdm_prot
|= RT2860_REG_PROT_CTRL_NONE
;
3327 rt2860_io_mac_write(sc
, RT2860_REG_TX_OFDM_PROT_CFG
, ofdm_prot
);
3329 /* HT frame protection */
3331 if ((vap
!= NULL
) && (vap
->iv_opmode
== IEEE80211_M_STA
) && (vap
->iv_state
== IEEE80211_S_RUN
))
3332 htopmode
= vap
->iv_bss
->ni_htopmode
;
3334 htopmode
= ic
->ic_curhtprotmode
;
3336 htprotmode
= ic
->ic_htprotmode
;
3338 /* force HT mixed mode and RTS/CTS protection if A-MPDU Tx aggregation is enabled */
3340 if (sc
->tx_ampdu_sessions
> 0)
3342 RT2860_DPRINTF(sc
, RT2860_DEBUG_PROT
,
3343 "%s: updating protection mode: forcing HT mixed mode and RTS/CTS protection\n",
3344 device_get_nameunit(sc
->dev
));
3346 htopmode
= IEEE80211_HTINFO_OPMODE_MIXED
;
3347 htprotmode
= IEEE80211_PROT_RTSCTS
;
3350 RT2860_DPRINTF(sc
, RT2860_DEBUG_PROT
,
3351 "%s: updating protection mode: HT operation mode=0x%02x, protection mode=%s\n",
3352 device_get_nameunit(sc
->dev
),
3353 htopmode
& IEEE80211_HTINFO_OPMODE
,
3354 (htprotmode
== IEEE80211_PROT_RTSCTS
) ? "RTS/CTS" :
3355 ((htprotmode
== IEEE80211_PROT_CTSONLY
) ? "CTS-to-self" : "none"));
3357 switch (htopmode
& IEEE80211_HTINFO_OPMODE
)
3359 /* IEEE80211_HTINFO_OPMODE_HT20PR */
3360 case IEEE80211_HTINFO_OPMODE_HT20PR
:
3361 mm20_prot
= RT2860_REG_PROT_NAV_SHORT
| RT2860_REG_PROT_CTRL_NONE
|
3362 RT2860_REG_TXOP_ALLOW_CCK
| RT2860_REG_TXOP_ALLOW_OFDM
|
3363 RT2860_REG_TXOP_ALLOW_MM20
| RT2860_REG_TXOP_ALLOW_GF20
|
3364 (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3365 (4 << RT2860_REG_PROT_MCS_SHIFT
);
3367 gf20_prot
= mm20_prot
;
3369 mm40_prot
= RT2860_REG_PROT_NAV_SHORT
| RT2860_REG_TXOP_ALLOW_ALL
|
3370 (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3371 (0x84 << RT2860_REG_PROT_MCS_SHIFT
);
3373 if (htprotmode
== IEEE80211_PROT_RTSCTS
)
3374 mm40_prot
|= RT2860_REG_PROT_CTRL_RTS_CTS
;
3375 else if (htprotmode
== IEEE80211_PROT_CTSONLY
)
3376 mm40_prot
|= RT2860_REG_PROT_CTRL_CTS
;
3378 mm40_prot
|= RT2860_REG_PROT_CTRL_NONE
;
3380 gf40_prot
= mm40_prot
;
3383 /* IEEE80211_HTINFO_OPMODE_MIXED */
3384 case IEEE80211_HTINFO_OPMODE_MIXED
:
3385 mm20_prot
= RT2860_REG_PROT_NAV_SHORT
|
3386 RT2860_REG_TXOP_ALLOW_CCK
| RT2860_REG_TXOP_ALLOW_OFDM
|
3387 RT2860_REG_TXOP_ALLOW_MM20
| RT2860_REG_TXOP_ALLOW_GF20
;
3389 if (ic
->ic_flags
& IEEE80211_F_USEPROT
)
3390 mm20_prot
|= (RT2860_REG_PROT_PHYMODE_CCK
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3391 (3 << RT2860_REG_PROT_MCS_SHIFT
);
3393 mm20_prot
|= (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3394 (4 << RT2860_REG_PROT_MCS_SHIFT
);
3396 if (htprotmode
== IEEE80211_PROT_RTSCTS
)
3397 mm20_prot
|= RT2860_REG_PROT_CTRL_RTS_CTS
;
3398 else if (htprotmode
== IEEE80211_PROT_CTSONLY
)
3399 mm20_prot
|= RT2860_REG_PROT_CTRL_CTS
;
3401 mm20_prot
|= RT2860_REG_PROT_CTRL_NONE
;
3403 gf20_prot
= mm20_prot
;
3405 mm40_prot
= RT2860_REG_PROT_NAV_SHORT
| RT2860_REG_TXOP_ALLOW_ALL
;
3407 if (ic
->ic_flags
& IEEE80211_F_USEPROT
)
3408 mm40_prot
|= (RT2860_REG_PROT_PHYMODE_CCK
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3409 (3 << RT2860_REG_PROT_MCS_SHIFT
);
3411 mm40_prot
|= (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3412 (0x84 << RT2860_REG_PROT_MCS_SHIFT
);
3414 if (htprotmode
== IEEE80211_PROT_RTSCTS
)
3415 mm40_prot
|= RT2860_REG_PROT_CTRL_RTS_CTS
;
3416 else if (htprotmode
== IEEE80211_PROT_CTSONLY
)
3417 mm40_prot
|= RT2860_REG_PROT_CTRL_CTS
;
3419 mm40_prot
|= RT2860_REG_PROT_CTRL_NONE
;
3421 gf40_prot
= mm40_prot
;
3425 * IEEE80211_HTINFO_OPMODE_PURE
3426 * IEEE80211_HTINFO_OPMODE_PROTOPT
3428 case IEEE80211_HTINFO_OPMODE_PURE
:
3429 case IEEE80211_HTINFO_OPMODE_PROTOPT
:
3431 mm20_prot
= RT2860_REG_PROT_NAV_SHORT
| RT2860_REG_PROT_CTRL_NONE
|
3432 RT2860_REG_TXOP_ALLOW_CCK
| RT2860_REG_TXOP_ALLOW_OFDM
|
3433 RT2860_REG_TXOP_ALLOW_MM20
| RT2860_REG_TXOP_ALLOW_GF20
|
3434 (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3435 (4 << RT2860_REG_PROT_MCS_SHIFT
);
3437 gf20_prot
= mm20_prot
;
3439 mm40_prot
= RT2860_REG_PROT_NAV_SHORT
| RT2860_REG_PROT_CTRL_NONE
|
3440 RT2860_REG_TXOP_ALLOW_ALL
|
3441 (RT2860_REG_PROT_PHYMODE_OFDM
<< RT2860_REG_PROT_PHYMODE_SHIFT
) |
3442 (0x84 << RT2860_REG_PROT_MCS_SHIFT
);
3444 gf40_prot
= mm40_prot
;
3448 rt2860_io_mac_write(sc
, RT2860_REG_TX_MM20_PROT_CFG
, mm20_prot
);
3449 rt2860_io_mac_write(sc
, RT2860_REG_TX_MM40_PROT_CFG
, mm40_prot
);
3450 rt2860_io_mac_write(sc
, RT2860_REG_TX_GF20_PROT_CFG
, gf20_prot
);
3451 rt2860_io_mac_write(sc
, RT2860_REG_TX_GF40_PROT_CFG
, gf40_prot
);
3455 * rt2860_asic_updateslot
3457 static void rt2860_asic_updateslot(struct rt2860_softc
*sc
)
3460 struct ieee80211com
*ic
;
3461 struct ieee80211vap
*vap
;
3466 vap
= TAILQ_FIRST(&ic
->ic_vaps
);
3468 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATE
,
3469 "%s: %s short slot time\n",
3470 device_get_nameunit(sc
->dev
),
3471 ((ic
->ic_flags
& IEEE80211_F_SHSLOT
) ||
3472 ((vap
!= NULL
) && (vap
->iv_flags
& IEEE80211_F_BURST
))) ? "enabling" : "disabling");
3474 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_BKOFF_SLOT_CFG
);
3478 if ((ic
->ic_flags
& IEEE80211_F_SHSLOT
) ||
3479 ((vap
!= NULL
) && (vap
->iv_flags
& IEEE80211_F_BURST
)))
3480 tmp
|= IEEE80211_DUR_SHSLOT
;
3482 tmp
|= IEEE80211_DUR_SLOT
;
3484 rt2860_io_mac_write(sc
, RT2860_REG_BKOFF_SLOT_CFG
, tmp
);
3488 * rt2860_asic_wme_update
3490 static void rt2860_asic_wme_update(struct rt2860_softc
*sc
)
3493 struct ieee80211com
*ic
;
3494 struct ieee80211_wme_state
*wme
;
3495 const struct wmeParams
*wmep
;
3501 wmep
= wme
->wme_chanParams
.cap_wmeParams
;
3503 RT2860_DPRINTF(sc
, RT2860_DEBUG_WME
,
3504 "%s: wme update: WME_AC_VO=%d/%d/%d/%d, WME_AC_VI=%d/%d/%d/%d, "
3505 "WME_AC_BK=%d/%d/%d/%d, WME_AC_BE=%d/%d/%d/%d\n",
3506 device_get_nameunit(sc
->dev
),
3507 wmep
[WME_AC_VO
].wmep_aifsn
,
3508 wmep
[WME_AC_VO
].wmep_logcwmin
, wmep
[WME_AC_VO
].wmep_logcwmax
,
3509 wmep
[WME_AC_VO
].wmep_txopLimit
,
3510 wmep
[WME_AC_VI
].wmep_aifsn
,
3511 wmep
[WME_AC_VI
].wmep_logcwmin
, wmep
[WME_AC_VI
].wmep_logcwmax
,
3512 wmep
[WME_AC_VI
].wmep_txopLimit
,
3513 wmep
[WME_AC_BK
].wmep_aifsn
,
3514 wmep
[WME_AC_BK
].wmep_logcwmin
, wmep
[WME_AC_BK
].wmep_logcwmax
,
3515 wmep
[WME_AC_BK
].wmep_txopLimit
,
3516 wmep
[WME_AC_BE
].wmep_aifsn
,
3517 wmep
[WME_AC_BE
].wmep_logcwmin
, wmep
[WME_AC_BE
].wmep_logcwmax
,
3518 wmep
[WME_AC_BE
].wmep_txopLimit
);
3520 for (i
= 0; i
< WME_NUM_AC
; i
++)
3521 rt2860_io_mac_write(sc
, RT2860_REG_TX_EDCA_AC_CFG(i
),
3522 (wmep
[i
].wmep_logcwmax
<< 16) | (wmep
[i
].wmep_logcwmin
<< 12) |
3523 (wmep
[i
].wmep_aifsn
<< 8) | wmep
[i
].wmep_txopLimit
);
3525 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_AIFSN_CFG
,
3526 (wmep
[WME_AC_VO
].wmep_aifsn
<< 12) | (wmep
[WME_AC_VI
].wmep_aifsn
<< 8) |
3527 (wmep
[WME_AC_BK
].wmep_aifsn
<< 4) | wmep
[WME_AC_BE
].wmep_aifsn
);
3529 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_CWMIN_CFG
,
3530 (wmep
[WME_AC_VO
].wmep_logcwmin
<< 12) | (wmep
[WME_AC_VI
].wmep_logcwmin
<< 8) |
3531 (wmep
[WME_AC_BK
].wmep_logcwmin
<< 4) | wmep
[WME_AC_BE
].wmep_logcwmin
);
3533 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_CWMAX_CFG
,
3534 (wmep
[WME_AC_VO
].wmep_logcwmax
<< 12) | (wmep
[WME_AC_VI
].wmep_logcwmax
<< 8) |
3535 (wmep
[WME_AC_BK
].wmep_logcwmax
<< 4) | wmep
[WME_AC_BE
].wmep_logcwmax
);
3537 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_TXOP0_CFG
,
3538 (wmep
[WME_AC_BK
].wmep_txopLimit
<< 16) | wmep
[WME_AC_BE
].wmep_txopLimit
);
3540 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WMM_TXOP1_CFG
,
3541 (wmep
[WME_AC_VO
].wmep_txopLimit
<< 16) | wmep
[WME_AC_VI
].wmep_txopLimit
);
3545 * rt2860_asic_update_beacon
3547 static void rt2860_asic_update_beacon(struct rt2860_softc
*sc
,
3548 struct ieee80211vap
*vap
)
3550 struct rt2860_softc_vap
*rvap
;
3552 struct rt2860_txwi
*txwi
;
3555 rvap
= (struct rt2860_softc_vap
*) vap
;
3557 m
= rvap
->beacon_mbuf
;
3558 txwi
= &rvap
->beacon_txwi
;
3560 /* disable temporarily TSF sync */
3562 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_BCN_TIME_CFG
);
3564 tmp
&= ~(RT2860_REG_BCN_TX_ENABLE
|
3565 RT2860_REG_TSF_TIMER_ENABLE
|
3566 RT2860_REG_TBTT_TIMER_ENABLE
);
3568 rt2860_io_mac_write(sc
, RT2860_REG_BCN_TIME_CFG
, tmp
);
3570 /* write Tx wireless info and beacon frame to on-chip memory */
3572 rt2860_io_mac_write_multi(sc
, RT2860_REG_BEACON_BASE(0),
3573 txwi
, sizeof(struct rt2860_txwi
));
3575 rt2860_io_mac_write_multi(sc
, RT2860_REG_BEACON_BASE(0) + sizeof(struct rt2860_txwi
),
3576 mtod(m
, uint8_t *), m
->m_pkthdr
.len
);
3578 /* enable again TSF sync */
3580 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_BCN_TIME_CFG
);
3582 tmp
|= (RT2860_REG_BCN_TX_ENABLE
|
3583 RT2860_REG_TSF_TIMER_ENABLE
|
3584 RT2860_REG_TBTT_TIMER_ENABLE
);
3586 rt2860_io_mac_write(sc
, RT2860_REG_BCN_TIME_CFG
, tmp
);
3590 * rt2860_asic_clear_keytables
3592 static void rt2860_asic_clear_keytables(struct rt2860_softc
*sc
)
3596 /* clear Rx WCID search table (entries = 256, entry size = 8) */
3598 for (i
= 0; i
< 256; i
++)
3600 rt2860_io_mac_write(sc
, RT2860_REG_WCID(i
), 0xffffffff);
3601 rt2860_io_mac_write(sc
, RT2860_REG_WCID(i
) + 4, 0x0000ffff);
3604 /* clear WCID attribute table (entries = 256, entry size = 4) */
3606 rt2860_io_mac_set_region_4(sc
, RT2860_REG_WCID_ATTR(0), 0, 256);
3608 /* clear IV/EIV table (entries = 256, entry size = 8) */
3610 rt2860_io_mac_set_region_4(sc
, RT2860_REG_IVEIV(0), 0, 2 * 256);
3612 /* clear pairwise key table (entries = 256, entry size = 32) */
3614 rt2860_io_mac_set_region_4(sc
, RT2860_REG_PKEY(0), 0, 8 * 256);
3616 /* clear shared key table (entries = 32, entry size = 32) */
3618 rt2860_io_mac_set_region_4(sc
, RT2860_REG_SKEY(0, 0), 0, 8 * 32);
3620 /* clear shared key mode (entries = 32, entry size = 2) */
3622 rt2860_io_mac_set_region_4(sc
, RT2860_REG_SKEY_MODE(0), 0, 16);
3626 * rt2860_beacon_alloc
3628 static int rt2860_beacon_alloc(struct rt2860_softc
*sc
,
3629 struct ieee80211vap
*vap
)
3631 struct ieee80211com
*ic
;
3632 struct rt2860_softc_vap
*rvap
;
3633 const struct ieee80211_txparam
*tp
;
3635 struct rt2860_txwi txwi
;
3639 rvap
= (struct rt2860_softc_vap
*) vap
;
3640 tp
= &vap
->iv_txparms
[ieee80211_chan2mode(ic
->ic_bsschan
)];
3642 m
= ieee80211_beacon_alloc(vap
->iv_bss
, &rvap
->beacon_offsets
);
3646 rate
= tp
->mgmtrate
;
3647 mcs
= rt2860_rate2mcs(rate
);
3649 memset(&txwi
, 0, sizeof(struct rt2860_txwi
));
3652 txwi
.pid_mpdu_len
= ((htole16(m
->m_pkthdr
.len
) & RT2860_TXWI_MPDU_LEN_MASK
) <<
3653 RT2860_TXWI_MPDU_LEN_SHIFT
);
3654 txwi
.txop
= (RT2860_TXWI_TXOP_HT
<< RT2860_TXWI_TXOP_SHIFT
);
3655 txwi
.mpdu_density_flags
|=
3656 (RT2860_TXWI_FLAGS_TS
<< RT2860_TXWI_FLAGS_SHIFT
);
3657 txwi
.bawin_size_xflags
|=
3658 (RT2860_TXWI_XFLAGS_NSEQ
<< RT2860_TXWI_XFLAGS_SHIFT
);
3660 if (ieee80211_rate2phytype(ic
->ic_rt
, rate
) != IEEE80211_T_OFDM
)
3662 txwi
.phymode_ifs_stbc_shortgi
=
3663 (RT2860_TXWI_PHYMODE_CCK
<< RT2860_TXWI_PHYMODE_SHIFT
);
3665 if (rate
!= 2 && (ic
->ic_flags
& IEEE80211_F_SHPREAMBLE
))
3666 mcs
|= RT2860_TXWI_MCS_SHOTPRE
;
3670 txwi
.phymode_ifs_stbc_shortgi
=
3671 (RT2860_TXWI_PHYMODE_OFDM
<< RT2860_TXWI_PHYMODE_SHIFT
);
3674 txwi
.bw_mcs
= (RT2860_TXWI_BW_20
<< RT2860_TXWI_BW_SHIFT
) |
3675 ((mcs
& RT2860_TXWI_MCS_MASK
) << RT2860_TXWI_MCS_SHIFT
);
3677 if (rvap
->beacon_mbuf
!= NULL
)
3679 m_free(rvap
->beacon_mbuf
);
3680 rvap
->beacon_mbuf
= NULL
;
3683 rvap
->beacon_mbuf
= m
;
3684 rvap
->beacon_txwi
= txwi
;
3692 static uint8_t rt2860_rxrate(struct rt2860_rxwi
*rxwi
)
3694 uint8_t mcs
, phymode
;
3697 mcs
= (rxwi
->bw_mcs
>> RT2860_RXWI_MCS_SHIFT
) & RT2860_RXWI_MCS_MASK
;
3698 phymode
= (rxwi
->phymode_stbc_shortgi
>> RT2860_RXWI_PHYMODE_SHIFT
) &
3699 RT2860_RXWI_PHYMODE_MASK
;
3705 case RT2860_RXWI_PHYMODE_CCK
:
3706 switch (mcs
& ~RT2860_RXWI_MCS_SHOTPRE
)
3708 case 0: rate
= 2; break; /* 1 Mbps */
3709 case 1: rate
= 4; break; /* 2 MBps */
3710 case 2: rate
= 11; break; /* 5.5 Mbps */
3711 case 3: rate
= 22; break; /* 11 Mbps */
3715 case RT2860_RXWI_PHYMODE_OFDM
:
3718 case 0: rate
= 12; break; /* 6 Mbps */
3719 case 1: rate
= 18; break; /* 9 Mbps */
3720 case 2: rate
= 24; break; /* 12 Mbps */
3721 case 3: rate
= 36; break; /* 18 Mbps */
3722 case 4: rate
= 48; break; /* 24 Mbps */
3723 case 5: rate
= 72; break; /* 36 Mbps */
3724 case 6: rate
= 96; break; /* 48 Mbps */
3725 case 7: rate
= 108; break; /* 54 Mbps */
3729 case RT2860_RXWI_PHYMODE_HT_MIXED
:
3730 case RT2860_RXWI_PHYMODE_HT_GF
:
3738 * rt2860_maxrssi_rxpath
3740 static uint8_t rt2860_maxrssi_rxpath(struct rt2860_softc
*sc
,
3741 const struct rt2860_rxwi
*rxwi
)
3747 if (sc
->nrxpath
> 1)
3748 if (rxwi
->rssi
[1] > rxwi
->rssi
[rxpath
])
3751 if (sc
->nrxpath
> 2)
3752 if (rxwi
->rssi
[2] > rxwi
->rssi
[rxpath
])
3761 static int8_t rt2860_rssi2dbm(struct rt2860_softc
*sc
,
3762 uint8_t rssi
, uint8_t rxpath
)
3765 struct ieee80211com
*ic
;
3766 struct ieee80211_channel
*c
;
3768 int8_t rssi_off
, lna_gain
;
3776 chan
= ieee80211_chan2ieee(ic
, c
);
3778 if (IEEE80211_IS_CHAN_5GHZ(c
))
3780 rssi_off
= sc
->rssi_off_5ghz
[rxpath
];
3783 lna_gain
= sc
->lna_gain
[1];
3784 else if (chan
<= 128)
3785 lna_gain
= sc
->lna_gain
[2];
3787 lna_gain
= sc
->lna_gain
[3];
3791 rssi_off
= sc
->rssi_off_2ghz
[rxpath
] - sc
->lna_gain
[0];
3792 lna_gain
= sc
->lna_gain
[0];
3795 return (-12 - rssi_off
- lna_gain
- rssi
);
3801 static uint8_t rt2860_rate2mcs(uint8_t rate
)
3828 static int rt2860_tx_mgmt(struct rt2860_softc
*sc
,
3829 struct mbuf
*m
, struct ieee80211_node
*ni
, int qid
)
3832 struct ieee80211com
*ic
;
3833 struct ieee80211vap
*vap
;
3834 const struct ieee80211_txparam
*tp
;
3835 struct rt2860_softc_node
*rni
;
3836 struct rt2860_softc_tx_ring
*ring
;
3837 struct rt2860_softc_tx_data
*data
;
3838 struct rt2860_txdesc
*desc
;
3839 struct rt2860_txwi
*txwi
;
3840 struct ieee80211_frame
*wh
;
3841 struct rt2860_softc_tx_radiotap_header
*tap
;
3842 bus_dma_segment_t dma_seg
[RT2860_SOFTC_MAX_SCATTER
];
3843 u_int hdrsize
, hdrspace
;
3844 uint8_t rate
, stbc
, shortgi
, mcs
, pid
, qsel
;
3845 uint16_t len
, dmalen
, mpdu_len
, dur
;
3846 int error
, mimops
, ndmasegs
, ndescs
, i
, j
;
3848 KASSERT(qid
>= 0 && qid
< RT2860_SOFTC_TX_RING_COUNT
,
3849 ("%s: Tx MGMT: invalid qid=%d\n",
3850 device_get_nameunit(sc
->dev
), qid
));
3855 rni
= (struct rt2860_softc_node
*) ni
;
3856 tp
= ni
->ni_txparms
;
3858 ring
= &sc
->tx_ring
[qid
];
3859 desc
= &ring
->desc
[ring
->desc_cur
];
3860 data
= &ring
->data
[ring
->data_cur
];
3861 txwi
= (struct rt2860_txwi
*) (ring
->seg0
+ ring
->data_cur
* RT2860_TX_DATA_SEG0_SIZE
);
3863 wh
= mtod(m
, struct ieee80211_frame
*);
3865 rate
= tp
->mgmtrate
& IEEE80211_RATE_VAL
;
3867 /* fill Tx wireless info */
3869 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
3872 mcs
= rt2860_rate2mcs(rate
);
3874 /* calculate MPDU length without padding */
3876 hdrsize
= ieee80211_hdrsize(wh
);
3877 hdrspace
= ieee80211_hdrspace(ic
, wh
);
3878 mpdu_len
= m
->m_pkthdr
.len
- hdrspace
+ hdrsize
;
3880 memset(txwi
, 0, sizeof(struct rt2860_txwi
));
3882 /* management frames do not need encryption */
3886 /* MIMO power save */
3888 if ((ni
->ni_flags
& IEEE80211_NODE_HT
) && (ni
->ni_flags
& IEEE80211_NODE_MIMO_PS
))
3892 if (ni
->ni_flags
& IEEE80211_NODE_MIMO_RTS
)
3894 /* dynamic MIMO power save */
3896 txwi
->mpdu_density_flags
|=
3897 (RT2860_TXWI_FLAGS_MIMOPS
<< RT2860_TXWI_FLAGS_SHIFT
);
3901 /* static MIMO power save */
3916 txwi
->pid_mpdu_len
= ((htole16(pid
) & RT2860_TXWI_PID_MASK
) <<
3917 RT2860_TXWI_PID_SHIFT
) | ((htole16(mpdu_len
) & RT2860_TXWI_MPDU_LEN_MASK
) <<
3918 RT2860_TXWI_MPDU_LEN_SHIFT
);
3920 stbc
= (ic
->ic_htcaps
& IEEE80211_HTCAP_TXSTBC
) &&
3921 (ni
->ni_flags
& IEEE80211_NODE_HT
) && (ni
->ni_htcap
& IEEE80211_HTCAP_RXSTBC
);
3923 shortgi
= (vap
->iv_flags_ht
& (IEEE80211_FHT_SHORTGI20
| IEEE80211_FHT_SHORTGI40
)) &&
3924 (ni
->ni_flags
& IEEE80211_NODE_HT
) && (ni
->ni_flags
& (IEEE80211_NODE_SGI20
| IEEE80211_NODE_SGI40
));
3926 txwi
->phymode_ifs_stbc_shortgi
|=
3927 ((stbc
& RT2860_TXWI_STBC_MASK
) << RT2860_TXWI_STBC_SHIFT
) |
3928 ((shortgi
& RT2860_TXWI_SHORTGI_MASK
) << RT2860_TXWI_SHORTGI_SHIFT
);
3930 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
3932 txwi
->phymode_ifs_stbc_shortgi
|=
3933 (RT2860_TXWI_PHYMODE_HT_MIXED
<< RT2860_TXWI_PHYMODE_SHIFT
);
3937 if (ieee80211_rate2phytype(ic
->ic_rt
, rate
) != IEEE80211_T_OFDM
)
3939 txwi
->phymode_ifs_stbc_shortgi
|=
3940 (RT2860_TXWI_PHYMODE_CCK
<< RT2860_TXWI_PHYMODE_SHIFT
);
3942 if (rate
!= 2 && (ic
->ic_flags
& IEEE80211_F_SHPREAMBLE
))
3943 mcs
|= RT2860_TXWI_MCS_SHOTPRE
;
3947 txwi
->phymode_ifs_stbc_shortgi
|=
3948 (RT2860_TXWI_PHYMODE_OFDM
<< RT2860_TXWI_PHYMODE_SHIFT
);
3952 txwi
->bw_mcs
= (RT2860_TXWI_BW_20
<< RT2860_TXWI_BW_SHIFT
) |
3953 ((mcs
& RT2860_TXWI_MCS_MASK
) << RT2860_TXWI_MCS_SHIFT
);
3955 txwi
->txop
= (RT2860_TXWI_TXOP_BACKOFF
<< RT2860_TXWI_TXOP_SHIFT
);
3957 /* skip ACKs for multicast frames */
3959 if (!IEEE80211_IS_MULTICAST(wh
->i_addr1
))
3961 txwi
->bawin_size_xflags
|=
3962 (RT2860_TXWI_XFLAGS_ACK
<< RT2860_TXWI_XFLAGS_SHIFT
);
3964 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
3966 /* preamble + plcp + signal extension + SIFS */
3968 dur
= 16 + 4 + 6 + 10;
3972 dur
= ieee80211_ack_duration(ic
->ic_rt
, rate
,
3973 ic
->ic_flags
& IEEE80211_F_SHPREAMBLE
);
3976 *(uint16_t *) wh
->i_dur
= htole16(dur
);
3979 /* ask MAC to insert timestamp into probe responses */
3981 if ((wh
->i_fc
[0] & (IEEE80211_FC0_TYPE_MASK
| IEEE80211_FC0_SUBTYPE_MASK
)) ==
3982 (IEEE80211_FC0_TYPE_MGT
| IEEE80211_FC0_SUBTYPE_PROBE_RESP
))
3983 txwi
->mpdu_density_flags
|=
3984 (RT2860_TXWI_FLAGS_TS
<< RT2860_TXWI_FLAGS_SHIFT
);
3986 if (ieee80211_radiotap_active_vap(vap
))
3990 tap
->flags
= IEEE80211_RADIOTAP_F_DATAPAD
;
3991 tap
->chan_flags
= htole32(ic
->ic_curchan
->ic_flags
);
3992 tap
->chan_freq
= htole16(ic
->ic_curchan
->ic_freq
);
3993 tap
->chan_ieee
= ic
->ic_curchan
->ic_ieee
;
3994 tap
->chan_maxpow
= 0;
3996 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
3997 tap
->rate
= mcs
| IEEE80211_RATE_MCS
;
4001 if (mcs
& RT2860_TXWI_MCS_SHOTPRE
)
4002 tap
->flags
|= IEEE80211_RADIOTAP_F_SHORTPRE
;
4005 tap
->flags
|= IEEE80211_RADIOTAP_F_SHORTGI
;
4007 if (wh
->i_fc
[1] & IEEE80211_FC1_WEP
)
4008 tap
->flags
|= IEEE80211_RADIOTAP_F_WEP
;
4010 if (wh
->i_fc
[1] & IEEE80211_FC1_WEP
)
4012 wh
->i_fc
[1] &= ~IEEE80211_FC1_WEP
;
4014 ieee80211_radiotap_tx(vap
, m
);
4016 wh
->i_fc
[1] |= IEEE80211_FC1_WEP
;
4020 ieee80211_radiotap_tx(vap
, m
);
4024 /* copy and trim 802.11 header */
4026 m_copydata(m
, 0, hdrsize
, (caddr_t
) (txwi
+ 1));
4029 error
= bus_dmamap_load_mbuf_sg(ring
->data_dma_tag
, data
->dma_map
, m
,
4030 dma_seg
, &ndmasegs
, 0);
4033 /* too many fragments, linearize */
4035 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
4036 "%s: could not load mbuf DMA map, trying to linearize mbuf: ndmasegs=%d, len=%d, error=%d\n",
4037 device_get_nameunit(sc
->dev
), ndmasegs
, m
->m_pkthdr
.len
, error
);
4039 m
= m_defrag(m
, M_DONTWAIT
);
4043 sc
->tx_defrag_packets
++;
4045 error
= bus_dmamap_load_mbuf_sg(ring
->data_dma_tag
, data
->dma_map
, m
,
4046 dma_seg
, &ndmasegs
, 0);
4049 printf("%s: could not load mbuf DMA map: ndmasegs=%d, len=%d, error=%d\n",
4050 device_get_nameunit(sc
->dev
), ndmasegs
, m
->m_pkthdr
.len
, error
);
4056 if (m
->m_pkthdr
.len
== 0)
4059 /* determine how many Tx descs are required */
4061 ndescs
= 1 + ndmasegs
/ 2;
4062 if ((ring
->desc_queued
+ ndescs
) > (RT2860_SOFTC_TX_RING_DESC_COUNT
- 2))
4064 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
4065 "%s: there are not enough Tx descs\n",
4066 device_get_nameunit(sc
->dev
));
4068 sc
->no_tx_desc_avail
++;
4070 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
4078 /* set up Tx descs */
4080 /* first segment is Tx wireless info and 802.11 header */
4082 len
= sizeof(struct rt2860_txwi
) + hdrsize
;
4084 /* align end on a 4-bytes boundary */
4086 dmalen
= (len
+ 3) & ~ 3;
4088 memset((caddr_t
) txwi
+ len
, 0, dmalen
- len
);
4090 qsel
= RT2860_TXDESC_QSEL_EDCA
;
4092 desc
->sdp0
= htole32(ring
->seg0_phys_addr
+ ring
->data_cur
* RT2860_TX_DATA_SEG0_SIZE
);
4093 desc
->sdl0
= htole16(dmalen
);
4094 desc
->qsel_flags
= (qsel
<< RT2860_TXDESC_QSEL_SHIFT
);
4096 /* set up payload segments */
4098 for (i
= ndmasegs
, j
= 0; i
>= 2; i
-= 2)
4100 desc
->sdp1
= htole32(dma_seg
[j
].ds_addr
);
4101 desc
->sdl1
= htole16(dma_seg
[j
].ds_len
);
4103 ring
->desc_queued
++;
4104 ring
->desc_cur
= (ring
->desc_cur
+ 1) % RT2860_SOFTC_TX_RING_DESC_COUNT
;
4108 desc
= &ring
->desc
[ring
->desc_cur
];
4110 desc
->sdp0
= htole32(dma_seg
[j
].ds_addr
);
4111 desc
->sdl0
= htole16(dma_seg
[j
].ds_len
);
4112 desc
->qsel_flags
= (qsel
<< RT2860_TXDESC_QSEL_SHIFT
);
4117 /* finalize last payload segment */
4121 desc
->sdp1
= htole32(dma_seg
[j
].ds_addr
);
4122 desc
->sdl1
= htole16(dma_seg
[j
].ds_len
| RT2860_TXDESC_SDL1_LASTSEG
);
4126 desc
->sdl0
|= htole16(RT2860_TXDESC_SDL0_LASTSEG
);
4130 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
4131 "%s: sending MGMT frame: qid=%d, hdrsize=%d, hdrspace=%d, len=%d, "
4132 "stbc=%d, shortgi=%d, mcs=%d, mimops=%d, DMA len=%d, ndmasegs=%d, DMA ds_len=%d/%d/%d/%d/%d\n",
4133 device_get_nameunit(sc
->dev
),
4134 qid
, hdrsize
, hdrspace
, m
->m_pkthdr
.len
+ hdrsize
,
4135 stbc
, shortgi
, mcs
, mimops
, dmalen
, ndmasegs
,
4136 (int) dma_seg
[0].ds_len
, (int) dma_seg
[1].ds_len
, (int) dma_seg
[2].ds_len
, (int) dma_seg
[3].ds_len
, (int) dma_seg
[4].ds_len
);
4138 bus_dmamap_sync(ring
->seg0_dma_tag
, ring
->seg0_dma_map
,
4139 BUS_DMASYNC_PREWRITE
);
4140 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
4141 BUS_DMASYNC_PREWRITE
);
4142 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
4143 BUS_DMASYNC_PREWRITE
);
4145 ring
->desc_queued
++;
4146 ring
->desc_cur
= (ring
->desc_cur
+ 1) % RT2860_SOFTC_TX_RING_DESC_COUNT
;
4148 ring
->data_queued
++;
4149 ring
->data_cur
= (ring
->data_cur
+ 1) % RT2860_SOFTC_TX_RING_DATA_COUNT
;
4153 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_CTX_IDX(qid
), ring
->desc_cur
);
4161 static int rt2860_tx_data(struct rt2860_softc
*sc
,
4162 struct mbuf
*m
, struct ieee80211_node
*ni
, int qid
)
4165 struct ieee80211com
*ic
;
4166 struct ieee80211vap
*vap
;
4167 const struct ieee80211_txparam
*tp
;
4168 struct rt2860_softc_node
*rni
;
4169 struct rt2860_softc_tx_ring
*ring
;
4170 struct rt2860_softc_tx_data
*data
;
4171 struct rt2860_txdesc
*desc
;
4172 struct rt2860_txwi
*txwi
;
4173 struct ieee80211_frame
*wh
;
4174 struct ieee80211_tx_ampdu
*tx_ampdu
;
4175 ieee80211_seq seqno
;
4176 struct rt2860_softc_tx_radiotap_header
*tap
;
4177 bus_dma_segment_t dma_seg
[RT2860_SOFTC_MAX_SCATTER
];
4178 u_int hdrsize
, hdrspace
;
4179 uint8_t type
, rate
, bw
, stbc
, shortgi
, mcs
, pid
, wcid
, mpdu_density
, bawin_size
, qsel
;
4180 uint16_t qos
, len
, dmalen
, mpdu_len
, dur
;
4181 int error
, hasqos
, ac
, tid
, ampdu
, mimops
, ndmasegs
, ndescs
, i
, j
;
4183 KASSERT(qid
>= 0 && qid
< RT2860_SOFTC_TX_RING_COUNT
,
4184 ("%s: Tx data: invalid qid=%d\n",
4185 device_get_nameunit(sc
->dev
), qid
));
4190 rni
= (struct rt2860_softc_node
*) ni
;
4191 tp
= ni
->ni_txparms
;
4193 ring
= &sc
->tx_ring
[qid
];
4194 desc
= &ring
->desc
[ring
->desc_cur
];
4195 data
= &ring
->data
[ring
->data_cur
];
4196 txwi
= (struct rt2860_txwi
*) (ring
->seg0
+ ring
->data_cur
* RT2860_TX_DATA_SEG0_SIZE
);
4198 wh
= mtod(m
, struct ieee80211_frame
*);
4200 type
= wh
->i_fc
[0] & IEEE80211_FC0_TYPE_MASK
;
4202 hasqos
= IEEE80211_QOS_HAS_SEQ(wh
);
4205 if (IEEE80211_HAS_ADDR4(wh
))
4206 qos
= le16toh(*(const uint16_t *)
4207 (((struct ieee80211_qosframe_addr4
*) wh
)->i_qos
));
4209 qos
= le16toh(*(const uint16_t *)
4210 (((struct ieee80211_qosframe
*) wh
)->i_qos
));
4217 if (IEEE80211_IS_MULTICAST(wh
->i_addr1
))
4218 rate
= tp
->mcastrate
;
4219 else if (m
->m_flags
& M_EAPOL
)
4220 rate
= tp
->mgmtrate
;
4221 else if (tp
->ucastrate
!= IEEE80211_FIXED_RATE_NONE
)
4222 rate
= tp
->ucastrate
;
4224 rate
= ni
->ni_txrate
;
4226 rate
&= IEEE80211_RATE_VAL
;
4228 /* fill Tx wireless info */
4230 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
4233 mcs
= rt2860_rate2mcs(rate
);
4235 if (type
== IEEE80211_FC0_TYPE_DATA
)
4236 wcid
= !IEEE80211_IS_MULTICAST(wh
->i_addr1
) ? RT2860_AID2WCID(ni
->ni_associd
) : 0;
4240 /* calculate MPDU length without padding */
4242 hdrsize
= ieee80211_hdrsize(wh
);
4243 hdrspace
= ieee80211_hdrspace(ic
, wh
);
4244 mpdu_len
= m
->m_pkthdr
.len
- hdrspace
+ hdrsize
;
4246 memset(txwi
, 0, sizeof(struct rt2860_txwi
));
4250 /* MIMO power save */
4252 if ((ni
->ni_flags
& IEEE80211_NODE_HT
) && (ni
->ni_flags
& IEEE80211_NODE_MIMO_PS
))
4256 if (ni
->ni_flags
& IEEE80211_NODE_MIMO_RTS
)
4258 /* dynamic MIMO power save */
4260 txwi
->mpdu_density_flags
|=
4261 (RT2860_TXWI_FLAGS_MIMOPS
<< RT2860_TXWI_FLAGS_SHIFT
);
4265 /* static MIMO power save */
4280 txwi
->pid_mpdu_len
= ((htole16(pid
) & RT2860_TXWI_PID_MASK
) <<
4281 RT2860_TXWI_PID_SHIFT
) | ((htole16(mpdu_len
) & RT2860_TXWI_MPDU_LEN_MASK
) <<
4282 RT2860_TXWI_MPDU_LEN_SHIFT
);
4284 stbc
= (ic
->ic_htcaps
& IEEE80211_HTCAP_TXSTBC
) &&
4285 (ni
->ni_flags
& IEEE80211_NODE_HT
) && (ni
->ni_htcap
& IEEE80211_HTCAP_RXSTBC
);
4287 shortgi
= (vap
->iv_flags_ht
& (IEEE80211_FHT_SHORTGI20
| IEEE80211_FHT_SHORTGI40
)) &&
4288 (ni
->ni_flags
& IEEE80211_NODE_HT
) && (ni
->ni_flags
& (IEEE80211_NODE_SGI20
| IEEE80211_NODE_SGI40
));
4290 txwi
->phymode_ifs_stbc_shortgi
|=
4291 ((stbc
& RT2860_TXWI_STBC_MASK
) << RT2860_TXWI_STBC_SHIFT
) |
4292 ((shortgi
& RT2860_TXWI_SHORTGI_MASK
) << RT2860_TXWI_SHORTGI_SHIFT
);
4294 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
4296 txwi
->phymode_ifs_stbc_shortgi
|=
4297 (RT2860_TXWI_PHYMODE_HT_MIXED
<< RT2860_TXWI_PHYMODE_SHIFT
);
4301 if (ieee80211_rate2phytype(ic
->ic_rt
, rate
) != IEEE80211_T_OFDM
)
4303 txwi
->phymode_ifs_stbc_shortgi
|=
4304 (RT2860_TXWI_PHYMODE_CCK
<< RT2860_TXWI_PHYMODE_SHIFT
);
4306 if (rate
!= 2 && (ic
->ic_flags
& IEEE80211_F_SHPREAMBLE
))
4307 mcs
|= RT2860_TXWI_MCS_SHOTPRE
;
4311 txwi
->phymode_ifs_stbc_shortgi
|=
4312 (RT2860_TXWI_PHYMODE_OFDM
<< RT2860_TXWI_PHYMODE_SHIFT
);
4316 if ((ni
->ni_flags
& IEEE80211_NODE_HT
) && (ni
->ni_chw
== 40))
4317 bw
= RT2860_TXWI_BW_40
;
4319 bw
= RT2860_TXWI_BW_20
;
4321 txwi
->bw_mcs
= ((bw
& RT2860_TXWI_BW_MASK
) << RT2860_TXWI_BW_SHIFT
) |
4322 ((mcs
& RT2860_TXWI_MCS_MASK
) << RT2860_TXWI_MCS_SHIFT
);
4324 txwi
->txop
= (RT2860_TXWI_TXOP_HT
<< RT2860_TXWI_TXOP_SHIFT
);
4326 if (!IEEE80211_IS_MULTICAST(wh
->i_addr1
) &&
4327 (!hasqos
|| (qos
& IEEE80211_QOS_ACKPOLICY
) != IEEE80211_QOS_ACKPOLICY_NOACK
))
4329 txwi
->bawin_size_xflags
|=
4330 (RT2860_TXWI_XFLAGS_ACK
<< RT2860_TXWI_XFLAGS_SHIFT
);
4332 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
4334 /* preamble + plcp + signal extension + SIFS */
4336 dur
= 16 + 4 + 6 + 10;
4340 dur
= ieee80211_ack_duration(ic
->ic_rt
, rate
,
4341 ic
->ic_flags
& IEEE80211_F_SHPREAMBLE
);
4344 *(uint16_t *) wh
->i_dur
= htole16(dur
);
4347 /* check for A-MPDU */
4349 if (m
->m_flags
& M_AMPDU_MPDU
)
4351 ac
= M_WME_GETAC(m
);
4352 tid
= WME_AC_TO_TID(ac
);
4353 tx_ampdu
= &ni
->ni_tx_ampdu
[ac
];
4355 mpdu_density
= RT2860_MS(ni
->ni_htparam
, IEEE80211_HTCAP_MPDUDENSITY
);
4356 bawin_size
= tx_ampdu
->txa_wnd
;
4358 txwi
->mpdu_density_flags
|=
4359 ((mpdu_density
& RT2860_TXWI_MPDU_DENSITY_MASK
) << RT2860_TXWI_MPDU_DENSITY_SHIFT
) |
4360 (RT2860_TXWI_FLAGS_AMPDU
<< RT2860_TXWI_FLAGS_SHIFT
);
4362 txwi
->bawin_size_xflags
|=
4363 ((bawin_size
& RT2860_TXWI_BAWIN_SIZE_MASK
) << RT2860_TXWI_BAWIN_SIZE_SHIFT
);
4365 seqno
= ni
->ni_txseqs
[tid
]++;
4367 *(uint16_t *) &wh
->i_seq
[0] = htole16(seqno
<< IEEE80211_SEQ_SEQ_SHIFT
);
4376 /* ask MAC to insert timestamp into probe responses */
4378 if ((wh
->i_fc
[0] & (IEEE80211_FC0_TYPE_MASK
| IEEE80211_FC0_SUBTYPE_MASK
)) ==
4379 (IEEE80211_FC0_TYPE_MGT
| IEEE80211_FC0_SUBTYPE_PROBE_RESP
))
4380 txwi
->mpdu_density_flags
|=
4381 (RT2860_TXWI_FLAGS_TS
<< RT2860_TXWI_FLAGS_SHIFT
);
4383 if (ieee80211_radiotap_active_vap(vap
))
4387 tap
->flags
= IEEE80211_RADIOTAP_F_DATAPAD
;
4388 tap
->chan_flags
= htole32(ic
->ic_curchan
->ic_flags
);
4389 tap
->chan_freq
= htole16(ic
->ic_curchan
->ic_freq
);
4390 tap
->chan_ieee
= ic
->ic_curchan
->ic_ieee
;
4391 tap
->chan_maxpow
= 0;
4393 if (ni
->ni_flags
& IEEE80211_NODE_HT
)
4394 tap
->rate
= mcs
| IEEE80211_RATE_MCS
;
4398 if (mcs
& RT2860_TXWI_MCS_SHOTPRE
)
4399 tap
->flags
|= IEEE80211_RADIOTAP_F_SHORTPRE
;
4402 tap
->flags
|= IEEE80211_RADIOTAP_F_SHORTGI
;
4404 if (wh
->i_fc
[1] & IEEE80211_FC1_WEP
)
4405 tap
->flags
|= IEEE80211_RADIOTAP_F_WEP
;
4407 if (wh
->i_fc
[1] & IEEE80211_FC1_WEP
)
4409 wh
->i_fc
[1] &= ~IEEE80211_FC1_WEP
;
4411 ieee80211_radiotap_tx(vap
, m
);
4413 wh
->i_fc
[1] |= IEEE80211_FC1_WEP
;
4417 ieee80211_radiotap_tx(vap
, m
);
4421 /* copy and trim 802.11 header */
4423 m_copydata(m
, 0, hdrsize
, (caddr_t
) (txwi
+ 1));
4426 error
= bus_dmamap_load_mbuf_sg(ring
->data_dma_tag
, data
->dma_map
, m
,
4427 dma_seg
, &ndmasegs
, 0);
4430 /* too many fragments, linearize */
4432 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
4433 "%s: could not load mbuf DMA map, trying to linearize mbuf: ndmasegs=%d, len=%d, error=%d\n",
4434 device_get_nameunit(sc
->dev
), ndmasegs
, m
->m_pkthdr
.len
, error
);
4436 m
= m_defrag(m
, M_DONTWAIT
);
4440 sc
->tx_defrag_packets
++;
4442 error
= bus_dmamap_load_mbuf_sg(ring
->data_dma_tag
, data
->dma_map
, m
,
4443 dma_seg
, &ndmasegs
, 0);
4446 printf("%s: could not load mbuf DMA map: ndmasegs=%d, len=%d, error=%d\n",
4447 device_get_nameunit(sc
->dev
), ndmasegs
, m
->m_pkthdr
.len
, error
);
4453 if (m
->m_pkthdr
.len
== 0)
4456 /* determine how many Tx descs are required */
4458 ndescs
= 1 + ndmasegs
/ 2;
4459 if ((ring
->desc_queued
+ ndescs
) > (RT2860_SOFTC_TX_RING_DESC_COUNT
- 2))
4461 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
4462 "%s: there are not enough Tx descs\n",
4463 device_get_nameunit(sc
->dev
));
4465 sc
->no_tx_desc_avail
++;
4467 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
4475 /* set up Tx descs */
4477 /* first segment is Tx wireless info and 802.11 header */
4479 len
= sizeof(struct rt2860_txwi
) + hdrsize
;
4481 /* align end on a 4-bytes boundary */
4483 dmalen
= (len
+ 3) & ~ 3;
4485 memset((caddr_t
) txwi
+ len
, 0, dmalen
- len
);
4487 qsel
= RT2860_TXDESC_QSEL_EDCA
;
4489 desc
->sdp0
= htole32(ring
->seg0_phys_addr
+ ring
->data_cur
* RT2860_TX_DATA_SEG0_SIZE
);
4490 desc
->sdl0
= htole16(dmalen
);
4491 desc
->qsel_flags
= (qsel
<< RT2860_TXDESC_QSEL_SHIFT
);
4493 /* set up payload segments */
4495 for (i
= ndmasegs
, j
= 0; i
>= 2; i
-= 2)
4497 desc
->sdp1
= htole32(dma_seg
[j
].ds_addr
);
4498 desc
->sdl1
= htole16(dma_seg
[j
].ds_len
);
4500 ring
->desc_queued
++;
4501 ring
->desc_cur
= (ring
->desc_cur
+ 1) % RT2860_SOFTC_TX_RING_DESC_COUNT
;
4505 desc
= &ring
->desc
[ring
->desc_cur
];
4507 desc
->sdp0
= htole32(dma_seg
[j
].ds_addr
);
4508 desc
->sdl0
= htole16(dma_seg
[j
].ds_len
);
4509 desc
->qsel_flags
= (qsel
<< RT2860_TXDESC_QSEL_SHIFT
);
4514 /* finalize last payload segment */
4518 desc
->sdp1
= htole32(dma_seg
[j
].ds_addr
);
4519 desc
->sdl1
= htole16(dma_seg
[j
].ds_len
| RT2860_TXDESC_SDL1_LASTSEG
);
4523 desc
->sdl0
|= htole16(RT2860_TXDESC_SDL0_LASTSEG
);
4527 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
4528 "%s: sending data: qid=%d, hdrsize=%d, hdrspace=%d, len=%d, "
4529 "bw=%d, stbc=%d, shortgi=%d, mcs=%d, wcid=0x%02x, ampdu=%d, mimops=%d, DMA len=%d, ndmasegs=%d, DMA ds_len=%d/%d/%d/%d/%d\n",
4530 device_get_nameunit(sc
->dev
),
4531 qid
, hdrsize
, hdrspace
, m
->m_pkthdr
.len
+ hdrsize
,
4532 bw
, stbc
, shortgi
, mcs
, wcid
, ampdu
, mimops
, dmalen
, ndmasegs
,
4533 (int) dma_seg
[0].ds_len
, (int) dma_seg
[1].ds_len
, (int) dma_seg
[2].ds_len
, (int) dma_seg
[3].ds_len
, (int) dma_seg
[4].ds_len
);
4535 bus_dmamap_sync(ring
->seg0_dma_tag
, ring
->seg0_dma_map
,
4536 BUS_DMASYNC_PREWRITE
);
4537 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
4538 BUS_DMASYNC_PREWRITE
);
4539 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
4540 BUS_DMASYNC_PREWRITE
);
4542 ring
->desc_queued
++;
4543 ring
->desc_cur
= (ring
->desc_cur
+ 1) % RT2860_SOFTC_TX_RING_DESC_COUNT
;
4545 ring
->data_queued
++;
4546 ring
->data_cur
= (ring
->data_cur
+ 1) % RT2860_SOFTC_TX_RING_DATA_COUNT
;
4550 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_CTX_IDX(qid
), ring
->desc_cur
);
4558 static int rt2860_tx_raw(struct rt2860_softc
*sc
,
4559 struct mbuf
*m
, struct ieee80211_node
*ni
,
4560 const struct ieee80211_bpf_params
*params
)
4562 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
4564 device_get_nameunit(sc
->dev
));
4572 static void rt2860_intr(void *arg
)
4574 struct rt2860_softc
*sc
;
4581 /* acknowledge interrupts */
4583 status
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_INT_STATUS
);
4584 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_STATUS
, status
);
4586 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4587 "%s: interrupt: status = 0x%08x\n",
4588 device_get_nameunit(sc
->dev
), status
);
4590 if (status
== 0xffffffff || /* device likely went away */
4591 status
== 0) /* not for us */
4596 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
4599 if (status
& RT2860_REG_INT_TX_COHERENT
)
4600 rt2860_tx_coherent_intr(sc
);
4602 if (status
& RT2860_REG_INT_RX_COHERENT
)
4603 rt2860_rx_coherent_intr(sc
);
4605 if (status
& RT2860_REG_INT_TXRX_COHERENT
)
4606 rt2860_txrx_coherent_intr(sc
);
4608 if (status
& RT2860_REG_INT_FIFO_STA_FULL
)
4609 rt2860_fifo_sta_full_intr(sc
);
4611 if (status
& RT2860_REG_INT_TX_MGMT_DONE
)
4612 rt2860_tx_intr(sc
, 5);
4614 if (status
& RT2860_REG_INT_RX_DONE
)
4617 if (status
& RT2860_REG_INT_RX_DELAY_DONE
)
4618 rt2860_rx_delay_intr(sc
);
4620 if (status
& RT2860_REG_INT_TX_HCCA_DONE
)
4621 rt2860_tx_intr(sc
, 4);
4623 if (status
& RT2860_REG_INT_TX_AC3_DONE
)
4624 rt2860_tx_intr(sc
, 3);
4626 if (status
& RT2860_REG_INT_TX_AC2_DONE
)
4627 rt2860_tx_intr(sc
, 2);
4629 if (status
& RT2860_REG_INT_TX_AC1_DONE
)
4630 rt2860_tx_intr(sc
, 1);
4632 if (status
& RT2860_REG_INT_TX_AC0_DONE
)
4633 rt2860_tx_intr(sc
, 0);
4635 if (status
& RT2860_REG_INT_TX_DELAY_DONE
)
4636 rt2860_tx_delay_intr(sc
);
4638 if (status
& RT2860_REG_INT_PRE_TBTT
)
4639 rt2860_pre_tbtt_intr(sc
);
4641 if (status
& RT2860_REG_INT_TBTT
)
4642 rt2860_tbtt_intr(sc
);
4644 if (status
& RT2860_REG_INT_MCU_CMD
)
4645 rt2860_mcu_cmd_intr(sc
);
4647 if (status
& RT2860_REG_INT_AUTO_WAKEUP
)
4648 rt2860_auto_wakeup_intr(sc
);
4650 if (status
& RT2860_REG_INT_GP_TIMER
)
4651 rt2860_gp_timer_intr(sc
);
4655 * rt2860_tx_coherent_intr
4657 static void rt2860_tx_coherent_intr(struct rt2860_softc
*sc
)
4662 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4663 "%s: Tx coherent interrupt\n",
4664 device_get_nameunit(sc
->dev
));
4666 sc
->tx_coherent_interrupts
++;
4668 /* restart DMA engine */
4670 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
4672 tmp
&= ~(RT2860_REG_TX_WB_DDONE
|
4673 RT2860_REG_RX_DMA_ENABLE
|
4674 RT2860_REG_TX_DMA_ENABLE
);
4676 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
4678 /* init Tx rings (4 EDCAs + HCCA + MGMT) */
4680 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
4681 rt2860_reset_tx_ring(sc
, &sc
->tx_ring
[i
]);
4683 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
4685 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_BASE_PTR(i
),
4686 sc
->tx_ring
[i
].desc_phys_addr
);
4687 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_MAX_CNT(i
),
4688 RT2860_SOFTC_TX_RING_DESC_COUNT
);
4689 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_CTX_IDX(i
), 0);
4694 rt2860_reset_rx_ring(sc
, &sc
->rx_ring
);
4696 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_BASE_PTR
,
4697 sc
->rx_ring
.desc_phys_addr
);
4698 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_MAX_CNT
,
4699 RT2860_SOFTC_RX_RING_DATA_COUNT
);
4700 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
4701 RT2860_SOFTC_RX_RING_DATA_COUNT
- 1);
4703 rt2860_txrx_enable(sc
);
4707 * rt2860_rx_coherent_intr
4709 static void rt2860_rx_coherent_intr(struct rt2860_softc
*sc
)
4714 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4715 "%s: Rx coherent interrupt\n",
4716 device_get_nameunit(sc
->dev
));
4718 sc
->rx_coherent_interrupts
++;
4720 /* restart DMA engine */
4722 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
4724 tmp
&= ~(RT2860_REG_TX_WB_DDONE
|
4725 RT2860_REG_RX_DMA_ENABLE
|
4726 RT2860_REG_TX_DMA_ENABLE
);
4728 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
4730 /* init Tx rings (4 EDCAs + HCCA + MGMT) */
4732 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
4733 rt2860_reset_tx_ring(sc
, &sc
->tx_ring
[i
]);
4735 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
4737 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_BASE_PTR(i
),
4738 sc
->tx_ring
[i
].desc_phys_addr
);
4739 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_MAX_CNT(i
),
4740 RT2860_SOFTC_TX_RING_DESC_COUNT
);
4741 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_CTX_IDX(i
), 0);
4746 rt2860_reset_rx_ring(sc
, &sc
->rx_ring
);
4748 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_BASE_PTR
,
4749 sc
->rx_ring
.desc_phys_addr
);
4750 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_MAX_CNT
,
4751 RT2860_SOFTC_RX_RING_DATA_COUNT
);
4752 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
4753 RT2860_SOFTC_RX_RING_DATA_COUNT
- 1);
4755 rt2860_txrx_enable(sc
);
4759 * rt2860_txrx_coherent_intr
4761 static void rt2860_txrx_coherent_intr(struct rt2860_softc
*sc
)
4766 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4767 "%s: Tx/Rx coherent interrupt\n",
4768 device_get_nameunit(sc
->dev
));
4770 sc
->txrx_coherent_interrupts
++;
4772 /* restart DMA engine */
4774 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
4776 tmp
&= ~(RT2860_REG_TX_WB_DDONE
|
4777 RT2860_REG_RX_DMA_ENABLE
|
4778 RT2860_REG_TX_DMA_ENABLE
);
4780 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
4782 /* init Tx rings (4 EDCAs + HCCA + MGMT) */
4784 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
4785 rt2860_reset_tx_ring(sc
, &sc
->tx_ring
[i
]);
4787 for (i
= 0; i
< RT2860_SOFTC_TX_RING_COUNT
; i
++)
4789 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_BASE_PTR(i
),
4790 sc
->tx_ring
[i
].desc_phys_addr
);
4791 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_MAX_CNT(i
),
4792 RT2860_SOFTC_TX_RING_DESC_COUNT
);
4793 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_TX_CTX_IDX(i
), 0);
4798 rt2860_reset_rx_ring(sc
, &sc
->rx_ring
);
4800 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_BASE_PTR
,
4801 sc
->rx_ring
.desc_phys_addr
);
4802 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_MAX_CNT
,
4803 RT2860_SOFTC_RX_RING_DATA_COUNT
);
4804 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
4805 RT2860_SOFTC_RX_RING_DATA_COUNT
- 1);
4807 rt2860_txrx_enable(sc
);
4811 * rt2860_fifo_sta_full_intr
4813 static void rt2860_fifo_sta_full_intr(struct rt2860_softc
*sc
)
4815 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4816 "%s: FIFO statistic full interrupt\n",
4817 device_get_nameunit(sc
->dev
));
4819 sc
->fifo_sta_full_interrupts
++;
4821 RT2860_SOFTC_LOCK(sc
);
4823 if (!(sc
->intr_disable_mask
& RT2860_REG_INT_FIFO_STA_FULL
))
4825 rt2860_intr_disable(sc
, RT2860_REG_INT_FIFO_STA_FULL
);
4827 taskqueue_enqueue(sc
->taskqueue
, &sc
->fifo_sta_full_task
);
4830 sc
->intr_pending_mask
|= RT2860_REG_INT_FIFO_STA_FULL
;
4832 RT2860_SOFTC_UNLOCK(sc
);
4838 static void rt2860_rx_intr(struct rt2860_softc
*sc
)
4840 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4841 "%s: Rx interrupt\n",
4842 device_get_nameunit(sc
->dev
));
4844 sc
->rx_interrupts
++;
4846 RT2860_SOFTC_LOCK(sc
);
4848 if (!(sc
->intr_disable_mask
& RT2860_REG_INT_RX_DONE
))
4850 rt2860_intr_disable(sc
, RT2860_REG_INT_RX_DONE
);
4852 taskqueue_enqueue(sc
->taskqueue
, &sc
->rx_done_task
);
4855 sc
->intr_pending_mask
|= RT2860_REG_INT_RX_DONE
;
4857 RT2860_SOFTC_UNLOCK(sc
);
4861 * rt2860_rx_delay_intr
4863 static void rt2860_rx_delay_intr(struct rt2860_softc
*sc
)
4865 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4866 "%s: Rx delay interrupt\n",
4867 device_get_nameunit(sc
->dev
));
4869 sc
->rx_delay_interrupts
++;
4875 static void rt2860_tx_intr(struct rt2860_softc
*sc
, int qid
)
4877 KASSERT(qid
>= 0 && qid
< RT2860_SOFTC_TX_RING_COUNT
,
4878 ("%s: Tx interrupt: invalid qid=%d\n",
4879 device_get_nameunit(sc
->dev
), qid
));
4881 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4882 "%s: Tx interrupt: qid=%d\n",
4883 device_get_nameunit(sc
->dev
), qid
);
4885 sc
->tx_interrupts
[qid
]++;
4887 RT2860_SOFTC_LOCK(sc
);
4889 if (!(sc
->intr_disable_mask
& (RT2860_REG_INT_TX_AC0_DONE
<< qid
)))
4891 rt2860_intr_disable(sc
, (RT2860_REG_INT_TX_AC0_DONE
<< qid
));
4893 taskqueue_enqueue(sc
->taskqueue
, &sc
->tx_done_task
);
4896 sc
->intr_pending_mask
|= (RT2860_REG_INT_TX_AC0_DONE
<< qid
);
4898 RT2860_SOFTC_UNLOCK(sc
);
4902 * rt2860_tx_delay_intr
4904 static void rt2860_tx_delay_intr(struct rt2860_softc
*sc
)
4906 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4907 "%s: Tx delay interrupt\n",
4908 device_get_nameunit(sc
->dev
));
4910 sc
->tx_delay_interrupts
++;
4914 * rt2860_pre_tbtt_intr
4916 static void rt2860_pre_tbtt_intr(struct rt2860_softc
*sc
)
4918 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4919 "%s: Pre-TBTT interrupt\n",
4920 device_get_nameunit(sc
->dev
));
4922 sc
->pre_tbtt_interrupts
++;
4928 static void rt2860_tbtt_intr(struct rt2860_softc
*sc
)
4930 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4931 "%s: TBTT interrupt\n",
4932 device_get_nameunit(sc
->dev
));
4934 sc
->tbtt_interrupts
++;
4938 * rt2860_mcu_cmd_intr
4940 static void rt2860_mcu_cmd_intr(struct rt2860_softc
*sc
)
4942 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4943 "%s: MCU command interrupt\n",
4944 device_get_nameunit(sc
->dev
));
4946 sc
->mcu_cmd_interrupts
++;
4950 * rt2860_auto_wakeup_intr
4952 static void rt2860_auto_wakeup_intr(struct rt2860_softc
*sc
)
4954 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4955 "%s: auto wakeup interrupt\n",
4956 device_get_nameunit(sc
->dev
));
4958 sc
->auto_wakeup_interrupts
++;
4962 * rt2860_gp_timer_intr
4964 static void rt2860_gp_timer_intr(struct rt2860_softc
*sc
)
4966 RT2860_DPRINTF(sc
, RT2860_DEBUG_INTR
,
4967 "%s: GP timer interrupt\n",
4968 device_get_nameunit(sc
->dev
));
4970 sc
->gp_timer_interrupts
++;
4974 * rt2860_rx_done_task
4976 static void rt2860_rx_done_task(void *context
, int pending
)
4978 struct rt2860_softc
*sc
;
4985 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
4986 "%s: Rx done task\n",
4987 device_get_nameunit(sc
->dev
));
4989 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
4992 sc
->intr_pending_mask
&= ~RT2860_REG_INT_RX_DONE
;
4994 again
= rt2860_rx_eof(sc
, sc
->rx_process_limit
);
4996 RT2860_SOFTC_LOCK(sc
);
4998 if ((sc
->intr_pending_mask
& RT2860_REG_INT_RX_DONE
) || again
)
5000 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
5001 "%s: Rx done task: scheduling again\n",
5002 device_get_nameunit(sc
->dev
));
5004 taskqueue_enqueue(sc
->taskqueue
, &sc
->rx_done_task
);
5008 rt2860_intr_enable(sc
, RT2860_REG_INT_RX_DONE
);
5011 RT2860_SOFTC_UNLOCK(sc
);
5015 * rt2860_tx_done_task
5017 static void rt2860_tx_done_task(void *context
, int pending
)
5019 struct rt2860_softc
*sc
;
5027 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
5028 "%s: Tx done task\n",
5029 device_get_nameunit(sc
->dev
));
5031 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
5034 for (i
= RT2860_SOFTC_TX_RING_COUNT
- 1; i
>= 0; i
--)
5036 if (sc
->intr_pending_mask
& (RT2860_REG_INT_TX_AC0_DONE
<< i
))
5038 sc
->intr_pending_mask
&= ~(RT2860_REG_INT_TX_AC0_DONE
<< i
);
5040 rt2860_tx_eof(sc
, &sc
->tx_ring
[i
]);
5046 ifp
->if_drv_flags
&= ~IFF_DRV_OACTIVE
;
5048 intr_mask
= (RT2860_REG_INT_TX_MGMT_DONE
|
5049 RT2860_REG_INT_TX_HCCA_DONE
|
5050 RT2860_REG_INT_TX_AC3_DONE
|
5051 RT2860_REG_INT_TX_AC2_DONE
|
5052 RT2860_REG_INT_TX_AC1_DONE
|
5053 RT2860_REG_INT_TX_AC0_DONE
);
5055 RT2860_SOFTC_LOCK(sc
);
5057 rt2860_intr_enable(sc
, ~sc
->intr_pending_mask
&
5058 (sc
->intr_disable_mask
& intr_mask
));
5060 if (sc
->intr_pending_mask
& intr_mask
)
5062 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
5063 "%s: Tx done task: scheduling again\n",
5064 device_get_nameunit(sc
->dev
));
5066 taskqueue_enqueue(sc
->taskqueue
, &sc
->tx_done_task
);
5069 RT2860_SOFTC_UNLOCK(sc
);
5073 * rt2860_fifo_sta_full_task
5075 static void rt2860_fifo_sta_full_task(void *context
, int pending
)
5077 struct rt2860_softc
*sc
;
5083 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATS
,
5084 "%s: FIFO statistic full task\n",
5085 device_get_nameunit(sc
->dev
));
5087 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
5090 sc
->intr_pending_mask
&= ~RT2860_REG_INT_FIFO_STA_FULL
;
5092 rt2860_drain_fifo_stats(sc
);
5094 RT2860_SOFTC_LOCK(sc
);
5096 if (sc
->intr_pending_mask
& RT2860_REG_INT_FIFO_STA_FULL
)
5098 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATS
,
5099 "%s: FIFO statistic full task: scheduling again\n",
5100 device_get_nameunit(sc
->dev
));
5102 taskqueue_enqueue(sc
->taskqueue
, &sc
->fifo_sta_full_task
);
5106 rt2860_intr_enable(sc
, RT2860_REG_INT_FIFO_STA_FULL
);
5109 RT2860_SOFTC_UNLOCK(sc
);
5113 * rt2860_periodic_task
5115 static void rt2860_periodic_task(void *context
, int pending
)
5117 struct rt2860_softc
*sc
;
5119 struct ieee80211com
*ic
;
5120 struct ieee80211vap
*vap
;
5125 vap
= TAILQ_FIRST(&ic
->ic_vaps
);
5127 RT2860_DPRINTF(sc
, RT2860_DEBUG_PERIODIC
,
5128 "%s: periodic task: round=%lu\n",
5129 device_get_nameunit(sc
->dev
), sc
->periodic_round
);
5131 if (!(ifp
->if_drv_flags
& IFF_DRV_RUNNING
))
5134 RT2860_SOFTC_LOCK(sc
);
5136 sc
->periodic_round
++;
5138 rt2860_update_stats(sc
);
5140 if ((sc
->periodic_round
% 10) == 0)
5142 rt2860_bbp_tuning(sc
);
5144 rt2860_update_raw_counters(sc
);
5146 rt2860_watchdog(sc
);
5148 if (vap
!= NULL
&& vap
->iv_opmode
!= IEEE80211_M_MONITOR
&& vap
->iv_state
== IEEE80211_S_RUN
)
5150 if (vap
->iv_opmode
== IEEE80211_M_STA
)
5151 rt2860_amrr_update_iter_func(vap
, vap
->iv_bss
);
5153 ieee80211_iterate_nodes(&ic
->ic_sta
, rt2860_amrr_update_iter_func
, vap
);
5157 RT2860_SOFTC_UNLOCK(sc
);
5159 callout_reset(&sc
->periodic_ch
, hz
/ 10, rt2860_periodic
, sc
);
5165 static int rt2860_rx_eof(struct rt2860_softc
*sc
, int limit
)
5168 struct ieee80211com
*ic
;
5169 struct ieee80211_frame
*wh
;
5170 struct ieee80211_node
*ni
;
5171 struct rt2860_softc_node
*rni
;
5172 struct rt2860_softc_rx_radiotap_header
*tap
;
5173 struct rt2860_softc_rx_ring
*ring
;
5174 struct rt2860_rxdesc
*desc
;
5175 struct rt2860_softc_rx_data
*data
;
5176 struct rt2860_rxwi
*rxwi
;
5177 struct mbuf
*m
, *mnew
;
5178 bus_dma_segment_t segs
[1];
5179 bus_dmamap_t dma_map
;
5180 uint32_t index
, desc_flags
;
5181 uint8_t cipher_err
, rssi
, ant
, phymode
, bw
, shortgi
, mcs
, keyidx
;
5183 int error
, nsegs
, len
, ampdu
, amsdu
, rssi_dbm_rel
, nframes
, i
;
5187 ring
= &sc
->rx_ring
;
5193 index
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_RX_DRX_IDX
);
5194 if (ring
->cur
== index
)
5197 desc
= &ring
->desc
[ring
->cur
];
5198 desc_flags
= le32toh(desc
->flags
);
5199 data
= &ring
->data
[ring
->cur
];
5201 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
5202 BUS_DMASYNC_POSTREAD
| BUS_DMASYNC_POSTWRITE
);
5204 if (!(desc
->sdl0
& htole16(RT2860_RXDESC_SDL0_DDONE
)))
5209 mnew
= m_getjcl(M_DONTWAIT
, MT_DATA
, M_PKTHDR
, MJUMPAGESIZE
);
5212 sc
->rx_mbuf_alloc_errors
++;
5217 mnew
->m_len
= mnew
->m_pkthdr
.len
= MJUMPAGESIZE
;
5219 error
= bus_dmamap_load_mbuf_sg(ring
->data_dma_tag
, ring
->spare_dma_map
,
5220 mnew
, segs
, &nsegs
, BUS_DMA_NOWAIT
);
5223 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
5224 "%s: could not load Rx mbuf DMA map: error=%d, nsegs=%d\n",
5225 device_get_nameunit(sc
->dev
), error
, nsegs
);
5229 sc
->rx_mbuf_dmamap_errors
++;
5235 KASSERT(nsegs
== 1, ("%s: too many DMA segments",
5236 device_get_nameunit(sc
->dev
)));
5238 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
5239 BUS_DMASYNC_POSTREAD
);
5240 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
5242 dma_map
= data
->dma_map
;
5243 data
->dma_map
= ring
->spare_dma_map
;
5244 ring
->spare_dma_map
= dma_map
;
5246 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
5247 BUS_DMASYNC_PREREAD
);
5252 desc
->sdp0
= htole32(segs
[0].ds_addr
);
5254 /* get Rx wireless info */
5256 rxwi
= mtod(m
, struct rt2860_rxwi
*);
5257 len
= (le16toh(rxwi
->tid_size
) >> RT2860_RXWI_SIZE_SHIFT
) &
5258 RT2860_RXWI_SIZE_MASK
;
5260 /* check for L2 padding between IEEE 802.11 frame header and body */
5262 if (desc_flags
& RT2860_RXDESC_FLAGS_L2PAD
)
5264 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
5265 "%s: L2 padding: len=%d\n",
5266 device_get_nameunit(sc
->dev
), len
);
5271 m
->m_pkthdr
.rcvif
= ifp
;
5272 m
->m_data
= (caddr_t
) (rxwi
+ 1);
5273 m
->m_pkthdr
.len
= m
->m_len
= len
;
5275 /* check for crc errors */
5277 if (desc_flags
& RT2860_RXDESC_FLAGS_CRC_ERR
)
5279 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
5280 "%s: rxdesc: crc error\n",
5281 device_get_nameunit(sc
->dev
));
5285 if (!(ifp
->if_flags
& IFF_PROMISC
))
5292 wh
= (struct ieee80211_frame
*) (rxwi
+ 1);
5294 /* check for cipher errors */
5296 if (desc_flags
& RT2860_RXDESC_FLAGS_DECRYPTED
)
5298 cipher_err
= ((desc_flags
>> RT2860_RXDESC_FLAGS_CIPHER_ERR_SHIFT
) &
5299 RT2860_RXDESC_FLAGS_CIPHER_ERR_MASK
);
5300 if (cipher_err
== RT2860_RXDESC_FLAGS_CIPHER_ERR_NONE
)
5302 if (wh
->i_fc
[1] & IEEE80211_FC1_WEP
)
5303 wh
->i_fc
[1] &= ~IEEE80211_FC1_WEP
;
5305 m
->m_flags
|= M_WEP
;
5307 sc
->rx_cipher_no_errors
++;
5311 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
5312 "%s: rxdesc: cipher error=0x%02x\n",
5313 device_get_nameunit(sc
->dev
), cipher_err
);
5315 if (cipher_err
== RT2860_RXDESC_FLAGS_CIPHER_ERR_ICV
)
5316 sc
->rx_cipher_icv_errors
++;
5317 else if (cipher_err
== RT2860_RXDESC_FLAGS_CIPHER_ERR_MIC
)
5318 sc
->rx_cipher_mic_errors
++;
5319 else if (cipher_err
== RT2860_RXDESC_FLAGS_CIPHER_ERR_INVALID_KEY
)
5320 sc
->rx_cipher_invalid_key_errors
++;
5322 if ((cipher_err
== RT2860_RXDESC_FLAGS_CIPHER_ERR_MIC
) &&
5323 (desc_flags
& RT2860_RXDESC_FLAGS_MYBSS
))
5325 ni
= ieee80211_find_rxnode(ic
, (const struct ieee80211_frame_min
*) wh
);
5328 keyidx
= (rxwi
->udf_bssidx_keyidx
>> RT2860_RXWI_KEYIDX_SHIFT
) &
5329 RT2860_RXWI_KEYIDX_MASK
;
5331 ieee80211_notify_michael_failure(ni
->ni_vap
, wh
, keyidx
);
5333 ieee80211_free_node(ni
);
5339 if (!(ifp
->if_flags
& IFF_PROMISC
))
5348 if (wh
->i_fc
[1] & IEEE80211_FC1_WEP
)
5350 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
5351 "%s: rxdesc: not decrypted but protected flag set\n",
5352 device_get_nameunit(sc
->dev
));
5356 if (!(ifp
->if_flags
& IFF_PROMISC
))
5364 /* check for A-MPDU */
5366 if (desc_flags
& RT2860_RXDESC_FLAGS_AMPDU
)
5368 m
->m_flags
|= M_AMPDU
;
5379 /* check for A-MSDU */
5381 if (desc_flags
& RT2860_RXDESC_FLAGS_AMSDU
)
5392 ant
= rt2860_maxrssi_rxpath(sc
, rxwi
);
5393 rssi
= rxwi
->rssi
[ant
];
5394 rssi_dbm
= rt2860_rssi2dbm(sc
, rssi
, ant
);
5395 phymode
= ((rxwi
->phymode_stbc_shortgi
>> RT2860_RXWI_PHYMODE_SHIFT
) &
5396 RT2860_RXWI_PHYMODE_MASK
);
5397 bw
= ((rxwi
->bw_mcs
>> RT2860_RXWI_BW_SHIFT
) & RT2860_RXWI_BW_MASK
);
5398 shortgi
= ((rxwi
->phymode_stbc_shortgi
>> RT2860_RXWI_SHORTGI_SHIFT
) &
5399 RT2860_RXWI_SHORTGI_MASK
);
5400 mcs
= ((rxwi
->bw_mcs
>> RT2860_RXWI_MCS_SHIFT
) & RT2860_RXWI_MCS_MASK
);
5402 if (ieee80211_radiotap_active(ic
))
5406 tap
->flags
= (desc_flags
& RT2860_RXDESC_FLAGS_L2PAD
) ? IEEE80211_RADIOTAP_F_DATAPAD
: 0;
5407 tap
->dbm_antsignal
= rssi_dbm
;
5408 tap
->dbm_antnoise
= RT2860_NOISE_FLOOR
;
5410 tap
->antsignal
= rssi
;
5411 tap
->chan_flags
= htole32(ic
->ic_curchan
->ic_flags
);
5412 tap
->chan_freq
= htole16(ic
->ic_curchan
->ic_freq
);
5413 tap
->chan_ieee
= ic
->ic_curchan
->ic_ieee
;
5414 tap
->chan_maxpow
= 0;
5416 if (phymode
== RT2860_TXWI_PHYMODE_HT_MIXED
|| phymode
== RT2860_TXWI_PHYMODE_HT_GF
)
5417 tap
->rate
= mcs
| IEEE80211_RATE_MCS
;
5419 tap
->rate
= rt2860_rxrate(rxwi
);
5421 if (desc_flags
& RT2860_RXDESC_FLAGS_CRC_ERR
)
5422 tap
->flags
|= IEEE80211_RADIOTAP_F_BADFCS
;
5424 if (desc_flags
& RT2860_RXDESC_FLAGS_FRAG
)
5425 tap
->flags
|= IEEE80211_RADIOTAP_F_FRAG
;
5427 if (rxwi
->bw_mcs
& RT2860_RXWI_MCS_SHOTPRE
)
5428 tap
->flags
|= IEEE80211_RADIOTAP_F_SHORTPRE
;
5431 tap
->flags
|= IEEE80211_RADIOTAP_F_SHORTGI
;
5435 * net80211 assumes that RSSI data are in the range [-127..127] and
5436 * in .5 dBm units relative to the current noise floor
5439 rssi_dbm_rel
= (rssi_dbm
- RT2860_NOISE_FLOOR
) * 2;
5440 if (rssi_dbm_rel
> 127)
5443 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
5444 "%s: received frame: len=%d, phymode=%d, bw=%d, shortgi=%d, mcs=%d, "
5445 "ant=%d, rssi=%d/%d/%d, snr=%d/%d, wcid=0x%02x, ampdu=%d, amsdu=%d, "
5446 "rssi_dbm=%d, rssi_dbm_rel=%d\n",
5447 device_get_nameunit(sc
->dev
),
5448 len
, phymode
, bw
, shortgi
, mcs
,
5449 ant
, rxwi
->rssi
[0], rxwi
->rssi
[1], rxwi
->rssi
[2],
5450 rxwi
->snr
[0], rxwi
->snr
[1],
5451 rxwi
->wcid
, ampdu
, amsdu
, rssi_dbm
, rssi_dbm_rel
);
5453 ni
= ieee80211_find_rxnode(ic
, (struct ieee80211_frame_min
*) wh
);
5456 rni
= (struct rt2860_softc_node
*) ni
;
5458 for (i
= 0; i
< RT2860_SOFTC_RSSI_COUNT
; i
++)
5460 rni
->last_rssi
[i
] = rxwi
->rssi
[i
];
5461 rni
->last_rssi_dbm
[i
] = rt2860_rssi2dbm(sc
, rxwi
->rssi
[i
], i
);
5464 ieee80211_input(ni
, m
, rssi_dbm_rel
, RT2860_NOISE_FLOOR
);
5465 ieee80211_free_node(ni
);
5469 ieee80211_input_all(ic
, m
, rssi_dbm_rel
, RT2860_NOISE_FLOOR
);
5474 desc
->sdl0
&= ~htole16(RT2860_RXDESC_SDL0_DDONE
);
5476 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
5477 BUS_DMASYNC_PREREAD
| BUS_DMASYNC_PREWRITE
);
5479 ring
->cur
= (ring
->cur
+ 1) % RT2860_SOFTC_RX_RING_DATA_COUNT
;
5485 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
5486 RT2860_SOFTC_RX_RING_DATA_COUNT
- 1);
5488 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_RX_CALC_IDX
,
5491 RT2860_DPRINTF(sc
, RT2860_DEBUG_RX
,
5492 "%s: Rx eof: nframes=%d\n",
5493 device_get_nameunit(sc
->dev
), nframes
);
5495 sc
->rx_packets
+= nframes
;
5497 return (limit
== 0);
5503 static void rt2860_tx_eof(struct rt2860_softc
*sc
,
5504 struct rt2860_softc_tx_ring
*ring
)
5507 struct rt2860_txdesc
*desc
;
5508 struct rt2860_softc_tx_data
*data
;
5510 int ndescs
, nframes
;
5519 index
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_TX_DTX_IDX(ring
->qid
));
5520 if (ring
->desc_next
== index
)
5525 rt2860_drain_fifo_stats(sc
);
5527 desc
= &ring
->desc
[ring
->desc_next
];
5529 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
5530 BUS_DMASYNC_POSTREAD
| BUS_DMASYNC_POSTWRITE
);
5532 if (desc
->sdl0
& htole16(RT2860_TXDESC_SDL0_LASTSEG
) ||
5533 desc
->sdl1
& htole16(RT2860_TXDESC_SDL1_LASTSEG
))
5537 data
= &ring
->data
[ring
->data_next
];
5539 if (data
->m
->m_flags
& M_TXCB
)
5540 ieee80211_process_callback(data
->ni
, data
->m
, 0);
5542 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
5543 BUS_DMASYNC_POSTWRITE
);
5544 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
5548 ieee80211_free_node(data
->ni
);
5555 RT2860_SOFTC_LOCK(sc
);
5557 ring
->data_queued
--;
5558 ring
->data_next
= (ring
->data_next
+ 1) % RT2860_SOFTC_TX_RING_DATA_COUNT
;
5560 RT2860_SOFTC_UNLOCK(sc
);
5563 desc
->sdl0
&= ~htole16(RT2860_TXDESC_SDL0_DDONE
);
5565 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
5566 BUS_DMASYNC_PREREAD
| BUS_DMASYNC_PREWRITE
);
5568 RT2860_SOFTC_LOCK(sc
);
5570 ring
->desc_queued
--;
5571 ring
->desc_next
= (ring
->desc_next
+ 1) % RT2860_SOFTC_TX_RING_DESC_COUNT
;
5573 RT2860_SOFTC_UNLOCK(sc
);
5576 RT2860_DPRINTF(sc
, RT2860_DEBUG_TX
,
5577 "%s: Tx eof: qid=%d, ndescs=%d, nframes=%d\n",
5578 device_get_nameunit(sc
->dev
), ring
->qid
, ndescs
, nframes
);
5582 * rt2860_update_stats
5584 static void rt2860_update_stats(struct rt2860_softc
*sc
)
5587 struct ieee80211com
*ic
;
5588 struct ieee80211vap
*vap
;
5589 struct ieee80211_node
*ni
;
5591 int beacons
, noretryok
, retryok
, failed
, underflows
, zerolen
;
5597 vap
= TAILQ_FIRST(&ic
->ic_vaps
);
5599 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATS
,
5600 "%s: update statistic\n",
5601 device_get_nameunit(sc
->dev
));
5603 rt2860_drain_fifo_stats(sc
);
5605 /* read and clear Tx statistic registers */
5607 rt2860_io_mac_read_multi(sc
, RT2860_REG_TX_STA_CNT0
,
5608 stacnt
, sizeof(stacnt
));
5610 stacnt
[0] = le32toh(stacnt
[0]);
5611 stacnt
[1] = le32toh(stacnt
[1]);
5612 stacnt
[2] = le32toh(stacnt
[2]);
5614 beacons
= stacnt
[0] >> 16;
5615 noretryok
= stacnt
[1] & 0xffff;
5616 retryok
= stacnt
[1] >> 16;
5617 failed
= stacnt
[0] & 0xffff;
5618 underflows
= stacnt
[2] >> 16;
5619 zerolen
= stacnt
[2] & 0xffff;
5621 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATS
,
5622 "%s: update statistic: beacons=%d, noretryok=%d, retryok=%d, failed=%d, underflows=%d, zerolen=%d\n",
5623 device_get_nameunit(sc
->dev
),
5624 beacons
, noretryok
, retryok
, failed
, underflows
, zerolen
);
5626 ifp
->if_oerrors
+= failed
;
5628 sc
->tx_beacons
+= beacons
;
5629 sc
->tx_noretryok
+= noretryok
;
5630 sc
->tx_retryok
+= retryok
;
5631 sc
->tx_failed
+= failed
;
5632 sc
->tx_underflows
+= underflows
;
5633 sc
->tx_zerolen
+= zerolen
;
5635 if (vap
!= NULL
&& vap
->iv_opmode
== IEEE80211_M_STA
&& vap
->iv_state
== IEEE80211_S_RUN
)
5639 associd
= (ni
!= NULL
) ? ni
->ni_associd
: 0;
5640 wcid
= RT2860_AID2WCID(associd
);
5642 rt2860_amrr_tx_update(&sc
->amrr_node
[wcid
],
5643 noretryok
+ retryok
+ failed
, noretryok
+ retryok
, retryok
+ failed
);
5650 static void rt2860_bbp_tuning(struct rt2860_softc
*sc
)
5653 struct ieee80211com
*ic
;
5654 struct ieee80211vap
*vap
;
5655 struct ieee80211_node
*ni
;
5657 int8_t rssi
, old
, new;
5659 /* RT2860C does not support BBP tuning */
5661 if (sc
->mac_rev
== 0x28600100)
5666 vap
= TAILQ_FIRST(&ic
->ic_vaps
);
5668 if ((ic
->ic_flags
& IEEE80211_F_SCAN
) || vap
== NULL
||
5669 vap
->iv_opmode
!= IEEE80211_M_STA
|| vap
->iv_state
!= IEEE80211_S_RUN
)
5674 chan
= ieee80211_chan2ieee(ic
, ni
->ni_chan
);
5678 else if (chan
<= 64)
5680 else if (chan
<= 128)
5685 rssi
= ieee80211_getrssi(vap
);
5687 if (IEEE80211_IS_CHAN_2GHZ(ni
->ni_chan
))
5689 new = 0x2e + sc
->lna_gain
[group
];
5693 if (!IEEE80211_IS_CHAN_HT40(ni
->ni_chan
))
5694 new = 0x32 + sc
->lna_gain
[group
] * 5 / 3;
5696 new = 0x3a + sc
->lna_gain
[group
] * 5 / 3;
5699 /* Tune if absolute average RSSI is greater than -80 */
5704 old
= rt2860_io_bbp_read(sc
, 66);
5707 rt2860_io_bbp_write(sc
, 66, new);
5713 static void rt2860_watchdog(struct rt2860_softc
*sc
)
5718 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_PBF_TXRXQ_PCNT
);
5720 RT2860_DPRINTF(sc
, RT2860_DEBUG_WATCHDOG
,
5721 "%s: watchdog: TXRXQ_PCNT=0x%08x\n",
5722 device_get_nameunit(sc
->dev
), tmp
);
5724 if (((tmp
>> RT2860_REG_TX0Q_PCNT_SHIFT
) & RT2860_REG_TX0Q_PCNT_MASK
) != 0)
5726 sc
->tx_queue_not_empty
[0]++;
5728 rt2860_io_mac_write(sc
, RT2860_REG_PBF_CFG
, 0xf40012);
5730 for (ntries
= 0; ntries
< 10; ntries
++)
5732 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_PBF_TXRXQ_PCNT
);
5733 if (((tmp
>> RT2860_REG_TX0Q_PCNT_SHIFT
) & RT2860_REG_TX0Q_PCNT_MASK
) == 0)
5739 rt2860_io_mac_write(sc
, RT2860_REG_PBF_CFG
, 0xf40006);
5742 if (((tmp
>> RT2860_REG_TX1Q_PCNT_SHIFT
) & RT2860_REG_TX1Q_PCNT_MASK
) != 0)
5744 sc
->tx_queue_not_empty
[1]++;
5746 rt2860_io_mac_write(sc
, RT2860_REG_PBF_CFG
, 0xf4000a);
5748 for (ntries
= 0; ntries
< 10; ntries
++)
5750 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_PBF_TXRXQ_PCNT
);
5751 if (((tmp
>> RT2860_REG_TX1Q_PCNT_SHIFT
) & RT2860_REG_TX1Q_PCNT_MASK
) == 0)
5757 rt2860_io_mac_write(sc
, RT2860_REG_PBF_CFG
, 0xf40006);
5762 * rt2860_drain_fifo_stats
5764 static void rt2860_drain_fifo_stats(struct rt2860_softc
*sc
)
5768 uint8_t wcid
, mcs
, pid
;
5769 int ok
, agg
, retrycnt
;
5773 /* drain Tx status FIFO (maxsize = 16) */
5775 while ((stats
= rt2860_io_mac_read(sc
, RT2860_REG_TX_STA_FIFO
)) &
5776 RT2860_REG_TX_STA_FIFO_VALID
)
5778 wcid
= (stats
>> RT2860_REG_TX_STA_FIFO_WCID_SHIFT
) &
5779 RT2860_REG_TX_STA_FIFO_WCID_MASK
;
5781 /* if no ACK was requested, no feedback is available */
5783 if (!(stats
& RT2860_REG_TX_STA_FIFO_ACK_REQ
) || wcid
== 0xff)
5786 /* update AMRR statistic */
5788 ok
= (stats
& RT2860_REG_TX_STA_FIFO_TX_OK
) ? 1 : 0;
5789 agg
= (stats
& RT2860_REG_TX_STA_FIFO_AGG
) ? 1 : 0;
5790 mcs
= (stats
>> RT2860_REG_TX_STA_FIFO_MCS_SHIFT
) &
5791 RT2860_REG_TX_STA_FIFO_MCS_MASK
;
5792 pid
= (stats
>> RT2860_REG_TX_STA_FIFO_PID_SHIFT
) &
5793 RT2860_REG_TX_STA_FIFO_PID_MASK
;
5794 retrycnt
= pid
- mcs
;
5796 RT2860_DPRINTF(sc
, RT2860_DEBUG_STATS
,
5797 "%s: FIFO statistic: wcid=0x%02x, ok=%d, agg=%d, mcs=0x%02x, pid=0x%02x, retrycnt=%d\n",
5798 device_get_nameunit(sc
->dev
),
5799 wcid
, ok
, agg
, mcs
, pid
, retrycnt
);
5801 rt2860_amrr_tx_complete(&sc
->amrr_node
[wcid
], ok
, retrycnt
);
5809 * rt2860_update_raw_counters
5811 static void rt2860_update_raw_counters(struct rt2860_softc
*sc
)
5815 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TX_AGG_CNT
);
5817 sc
->tx_nonagg
+= tmp
& 0xffff;
5818 sc
->tx_agg
+= tmp
>> 16;
5820 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TX_AGG_CNT0
);
5822 sc
->tx_ampdu
+= (tmp
& 0xffff) / 1 + (tmp
>> 16) / 2;
5824 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TX_AGG_CNT1
);
5826 sc
->tx_ampdu
+= (tmp
& 0xffff) / 3 + (tmp
>> 16) / 4;
5828 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TX_AGG_CNT2
);
5830 sc
->tx_ampdu
+= (tmp
& 0xffff) / 5 + (tmp
>> 16) / 6;
5832 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TX_AGG_CNT3
);
5834 sc
->tx_ampdu
+= (tmp
& 0xffff) / 7 + (tmp
>> 16) / 8;
5836 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TX_AGG_CNT4
);
5838 sc
->tx_ampdu
+= (tmp
& 0xffff) / 9 + (tmp
>> 16) / 10;
5840 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TX_AGG_CNT5
);
5842 sc
->tx_ampdu
+= (tmp
& 0xffff) / 11 + (tmp
>> 16) / 12;
5844 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TX_AGG_CNT6
);
5846 sc
->tx_ampdu
+= (tmp
& 0xffff) / 13 + (tmp
>> 16) / 14;
5848 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TX_AGG_CNT7
);
5850 sc
->tx_ampdu
+= (tmp
& 0xffff) / 15 + (tmp
>> 16) / 16;
5852 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_RX_STA_CNT0
);
5854 sc
->rx_crc_errors
+= tmp
& 0xffff;
5855 sc
->rx_phy_errors
+= tmp
>> 16;
5857 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_RX_STA_CNT1
);
5859 sc
->rx_false_ccas
+= tmp
& 0xffff;
5860 sc
->rx_plcp_errors
+= tmp
>> 16;
5862 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_RX_STA_CNT2
);
5864 sc
->rx_dup_packets
+= tmp
& 0xffff;
5865 sc
->rx_fifo_overflows
+= tmp
>> 16;
5867 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_TXRX_MPDU_DEN_CNT
);
5869 sc
->tx_mpdu_zero_density
+= tmp
& 0xffff;
5870 sc
->rx_mpdu_zero_density
+= tmp
>> 16;
5874 * rt2860_intr_enable
5876 static void rt2860_intr_enable(struct rt2860_softc
*sc
, uint32_t intr_mask
)
5880 sc
->intr_disable_mask
&= ~intr_mask
;
5882 tmp
= sc
->intr_enable_mask
& ~sc
->intr_disable_mask
;
5884 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_MASK
, tmp
);
5888 * rt2860_intr_disable
5890 static void rt2860_intr_disable(struct rt2860_softc
*sc
, uint32_t intr_mask
)
5894 sc
->intr_disable_mask
|= intr_mask
;
5896 tmp
= sc
->intr_enable_mask
& ~sc
->intr_disable_mask
;
5898 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_INT_MASK
, tmp
);
5902 * rt2860_txrx_enable
5904 static int rt2860_txrx_enable(struct rt2860_softc
*sc
)
5906 struct ieee80211com
*ic
;
5914 /* enable Tx/Rx DMA engine */
5916 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
, RT2860_REG_TX_ENABLE
);
5918 for (ntries
= 0; ntries
< 200; ntries
++)
5920 tmp
= rt2860_io_mac_read(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
);
5921 if (!(tmp
& (RT2860_REG_TX_DMA_BUSY
| RT2860_REG_RX_DMA_BUSY
)))
5929 printf("%s: timeout waiting for DMA engine\n",
5930 device_get_nameunit(sc
->dev
));
5936 tmp
|= RT2860_REG_TX_WB_DDONE
|
5937 RT2860_REG_RX_DMA_ENABLE
|
5938 RT2860_REG_TX_DMA_ENABLE
|
5939 (RT2860_REG_WPDMA_BT_SIZE64
<< RT2860_REG_WPDMA_BT_SIZE_SHIFT
);
5941 rt2860_io_mac_write(sc
, RT2860_REG_SCHDMA_WPDMA_GLO_CFG
, tmp
);
5945 tmp
= RT2860_REG_RX_FILTER_DROP_CRC_ERR
|
5946 RT2860_REG_RX_FILTER_DROP_PHY_ERR
;
5948 if (ic
->ic_opmode
!= IEEE80211_M_MONITOR
)
5950 tmp
|= RT2860_REG_RX_FILTER_DROP_DUPL
|
5951 RT2860_REG_RX_FILTER_DROP_CTS
|
5952 RT2860_REG_RX_FILTER_DROP_BA
|
5953 RT2860_REG_RX_FILTER_DROP_ACK
|
5954 RT2860_REG_RX_FILTER_DROP_VER_ERR
|
5955 RT2860_REG_RX_FILTER_DROP_CTRL_RSV
|
5956 RT2860_REG_RX_FILTER_DROP_CFACK
|
5957 RT2860_REG_RX_FILTER_DROP_CFEND
;
5959 if (ic
->ic_opmode
== IEEE80211_M_STA
)
5960 tmp
|= RT2860_REG_RX_FILTER_DROP_RTS
|
5961 RT2860_REG_RX_FILTER_DROP_PSPOLL
;
5963 if (!(ifp
->if_flags
& IFF_PROMISC
))
5964 tmp
|= RT2860_REG_RX_FILTER_DROP_UC_NOME
;
5967 rt2860_io_mac_write(sc
, RT2860_REG_RX_FILTER_CFG
, tmp
);
5969 rt2860_io_mac_write(sc
, RT2860_REG_SYS_CTRL
,
5970 RT2860_REG_RX_ENABLE
| RT2860_REG_TX_ENABLE
);
5976 * rt2860_alloc_rx_ring
5978 static int rt2860_alloc_rx_ring(struct rt2860_softc
*sc
,
5979 struct rt2860_softc_rx_ring
*ring
)
5981 struct rt2860_rxdesc
*desc
;
5982 struct rt2860_softc_rx_data
*data
;
5983 bus_dma_segment_t segs
[1];
5984 int i
, nsegs
, error
;
5986 error
= bus_dma_tag_create(bus_get_dma_tag(sc
->dev
), PAGE_SIZE
, 0,
5987 BUS_SPACE_MAXADDR_32BIT
, BUS_SPACE_MAXADDR
, NULL
, NULL
,
5988 RT2860_SOFTC_RX_RING_DATA_COUNT
* sizeof(struct rt2860_rxdesc
), 1,
5989 RT2860_SOFTC_RX_RING_DATA_COUNT
* sizeof(struct rt2860_rxdesc
),
5990 0, NULL
, NULL
, &ring
->desc_dma_tag
);
5993 printf("%s: could not create Rx desc DMA tag\n",
5994 device_get_nameunit(sc
->dev
));
5998 error
= bus_dmamem_alloc(ring
->desc_dma_tag
, (void **) &ring
->desc
,
5999 BUS_DMA_NOWAIT
| BUS_DMA_ZERO
, &ring
->desc_dma_map
);
6002 printf("%s: could not allocate Rx desc DMA memory\n",
6003 device_get_nameunit(sc
->dev
));
6007 error
= bus_dmamap_load(ring
->desc_dma_tag
, ring
->desc_dma_map
,
6009 RT2860_SOFTC_RX_RING_DATA_COUNT
* sizeof(struct rt2860_rxdesc
),
6010 rt2860_dma_map_addr
, &ring
->desc_phys_addr
, 0);
6013 printf("%s: could not load Rx desc DMA map\n",
6014 device_get_nameunit(sc
->dev
));
6018 error
= bus_dma_tag_create(bus_get_dma_tag(sc
->dev
), PAGE_SIZE
, 0,
6019 BUS_SPACE_MAXADDR_32BIT
, BUS_SPACE_MAXADDR
, NULL
, NULL
,
6020 MJUMPAGESIZE
, 1, MJUMPAGESIZE
, 0, NULL
, NULL
,
6021 &ring
->data_dma_tag
);
6024 printf("%s: could not create Rx data DMA tag\n",
6025 device_get_nameunit(sc
->dev
));
6029 for (i
= 0; i
< RT2860_SOFTC_RX_RING_DATA_COUNT
; i
++)
6031 desc
= &ring
->desc
[i
];
6032 data
= &ring
->data
[i
];
6034 error
= bus_dmamap_create(ring
->data_dma_tag
, 0, &data
->dma_map
);
6037 printf("%s: could not create Rx data DMA map\n",
6038 device_get_nameunit(sc
->dev
));
6042 data
->m
= m_getjcl(M_DONTWAIT
, MT_DATA
, M_PKTHDR
, MJUMPAGESIZE
);
6043 if (data
->m
== NULL
)
6045 printf("%s: could not allocate Rx mbuf\n",
6046 device_get_nameunit(sc
->dev
));
6051 data
->m
->m_len
= data
->m
->m_pkthdr
.len
= MJUMPAGESIZE
;
6053 error
= bus_dmamap_load_mbuf_sg(ring
->data_dma_tag
, data
->dma_map
,
6054 data
->m
, segs
, &nsegs
, BUS_DMA_NOWAIT
);
6057 printf("%s: could not load Rx mbuf DMA map\n",
6058 device_get_nameunit(sc
->dev
));
6062 KASSERT(nsegs
== 1, ("%s: too many DMA segments",
6063 device_get_nameunit(sc
->dev
)));
6065 desc
->sdp0
= htole32(segs
[0].ds_addr
);
6066 desc
->sdl0
= htole16(MJUMPAGESIZE
);
6069 error
= bus_dmamap_create(ring
->data_dma_tag
, 0, &ring
->spare_dma_map
);
6072 printf("%s: could not create Rx spare DMA map\n",
6073 device_get_nameunit(sc
->dev
));
6077 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
6078 BUS_DMASYNC_PREREAD
| BUS_DMASYNC_PREWRITE
);
6084 rt2860_free_rx_ring(sc
, ring
);
6090 * rt2860_reset_rx_ring
6092 static void rt2860_reset_rx_ring(struct rt2860_softc
*sc
,
6093 struct rt2860_softc_rx_ring
*ring
)
6095 struct rt2860_rxdesc
*desc
;
6098 for (i
= 0; i
< RT2860_SOFTC_RX_RING_DATA_COUNT
; i
++)
6100 desc
= &ring
->desc
[i
];
6102 desc
->sdl0
&= ~htole16(RT2860_RXDESC_SDL0_DDONE
);
6105 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
6106 BUS_DMASYNC_PREREAD
| BUS_DMASYNC_PREWRITE
);
6112 * rt2860_free_rx_ring
6114 static void rt2860_free_rx_ring(struct rt2860_softc
*sc
,
6115 struct rt2860_softc_rx_ring
*ring
)
6117 struct rt2860_softc_rx_data
*data
;
6120 if (ring
->desc
!= NULL
)
6122 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
6123 BUS_DMASYNC_POSTWRITE
);
6124 bus_dmamap_unload(ring
->desc_dma_tag
, ring
->desc_dma_map
);
6125 bus_dmamem_free(ring
->desc_dma_tag
, ring
->desc
,
6126 ring
->desc_dma_map
);
6129 if (ring
->desc_dma_tag
!= NULL
)
6130 bus_dma_tag_destroy(ring
->desc_dma_tag
);
6132 for (i
= 0; i
< RT2860_SOFTC_RX_RING_DATA_COUNT
; i
++)
6134 data
= &ring
->data
[i
];
6136 if (data
->m
!= NULL
)
6138 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
6139 BUS_DMASYNC_POSTREAD
);
6140 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
6144 if (data
->dma_map
!= NULL
)
6145 bus_dmamap_destroy(ring
->data_dma_tag
, data
->dma_map
);
6148 if (ring
->spare_dma_map
!= NULL
)
6149 bus_dmamap_destroy(ring
->data_dma_tag
, ring
->spare_dma_map
);
6151 if (ring
->data_dma_tag
!= NULL
)
6152 bus_dma_tag_destroy(ring
->data_dma_tag
);
6156 * rt2860_alloc_tx_ring
6158 static int rt2860_alloc_tx_ring(struct rt2860_softc
*sc
,
6159 struct rt2860_softc_tx_ring
*ring
, int qid
)
6161 struct rt2860_softc_tx_data
*data
;
6164 error
= bus_dma_tag_create(bus_get_dma_tag(sc
->dev
), PAGE_SIZE
, 0,
6165 BUS_SPACE_MAXADDR_32BIT
, BUS_SPACE_MAXADDR
, NULL
, NULL
,
6166 RT2860_SOFTC_TX_RING_DESC_COUNT
* sizeof(struct rt2860_txdesc
), 1,
6167 RT2860_SOFTC_TX_RING_DESC_COUNT
* sizeof(struct rt2860_txdesc
),
6168 0, NULL
, NULL
, &ring
->desc_dma_tag
);
6171 printf("%s: could not create Tx desc DMA tag\n",
6172 device_get_nameunit(sc
->dev
));
6176 error
= bus_dmamem_alloc(ring
->desc_dma_tag
, (void **) &ring
->desc
,
6177 BUS_DMA_NOWAIT
| BUS_DMA_ZERO
, &ring
->desc_dma_map
);
6180 printf("%s: could not allocate Tx desc DMA memory\n",
6181 device_get_nameunit(sc
->dev
));
6185 error
= bus_dmamap_load(ring
->desc_dma_tag
, ring
->desc_dma_map
,
6187 RT2860_SOFTC_TX_RING_DESC_COUNT
* sizeof(struct rt2860_txdesc
),
6188 rt2860_dma_map_addr
, &ring
->desc_phys_addr
, 0);
6191 printf("%s: could not load Tx desc DMA map\n",
6192 device_get_nameunit(sc
->dev
));
6196 ring
->desc_queued
= 0;
6198 ring
->desc_next
= 0;
6200 error
= bus_dma_tag_create(bus_get_dma_tag(sc
->dev
), PAGE_SIZE
, 0,
6201 BUS_SPACE_MAXADDR_32BIT
, BUS_SPACE_MAXADDR
, NULL
, NULL
,
6202 RT2860_SOFTC_TX_RING_DATA_COUNT
* RT2860_TX_DATA_SEG0_SIZE
, 1,
6203 RT2860_SOFTC_TX_RING_DATA_COUNT
* RT2860_TX_DATA_SEG0_SIZE
,
6204 0, NULL
, NULL
, &ring
->seg0_dma_tag
);
6207 printf("%s: could not create Tx seg0 DMA tag\n",
6208 device_get_nameunit(sc
->dev
));
6212 error
= bus_dmamem_alloc(ring
->seg0_dma_tag
, (void **) &ring
->seg0
,
6213 BUS_DMA_NOWAIT
| BUS_DMA_ZERO
, &ring
->seg0_dma_map
);
6216 printf("%s: could not allocate Tx seg0 DMA memory\n",
6217 device_get_nameunit(sc
->dev
));
6221 error
= bus_dmamap_load(ring
->seg0_dma_tag
, ring
->seg0_dma_map
,
6223 RT2860_SOFTC_TX_RING_DATA_COUNT
* RT2860_TX_DATA_SEG0_SIZE
,
6224 rt2860_dma_map_addr
, &ring
->seg0_phys_addr
, 0);
6227 printf("%s: could not load Tx seg0 DMA map\n",
6228 device_get_nameunit(sc
->dev
));
6232 error
= bus_dma_tag_create(bus_get_dma_tag(sc
->dev
), PAGE_SIZE
, 0,
6233 BUS_SPACE_MAXADDR_32BIT
, BUS_SPACE_MAXADDR
, NULL
, NULL
,
6234 MJUMPAGESIZE
, RT2860_SOFTC_MAX_SCATTER
, MJUMPAGESIZE
, 0, NULL
, NULL
,
6235 &ring
->data_dma_tag
);
6238 printf("%s: could not create Tx data DMA tag\n",
6239 device_get_nameunit(sc
->dev
));
6243 for (i
= 0; i
< RT2860_SOFTC_TX_RING_DATA_COUNT
; i
++)
6245 data
= &ring
->data
[i
];
6247 error
= bus_dmamap_create(ring
->data_dma_tag
, 0, &data
->dma_map
);
6250 printf("%s: could not create Tx data DMA map\n",
6251 device_get_nameunit(sc
->dev
));
6256 ring
->data_queued
= 0;
6258 ring
->data_next
= 0;
6266 rt2860_free_tx_ring(sc
, ring
);
6272 * rt2860_reset_tx_ring
6274 static void rt2860_reset_tx_ring(struct rt2860_softc
*sc
,
6275 struct rt2860_softc_tx_ring
*ring
)
6277 struct rt2860_softc_tx_data
*data
;
6278 struct rt2860_txdesc
*desc
;
6281 for (i
= 0; i
< RT2860_SOFTC_TX_RING_DESC_COUNT
; i
++)
6283 desc
= &ring
->desc
[i
];
6289 ring
->desc_queued
= 0;
6291 ring
->desc_next
= 0;
6293 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
6294 BUS_DMASYNC_PREWRITE
);
6296 bus_dmamap_sync(ring
->seg0_dma_tag
, ring
->seg0_dma_map
,
6297 BUS_DMASYNC_PREWRITE
);
6299 for (i
= 0; i
< RT2860_SOFTC_TX_RING_DATA_COUNT
; i
++)
6301 data
= &ring
->data
[i
];
6303 if (data
->m
!= NULL
)
6305 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
6306 BUS_DMASYNC_POSTWRITE
);
6307 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
6312 if (data
->ni
!= NULL
)
6314 ieee80211_free_node(data
->ni
);
6319 ring
->data_queued
= 0;
6321 ring
->data_next
= 0;
6325 * rt2860_free_tx_ring
6327 static void rt2860_free_tx_ring(struct rt2860_softc
*sc
,
6328 struct rt2860_softc_tx_ring
*ring
)
6330 struct rt2860_softc_tx_data
*data
;
6333 if (ring
->desc
!= NULL
)
6335 bus_dmamap_sync(ring
->desc_dma_tag
, ring
->desc_dma_map
,
6336 BUS_DMASYNC_POSTWRITE
);
6337 bus_dmamap_unload(ring
->desc_dma_tag
, ring
->desc_dma_map
);
6338 bus_dmamem_free(ring
->desc_dma_tag
, ring
->desc
,
6339 ring
->desc_dma_map
);
6342 if (ring
->desc_dma_tag
!= NULL
)
6343 bus_dma_tag_destroy(ring
->desc_dma_tag
);
6345 if (ring
->seg0
!= NULL
)
6347 bus_dmamap_sync(ring
->seg0_dma_tag
, ring
->seg0_dma_map
,
6348 BUS_DMASYNC_POSTWRITE
);
6349 bus_dmamap_unload(ring
->seg0_dma_tag
, ring
->seg0_dma_map
);
6350 bus_dmamem_free(ring
->seg0_dma_tag
, ring
->seg0
,
6351 ring
->seg0_dma_map
);
6354 if (ring
->seg0_dma_tag
!= NULL
)
6355 bus_dma_tag_destroy(ring
->seg0_dma_tag
);
6357 for (i
= 0; i
< RT2860_SOFTC_TX_RING_DATA_COUNT
; i
++)
6359 data
= &ring
->data
[i
];
6361 if (data
->m
!= NULL
)
6363 bus_dmamap_sync(ring
->data_dma_tag
, data
->dma_map
,
6364 BUS_DMASYNC_POSTWRITE
);
6365 bus_dmamap_unload(ring
->data_dma_tag
, data
->dma_map
);
6369 if (data
->ni
!= NULL
)
6370 ieee80211_free_node(data
->ni
);
6372 if (data
->dma_map
!= NULL
)
6373 bus_dmamap_destroy(ring
->data_dma_tag
, data
->dma_map
);
6376 if (ring
->data_dma_tag
!= NULL
)
6377 bus_dma_tag_destroy(ring
->data_dma_tag
);
6381 * rt2860_dma_map_addr
6383 static void rt2860_dma_map_addr(void *arg
, bus_dma_segment_t
*segs
,
6384 int nseg
, int error
)
6389 KASSERT(nseg
== 1, ("too many DMA segments, %d should be 1", nseg
));
6391 *(bus_addr_t
*) arg
= segs
[0].ds_addr
;
6395 * rt2860_sysctl_attach
6397 static void rt2860_sysctl_attach(struct rt2860_softc
*sc
)
6399 struct sysctl_ctx_list
*ctx
;
6400 struct sysctl_oid
*tree
;
6401 struct sysctl_oid
*stats
;
6403 ctx
= device_get_sysctl_ctx(sc
->dev
);
6404 tree
= device_get_sysctl_tree(sc
->dev
);
6406 stats
= SYSCTL_ADD_NODE(ctx
, SYSCTL_CHILDREN(tree
), OID_AUTO
,
6407 "stats", CTLFLAG_RD
, 0, "statistic");
6409 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6410 "interrupts", CTLFLAG_RD
, &sc
->interrupts
, 0,
6413 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6414 "tx_coherent_interrupts", CTLFLAG_RD
, &sc
->tx_coherent_interrupts
, 0,
6415 "Tx coherent interrupts");
6417 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6418 "rx_coherent_interrupts", CTLFLAG_RD
, &sc
->rx_coherent_interrupts
, 0,
6419 "Rx coherent interrupts");
6421 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6422 "txrx_coherent_interrupts", CTLFLAG_RD
, &sc
->txrx_coherent_interrupts
, 0,
6423 "Tx/Rx coherent interrupts");
6425 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6426 "fifo_sta_full_interrupts", CTLFLAG_RD
, &sc
->fifo_sta_full_interrupts
, 0,
6427 "FIFO statistic full interrupts");
6429 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6430 "rx_interrupts", CTLFLAG_RD
, &sc
->rx_interrupts
, 0,
6433 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6434 "rx_delay_interrupts", CTLFLAG_RD
, &sc
->rx_delay_interrupts
, 0,
6435 "Rx delay interrupts");
6437 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6438 "tx_mgmt_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[5], 0,
6439 "Tx MGMT interrupts");
6441 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6442 "tx_hcca_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[4], 0,
6443 "Tx HCCA interrupts");
6445 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6446 "tx_ac3_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[3], 0,
6447 "Tx AC3 interrupts");
6449 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6450 "tx_ac2_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[2], 0,
6451 "Tx AC2 interrupts");
6453 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6454 "tx_ac1_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[1], 0,
6455 "Tx AC1 interrupts");
6457 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6458 "tx_ac0_interrupts", CTLFLAG_RD
, &sc
->tx_interrupts
[0], 0,
6459 "Tx AC0 interrupts");
6461 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6462 "tx_delay_interrupts", CTLFLAG_RD
, &sc
->tx_delay_interrupts
, 0,
6463 "Tx delay interrupts");
6465 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6466 "pre_tbtt_interrupts", CTLFLAG_RD
, &sc
->pre_tbtt_interrupts
, 0,
6467 "Pre-TBTT interrupts");
6469 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6470 "tbtt_interrupts", CTLFLAG_RD
, &sc
->tbtt_interrupts
, 0,
6473 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6474 "mcu_cmd_interrupts", CTLFLAG_RD
, &sc
->mcu_cmd_interrupts
, 0,
6475 "MCU command interrupts");
6477 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6478 "auto_wakeup_interrupts", CTLFLAG_RD
, &sc
->auto_wakeup_interrupts
, 0,
6479 "auto wakeup interrupts");
6481 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6482 "gp_timer_interrupts", CTLFLAG_RD
, &sc
->gp_timer_interrupts
, 0,
6483 "GP timer interrupts");
6485 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6486 "tx_mgmt_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[5].desc_queued
, 0,
6487 "Tx MGMT descriptors queued");
6489 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6490 "tx_mgmt_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[5].data_queued
, 0,
6491 "Tx MGMT data queued");
6493 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6494 "tx_hcca_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[4].desc_queued
, 0,
6495 "Tx HCCA descriptors queued");
6497 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6498 "tx_hcca_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[4].data_queued
, 0,
6499 "Tx HCCA data queued");
6501 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6502 "tx_ac3_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[3].desc_queued
, 0,
6503 "Tx AC3 descriptors queued");
6505 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6506 "tx_ac3_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[3].data_queued
, 0,
6507 "Tx AC3 data queued");
6509 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6510 "tx_ac2_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[2].desc_queued
, 0,
6511 "Tx AC2 descriptors queued");
6513 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6514 "tx_ac2_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[2].data_queued
, 0,
6515 "Tx AC2 data queued");
6517 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6518 "tx_ac1_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[1].desc_queued
, 0,
6519 "Tx AC1 descriptors queued");
6521 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6522 "tx_ac1_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[1].data_queued
, 0,
6523 "Tx AC1 data queued");
6525 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6526 "tx_ac0_desc_queued", CTLFLAG_RD
, &sc
->tx_ring
[0].desc_queued
, 0,
6527 "Tx AC0 descriptors queued");
6529 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6530 "tx_ac0_data_queued", CTLFLAG_RD
, &sc
->tx_ring
[0].data_queued
, 0,
6531 "Tx AC0 data queued");
6533 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6534 "tx_mgmt_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[5], 0,
6535 "Tx MGMT data queue full");
6537 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6538 "tx_hcca_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[4], 0,
6539 "Tx HCCA data queue full");
6541 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6542 "tx_ac3_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[3], 0,
6543 "Tx AC3 data queue full");
6545 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6546 "tx_ac2_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[2], 0,
6547 "Tx AC2 data queue full");
6549 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6550 "tx_ac1_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[1], 0,
6551 "Tx AC1 data queue full");
6553 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6554 "tx_ac0_data_queue_full", CTLFLAG_RD
, &sc
->tx_data_queue_full
[0], 0,
6555 "Tx AC0 data queue full");
6557 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6558 "tx_watchdog_timeouts", CTLFLAG_RD
, &sc
->tx_watchdog_timeouts
, 0,
6559 "Tx watchdog timeouts");
6561 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6562 "tx_defrag_packets", CTLFLAG_RD
, &sc
->tx_defrag_packets
, 0,
6563 "Tx defragmented packets");
6565 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6566 "no_tx_desc_avail", CTLFLAG_RD
, &sc
->no_tx_desc_avail
, 0,
6567 "no Tx descriptors available");
6569 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6570 "rx_mbuf_alloc_errors", CTLFLAG_RD
, &sc
->rx_mbuf_alloc_errors
, 0,
6571 "Rx mbuf allocation errors");
6573 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6574 "rx_mbuf_dmamap_errors", CTLFLAG_RD
, &sc
->rx_mbuf_dmamap_errors
, 0,
6575 "Rx mbuf DMA mapping errors");
6577 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6578 "tx_queue_0_not_empty", CTLFLAG_RD
, &sc
->tx_queue_not_empty
[0], 0,
6579 "Tx queue 0 not empty");
6581 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6582 "tx_queue_1_not_empty", CTLFLAG_RD
, &sc
->tx_queue_not_empty
[1], 0,
6583 "Tx queue 1 not empty");
6585 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6586 "tx_beacons", CTLFLAG_RD
, &sc
->tx_beacons
, 0,
6589 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6590 "tx_noretryok", CTLFLAG_RD
, &sc
->tx_noretryok
, 0,
6591 "Tx successfull without retries");
6593 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6594 "tx_retryok", CTLFLAG_RD
, &sc
->tx_retryok
, 0,
6595 "Tx successfull with retries");
6597 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6598 "tx_failed", CTLFLAG_RD
, &sc
->tx_failed
, 0,
6601 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6602 "tx_underflows", CTLFLAG_RD
, &sc
->tx_underflows
, 0,
6605 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6606 "tx_zerolen", CTLFLAG_RD
, &sc
->tx_zerolen
, 0,
6609 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6610 "tx_nonagg", CTLFLAG_RD
, &sc
->tx_nonagg
, 0,
6611 "Tx non-aggregated");
6613 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6614 "tx_agg", CTLFLAG_RD
, &sc
->tx_agg
, 0,
6617 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6618 "tx_ampdu", CTLFLAG_RD
, &sc
->tx_ampdu
, 0,
6621 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6622 "tx_mpdu_zero_density", CTLFLAG_RD
, &sc
->tx_mpdu_zero_density
, 0,
6623 "Tx MPDU with zero density");
6625 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6626 "rx_packets", CTLFLAG_RD
, &sc
->rx_packets
, 0,
6629 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6630 "rx_ampdu", CTLFLAG_RD
, &sc
->rx_ampdu
, 0,
6633 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6634 "rx_mpdu_zero_density", CTLFLAG_RD
, &sc
->rx_mpdu_zero_density
, 0,
6635 "Rx MPDU with zero density");
6637 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6638 "rx_amsdu", CTLFLAG_RD
, &sc
->rx_amsdu
, 0,
6641 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6642 "rx_crc_errors", CTLFLAG_RD
, &sc
->rx_crc_errors
, 0,
6645 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6646 "rx_phy_errors", CTLFLAG_RD
, &sc
->rx_phy_errors
, 0,
6649 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6650 "rx_false_ccas", CTLFLAG_RD
, &sc
->rx_false_ccas
, 0,
6653 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6654 "rx_plcp_errors", CTLFLAG_RD
, &sc
->rx_plcp_errors
, 0,
6657 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6658 "rx_dup_packets", CTLFLAG_RD
, &sc
->rx_dup_packets
, 0,
6659 "Rx duplicate packets");
6661 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6662 "rx_fifo_overflows", CTLFLAG_RD
, &sc
->rx_fifo_overflows
, 0,
6663 "Rx FIFO overflows");
6665 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6666 "rx_cipher_no_errors", CTLFLAG_RD
, &sc
->rx_cipher_no_errors
, 0,
6667 "Rx cipher no errors");
6669 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6670 "rx_cipher_icv_errors", CTLFLAG_RD
, &sc
->rx_cipher_icv_errors
, 0,
6671 "Rx cipher ICV errors");
6673 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6674 "rx_cipher_mic_errors", CTLFLAG_RD
, &sc
->rx_cipher_mic_errors
, 0,
6675 "Rx cipher MIC errors");
6677 SYSCTL_ADD_INT(ctx
, SYSCTL_CHILDREN(stats
), OID_AUTO
,
6678 "rx_cipher_invalid_key_errors", CTLFLAG_RD
, &sc
->rx_cipher_invalid_key_errors
, 0,
6679 "Rx cipher invalid key errors");
6682 static device_method_t rt2860_dev_methods
[] =
6684 DEVMETHOD(device_probe
, rt2860_probe
),
6685 DEVMETHOD(device_attach
, rt2860_attach
),
6686 DEVMETHOD(device_detach
, rt2860_detach
),
6687 DEVMETHOD(device_shutdown
, rt2860_shutdown
),
6688 DEVMETHOD(device_suspend
, rt2860_suspend
),
6689 DEVMETHOD(device_resume
, rt2860_resume
),
6693 static driver_t rt2860_driver
=
6697 sizeof(struct rt2860_softc
)
6700 static devclass_t rt2860_dev_class
;
6702 DRIVER_MODULE(rt2860
, pci
, rt2860_driver
, rt2860_dev_class
, 0, 0);
6704 MODULE_DEPEND(rt2860
, pci
, 1, 1, 1);
6705 MODULE_DEPEND(rt2860
, wlan
, 1, 1, 1);