1 /******************************************************************************
3 * Copyright(c) 2009-2010 Realtek Corporation.
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of version 2 of the GNU General Public License as
7 * published by the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
14 * The full GNU General Public License is included in this distribution in the
15 * file called LICENSE.
17 * Contact Information:
18 * wlanfae <wlanfae@realtek.com>
19 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
20 * Hsinchu 300, Taiwan.
22 * Larry Finger <Larry.Finger@lwfinger.net>
24 *****************************************************************************/
40 #include "../pwrseqcmd.h"
42 #include "../btcoexist/rtl_btc.h"
46 static void _rtl8821ae_return_beacon_queue_skb(struct ieee80211_hw *hw)
48 struct rtl_priv *rtlpriv = rtl_priv(hw);
49 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
50 struct rtl8192_tx_ring *ring = &rtlpci->tx_ring[BEACON_QUEUE];
53 spin_lock_irqsave(&rtlpriv->locks.irq_th_lock, flags);
54 while (skb_queue_len(&ring->queue)) {
55 struct rtl_tx_desc *entry = &ring->desc[ring->idx];
56 struct sk_buff *skb = __skb_dequeue(&ring->queue);
58 pci_unmap_single(rtlpci->pdev,
59 rtlpriv->cfg->ops->get_desc(
60 (u8 *)entry, true, HW_DESC_TXBUFF_ADDR),
61 skb->len, PCI_DMA_TODEVICE);
63 ring->idx = (ring->idx + 1) % ring->entries;
65 spin_unlock_irqrestore(&rtlpriv->locks.irq_th_lock, flags);
68 static void _rtl8821ae_set_bcn_ctrl_reg(struct ieee80211_hw *hw,
69 u8 set_bits, u8 clear_bits)
71 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
72 struct rtl_priv *rtlpriv = rtl_priv(hw);
74 rtlpci->reg_bcn_ctrl_val |= set_bits;
75 rtlpci->reg_bcn_ctrl_val &= ~clear_bits;
77 rtl_write_byte(rtlpriv, REG_BCN_CTRL, (u8)rtlpci->reg_bcn_ctrl_val);
80 void _rtl8821ae_stop_tx_beacon(struct ieee80211_hw *hw)
82 struct rtl_priv *rtlpriv = rtl_priv(hw);
85 tmp1byte = rtl_read_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2);
86 rtl_write_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2, tmp1byte & (~BIT(6)));
87 rtl_write_byte(rtlpriv, REG_TBTT_PROHIBIT + 1, 0x64);
88 tmp1byte = rtl_read_byte(rtlpriv, REG_TBTT_PROHIBIT + 2);
89 tmp1byte &= ~(BIT(0));
90 rtl_write_byte(rtlpriv, REG_TBTT_PROHIBIT + 2, tmp1byte);
93 void _rtl8821ae_resume_tx_beacon(struct ieee80211_hw *hw)
95 struct rtl_priv *rtlpriv = rtl_priv(hw);
98 tmp1byte = rtl_read_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2);
99 rtl_write_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2, tmp1byte | BIT(6));
100 rtl_write_byte(rtlpriv, REG_TBTT_PROHIBIT + 1, 0xff);
101 tmp1byte = rtl_read_byte(rtlpriv, REG_TBTT_PROHIBIT + 2);
103 rtl_write_byte(rtlpriv, REG_TBTT_PROHIBIT + 2, tmp1byte);
106 static void _rtl8821ae_enable_bcn_sub_func(struct ieee80211_hw *hw)
108 _rtl8821ae_set_bcn_ctrl_reg(hw, 0, BIT(1));
111 static void _rtl8821ae_disable_bcn_sub_func(struct ieee80211_hw *hw)
113 _rtl8821ae_set_bcn_ctrl_reg(hw, BIT(1), 0);
116 static void _rtl8821ae_set_fw_clock_on(struct ieee80211_hw *hw,
117 u8 rpwm_val, bool b_need_turn_off_ckk)
119 struct rtl_priv *rtlpriv = rtl_priv(hw);
120 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
121 bool b_support_remote_wake_up;
122 u32 count = 0, isr_regaddr, content;
123 bool b_schedule_timer = b_need_turn_off_ckk;
125 rtlpriv->cfg->ops->get_hw_reg(hw, HAL_DEF_WOWLAN,
126 (u8 *)(&b_support_remote_wake_up));
128 if (!rtlhal->fw_ready)
130 if (!rtlpriv->psc.fw_current_inpsmode)
134 spin_lock_bh(&rtlpriv->locks.fw_ps_lock);
135 if (rtlhal->fw_clk_change_in_progress) {
136 while (rtlhal->fw_clk_change_in_progress) {
137 spin_unlock_bh(&rtlpriv->locks.fw_ps_lock);
142 spin_lock_bh(&rtlpriv->locks.fw_ps_lock);
144 spin_unlock_bh(&rtlpriv->locks.fw_ps_lock);
146 rtlhal->fw_clk_change_in_progress = false;
147 spin_unlock_bh(&rtlpriv->locks.fw_ps_lock);
152 if (IS_IN_LOW_POWER_STATE_8821AE(rtlhal->fw_ps_state)) {
153 rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_SET_RPWM,
155 if (FW_PS_IS_ACK(rpwm_val)) {
156 isr_regaddr = REG_HISR;
157 content = rtl_read_dword(rtlpriv, isr_regaddr);
158 while (!(content & IMR_CPWM) && (count < 500)) {
161 content = rtl_read_dword(rtlpriv, isr_regaddr);
164 if (content & IMR_CPWM) {
165 rtl_write_word(rtlpriv, isr_regaddr, 0x0100);
166 rtlhal->fw_ps_state = FW_PS_STATE_RF_ON_8821AE;
167 RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
168 "Receive CPWM INT!!! Set rtlhal->FwPSState = %X\n",
169 rtlhal->fw_ps_state);
173 spin_lock_bh(&rtlpriv->locks.fw_ps_lock);
174 rtlhal->fw_clk_change_in_progress = false;
175 spin_unlock_bh(&rtlpriv->locks.fw_ps_lock);
176 if (b_schedule_timer)
177 mod_timer(&rtlpriv->works.fw_clockoff_timer,
178 jiffies + MSECS(10));
180 spin_lock_bh(&rtlpriv->locks.fw_ps_lock);
181 rtlhal->fw_clk_change_in_progress = false;
182 spin_unlock_bh(&rtlpriv->locks.fw_ps_lock);
186 static void _rtl8821ae_set_fw_clock_off(struct ieee80211_hw *hw,
189 struct rtl_priv *rtlpriv = rtl_priv(hw);
190 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
191 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
192 struct rtl8192_tx_ring *ring;
193 enum rf_pwrstate rtstate;
194 bool b_schedule_timer = false;
197 if (!rtlhal->fw_ready)
199 if (!rtlpriv->psc.fw_current_inpsmode)
201 if (!rtlhal->allow_sw_to_change_hwclc)
203 rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_RF_STATE, (u8 *)(&rtstate));
204 if (rtstate == ERFOFF || rtlpriv->psc.inactive_pwrstate == ERFOFF)
207 for (queue = 0; queue < RTL_PCI_MAX_TX_QUEUE_COUNT; queue++) {
208 ring = &rtlpci->tx_ring[queue];
209 if (skb_queue_len(&ring->queue)) {
210 b_schedule_timer = true;
215 if (b_schedule_timer) {
216 mod_timer(&rtlpriv->works.fw_clockoff_timer,
217 jiffies + MSECS(10));
221 if (FW_PS_STATE(rtlhal->fw_ps_state) !=
222 FW_PS_STATE_RF_OFF_LOW_PWR_8821AE) {
223 spin_lock_bh(&rtlpriv->locks.fw_ps_lock);
224 if (!rtlhal->fw_clk_change_in_progress) {
225 rtlhal->fw_clk_change_in_progress = true;
226 spin_unlock_bh(&rtlpriv->locks.fw_ps_lock);
227 rtlhal->fw_ps_state = FW_PS_STATE(rpwm_val);
228 rtl_write_word(rtlpriv, REG_HISR, 0x0100);
229 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SET_RPWM,
231 spin_lock_bh(&rtlpriv->locks.fw_ps_lock);
232 rtlhal->fw_clk_change_in_progress = false;
233 spin_unlock_bh(&rtlpriv->locks.fw_ps_lock);
235 spin_unlock_bh(&rtlpriv->locks.fw_ps_lock);
236 mod_timer(&rtlpriv->works.fw_clockoff_timer,
237 jiffies + MSECS(10));
242 static void _rtl8821ae_set_fw_ps_rf_on(struct ieee80211_hw *hw)
246 rpwm_val |= (FW_PS_STATE_RF_OFF_8821AE | FW_PS_ACK);
247 _rtl8821ae_set_fw_clock_on(hw, rpwm_val, true);
250 static void _rtl8821ae_fwlps_leave(struct ieee80211_hw *hw)
252 struct rtl_priv *rtlpriv = rtl_priv(hw);
253 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
254 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
255 bool fw_current_inps = false;
256 u8 rpwm_val = 0, fw_pwrmode = FW_PS_ACTIVE_MODE;
258 if (ppsc->low_power_enable) {
259 rpwm_val = (FW_PS_STATE_ALL_ON_8821AE|FW_PS_ACK);/* RF on */
260 _rtl8821ae_set_fw_clock_on(hw, rpwm_val, false);
261 rtlhal->allow_sw_to_change_hwclc = false;
262 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_H2C_FW_PWRMODE,
263 (u8 *)(&fw_pwrmode));
264 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_FW_PSMODE_STATUS,
265 (u8 *)(&fw_current_inps));
267 rpwm_val = FW_PS_STATE_ALL_ON_8821AE; /* RF on */
268 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SET_RPWM,
270 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_H2C_FW_PWRMODE,
271 (u8 *)(&fw_pwrmode));
272 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_FW_PSMODE_STATUS,
273 (u8 *)(&fw_current_inps));
277 static void _rtl8821ae_fwlps_enter(struct ieee80211_hw *hw)
279 struct rtl_priv *rtlpriv = rtl_priv(hw);
280 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
281 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
282 bool fw_current_inps = true;
285 if (ppsc->low_power_enable) {
286 rpwm_val = FW_PS_STATE_RF_OFF_LOW_PWR_8821AE; /* RF off */
287 rtlpriv->cfg->ops->set_hw_reg(hw,
288 HW_VAR_FW_PSMODE_STATUS,
289 (u8 *)(&fw_current_inps));
290 rtlpriv->cfg->ops->set_hw_reg(hw,
291 HW_VAR_H2C_FW_PWRMODE,
292 (u8 *)(&ppsc->fwctrl_psmode));
293 rtlhal->allow_sw_to_change_hwclc = true;
294 _rtl8821ae_set_fw_clock_off(hw, rpwm_val);
296 rpwm_val = FW_PS_STATE_RF_OFF_8821AE; /* RF off */
297 rtlpriv->cfg->ops->set_hw_reg(hw,
298 HW_VAR_FW_PSMODE_STATUS,
299 (u8 *)(&fw_current_inps));
300 rtlpriv->cfg->ops->set_hw_reg(hw,
301 HW_VAR_H2C_FW_PWRMODE,
302 (u8 *)(&ppsc->fwctrl_psmode));
303 rtlpriv->cfg->ops->set_hw_reg(hw,
309 static void _rtl8821ae_download_rsvd_page(struct ieee80211_hw *hw,
310 bool dl_whole_packets)
312 struct rtl_priv *rtlpriv = rtl_priv(hw);
313 struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
314 u8 tmp_regcr, tmp_reg422, bcnvalid_reg;
315 u8 count = 0, dlbcn_count = 0;
316 bool send_beacon = false;
318 tmp_regcr = rtl_read_byte(rtlpriv, REG_CR + 1);
319 rtl_write_byte(rtlpriv, REG_CR + 1, (tmp_regcr | BIT(0)));
321 _rtl8821ae_set_bcn_ctrl_reg(hw, 0, BIT(3));
322 _rtl8821ae_set_bcn_ctrl_reg(hw, BIT(4), 0);
324 tmp_reg422 = rtl_read_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2);
325 rtl_write_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2,
326 tmp_reg422 & (~BIT(6)));
327 if (tmp_reg422 & BIT(6))
331 bcnvalid_reg = rtl_read_byte(rtlpriv, REG_TDECTRL + 2);
332 rtl_write_byte(rtlpriv, REG_TDECTRL + 2,
333 (bcnvalid_reg | BIT(0)));
334 _rtl8821ae_return_beacon_queue_skb(hw);
336 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE)
337 rtl8812ae_set_fw_rsvdpagepkt(hw, false,
340 rtl8821ae_set_fw_rsvdpagepkt(hw, false,
343 bcnvalid_reg = rtl_read_byte(rtlpriv, REG_TDECTRL + 2);
345 while (!(bcnvalid_reg & BIT(0)) && count < 20) {
348 bcnvalid_reg = rtl_read_byte(rtlpriv, REG_TDECTRL + 2);
351 } while (!(bcnvalid_reg & BIT(0)) && dlbcn_count < 5);
353 if (!(bcnvalid_reg & BIT(0)))
354 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
355 "Download RSVD page failed!\n");
356 if (bcnvalid_reg & BIT(0) && rtlhal->enter_pnp_sleep) {
357 rtl_write_byte(rtlpriv, REG_TDECTRL + 2, bcnvalid_reg | BIT(0));
358 _rtl8821ae_return_beacon_queue_skb(hw);
362 rtl_write_byte(rtlpriv, REG_TDECTRL + 2,
363 bcnvalid_reg | BIT(0));
365 _rtl8821ae_return_beacon_queue_skb(hw);
367 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE)
368 rtl8812ae_set_fw_rsvdpagepkt(hw, true,
371 rtl8821ae_set_fw_rsvdpagepkt(hw, true,
374 /* check rsvd page download OK. */
375 bcnvalid_reg = rtl_read_byte(rtlpriv,
378 while (!(bcnvalid_reg & BIT(0)) && count < 20) {
382 rtl_read_byte(rtlpriv,
386 } while (!(bcnvalid_reg & BIT(0)) && dlbcn_count < 5);
388 if (!(bcnvalid_reg & BIT(0)))
389 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
390 "2 Download RSVD page failed!\n");
394 if (bcnvalid_reg & BIT(0))
395 rtl_write_byte(rtlpriv, REG_TDECTRL + 2, BIT(0));
397 _rtl8821ae_set_bcn_ctrl_reg(hw, BIT(3), 0);
398 _rtl8821ae_set_bcn_ctrl_reg(hw, 0, BIT(4));
401 rtl_write_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2, tmp_reg422);
403 if (!rtlhal->enter_pnp_sleep) {
404 tmp_regcr = rtl_read_byte(rtlpriv, REG_CR + 1);
405 rtl_write_byte(rtlpriv, REG_CR + 1, (tmp_regcr & ~(BIT(0))));
409 void rtl8821ae_get_hw_reg(struct ieee80211_hw *hw, u8 variable, u8 *val)
411 struct rtl_priv *rtlpriv = rtl_priv(hw);
412 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
413 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
414 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
417 case HW_VAR_ETHER_ADDR:
418 *((u32 *)(val)) = rtl_read_dword(rtlpriv, REG_MACID);
419 *((u16 *)(val+4)) = rtl_read_word(rtlpriv, REG_MACID + 4);
422 *((u32 *)(val)) = rtl_read_dword(rtlpriv, REG_BSSID);
423 *((u16 *)(val+4)) = rtl_read_word(rtlpriv, REG_BSSID+4);
425 case HW_VAR_MEDIA_STATUS:
426 val[0] = rtl_read_byte(rtlpriv, MSR) & 0x3;
428 case HW_VAR_SLOT_TIME:
429 *((u8 *)(val)) = mac->slot_time;
431 case HW_VAR_BEACON_INTERVAL:
432 *((u16 *)(val)) = rtl_read_word(rtlpriv, REG_BCN_INTERVAL);
434 case HW_VAR_ATIM_WINDOW:
435 *((u16 *)(val)) = rtl_read_word(rtlpriv, REG_ATIMWND);
438 *((u32 *)(val)) = rtlpci->receive_config;
440 case HW_VAR_RF_STATE:
441 *((enum rf_pwrstate *)(val)) = ppsc->rfpwr_state;
443 case HW_VAR_FWLPS_RF_ON:{
444 enum rf_pwrstate rfstate;
447 rtlpriv->cfg->ops->get_hw_reg(hw,
450 if (rfstate == ERFOFF) {
451 *((bool *)(val)) = true;
453 val_rcr = rtl_read_dword(rtlpriv, REG_RCR);
454 val_rcr &= 0x00070000;
456 *((bool *)(val)) = false;
458 *((bool *)(val)) = true;
461 case HW_VAR_FW_PSMODE_STATUS:
462 *((bool *)(val)) = ppsc->fw_current_inpsmode;
464 case HW_VAR_CORRECT_TSF:{
466 u32 *ptsf_low = (u32 *)&tsf;
467 u32 *ptsf_high = ((u32 *)&tsf) + 1;
469 *ptsf_high = rtl_read_dword(rtlpriv, (REG_TSFTR + 4));
470 *ptsf_low = rtl_read_dword(rtlpriv, REG_TSFTR);
472 *((u64 *)(val)) = tsf;
476 if (ppsc->wo_wlan_mode)
477 *((bool *)(val)) = true;
479 *((bool *)(val)) = false;
482 RT_TRACE(rtlpriv, COMP_ERR, DBG_LOUD,
483 "switch case %#x not processed\n", variable);
488 void rtl8821ae_set_hw_reg(struct ieee80211_hw *hw, u8 variable, u8 *val)
490 struct rtl_priv *rtlpriv = rtl_priv(hw);
491 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
492 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
493 struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
494 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
495 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
499 case HW_VAR_ETHER_ADDR:{
500 for (idx = 0; idx < ETH_ALEN; idx++) {
501 rtl_write_byte(rtlpriv, (REG_MACID + idx),
506 case HW_VAR_BASIC_RATE:{
507 u16 b_rate_cfg = ((u16 *)val)[0];
508 b_rate_cfg = b_rate_cfg & 0x15f;
509 rtl_write_word(rtlpriv, REG_RRSR, b_rate_cfg);
513 for (idx = 0; idx < ETH_ALEN; idx++) {
514 rtl_write_byte(rtlpriv, (REG_BSSID + idx),
520 rtl_write_byte(rtlpriv, REG_SIFS_CTX + 1, val[0]);
521 rtl_write_byte(rtlpriv, REG_SIFS_TRX + 1, val[0]);
523 rtl_write_byte(rtlpriv, REG_SPEC_SIFS + 1, val[0]);
524 rtl_write_byte(rtlpriv, REG_MAC_SPEC_SIFS + 1, val[0]);
526 rtl_write_byte(rtlpriv, REG_RESP_SIFS_OFDM + 1, val[0]);
527 rtl_write_byte(rtlpriv, REG_RESP_SIFS_OFDM, val[0]);
529 case HW_VAR_R2T_SIFS:
530 rtl_write_byte(rtlpriv, REG_RESP_SIFS_OFDM + 1, val[0]);
532 case HW_VAR_SLOT_TIME:{
535 RT_TRACE(rtlpriv, COMP_MLME, DBG_LOUD,
536 "HW_VAR_SLOT_TIME %x\n", val[0]);
538 rtl_write_byte(rtlpriv, REG_SLOT, val[0]);
540 for (e_aci = 0; e_aci < AC_MAX; e_aci++) {
541 rtlpriv->cfg->ops->set_hw_reg(hw,
546 case HW_VAR_ACK_PREAMBLE:{
548 u8 short_preamble = (bool)(*(u8 *)val);
550 reg_tmp = rtl_read_byte(rtlpriv, REG_TRXPTCL_CTL+2);
551 if (short_preamble) {
553 rtl_write_byte(rtlpriv, REG_TRXPTCL_CTL + 2,
556 reg_tmp &= (~BIT(1));
557 rtl_write_byte(rtlpriv,
562 case HW_VAR_WPA_CONFIG:
563 rtl_write_byte(rtlpriv, REG_SECCFG, *((u8 *)val));
565 case HW_VAR_AMPDU_MIN_SPACE:{
566 u8 min_spacing_to_set;
569 min_spacing_to_set = *((u8 *)val);
570 if (min_spacing_to_set <= 7) {
573 if (min_spacing_to_set < sec_min_space)
574 min_spacing_to_set = sec_min_space;
576 mac->min_space_cfg = ((mac->min_space_cfg &
580 *val = min_spacing_to_set;
582 RT_TRACE(rtlpriv, COMP_MLME, DBG_LOUD,
583 "Set HW_VAR_AMPDU_MIN_SPACE: %#x\n",
586 rtl_write_byte(rtlpriv, REG_AMPDU_MIN_SPACE,
590 case HW_VAR_SHORTGI_DENSITY:{
593 density_to_set = *((u8 *)val);
594 mac->min_space_cfg |= (density_to_set << 3);
596 RT_TRACE(rtlpriv, COMP_MLME, DBG_LOUD,
597 "Set HW_VAR_SHORTGI_DENSITY: %#x\n",
600 rtl_write_byte(rtlpriv, REG_AMPDU_MIN_SPACE,
604 case HW_VAR_AMPDU_FACTOR:{
605 u32 ampdu_len = (*((u8 *)val));
607 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE) {
608 if (ampdu_len < VHT_AGG_SIZE_128K)
610 (0x2000 << (*((u8 *)val))) - 1;
613 } else if (rtlhal->hw_type == HARDWARE_TYPE_RTL8821AE) {
614 if (ampdu_len < HT_AGG_SIZE_64K)
616 (0x2000 << (*((u8 *)val))) - 1;
620 ampdu_len |= BIT(31);
622 rtl_write_dword(rtlpriv,
623 REG_AMPDU_MAX_LENGTH_8812, ampdu_len);
625 case HW_VAR_AC_PARAM:{
626 u8 e_aci = *((u8 *)val);
628 rtl8821ae_dm_init_edca_turbo(hw);
629 if (rtlpci->acm_method != EACMWAY2_SW)
630 rtlpriv->cfg->ops->set_hw_reg(hw,
634 case HW_VAR_ACM_CTRL:{
635 u8 e_aci = *((u8 *)val);
636 union aci_aifsn *p_aci_aifsn =
637 (union aci_aifsn *)(&mac->ac[0].aifs);
638 u8 acm = p_aci_aifsn->f.acm;
639 u8 acm_ctrl = rtl_read_byte(rtlpriv, REG_ACMHWCTRL);
642 acm_ctrl | ((rtlpci->acm_method == 2) ? 0x0 : 0x1);
647 acm_ctrl |= ACMHW_BEQEN;
650 acm_ctrl |= ACMHW_VIQEN;
653 acm_ctrl |= ACMHW_VOQEN;
656 RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
657 "HW_VAR_ACM_CTRL acm set failed: eACI is %d\n",
664 acm_ctrl &= (~ACMHW_BEQEN);
667 acm_ctrl &= (~ACMHW_VIQEN);
670 acm_ctrl &= (~ACMHW_VOQEN);
673 RT_TRACE(rtlpriv, COMP_ERR, DBG_LOUD,
674 "switch case %#x not processed\n",
680 RT_TRACE(rtlpriv, COMP_QOS, DBG_TRACE,
681 "SetHwReg8190pci(): [HW_VAR_ACM_CTRL] Write 0x%X\n",
683 rtl_write_byte(rtlpriv, REG_ACMHWCTRL, acm_ctrl);
686 rtl_write_dword(rtlpriv, REG_RCR, ((u32 *)(val))[0]);
687 rtlpci->receive_config = ((u32 *)(val))[0];
689 case HW_VAR_RETRY_LIMIT:{
690 u8 retry_limit = ((u8 *)(val))[0];
692 rtl_write_word(rtlpriv, REG_RL,
693 retry_limit << RETRY_LIMIT_SHORT_SHIFT |
694 retry_limit << RETRY_LIMIT_LONG_SHIFT);
696 case HW_VAR_DUAL_TSF_RST:
697 rtl_write_byte(rtlpriv, REG_DUAL_TSF_RST, (BIT(0) | BIT(1)));
699 case HW_VAR_EFUSE_BYTES:
700 rtlefuse->efuse_usedbytes = *((u16 *)val);
702 case HW_VAR_EFUSE_USAGE:
703 rtlefuse->efuse_usedpercentage = *((u8 *)val);
706 rtl8821ae_phy_set_io_cmd(hw, (*(enum io_type *)val));
708 case HW_VAR_SET_RPWM:{
711 rpwm_val = rtl_read_byte(rtlpriv, REG_PCIE_HRPWM);
714 if (rpwm_val & BIT(7)) {
715 rtl_write_byte(rtlpriv, REG_PCIE_HRPWM,
718 rtl_write_byte(rtlpriv, REG_PCIE_HRPWM,
719 ((*(u8 *)val) | BIT(7)));
723 case HW_VAR_H2C_FW_PWRMODE:
724 rtl8821ae_set_fw_pwrmode_cmd(hw, (*(u8 *)val));
726 case HW_VAR_FW_PSMODE_STATUS:
727 ppsc->fw_current_inpsmode = *((bool *)val);
729 case HW_VAR_INIT_RTS_RATE:
731 case HW_VAR_RESUME_CLK_ON:
732 _rtl8821ae_set_fw_ps_rf_on(hw);
734 case HW_VAR_FW_LPS_ACTION:{
735 bool b_enter_fwlps = *((bool *)val);
738 _rtl8821ae_fwlps_enter(hw);
740 _rtl8821ae_fwlps_leave(hw);
742 case HW_VAR_H2C_FW_JOINBSSRPT:{
743 u8 mstatus = (*(u8 *)val);
745 if (mstatus == RT_MEDIA_CONNECT) {
746 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_AID,
748 _rtl8821ae_download_rsvd_page(hw, false);
750 rtl8821ae_set_fw_media_status_rpt_cmd(hw, mstatus);
753 case HW_VAR_H2C_FW_P2P_PS_OFFLOAD:
754 rtl8821ae_set_p2p_ps_offload_cmd(hw, (*(u8 *)val));
758 u2btmp = rtl_read_word(rtlpriv, REG_BCN_PSR_RPT);
760 rtl_write_word(rtlpriv, REG_BCN_PSR_RPT, (u2btmp |
763 case HW_VAR_CORRECT_TSF:{
764 u8 btype_ibss = ((u8 *)(val))[0];
767 _rtl8821ae_stop_tx_beacon(hw);
769 _rtl8821ae_set_bcn_ctrl_reg(hw, 0, BIT(3));
771 rtl_write_dword(rtlpriv, REG_TSFTR,
772 (u32)(mac->tsf & 0xffffffff));
773 rtl_write_dword(rtlpriv, REG_TSFTR + 4,
774 (u32)((mac->tsf >> 32) & 0xffffffff));
776 _rtl8821ae_set_bcn_ctrl_reg(hw, BIT(3), 0);
779 _rtl8821ae_resume_tx_beacon(hw);
781 case HW_VAR_NAV_UPPER: {
782 u32 us_nav_upper = ((u32)*val);
784 if (us_nav_upper > HAL_92C_NAV_UPPER_UNIT * 0xFF) {
785 RT_TRACE(rtlpriv, COMP_INIT , DBG_WARNING,
786 "The setting value (0x%08X us) of NAV_UPPER is larger than (%d * 0xFF)!!!\n",
787 us_nav_upper, HAL_92C_NAV_UPPER_UNIT);
790 rtl_write_byte(rtlpriv, REG_NAV_UPPER,
791 ((u8)((us_nav_upper +
792 HAL_92C_NAV_UPPER_UNIT - 1) /
793 HAL_92C_NAV_UPPER_UNIT)));
795 case HW_VAR_KEEP_ALIVE: {
798 array[1] = *((u8 *)val);
799 rtl8821ae_fill_h2c_cmd(hw, H2C_8821AE_KEEP_ALIVE_CTRL, 2,
803 RT_TRACE(rtlpriv, COMP_ERR, DBG_LOUD,
804 "switch case %#x not processed\n", variable);
809 static bool _rtl8821ae_llt_write(struct ieee80211_hw *hw, u32 address, u32 data)
811 struct rtl_priv *rtlpriv = rtl_priv(hw);
814 u32 value = _LLT_INIT_ADDR(address) | _LLT_INIT_DATA(data) |
815 _LLT_OP(_LLT_WRITE_ACCESS);
817 rtl_write_dword(rtlpriv, REG_LLT_INIT, value);
820 value = rtl_read_dword(rtlpriv, REG_LLT_INIT);
821 if (_LLT_NO_ACTIVE == _LLT_OP_VALUE(value))
824 if (count > POLLING_LLT_THRESHOLD) {
825 pr_err("Failed to polling write LLT done at address %d!\n",
835 static bool _rtl8821ae_llt_table_init(struct ieee80211_hw *hw)
837 struct rtl_priv *rtlpriv = rtl_priv(hw);
845 txpktbuf_bndy = 0xF7;
848 rtl_write_byte(rtlpriv, REG_TRXFF_BNDY, txpktbuf_bndy);
849 rtl_write_word(rtlpriv, REG_TRXFF_BNDY + 2, MAX_RX_DMA_BUFFER_SIZE - 1);
851 rtl_write_byte(rtlpriv, REG_TDECTRL + 1, txpktbuf_bndy);
853 rtl_write_byte(rtlpriv, REG_TXPKTBUF_BCNQ_BDNY, txpktbuf_bndy);
854 rtl_write_byte(rtlpriv, REG_TXPKTBUF_MGQ_BDNY, txpktbuf_bndy);
856 rtl_write_byte(rtlpriv, REG_PBP, 0x31);
857 rtl_write_byte(rtlpriv, REG_RX_DRVINFO_SZ, 0x4);
859 for (i = 0; i < (txpktbuf_bndy - 1); i++) {
860 status = _rtl8821ae_llt_write(hw, i, i + 1);
865 status = _rtl8821ae_llt_write(hw, (txpktbuf_bndy - 1), 0xFF);
869 for (i = txpktbuf_bndy; i < maxpage; i++) {
870 status = _rtl8821ae_llt_write(hw, i, (i + 1));
875 status = _rtl8821ae_llt_write(hw, maxpage, txpktbuf_bndy);
879 rtl_write_dword(rtlpriv, REG_RQPN, rqpn);
881 rtl_write_byte(rtlpriv, REG_RQPN_NPQ, 0x00);
886 static void _rtl8821ae_gen_refresh_led_state(struct ieee80211_hw *hw)
888 struct rtl_priv *rtlpriv = rtl_priv(hw);
889 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
890 struct rtl_led *pled0 = &rtlpriv->ledctl.sw_led0;
891 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
893 if (rtlpriv->rtlhal.up_first_time)
896 if (ppsc->rfoff_reason == RF_CHANGE_BY_IPS)
897 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE)
898 rtl8812ae_sw_led_on(hw, pled0);
900 rtl8821ae_sw_led_on(hw, pled0);
901 else if (ppsc->rfoff_reason == RF_CHANGE_BY_INIT)
902 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE)
903 rtl8812ae_sw_led_on(hw, pled0);
905 rtl8821ae_sw_led_on(hw, pled0);
907 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE)
908 rtl8812ae_sw_led_off(hw, pled0);
910 rtl8821ae_sw_led_off(hw, pled0);
913 static bool _rtl8821ae_init_mac(struct ieee80211_hw *hw)
915 struct rtl_priv *rtlpriv = rtl_priv(hw);
916 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
917 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
921 bool mac_func_enable = rtlhal->mac_func_enable;
923 rtl_write_byte(rtlpriv, REG_RSV_CTRL, 0x00);
925 /*Auto Power Down to CHIP-off State*/
926 bytetmp = rtl_read_byte(rtlpriv, REG_APS_FSMCO + 1) & (~BIT(7));
927 rtl_write_byte(rtlpriv, REG_APS_FSMCO + 1, bytetmp);
929 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE) {
930 /* HW Power on sequence*/
931 if (!rtl_hal_pwrseqcmdparsing(rtlpriv, PWR_CUT_ALL_MSK,
932 PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,
933 RTL8812_NIC_ENABLE_FLOW)) {
934 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
935 "init 8812 MAC Fail as power on failure\n");
939 /* HW Power on sequence */
940 if (!rtl_hal_pwrseqcmdparsing(rtlpriv, PWR_CUT_A_MSK,
941 PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,
942 RTL8821A_NIC_ENABLE_FLOW)){
943 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
944 "init 8821 MAC Fail as power on failure\n");
949 bytetmp = rtl_read_byte(rtlpriv, REG_APS_FSMCO) | BIT(4);
950 rtl_write_byte(rtlpriv, REG_APS_FSMCO, bytetmp);
952 bytetmp = rtl_read_byte(rtlpriv, REG_CR);
954 rtl_write_byte(rtlpriv, REG_CR, bytetmp);
958 rtl_write_byte(rtlpriv, REG_HWSEQ_CTRL, bytetmp);
961 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8821AE) {
962 bytetmp = rtl_read_byte(rtlpriv, REG_SYS_CFG + 3);
963 if (bytetmp & BIT(0)) {
964 bytetmp = rtl_read_byte(rtlpriv, 0x7c);
966 rtl_write_byte(rtlpriv, 0x7c, bytetmp);
970 bytetmp = rtl_read_byte(rtlpriv, REG_GPIO_MUXCFG + 1);
972 rtl_write_byte(rtlpriv, REG_GPIO_MUXCFG + 1, bytetmp);
974 rtl_write_word(rtlpriv, REG_CR, 0x2ff);
976 if (!mac_func_enable) {
977 if (!_rtl8821ae_llt_table_init(hw))
981 rtl_write_dword(rtlpriv, REG_HISR, 0xffffffff);
982 rtl_write_dword(rtlpriv, REG_HISRE, 0xffffffff);
984 /* Enable FW Beamformer Interrupt */
985 bytetmp = rtl_read_byte(rtlpriv, REG_FWIMR + 3);
986 rtl_write_byte(rtlpriv, REG_FWIMR + 3, bytetmp | BIT(6));
988 wordtmp = rtl_read_word(rtlpriv, REG_TRXDMA_CTRL);
991 rtl_write_word(rtlpriv, REG_TRXDMA_CTRL, wordtmp);
993 rtl_write_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 1, 0x1F);
994 rtl_write_dword(rtlpriv, REG_RCR, rtlpci->receive_config);
995 rtl_write_word(rtlpriv, REG_RXFLTMAP2, 0xFFFF);
997 rtl_write_dword(rtlpriv, REG_BCNQ_DESA,
998 rtlpci->tx_ring[BEACON_QUEUE].dma & DMA_BIT_MASK(32));
999 rtl_write_dword(rtlpriv, REG_MGQ_DESA,
1000 rtlpci->tx_ring[MGNT_QUEUE].dma & DMA_BIT_MASK(32));
1001 rtl_write_dword(rtlpriv, REG_VOQ_DESA,
1002 rtlpci->tx_ring[VO_QUEUE].dma & DMA_BIT_MASK(32));
1003 rtl_write_dword(rtlpriv, REG_VIQ_DESA,
1004 rtlpci->tx_ring[VI_QUEUE].dma & DMA_BIT_MASK(32));
1005 rtl_write_dword(rtlpriv, REG_BEQ_DESA,
1006 rtlpci->tx_ring[BE_QUEUE].dma & DMA_BIT_MASK(32));
1007 rtl_write_dword(rtlpriv, REG_BKQ_DESA,
1008 rtlpci->tx_ring[BK_QUEUE].dma & DMA_BIT_MASK(32));
1009 rtl_write_dword(rtlpriv, REG_HQ_DESA,
1010 rtlpci->tx_ring[HIGH_QUEUE].dma & DMA_BIT_MASK(32));
1011 rtl_write_dword(rtlpriv, REG_RX_DESA,
1012 rtlpci->rx_ring[RX_MPDU_QUEUE].dma & DMA_BIT_MASK(32));
1014 rtl_write_byte(rtlpriv, REG_PCIE_CTRL_REG + 3, 0x77);
1016 rtl_write_dword(rtlpriv, REG_INT_MIG, 0);
1018 rtl_write_dword(rtlpriv, REG_MCUTST_1, 0);
1020 rtl_write_byte(rtlpriv, REG_SECONDARY_CCA_CTRL, 0x3);
1021 _rtl8821ae_gen_refresh_led_state(hw);
1026 static void _rtl8821ae_hw_configure(struct ieee80211_hw *hw)
1028 struct rtl_priv *rtlpriv = rtl_priv(hw);
1029 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
1032 reg_rrsr = RATE_ALL_CCK | RATE_ALL_OFDM_AG;
1034 rtl_write_dword(rtlpriv, REG_RRSR, reg_rrsr);
1035 /* ARFB table 9 for 11ac 5G 2SS */
1036 rtl_write_dword(rtlpriv, REG_ARFR0 + 4, 0xfffff000);
1037 /* ARFB table 10 for 11ac 5G 1SS */
1038 rtl_write_dword(rtlpriv, REG_ARFR1 + 4, 0x003ff000);
1039 /* ARFB table 11 for 11ac 24G 1SS */
1040 rtl_write_dword(rtlpriv, REG_ARFR2, 0x00000015);
1041 rtl_write_dword(rtlpriv, REG_ARFR2 + 4, 0x003ff000);
1042 /* ARFB table 12 for 11ac 24G 1SS */
1043 rtl_write_dword(rtlpriv, REG_ARFR3, 0x00000015);
1044 rtl_write_dword(rtlpriv, REG_ARFR3 + 4, 0xffcff000);
1045 /* 0x420[7] = 0 , enable retry AMPDU in new AMPD not singal MPDU. */
1046 rtl_write_word(rtlpriv, REG_FWHW_TXQ_CTRL, 0x1F00);
1047 rtl_write_byte(rtlpriv, REG_AMPDU_MAX_TIME, 0x70);
1050 rtl_write_word(rtlpriv, REG_RL, 0x0707);
1052 /* Set Data / Response auto rate fallack retry count*/
1053 rtl_write_dword(rtlpriv, REG_DARFRC, 0x01000000);
1054 rtl_write_dword(rtlpriv, REG_DARFRC + 4, 0x07060504);
1055 rtl_write_dword(rtlpriv, REG_RARFRC, 0x01000000);
1056 rtl_write_dword(rtlpriv, REG_RARFRC + 4, 0x07060504);
1058 rtlpci->reg_bcn_ctrl_val = 0x1d;
1059 rtl_write_byte(rtlpriv, REG_BCN_CTRL, rtlpci->reg_bcn_ctrl_val);
1061 /* TBTT prohibit hold time. Suggested by designer TimChen. */
1062 rtl_write_byte(rtlpriv, REG_TBTT_PROHIBIT + 1, 0xff);
1064 /* AGGR_BK_TIME Reg51A 0x16 */
1065 rtl_write_word(rtlpriv, REG_NAV_PROT_LEN, 0x0040);
1067 /*For Rx TP. Suggested by SD1 Richard. Added by tynli. 2010.04.12.*/
1068 rtl_write_dword(rtlpriv, REG_FAST_EDCA_CTRL, 0x03086666);
1070 rtl_write_byte(rtlpriv, REG_HT_SINGLE_AMPDU, 0x80);
1071 rtl_write_byte(rtlpriv, REG_RX_PKT_LIMIT, 0x20);
1072 rtl_write_word(rtlpriv, REG_MAX_AGGR_NUM, 0x1F1F);
1075 static u16 _rtl8821ae_mdio_read(struct rtl_priv *rtlpriv, u8 addr)
1078 u8 tmp = 0, count = 0;
1080 rtl_write_byte(rtlpriv, REG_MDIO_CTL, addr | BIT(6));
1081 tmp = rtl_read_byte(rtlpriv, REG_MDIO_CTL) & BIT(6);
1083 while (tmp && count < 20) {
1085 tmp = rtl_read_byte(rtlpriv, REG_MDIO_CTL) & BIT(6);
1089 ret = rtl_read_word(rtlpriv, REG_MDIO_RDATA);
1094 static void _rtl8821ae_mdio_write(struct rtl_priv *rtlpriv, u8 addr, u16 data)
1096 u8 tmp = 0, count = 0;
1098 rtl_write_word(rtlpriv, REG_MDIO_WDATA, data);
1099 rtl_write_byte(rtlpriv, REG_MDIO_CTL, addr | BIT(5));
1100 tmp = rtl_read_byte(rtlpriv, REG_MDIO_CTL) & BIT(5);
1102 while (tmp && count < 20) {
1104 tmp = rtl_read_byte(rtlpriv, REG_MDIO_CTL) & BIT(5);
1109 static u8 _rtl8821ae_dbi_read(struct rtl_priv *rtlpriv, u16 addr)
1111 u16 read_addr = addr & 0xfffc;
1112 u8 tmp = 0, count = 0, ret = 0;
1114 rtl_write_word(rtlpriv, REG_DBI_ADDR, read_addr);
1115 rtl_write_byte(rtlpriv, REG_DBI_FLAG, 0x2);
1116 tmp = rtl_read_byte(rtlpriv, REG_DBI_FLAG);
1118 while (tmp && count < 20) {
1120 tmp = rtl_read_byte(rtlpriv, REG_DBI_FLAG);
1124 read_addr = REG_DBI_RDATA + addr % 4;
1125 ret = rtl_read_byte(rtlpriv, read_addr);
1130 static void _rtl8821ae_dbi_write(struct rtl_priv *rtlpriv, u16 addr, u8 data)
1132 u8 tmp = 0, count = 0;
1133 u16 wrtie_addr, remainder = addr % 4;
1135 wrtie_addr = REG_DBI_WDATA + remainder;
1136 rtl_write_byte(rtlpriv, wrtie_addr, data);
1138 wrtie_addr = (addr & 0xfffc) | (BIT(0) << (remainder + 12));
1139 rtl_write_word(rtlpriv, REG_DBI_ADDR, wrtie_addr);
1141 rtl_write_byte(rtlpriv, REG_DBI_FLAG, 0x1);
1143 tmp = rtl_read_byte(rtlpriv, REG_DBI_FLAG);
1145 while (tmp && count < 20) {
1147 tmp = rtl_read_byte(rtlpriv, REG_DBI_FLAG);
1152 static void _rtl8821ae_enable_aspm_back_door(struct ieee80211_hw *hw)
1154 struct rtl_priv *rtlpriv = rtl_priv(hw);
1155 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
1158 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8821AE) {
1159 if (_rtl8821ae_mdio_read(rtlpriv, 0x04) != 0x8544)
1160 _rtl8821ae_mdio_write(rtlpriv, 0x04, 0x8544);
1162 if (_rtl8821ae_mdio_read(rtlpriv, 0x0b) != 0x0070)
1163 _rtl8821ae_mdio_write(rtlpriv, 0x0b, 0x0070);
1166 tmp = _rtl8821ae_dbi_read(rtlpriv, 0x70f);
1167 _rtl8821ae_dbi_write(rtlpriv, 0x70f, tmp | BIT(7));
1169 tmp = _rtl8821ae_dbi_read(rtlpriv, 0x719);
1170 _rtl8821ae_dbi_write(rtlpriv, 0x719, tmp | BIT(3) | BIT(4));
1172 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE) {
1173 tmp = _rtl8821ae_dbi_read(rtlpriv, 0x718);
1174 _rtl8821ae_dbi_write(rtlpriv, 0x718, tmp|BIT(4));
1178 void rtl8821ae_enable_hw_security_config(struct ieee80211_hw *hw)
1180 struct rtl_priv *rtlpriv = rtl_priv(hw);
1184 RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
1185 "PairwiseEncAlgorithm = %d GroupEncAlgorithm = %d\n",
1186 rtlpriv->sec.pairwise_enc_algorithm,
1187 rtlpriv->sec.group_enc_algorithm);
1189 if (rtlpriv->cfg->mod_params->sw_crypto || rtlpriv->sec.use_sw_sec) {
1190 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
1191 "not open hw encryption\n");
1195 sec_reg_value = SCR_TXENCENABLE | SCR_RXDECENABLE;
1197 if (rtlpriv->sec.use_defaultkey) {
1198 sec_reg_value |= SCR_TXUSEDK;
1199 sec_reg_value |= SCR_RXUSEDK;
1202 sec_reg_value |= (SCR_RXBCUSEDK | SCR_TXBCUSEDK);
1204 tmp = rtl_read_byte(rtlpriv, REG_CR + 1);
1205 rtl_write_byte(rtlpriv, REG_CR + 1, tmp | BIT(1));
1207 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
1208 "The SECR-value %x\n", sec_reg_value);
1210 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_WPA_CONFIG, &sec_reg_value);
1213 /* Static MacID Mapping (cf. Used in MacIdDoStaticMapping) ---------- */
1214 #define MAC_ID_STATIC_FOR_DEFAULT_PORT 0
1215 #define MAC_ID_STATIC_FOR_BROADCAST_MULTICAST 1
1216 #define MAC_ID_STATIC_FOR_BT_CLIENT_START 2
1217 #define MAC_ID_STATIC_FOR_BT_CLIENT_END 3
1218 /* ----------------------------------------------------------- */
1220 static void rtl8821ae_macid_initialize_mediastatus(struct ieee80211_hw *hw)
1222 struct rtl_priv *rtlpriv = rtl_priv(hw);
1223 u8 media_rpt[4] = {RT_MEDIA_CONNECT, 1,
1224 MAC_ID_STATIC_FOR_BROADCAST_MULTICAST,
1225 MAC_ID_STATIC_FOR_BT_CLIENT_END};
1227 rtlpriv->cfg->ops->set_hw_reg(hw,
1228 HW_VAR_H2C_FW_MEDIASTATUSRPT, media_rpt);
1230 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
1231 "Initialize MacId media status: from %d to %d\n",
1232 MAC_ID_STATIC_FOR_BROADCAST_MULTICAST,
1233 MAC_ID_STATIC_FOR_BT_CLIENT_END);
1236 static bool _rtl8821ae_check_pcie_dma_hang(struct ieee80211_hw *hw)
1238 struct rtl_priv *rtlpriv = rtl_priv(hw);
1241 /* write reg 0x350 Bit[26]=1. Enable debug port. */
1242 tmp = rtl_read_byte(rtlpriv, REG_DBI_CTRL + 3);
1243 if (!(tmp & BIT(2))) {
1244 rtl_write_byte(rtlpriv, REG_DBI_CTRL + 3, (tmp | BIT(2)));
1248 /* read reg 0x350 Bit[25] if 1 : RX hang */
1249 /* read reg 0x350 Bit[24] if 1 : TX hang */
1250 tmp = rtl_read_byte(rtlpriv, REG_DBI_CTRL + 3);
1251 if ((tmp & BIT(0)) || (tmp & BIT(1))) {
1252 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
1253 "CheckPcieDMAHang8821AE(): true! Reset PCIE DMA!\n");
1260 static bool _rtl8821ae_reset_pcie_interface_dma(struct ieee80211_hw *hw,
1264 struct rtl_priv *rtlpriv = rtl_priv(hw);
1265 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
1267 bool release_mac_rx_pause;
1268 u8 backup_pcie_dma_pause;
1270 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "\n");
1272 /* 1. Disable register write lock. 0x1c[1] = 0 */
1273 tmp = rtl_read_byte(rtlpriv, REG_RSV_CTRL);
1275 rtl_write_byte(rtlpriv, REG_RSV_CTRL, tmp);
1276 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8821AE) {
1277 /* write 0xCC bit[2] = 1'b1 */
1278 tmp = rtl_read_byte(rtlpriv, REG_PMC_DBG_CTRL2);
1280 rtl_write_byte(rtlpriv, REG_PMC_DBG_CTRL2, tmp);
1283 /* 2. Check and pause TRX DMA */
1284 /* write 0x284 bit[18] = 1'b1 */
1285 /* write 0x301 = 0xFF */
1286 tmp = rtl_read_byte(rtlpriv, REG_RXDMA_CONTROL);
1288 /* Already pause before the function for another purpose. */
1289 release_mac_rx_pause = false;
1291 rtl_write_byte(rtlpriv, REG_RXDMA_CONTROL, (tmp | BIT(2)));
1292 release_mac_rx_pause = true;
1294 backup_pcie_dma_pause = rtl_read_byte(rtlpriv, REG_PCIE_CTRL_REG + 1);
1295 if (backup_pcie_dma_pause != 0xFF)
1296 rtl_write_byte(rtlpriv, REG_PCIE_CTRL_REG + 1, 0xFF);
1299 /* 3. reset TRX function */
1300 /* write 0x100 = 0x00 */
1301 rtl_write_byte(rtlpriv, REG_CR, 0);
1304 /* 4. Reset PCIe DMA. 0x3[0] = 0 */
1305 tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
1307 rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1, tmp);
1309 /* 5. Enable PCIe DMA. 0x3[0] = 1 */
1310 tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN + 1);
1312 rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1, tmp);
1315 /* 6. enable TRX function */
1316 /* write 0x100 = 0xFF */
1317 rtl_write_byte(rtlpriv, REG_CR, 0xFF);
1319 /* We should init LLT & RQPN and
1320 * prepare Tx/Rx descrptor address later
1321 * because MAC function is reset.*/
1324 /* 7. Restore PCIe autoload down bit */
1325 /* 8812AE does not has the defination. */
1326 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8821AE) {
1327 /* write 0xF8 bit[17] = 1'b1 */
1328 tmp = rtl_read_byte(rtlpriv, REG_MAC_PHY_CTRL_NORMAL + 2);
1330 rtl_write_byte(rtlpriv, REG_MAC_PHY_CTRL_NORMAL + 2, tmp);
1333 /* In MAC power on state, BB and RF maybe in ON state,
1334 * if we release TRx DMA here.
1335 * it will cause packets to be started to Tx/Rx,
1336 * so we release Tx/Rx DMA later.*/
1337 if (!mac_power_on/* || in_watchdog*/) {
1338 /* 8. release TRX DMA */
1339 /* write 0x284 bit[18] = 1'b0 */
1340 /* write 0x301 = 0x00 */
1341 if (release_mac_rx_pause) {
1342 tmp = rtl_read_byte(rtlpriv, REG_RXDMA_CONTROL);
1343 rtl_write_byte(rtlpriv, REG_RXDMA_CONTROL,
1346 rtl_write_byte(rtlpriv, REG_PCIE_CTRL_REG + 1,
1347 backup_pcie_dma_pause);
1350 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8821AE) {
1351 /* 9. lock system register */
1352 /* write 0xCC bit[2] = 1'b0 */
1353 tmp = rtl_read_byte(rtlpriv, REG_PMC_DBG_CTRL2);
1355 rtl_write_byte(rtlpriv, REG_PMC_DBG_CTRL2, tmp);
1360 static void _rtl8821ae_get_wakeup_reason(struct ieee80211_hw *hw)
1362 struct rtl_priv *rtlpriv = rtl_priv(hw);
1363 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
1364 struct rtl_ps_ctl *ppsc = rtl_psc(rtlpriv);
1368 fw_reason = rtl_read_byte(rtlpriv, REG_MCUTST_WOWLAN);
1370 RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD, "WOL Read 0x1c7 = %02X\n",
1373 ppsc->wakeup_reason = 0;
1375 rtlhal->last_suspend_sec = ts.tv_sec;
1377 switch (fw_reason) {
1378 case FW_WOW_V2_PTK_UPDATE_EVENT:
1379 ppsc->wakeup_reason = WOL_REASON_PTK_UPDATE;
1380 do_gettimeofday(&ts);
1381 ppsc->last_wakeup_time = ts.tv_sec*1000 + ts.tv_usec/1000;
1382 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1383 "It's a WOL PTK Key update event!\n");
1385 case FW_WOW_V2_GTK_UPDATE_EVENT:
1386 ppsc->wakeup_reason = WOL_REASON_GTK_UPDATE;
1387 do_gettimeofday(&ts);
1388 ppsc->last_wakeup_time = ts.tv_sec*1000 + ts.tv_usec/1000;
1389 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1390 "It's a WOL GTK Key update event!\n");
1392 case FW_WOW_V2_DISASSOC_EVENT:
1393 ppsc->wakeup_reason = WOL_REASON_DISASSOC;
1394 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1395 "It's a disassociation event!\n");
1397 case FW_WOW_V2_DEAUTH_EVENT:
1398 ppsc->wakeup_reason = WOL_REASON_DEAUTH;
1399 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1400 "It's a deauth event!\n");
1402 case FW_WOW_V2_FW_DISCONNECT_EVENT:
1403 ppsc->wakeup_reason = WOL_REASON_AP_LOST;
1404 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1405 "It's a Fw disconnect decision (AP lost) event!\n");
1407 case FW_WOW_V2_MAGIC_PKT_EVENT:
1408 ppsc->wakeup_reason = WOL_REASON_MAGIC_PKT;
1409 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1410 "It's a magic packet event!\n");
1412 case FW_WOW_V2_UNICAST_PKT_EVENT:
1413 ppsc->wakeup_reason = WOL_REASON_UNICAST_PKT;
1414 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1415 "It's an unicast packet event!\n");
1417 case FW_WOW_V2_PATTERN_PKT_EVENT:
1418 ppsc->wakeup_reason = WOL_REASON_PATTERN_PKT;
1419 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1420 "It's a pattern match event!\n");
1422 case FW_WOW_V2_RTD3_SSID_MATCH_EVENT:
1423 ppsc->wakeup_reason = WOL_REASON_RTD3_SSID_MATCH;
1424 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1425 "It's an RTD3 Ssid match event!\n");
1427 case FW_WOW_V2_REALWOW_V2_WAKEUPPKT:
1428 ppsc->wakeup_reason = WOL_REASON_REALWOW_V2_WAKEUPPKT;
1429 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1430 "It's an RealWoW wake packet event!\n");
1432 case FW_WOW_V2_REALWOW_V2_ACKLOST:
1433 ppsc->wakeup_reason = WOL_REASON_REALWOW_V2_ACKLOST;
1434 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1435 "It's an RealWoW ack lost event!\n");
1438 RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
1439 "WOL Read 0x1c7 = %02X, Unknown reason!\n",
1445 static void _rtl8821ae_init_trx_desc_hw_address(struct ieee80211_hw *hw)
1447 struct rtl_priv *rtlpriv = rtl_priv(hw);
1448 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
1451 rtl_write_dword(rtlpriv, REG_BCNQ_DESA,
1452 rtlpci->tx_ring[BEACON_QUEUE].dma & DMA_BIT_MASK(32));
1453 rtl_write_dword(rtlpriv, REG_MGQ_DESA,
1454 rtlpci->tx_ring[MGNT_QUEUE].dma & DMA_BIT_MASK(32));
1455 rtl_write_dword(rtlpriv, REG_VOQ_DESA,
1456 rtlpci->tx_ring[VO_QUEUE].dma & DMA_BIT_MASK(32));
1457 rtl_write_dword(rtlpriv, REG_VIQ_DESA,
1458 rtlpci->tx_ring[VI_QUEUE].dma & DMA_BIT_MASK(32));
1459 rtl_write_dword(rtlpriv, REG_BEQ_DESA,
1460 rtlpci->tx_ring[BE_QUEUE].dma & DMA_BIT_MASK(32));
1461 rtl_write_dword(rtlpriv, REG_BKQ_DESA,
1462 rtlpci->tx_ring[BK_QUEUE].dma & DMA_BIT_MASK(32));
1463 rtl_write_dword(rtlpriv, REG_HQ_DESA,
1464 rtlpci->tx_ring[HIGH_QUEUE].dma & DMA_BIT_MASK(32));
1465 rtl_write_dword(rtlpriv, REG_RX_DESA,
1466 rtlpci->rx_ring[RX_MPDU_QUEUE].dma & DMA_BIT_MASK(32));
1469 static bool _rtl8821ae_init_llt_table(struct ieee80211_hw *hw, u32 boundary)
1473 u32 txpktbuf_bndy = boundary;
1474 u32 last_entry_of_txpktbuf = LAST_ENTRY_OF_TX_PKT_BUFFER;
1476 for (i = 0 ; i < (txpktbuf_bndy - 1) ; i++) {
1477 status = _rtl8821ae_llt_write(hw, i , i + 1);
1482 status = _rtl8821ae_llt_write(hw, (txpktbuf_bndy - 1), 0xFF);
1486 for (i = txpktbuf_bndy ; i < last_entry_of_txpktbuf ; i++) {
1487 status = _rtl8821ae_llt_write(hw, i, (i + 1));
1492 status = _rtl8821ae_llt_write(hw, last_entry_of_txpktbuf,
1500 static bool _rtl8821ae_dynamic_rqpn(struct ieee80211_hw *hw, u32 boundary,
1501 u16 npq_rqpn_value, u32 rqpn_val)
1503 struct rtl_priv *rtlpriv = rtl_priv(hw);
1506 u16 count = 0, tmp16;
1507 bool support_remote_wakeup;
1509 rtlpriv->cfg->ops->get_hw_reg(hw, HAL_DEF_WOWLAN,
1510 (u8 *)(&support_remote_wakeup));
1512 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
1513 "boundary=%#X, NPQ_RQPNValue=%#X, RQPNValue=%#X\n",
1514 boundary, npq_rqpn_value, rqpn_val);
1517 * 1. 0x301[7:0] = 0xFE */
1518 rtl_write_byte(rtlpriv, REG_PCIE_CTRL_REG + 1, 0xFE);
1521 * 2. polling till 0x41A[15:0]=0x07FF */
1522 tmp16 = rtl_read_word(rtlpriv, REG_TXPKT_EMPTY);
1523 while ((tmp16 & 0x07FF) != 0x07FF) {
1525 tmp16 = rtl_read_word(rtlpriv, REG_TXPKT_EMPTY);
1527 if ((count % 200) == 0) {
1528 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
1529 "Tx queue is not empty for 20ms!\n");
1531 if (count >= 1000) {
1532 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
1533 "Wait for Tx FIFO empty timeout!\n");
1539 * 3. reg 0x522=0xFF */
1540 rtl_write_byte(rtlpriv, REG_TXPAUSE, 0xFF);
1542 /* Wait TX State Machine OK
1543 * 4. polling till reg 0x5FB~0x5F8 = 0x00000000 for 50ms */
1545 while (rtl_read_byte(rtlpriv, REG_SCH_TXCMD) != 0) {
1549 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
1550 "Wait for TX State Machine ready timeout !!\n");
1557 * 6. wait till 0x284[17] == 1
1558 * wait RX DMA idle */
1560 tmp = rtl_read_byte(rtlpriv, REG_RXDMA_CONTROL);
1561 rtl_write_byte(rtlpriv, REG_RXDMA_CONTROL, (tmp | BIT(2)));
1563 tmp = rtl_read_byte(rtlpriv, REG_RXDMA_CONTROL);
1566 } while (!(tmp & BIT(1)) && count < 100);
1568 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
1569 "Wait until Rx DMA Idle. count=%d REG[0x286]=0x%x\n",
1573 * 7. 0x02 [0] = 0 */
1574 tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN);
1576 rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, tmp);
1581 rtl_write_byte(rtlpriv, REG_CR, 0x00);
1584 /* Disable MAC Security Engine
1585 * 9. 0x100 bit[9]=0 */
1586 tmp = rtl_read_byte(rtlpriv, REG_CR + 1);
1588 rtl_write_byte(rtlpriv, REG_CR + 1, tmp);
1590 /* To avoid DD-Tim Circuit hang
1591 * 10. 0x553 bit[5]=1 */
1592 tmp = rtl_read_byte(rtlpriv, REG_DUAL_TSF_RST);
1593 rtl_write_byte(rtlpriv, REG_DUAL_TSF_RST, (tmp | BIT(5)));
1595 /* Enable MAC Security Engine
1596 * 11. 0x100 bit[9]=1 */
1597 tmp = rtl_read_byte(rtlpriv, REG_CR + 1);
1598 rtl_write_byte(rtlpriv, REG_CR + 1, (tmp | BIT(1)));
1603 rtl_write_byte(rtlpriv, REG_CR, 0xFF);
1607 * 13. 0x02 [0] = 1 */
1608 tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN);
1609 rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, (tmp | BIT(0)));
1612 * 14,15. set beacon head page (reg 0x209 and 0x424) */
1613 rtl_write_byte(rtlpriv, REG_TDECTRL + 1, (u8)boundary);
1614 rtl_write_byte(rtlpriv, REG_TXPKTBUF_BCNQ_BDNY, (u8)boundary);
1615 rtl_write_byte(rtlpriv, REG_TXPKTBUF_MGQ_BDNY, (u8)boundary);
1617 /* 16. WMAC_LBK_BF_HD 0x45D[7:0]
1619 rtl_write_byte(rtlpriv, REG_TXPKTBUF_WMAC_LBK_BF_HD,
1622 rtl_write_word(rtlpriv, REG_TRXFF_BNDY, boundary);
1626 if (!_rtl8821ae_init_llt_table(hw, boundary)) {
1627 RT_TRACE(rtlpriv, COMP_INIT, DBG_WARNING,
1628 "Failed to init LLT table!\n");
1633 * 18. reallocate RQPN and init LLT */
1634 rtl_write_word(rtlpriv, REG_RQPN_NPQ, npq_rqpn_value);
1635 rtl_write_dword(rtlpriv, REG_RQPN, rqpn_val);
1639 rtl_write_byte(rtlpriv, REG_TXPAUSE, 0x00);
1642 * 20. 0x301[7:0] = 0x00
1643 * 21. 0x284[18] = 0 */
1644 rtl_write_byte(rtlpriv, REG_PCIE_CTRL_REG + 1, 0x00);
1645 tmp = rtl_read_byte(rtlpriv, REG_RXDMA_CONTROL);
1646 rtl_write_byte(rtlpriv, REG_RXDMA_CONTROL, (tmp&~BIT(2)));
1648 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "End.\n");
1652 static void _rtl8821ae_simple_initialize_adapter(struct ieee80211_hw *hw)
1654 struct rtl_priv *rtlpriv = rtl_priv(hw);
1655 struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
1656 struct rtl_ps_ctl *ppsc = rtl_psc(rtlpriv);
1658 #if (USE_SPECIFIC_FW_TO_SUPPORT_WOWLAN == 1)
1659 /* Re-download normal Fw. */
1660 rtl8821ae_set_fw_related_for_wowlan(hw, false);
1663 /* Re-Initialize LLT table. */
1664 if (rtlhal->re_init_llt_table) {
1665 u32 rqpn = 0x80e70808;
1666 u8 rqpn_npq = 0, boundary = 0xF8;
1667 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE) {
1671 if (_rtl8821ae_dynamic_rqpn(hw, boundary, rqpn_npq, rqpn))
1672 rtlhal->re_init_llt_table = false;
1675 ppsc->rfpwr_state = ERFON;
1678 static void _rtl8821ae_enable_l1off(struct ieee80211_hw *hw)
1681 struct rtl_priv *rtlpriv = rtl_priv(hw);
1683 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "--->\n");
1685 tmp = _rtl8821ae_dbi_read(rtlpriv, 0x160);
1686 if (!(tmp & (BIT(2) | BIT(3)))) {
1687 RT_TRACE(rtlpriv, COMP_POWER | COMP_INIT, DBG_LOUD,
1688 "0x160(%#x)return!!\n", tmp);
1692 tmp = _rtl8821ae_mdio_read(rtlpriv, 0x1b);
1693 _rtl8821ae_mdio_write(rtlpriv, 0x1b, (tmp | BIT(4)));
1695 tmp = _rtl8821ae_dbi_read(rtlpriv, 0x718);
1696 _rtl8821ae_dbi_write(rtlpriv, 0x718, tmp | BIT(5));
1698 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "<---\n");
1701 static void _rtl8821ae_enable_ltr(struct ieee80211_hw *hw)
1704 struct rtl_priv *rtlpriv = rtl_priv(hw);
1706 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "--->\n");
1708 /* Check 0x98[10] */
1709 tmp = _rtl8821ae_dbi_read(rtlpriv, 0x99);
1710 if (!(tmp & BIT(2))) {
1711 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
1712 "<---0x99(%#x) return!!\n", tmp);
1716 /* LTR idle latency, 0x90 for 144us */
1717 rtl_write_dword(rtlpriv, 0x798, 0x88908890);
1719 /* LTR active latency, 0x3c for 60us */
1720 rtl_write_dword(rtlpriv, 0x79c, 0x883c883c);
1722 tmp = rtl_read_byte(rtlpriv, 0x7a4);
1723 rtl_write_byte(rtlpriv, 0x7a4, (tmp | BIT(4)));
1725 tmp = rtl_read_byte(rtlpriv, 0x7a4);
1726 rtl_write_byte(rtlpriv, 0x7a4, (tmp & (~BIT(0))));
1727 rtl_write_byte(rtlpriv, 0x7a4, (tmp | BIT(0)));
1729 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "<---\n");
1732 static bool _rtl8821ae_wowlan_initialize_adapter(struct ieee80211_hw *hw)
1734 struct rtl_priv *rtlpriv = rtl_priv(hw);
1735 struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
1736 bool init_finished = true;
1739 /* Get Fw wake up reason. */
1740 _rtl8821ae_get_wakeup_reason(hw);
1742 /* Patch Pcie Rx DMA hang after S3/S4 several times.
1743 * The root cause has not be found. */
1744 if (_rtl8821ae_check_pcie_dma_hang(hw))
1745 _rtl8821ae_reset_pcie_interface_dma(hw, true, false);
1747 /* Prepare Tx/Rx Desc Hw address. */
1748 _rtl8821ae_init_trx_desc_hw_address(hw);
1750 /* Release Pcie Interface Rx DMA to allow wake packet DMA. */
1751 rtl_write_byte(rtlpriv, REG_PCIE_CTRL_REG + 1, 0xFE);
1752 RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD, "Enable PCIE Rx DMA.\n");
1754 /* Check wake up event.
1755 * We should check wake packet bit before disable wowlan by H2C or
1756 * Fw will clear the bit. */
1757 tmp = rtl_read_byte(rtlpriv, REG_FTISR + 3);
1758 RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
1759 "Read REG_FTISR 0x13f = %#X\n", tmp);
1761 /* Set the WoWLAN related function control disable. */
1762 rtl8821ae_set_fw_wowlan_mode(hw, false);
1763 rtl8821ae_set_fw_remote_wake_ctrl_cmd(hw, 0);
1765 if (rtlhal->hw_rof_enable) {
1766 tmp = rtl_read_byte(rtlpriv, REG_HSISR + 3);
1768 /* Clear GPIO9 ISR */
1769 rtl_write_byte(rtlpriv, REG_HSISR + 3, tmp | BIT(1));
1770 init_finished = false;
1772 init_finished = true;
1776 if (init_finished) {
1777 _rtl8821ae_simple_initialize_adapter(hw);
1779 /* Release Pcie Interface Tx DMA. */
1780 rtl_write_byte(rtlpriv, REG_PCIE_CTRL_REG + 1, 0x00);
1781 /* Release Pcie RX DMA */
1782 rtl_write_byte(rtlpriv, REG_RXDMA_CONTROL, 0x02);
1784 tmp = rtl_read_byte(rtlpriv, REG_CR + 1);
1785 rtl_write_byte(rtlpriv, REG_CR + 1, (tmp & (~BIT(0))));
1787 _rtl8821ae_enable_l1off(hw);
1788 _rtl8821ae_enable_ltr(hw);
1791 return init_finished;
1794 static void _rtl8812ae_bb8812_config_1t(struct ieee80211_hw *hw)
1796 /* BB OFDM RX Path_A */
1797 rtl_set_bbreg(hw, 0x808, 0xff, 0x11);
1798 /* BB OFDM TX Path_A */
1799 rtl_set_bbreg(hw, 0x80c, MASKLWORD, 0x1111);
1800 /* BB CCK R/Rx Path_A */
1801 rtl_set_bbreg(hw, 0xa04, 0x0c000000, 0x0);
1803 rtl_set_bbreg(hw, 0x8bc, 0xc0000060, 0x4);
1804 /* RF Path_B HSSI OFF */
1805 rtl_set_bbreg(hw, 0xe00, 0xf, 0x4);
1806 /* RF Path_B Power Down */
1807 rtl_set_bbreg(hw, 0xe90, MASKDWORD, 0);
1808 /* ADDA Path_B OFF */
1809 rtl_set_bbreg(hw, 0xe60, MASKDWORD, 0);
1810 rtl_set_bbreg(hw, 0xe64, MASKDWORD, 0);
1813 static void _rtl8821ae_poweroff_adapter(struct ieee80211_hw *hw)
1815 struct rtl_priv *rtlpriv = rtl_priv(hw);
1816 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
1819 rtlhal->mac_func_enable = false;
1821 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8821AE) {
1822 /* Combo (PCIe + USB) Card and PCIe-MF Card */
1823 /* 1. Run LPS WL RFOFF flow */
1824 /* RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
1825 "=====>CardDisableRTL8812E,RTL8821A_NIC_LPS_ENTER_FLOW\n");
1827 rtl_hal_pwrseqcmdparsing(rtlpriv,
1828 PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK,
1829 PWR_INTF_PCI_MSK, RTL8821A_NIC_LPS_ENTER_FLOW);
1831 /* 2. 0x1F[7:0] = 0 */
1833 /* rtl_write_byte(rtlpriv, REG_RF_CTRL, 0x00); */
1834 if ((rtl_read_byte(rtlpriv, REG_MCUFWDL) & BIT(7)) &&
1836 rtl8821ae_firmware_selfreset(hw);
1839 /* Reset MCU. Suggested by Filen. */
1840 u1b_tmp = rtl_read_byte(rtlpriv, REG_SYS_FUNC_EN+1);
1841 rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN+1, (u1b_tmp & (~BIT(2))));
1843 /* g. MCUFWDL 0x80[1:0]=0 */
1844 /* reset MCU ready status */
1845 rtl_write_byte(rtlpriv, REG_MCUFWDL, 0x00);
1847 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8821AE) {
1848 /* HW card disable configuration. */
1849 rtl_hal_pwrseqcmdparsing(rtlpriv, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK,
1850 PWR_INTF_PCI_MSK, RTL8821A_NIC_DISABLE_FLOW);
1852 /* HW card disable configuration. */
1853 rtl_hal_pwrseqcmdparsing(rtlpriv, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK,
1854 PWR_INTF_PCI_MSK, RTL8812_NIC_DISABLE_FLOW);
1857 /* Reset MCU IO Wrapper */
1858 u1b_tmp = rtl_read_byte(rtlpriv, REG_RSV_CTRL + 1);
1859 rtl_write_byte(rtlpriv, REG_RSV_CTRL + 1, (u1b_tmp & (~BIT(0))));
1860 u1b_tmp = rtl_read_byte(rtlpriv, REG_RSV_CTRL + 1);
1861 rtl_write_byte(rtlpriv, REG_RSV_CTRL + 1, u1b_tmp | BIT(0));
1863 /* 7. RSV_CTRL 0x1C[7:0] = 0x0E */
1864 /* lock ISO/CLK/Power control register */
1865 rtl_write_byte(rtlpriv, REG_RSV_CTRL, 0x0e);
1868 int rtl8821ae_hw_init(struct ieee80211_hw *hw)
1870 struct rtl_priv *rtlpriv = rtl_priv(hw);
1871 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
1872 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
1873 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
1874 bool rtstatus = true;
1877 bool support_remote_wakeup;
1878 u32 nav_upper = WIFI_NAV_UPPER_US;
1880 rtlhal->being_init_adapter = true;
1881 rtlpriv->cfg->ops->get_hw_reg(hw, HAL_DEF_WOWLAN,
1882 (u8 *)(&support_remote_wakeup));
1883 rtlpriv->intf_ops->disable_aspm(hw);
1885 /*YP wowlan not considered*/
1887 tmp_u1b = rtl_read_byte(rtlpriv, REG_CR);
1888 if (tmp_u1b != 0 && tmp_u1b != 0xEA) {
1889 rtlhal->mac_func_enable = true;
1890 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
1891 "MAC has already power on.\n");
1893 rtlhal->mac_func_enable = false;
1894 rtlhal->fw_ps_state = FW_PS_STATE_ALL_ON_8821AE;
1897 if (support_remote_wakeup &&
1898 rtlhal->wake_from_pnp_sleep &&
1899 rtlhal->mac_func_enable) {
1900 if (_rtl8821ae_wowlan_initialize_adapter(hw)) {
1901 rtlhal->being_init_adapter = false;
1906 if (_rtl8821ae_check_pcie_dma_hang(hw)) {
1907 _rtl8821ae_reset_pcie_interface_dma(hw,
1908 rtlhal->mac_func_enable,
1910 rtlhal->mac_func_enable = false;
1913 /* Reset MAC/BB/RF status if it is not powered off
1914 * before calling initialize Hw flow to prevent
1915 * from interface and MAC status mismatch.
1916 * 2013.06.21, by tynli. Suggested by SD1 JackieLau. */
1917 if (rtlhal->mac_func_enable) {
1918 _rtl8821ae_poweroff_adapter(hw);
1919 rtlhal->mac_func_enable = false;
1922 rtstatus = _rtl8821ae_init_mac(hw);
1923 if (rtstatus != true) {
1924 pr_err("Init MAC failed\n");
1929 tmp_u1b = rtl_read_byte(rtlpriv, REG_SYS_CFG);
1931 rtl_write_byte(rtlpriv, REG_SYS_CFG, tmp_u1b);
1933 err = rtl8821ae_download_fw(hw, false);
1935 RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
1936 "Failed to download FW. Init HW without FW now\n");
1938 rtlhal->fw_ready = false;
1941 rtlhal->fw_ready = true;
1943 ppsc->fw_current_inpsmode = false;
1944 rtlhal->fw_ps_state = FW_PS_STATE_ALL_ON_8821AE;
1945 rtlhal->fw_clk_change_in_progress = false;
1946 rtlhal->allow_sw_to_change_hwclc = false;
1947 rtlhal->last_hmeboxnum = 0;
1949 /*SIC_Init(Adapter);
1950 if(rtlhal->AMPDUBurstMode)
1951 rtl_write_byte(rtlpriv,REG_AMPDU_BURST_MODE_8812, 0x7F);*/
1953 rtl8821ae_phy_mac_config(hw);
1954 /* because last function modify RCR, so we update
1955 * rcr var here, or TP will unstable for receive_config
1956 * is wrong, RX RCR_ACRC32 will cause TP unstabel & Rx
1957 * RCR_APP_ICV will cause mac80211 unassoc for cisco 1252
1958 rtlpci->receive_config = rtl_read_dword(rtlpriv, REG_RCR);
1959 rtlpci->receive_config &= ~(RCR_ACRC32 | RCR_AICV);
1960 rtl_write_dword(rtlpriv, REG_RCR, rtlpci->receive_config);*/
1961 rtl8821ae_phy_bb_config(hw);
1963 rtl8821ae_phy_rf_config(hw);
1965 if (rtlpriv->phy.rf_type == RF_1T1R &&
1966 rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE)
1967 _rtl8812ae_bb8812_config_1t(hw);
1969 _rtl8821ae_hw_configure(hw);
1971 rtl8821ae_phy_switch_wirelessband(hw, BAND_ON_2_4G);
1973 /*set wireless mode*/
1975 rtlhal->mac_func_enable = true;
1977 rtl_cam_reset_all_entry(hw);
1979 rtl8821ae_enable_hw_security_config(hw);
1981 ppsc->rfpwr_state = ERFON;
1983 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_ETHER_ADDR, mac->mac_addr);
1984 _rtl8821ae_enable_aspm_back_door(hw);
1985 rtlpriv->intf_ops->enable_aspm(hw);
1987 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE &&
1988 (rtlhal->rfe_type == 1 || rtlhal->rfe_type == 5))
1989 rtl_set_bbreg(hw, 0x900, 0x00000303, 0x0302);
1991 rtl8821ae_bt_hw_init(hw);
1992 rtlpriv->rtlhal.being_init_adapter = false;
1994 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_NAV_UPPER, (u8 *)&nav_upper);
1996 /* rtl8821ae_dm_check_txpower_tracking(hw); */
1997 /* rtl8821ae_phy_lc_calibrate(hw); */
1998 if (support_remote_wakeup)
1999 rtl_write_byte(rtlpriv, REG_WOW_CTRL, 0);
2002 tmp_u1b = rtl_read_byte(rtlpriv, REG_RXDMA_CONTROL);
2003 if (tmp_u1b & BIT(2)) {
2004 /* Release Rx DMA if needed*/
2006 rtl_write_byte(rtlpriv, REG_RXDMA_CONTROL, tmp_u1b);
2009 /* Release Tx/Rx PCIE DMA if*/
2010 rtl_write_byte(rtlpriv, REG_PCIE_CTRL_REG + 1, 0);
2012 rtl8821ae_dm_init(hw);
2013 rtl8821ae_macid_initialize_mediastatus(hw);
2015 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "rtl8821ae_hw_init() <====\n");
2019 static enum version_8821ae _rtl8821ae_read_chip_version(struct ieee80211_hw *hw)
2021 struct rtl_priv *rtlpriv = rtl_priv(hw);
2022 struct rtl_phy *rtlphy = &rtlpriv->phy;
2023 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
2024 enum version_8821ae version = VERSION_UNKNOWN;
2027 value32 = rtl_read_dword(rtlpriv, REG_SYS_CFG);
2028 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2029 "ReadChipVersion8812A 0xF0 = 0x%x\n", value32);
2031 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE)
2032 rtlphy->rf_type = RF_2T2R;
2033 else if (rtlhal->hw_type == HARDWARE_TYPE_RTL8821AE)
2034 rtlphy->rf_type = RF_1T1R;
2036 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2037 "RF_Type is %x!!\n", rtlphy->rf_type);
2039 if (value32 & TRP_VAUX_EN) {
2040 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE) {
2041 if (rtlphy->rf_type == RF_2T2R)
2042 version = VERSION_TEST_CHIP_2T2R_8812;
2044 version = VERSION_TEST_CHIP_1T1R_8812;
2046 version = VERSION_TEST_CHIP_8821;
2048 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE) {
2049 u32 rtl_id = ((value32 & CHIP_VER_RTL_MASK) >> 12) + 1;
2051 if (rtlphy->rf_type == RF_2T2R)
2053 (enum version_8821ae)(CHIP_8812
2057 version = (enum version_8821ae)(CHIP_8812
2060 version = (enum version_8821ae)(version | (rtl_id << 12));
2061 } else if (rtlhal->hw_type == HARDWARE_TYPE_RTL8821AE) {
2062 u32 rtl_id = value32 & CHIP_VER_RTL_MASK;
2064 version = (enum version_8821ae)(CHIP_8821
2065 | NORMAL_CHIP | rtl_id);
2069 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8821AE) {
2071 value32 = rtl_read_dword(rtlpriv, REG_MULTI_FUNC_CTRL);
2072 rtlhal->hw_rof_enable = ((value32 & WL_HWROF_EN) ? 1 : 0);
2076 case VERSION_TEST_CHIP_1T1R_8812:
2077 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2078 "Chip Version ID: VERSION_TEST_CHIP_1T1R_8812\n");
2080 case VERSION_TEST_CHIP_2T2R_8812:
2081 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2082 "Chip Version ID: VERSION_TEST_CHIP_2T2R_8812\n");
2084 case VERSION_NORMAL_TSMC_CHIP_1T1R_8812:
2085 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2086 "Chip Version ID:VERSION_NORMAL_TSMC_CHIP_1T1R_8812\n");
2088 case VERSION_NORMAL_TSMC_CHIP_2T2R_8812:
2089 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2090 "Chip Version ID: VERSION_NORMAL_TSMC_CHIP_2T2R_8812\n");
2092 case VERSION_NORMAL_TSMC_CHIP_1T1R_8812_C_CUT:
2093 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2094 "Chip Version ID: VERSION_NORMAL_TSMC_CHIP_1T1R_8812 C CUT\n");
2096 case VERSION_NORMAL_TSMC_CHIP_2T2R_8812_C_CUT:
2097 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2098 "Chip Version ID: VERSION_NORMAL_TSMC_CHIP_2T2R_8812 C CUT\n");
2100 case VERSION_TEST_CHIP_8821:
2101 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2102 "Chip Version ID: VERSION_TEST_CHIP_8821\n");
2104 case VERSION_NORMAL_TSMC_CHIP_8821:
2105 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2106 "Chip Version ID: VERSION_NORMAL_TSMC_CHIP_8821 A CUT\n");
2108 case VERSION_NORMAL_TSMC_CHIP_8821_B_CUT:
2109 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2110 "Chip Version ID: VERSION_NORMAL_TSMC_CHIP_8821 B CUT\n");
2113 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2114 "Chip Version ID: Unknown (0x%X)\n", version);
2121 static int _rtl8821ae_set_media_status(struct ieee80211_hw *hw,
2122 enum nl80211_iftype type)
2124 struct rtl_priv *rtlpriv = rtl_priv(hw);
2125 u8 bt_msr = rtl_read_byte(rtlpriv, MSR);
2126 enum led_ctl_mode ledaction = LED_CTL_NO_LINK;
2129 rtl_write_dword(rtlpriv, REG_BCN_CTRL, 0);
2130 RT_TRACE(rtlpriv, COMP_BEACON, DBG_LOUD,
2131 "clear 0x550 when set HW_VAR_MEDIA_STATUS\n");
2133 if (type == NL80211_IFTYPE_UNSPECIFIED ||
2134 type == NL80211_IFTYPE_STATION) {
2135 _rtl8821ae_stop_tx_beacon(hw);
2136 _rtl8821ae_enable_bcn_sub_func(hw);
2137 } else if (type == NL80211_IFTYPE_ADHOC ||
2138 type == NL80211_IFTYPE_AP) {
2139 _rtl8821ae_resume_tx_beacon(hw);
2140 _rtl8821ae_disable_bcn_sub_func(hw);
2142 RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
2143 "Set HW_VAR_MEDIA_STATUS: No such media status(%x).\n",
2148 case NL80211_IFTYPE_UNSPECIFIED:
2149 bt_msr |= MSR_NOLINK;
2150 ledaction = LED_CTL_LINK;
2151 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
2152 "Set Network type to NO LINK!\n");
2154 case NL80211_IFTYPE_ADHOC:
2155 bt_msr |= MSR_ADHOC;
2156 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
2157 "Set Network type to Ad Hoc!\n");
2159 case NL80211_IFTYPE_STATION:
2160 bt_msr |= MSR_INFRA;
2161 ledaction = LED_CTL_LINK;
2162 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
2163 "Set Network type to STA!\n");
2165 case NL80211_IFTYPE_AP:
2167 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
2168 "Set Network type to AP!\n");
2171 pr_err("Network type %d not support!\n", type);
2175 rtl_write_byte(rtlpriv, MSR, bt_msr);
2176 rtlpriv->cfg->ops->led_control(hw, ledaction);
2177 if ((bt_msr & MSR_MASK) == MSR_AP)
2178 rtl_write_byte(rtlpriv, REG_BCNTCFG + 1, 0x00);
2180 rtl_write_byte(rtlpriv, REG_BCNTCFG + 1, 0x66);
2185 void rtl8821ae_set_check_bssid(struct ieee80211_hw *hw, bool check_bssid)
2187 struct rtl_priv *rtlpriv = rtl_priv(hw);
2188 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
2189 u32 reg_rcr = rtlpci->receive_config;
2191 if (rtlpriv->psc.rfpwr_state != ERFON)
2195 reg_rcr |= (RCR_CBSSID_DATA | RCR_CBSSID_BCN);
2196 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_RCR,
2198 _rtl8821ae_set_bcn_ctrl_reg(hw, 0, BIT(4));
2199 } else if (!check_bssid) {
2200 reg_rcr &= (~(RCR_CBSSID_DATA | RCR_CBSSID_BCN));
2201 _rtl8821ae_set_bcn_ctrl_reg(hw, BIT(4), 0);
2202 rtlpriv->cfg->ops->set_hw_reg(hw,
2203 HW_VAR_RCR, (u8 *)(®_rcr));
2207 int rtl8821ae_set_network_type(struct ieee80211_hw *hw, enum nl80211_iftype type)
2209 struct rtl_priv *rtlpriv = rtl_priv(hw);
2211 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "rtl8821ae_set_network_type!\n");
2213 if (_rtl8821ae_set_media_status(hw, type))
2216 if (rtlpriv->mac80211.link_state == MAC80211_LINKED) {
2217 if (type != NL80211_IFTYPE_AP)
2218 rtl8821ae_set_check_bssid(hw, true);
2220 rtl8821ae_set_check_bssid(hw, false);
2226 /* don't set REG_EDCA_BE_PARAM here because mac80211 will send pkt when scan */
2227 void rtl8821ae_set_qos(struct ieee80211_hw *hw, int aci)
2229 struct rtl_priv *rtlpriv = rtl_priv(hw);
2230 rtl8821ae_dm_init_edca_turbo(hw);
2233 rtl_write_dword(rtlpriv, REG_EDCA_BK_PARAM, 0xa44f);
2236 /* rtl_write_dword(rtlpriv, REG_EDCA_BE_PARAM, u4b_ac_param); */
2239 rtl_write_dword(rtlpriv, REG_EDCA_VI_PARAM, 0x5e4322);
2242 rtl_write_dword(rtlpriv, REG_EDCA_VO_PARAM, 0x2f3222);
2245 WARN_ONCE(true, "rtl8821ae: invalid aci: %d !\n", aci);
2250 static void rtl8821ae_clear_interrupt(struct ieee80211_hw *hw)
2252 struct rtl_priv *rtlpriv = rtl_priv(hw);
2253 u32 tmp = rtl_read_dword(rtlpriv, REG_HISR);
2255 rtl_write_dword(rtlpriv, REG_HISR, tmp);
2257 tmp = rtl_read_dword(rtlpriv, REG_HISRE);
2258 rtl_write_dword(rtlpriv, REG_HISRE, tmp);
2260 tmp = rtl_read_dword(rtlpriv, REG_HSISR);
2261 rtl_write_dword(rtlpriv, REG_HSISR, tmp);
2264 void rtl8821ae_enable_interrupt(struct ieee80211_hw *hw)
2266 struct rtl_priv *rtlpriv = rtl_priv(hw);
2267 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
2269 if (rtlpci->int_clear)
2270 rtl8821ae_clear_interrupt(hw);/*clear it here first*/
2272 rtl_write_dword(rtlpriv, REG_HIMR, rtlpci->irq_mask[0] & 0xFFFFFFFF);
2273 rtl_write_dword(rtlpriv, REG_HIMRE, rtlpci->irq_mask[1] & 0xFFFFFFFF);
2274 rtlpci->irq_enabled = true;
2275 /* there are some C2H CMDs have been sent before
2276 system interrupt is enabled, e.g., C2H, CPWM.
2277 *So we need to clear all C2H events that FW has
2278 notified, otherwise FW won't schedule any commands anymore.
2280 /* rtl_write_byte(rtlpriv, REG_C2HEVT_CLEAR, 0); */
2281 /*enable system interrupt*/
2282 rtl_write_dword(rtlpriv, REG_HSIMR, rtlpci->sys_irq_mask & 0xFFFFFFFF);
2285 void rtl8821ae_disable_interrupt(struct ieee80211_hw *hw)
2287 struct rtl_priv *rtlpriv = rtl_priv(hw);
2288 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
2290 rtl_write_dword(rtlpriv, REG_HIMR, IMR_DISABLED);
2291 rtl_write_dword(rtlpriv, REG_HIMRE, IMR_DISABLED);
2292 rtlpci->irq_enabled = false;
2293 /*synchronize_irq(rtlpci->pdev->irq);*/
2296 static void _rtl8821ae_clear_pci_pme_status(struct ieee80211_hw *hw)
2298 struct rtl_priv *rtlpriv = rtl_priv(hw);
2299 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
2306 /* Get the Capability pointer first,
2307 * the Capability Pointer is located at
2308 * offset 0x34 from the Function Header */
2310 pci_read_config_byte(rtlpci->pdev, 0x34, &cap_pointer);
2311 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2312 "PCI configuration 0x34 = 0x%2x\n", cap_pointer);
2315 pci_read_config_word(rtlpci->pdev, cap_pointer, &cap_hdr);
2316 cap_id = cap_hdr & 0xFF;
2318 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2319 "in pci configuration, cap_pointer%x = %x\n",
2320 cap_pointer, cap_id);
2322 if (cap_id == 0x01) {
2325 /* point to next Capability */
2326 cap_pointer = (cap_hdr >> 8) & 0xFF;
2327 /* 0: end of pci capability, 0xff: invalid value */
2328 if (cap_pointer == 0x00 || cap_pointer == 0xff) {
2333 } while (cnt++ < 200);
2335 if (cap_id == 0x01) {
2336 /* Get the PM CSR (Control/Status Register),
2337 * The PME_Status is located at PM Capatibility offset 5, bit 7
2339 pci_read_config_byte(rtlpci->pdev, cap_pointer + 5, &pmcs_reg);
2341 if (pmcs_reg & BIT(7)) {
2342 /* PME event occured, clear the PM_Status by write 1 */
2343 pmcs_reg = pmcs_reg | BIT(7);
2345 pci_write_config_byte(rtlpci->pdev, cap_pointer + 5,
2347 /* Read it back to check */
2348 pci_read_config_byte(rtlpci->pdev, cap_pointer + 5,
2350 RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
2351 "Clear PME status 0x%2x to 0x%2x\n",
2352 cap_pointer + 5, pmcs_reg);
2354 RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
2355 "PME status(0x%2x) = 0x%2x\n",
2356 cap_pointer + 5, pmcs_reg);
2359 RT_TRACE(rtlpriv, COMP_INIT, DBG_WARNING,
2360 "Cannot find PME Capability\n");
2364 void rtl8821ae_card_disable(struct ieee80211_hw *hw)
2366 struct rtl_priv *rtlpriv = rtl_priv(hw);
2367 struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
2368 struct rtl_ps_ctl *ppsc = rtl_psc(rtlpriv);
2369 struct rtl_mac *mac = rtl_mac(rtlpriv);
2370 enum nl80211_iftype opmode;
2371 bool support_remote_wakeup;
2375 rtlpriv->cfg->ops->get_hw_reg(hw, HAL_DEF_WOWLAN,
2376 (u8 *)(&support_remote_wakeup));
2378 RT_SET_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_HALT_NIC);
2380 if (!(support_remote_wakeup && mac->opmode == NL80211_IFTYPE_STATION)
2381 || !rtlhal->enter_pnp_sleep) {
2382 RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG, "Normal Power off\n");
2383 mac->link_state = MAC80211_NOLINK;
2384 opmode = NL80211_IFTYPE_UNSPECIFIED;
2385 _rtl8821ae_set_media_status(hw, opmode);
2386 _rtl8821ae_poweroff_adapter(hw);
2388 RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG, "Wowlan Supported.\n");
2389 /* 3 <1> Prepare for configuring wowlan related infomations */
2390 /* Clear Fw WoWLAN event. */
2391 rtl_write_byte(rtlpriv, REG_MCUTST_WOWLAN, 0x0);
2393 #if (USE_SPECIFIC_FW_TO_SUPPORT_WOWLAN == 1)
2394 rtl8821ae_set_fw_related_for_wowlan(hw, true);
2396 /* Dynamically adjust Tx packet boundary
2397 * for download reserved page packet.
2398 * reserve 30 pages for rsvd page */
2399 if (_rtl8821ae_dynamic_rqpn(hw, 0xE0, 0x3, 0x80c20d0d))
2400 rtlhal->re_init_llt_table = true;
2402 /* 3 <2> Set Fw releted H2C cmd. */
2404 /* Set WoWLAN related security information. */
2405 rtl8821ae_set_fw_global_info_cmd(hw);
2407 _rtl8821ae_download_rsvd_page(hw, true);
2409 /* Just enable AOAC related functions when we connect to AP. */
2410 printk("mac->link_state = %d\n", mac->link_state);
2411 if (mac->link_state >= MAC80211_LINKED &&
2412 mac->opmode == NL80211_IFTYPE_STATION) {
2413 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_AID, NULL);
2414 rtl8821ae_set_fw_media_status_rpt_cmd(hw,
2417 rtl8821ae_set_fw_wowlan_mode(hw, true);
2418 /* Enable Fw Keep alive mechanism. */
2419 rtl8821ae_set_fw_keep_alive_cmd(hw, true);
2421 /* Enable disconnect decision control. */
2422 rtl8821ae_set_fw_disconnect_decision_ctrl_cmd(hw, true);
2425 /* 3 <3> Hw Configutations */
2427 /* Wait untill Rx DMA Finished before host sleep.
2428 * FW Pause Rx DMA may happens when received packet doing dma.
2430 rtl_write_byte(rtlpriv, REG_RXDMA_CONTROL, BIT(2));
2432 tmp = rtl_read_byte(rtlpriv, REG_RXDMA_CONTROL);
2434 while (!(tmp & BIT(1)) && (count++ < 100)) {
2436 tmp = rtl_read_byte(rtlpriv, REG_RXDMA_CONTROL);
2438 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2439 "Wait Rx DMA Finished before host sleep. count=%d\n",
2442 /* reset trx ring */
2443 rtlpriv->intf_ops->reset_trx_ring(hw);
2445 rtl_write_byte(rtlpriv, REG_APS_FSMCO + 1, 0x0);
2447 _rtl8821ae_clear_pci_pme_status(hw);
2448 tmp = rtl_read_byte(rtlpriv, REG_SYS_CLKR);
2449 rtl_write_byte(rtlpriv, REG_SYS_CLKR, tmp | BIT(3));
2450 /* prevent 8051 to be reset by PERST */
2451 rtl_write_byte(rtlpriv, REG_RSV_CTRL, 0x20);
2452 rtl_write_byte(rtlpriv, REG_RSV_CTRL, 0x60);
2455 if (rtlpriv->rtlhal.driver_is_goingto_unload ||
2456 ppsc->rfoff_reason > RF_CHANGE_BY_PS)
2457 rtlpriv->cfg->ops->led_control(hw, LED_CTL_POWER_OFF);
2458 /* For wowlan+LPS+32k. */
2459 if (support_remote_wakeup && rtlhal->enter_pnp_sleep) {
2460 /* Set the WoWLAN related function control enable.
2461 * It should be the last H2C cmd in the WoWLAN flow. */
2462 rtl8821ae_set_fw_remote_wake_ctrl_cmd(hw, 1);
2464 /* Stop Pcie Interface Tx DMA. */
2465 rtl_write_byte(rtlpriv, REG_PCIE_CTRL_REG + 1, 0xff);
2466 RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD, "Stop PCIE Tx DMA.\n");
2468 /* Wait for TxDMA idle. */
2471 tmp = rtl_read_byte(rtlpriv, REG_PCIE_CTRL_REG);
2474 } while ((tmp != 0) && (count < 100));
2475 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2476 "Wait Tx DMA Finished before host sleep. count=%d\n",
2479 if (rtlhal->hw_rof_enable) {
2480 printk("hw_rof_enable\n");
2481 tmp = rtl_read_byte(rtlpriv, REG_HSISR + 3);
2482 rtl_write_byte(rtlpriv, REG_HSISR + 3, tmp | BIT(1));
2485 /* after power off we should do iqk again */
2486 rtlpriv->phy.iqk_initialized = false;
2489 void rtl8821ae_interrupt_recognized(struct ieee80211_hw *hw,
2490 u32 *p_inta, u32 *p_intb)
2492 struct rtl_priv *rtlpriv = rtl_priv(hw);
2493 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
2495 *p_inta = rtl_read_dword(rtlpriv, ISR) & rtlpci->irq_mask[0];
2496 rtl_write_dword(rtlpriv, ISR, *p_inta);
2498 *p_intb = rtl_read_dword(rtlpriv, REG_HISRE) & rtlpci->irq_mask[1];
2499 rtl_write_dword(rtlpriv, REG_HISRE, *p_intb);
2502 void rtl8821ae_set_beacon_related_registers(struct ieee80211_hw *hw)
2504 struct rtl_priv *rtlpriv = rtl_priv(hw);
2505 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
2506 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
2507 u16 bcn_interval, atim_window;
2509 bcn_interval = mac->beacon_interval;
2510 atim_window = 2; /*FIX MERGE */
2511 rtl8821ae_disable_interrupt(hw);
2512 rtl_write_word(rtlpriv, REG_ATIMWND, atim_window);
2513 rtl_write_word(rtlpriv, REG_BCN_INTERVAL, bcn_interval);
2514 rtl_write_word(rtlpriv, REG_BCNTCFG, 0x660f);
2515 rtl_write_byte(rtlpriv, REG_RXTSF_OFFSET_CCK, 0x18);
2516 rtl_write_byte(rtlpriv, REG_RXTSF_OFFSET_OFDM, 0x18);
2517 rtl_write_byte(rtlpriv, 0x606, 0x30);
2518 rtlpci->reg_bcn_ctrl_val |= BIT(3);
2519 rtl_write_byte(rtlpriv, REG_BCN_CTRL, (u8)rtlpci->reg_bcn_ctrl_val);
2520 rtl8821ae_enable_interrupt(hw);
2523 void rtl8821ae_set_beacon_interval(struct ieee80211_hw *hw)
2525 struct rtl_priv *rtlpriv = rtl_priv(hw);
2526 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
2527 u16 bcn_interval = mac->beacon_interval;
2529 RT_TRACE(rtlpriv, COMP_BEACON, DBG_DMESG,
2530 "beacon_interval:%d\n", bcn_interval);
2531 rtl8821ae_disable_interrupt(hw);
2532 rtl_write_word(rtlpriv, REG_BCN_INTERVAL, bcn_interval);
2533 rtl8821ae_enable_interrupt(hw);
2536 void rtl8821ae_update_interrupt_mask(struct ieee80211_hw *hw,
2537 u32 add_msr, u32 rm_msr)
2539 struct rtl_priv *rtlpriv = rtl_priv(hw);
2540 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
2542 RT_TRACE(rtlpriv, COMP_INTR, DBG_LOUD,
2543 "add_msr:%x, rm_msr:%x\n", add_msr, rm_msr);
2546 rtlpci->irq_mask[0] |= add_msr;
2548 rtlpci->irq_mask[0] &= (~rm_msr);
2549 rtl8821ae_disable_interrupt(hw);
2550 rtl8821ae_enable_interrupt(hw);
2553 static u8 _rtl8821ae_get_chnl_group(u8 chnl)
2558 if (1 <= chnl && chnl <= 2)
2560 else if (3 <= chnl && chnl <= 5)
2562 else if (6 <= chnl && chnl <= 8)
2564 else if (9 <= chnl && chnl <= 11)
2566 else /*if (12 <= chnl && chnl <= 14)*/
2569 if (36 <= chnl && chnl <= 42)
2571 else if (44 <= chnl && chnl <= 48)
2573 else if (50 <= chnl && chnl <= 58)
2575 else if (60 <= chnl && chnl <= 64)
2577 else if (100 <= chnl && chnl <= 106)
2579 else if (108 <= chnl && chnl <= 114)
2581 else if (116 <= chnl && chnl <= 122)
2583 else if (124 <= chnl && chnl <= 130)
2585 else if (132 <= chnl && chnl <= 138)
2587 else if (140 <= chnl && chnl <= 144)
2589 else if (149 <= chnl && chnl <= 155)
2591 else if (157 <= chnl && chnl <= 161)
2593 else if (165 <= chnl && chnl <= 171)
2595 else if (173 <= chnl && chnl <= 177)
2599 "rtl8821ae: 5G, Channel %d in Group not found\n",
2605 static void _rtl8821ae_read_power_value_fromprom(struct ieee80211_hw *hw,
2606 struct txpower_info_2g *pwrinfo24g,
2607 struct txpower_info_5g *pwrinfo5g,
2611 struct rtl_priv *rtlpriv = rtl_priv(hw);
2612 u32 rfPath, eeAddr = EEPROM_TX_PWR_INX, group, TxCount = 0;
2614 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2615 "hal_ReadPowerValueFromPROM8821ae(): hwinfo[0x%x]=0x%x\n",
2616 (eeAddr+1), hwinfo[eeAddr+1]);
2617 if (0xFF == hwinfo[eeAddr+1]) /*YJ,add,120316*/
2618 autoload_fail = true;
2620 if (autoload_fail) {
2621 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
2622 "auto load fail : Use Default value!\n");
2623 for (rfPath = 0 ; rfPath < MAX_RF_PATH ; rfPath++) {
2624 /*2.4G default value*/
2625 for (group = 0 ; group < MAX_CHNL_GROUP_24G; group++) {
2626 pwrinfo24g->index_cck_base[rfPath][group] = 0x2D;
2627 pwrinfo24g->index_bw40_base[rfPath][group] = 0x2D;
2629 for (TxCount = 0; TxCount < MAX_TX_COUNT; TxCount++) {
2631 pwrinfo24g->bw20_diff[rfPath][0] = 0x02;
2632 pwrinfo24g->ofdm_diff[rfPath][0] = 0x04;
2634 pwrinfo24g->bw20_diff[rfPath][TxCount] = 0xFE;
2635 pwrinfo24g->bw40_diff[rfPath][TxCount] = 0xFE;
2636 pwrinfo24g->cck_diff[rfPath][TxCount] = 0xFE;
2637 pwrinfo24g->ofdm_diff[rfPath][TxCount] = 0xFE;
2640 /*5G default value*/
2641 for (group = 0 ; group < MAX_CHNL_GROUP_5G; group++)
2642 pwrinfo5g->index_bw40_base[rfPath][group] = 0x2A;
2644 for (TxCount = 0; TxCount < MAX_TX_COUNT; TxCount++) {
2646 pwrinfo5g->ofdm_diff[rfPath][0] = 0x04;
2647 pwrinfo5g->bw20_diff[rfPath][0] = 0x00;
2648 pwrinfo5g->bw80_diff[rfPath][0] = 0xFE;
2649 pwrinfo5g->bw160_diff[rfPath][0] = 0xFE;
2651 pwrinfo5g->ofdm_diff[rfPath][0] = 0xFE;
2652 pwrinfo5g->bw20_diff[rfPath][0] = 0xFE;
2653 pwrinfo5g->bw40_diff[rfPath][0] = 0xFE;
2654 pwrinfo5g->bw80_diff[rfPath][0] = 0xFE;
2655 pwrinfo5g->bw160_diff[rfPath][0] = 0xFE;
2662 rtl_priv(hw)->efuse.txpwr_fromeprom = true;
2664 for (rfPath = 0 ; rfPath < MAX_RF_PATH ; rfPath++) {
2665 /*2.4G default value*/
2666 for (group = 0 ; group < MAX_CHNL_GROUP_24G; group++) {
2667 pwrinfo24g->index_cck_base[rfPath][group] = hwinfo[eeAddr++];
2668 if (pwrinfo24g->index_cck_base[rfPath][group] == 0xFF)
2669 pwrinfo24g->index_cck_base[rfPath][group] = 0x2D;
2671 for (group = 0 ; group < MAX_CHNL_GROUP_24G - 1; group++) {
2672 pwrinfo24g->index_bw40_base[rfPath][group] = hwinfo[eeAddr++];
2673 if (pwrinfo24g->index_bw40_base[rfPath][group] == 0xFF)
2674 pwrinfo24g->index_bw40_base[rfPath][group] = 0x2D;
2676 for (TxCount = 0; TxCount < MAX_TX_COUNT; TxCount++) {
2678 pwrinfo24g->bw40_diff[rfPath][TxCount] = 0;
2679 /*bit sign number to 8 bit sign number*/
2680 pwrinfo24g->bw20_diff[rfPath][TxCount] = (hwinfo[eeAddr] & 0xf0) >> 4;
2681 if (pwrinfo24g->bw20_diff[rfPath][TxCount] & BIT(3))
2682 pwrinfo24g->bw20_diff[rfPath][TxCount] |= 0xF0;
2683 /*bit sign number to 8 bit sign number*/
2684 pwrinfo24g->ofdm_diff[rfPath][TxCount] = (hwinfo[eeAddr] & 0x0f);
2685 if (pwrinfo24g->ofdm_diff[rfPath][TxCount] & BIT(3))
2686 pwrinfo24g->ofdm_diff[rfPath][TxCount] |= 0xF0;
2688 pwrinfo24g->cck_diff[rfPath][TxCount] = 0;
2691 pwrinfo24g->bw40_diff[rfPath][TxCount] = (hwinfo[eeAddr]&0xf0) >> 4;
2692 if (pwrinfo24g->bw40_diff[rfPath][TxCount] & BIT(3))
2693 pwrinfo24g->bw40_diff[rfPath][TxCount] |= 0xF0;
2695 pwrinfo24g->bw20_diff[rfPath][TxCount] = (hwinfo[eeAddr] & 0x0f);
2696 if (pwrinfo24g->bw20_diff[rfPath][TxCount] & BIT(3))
2697 pwrinfo24g->bw20_diff[rfPath][TxCount] |= 0xF0;
2701 pwrinfo24g->ofdm_diff[rfPath][TxCount] = (hwinfo[eeAddr] & 0xf0) >> 4;
2702 if (pwrinfo24g->ofdm_diff[rfPath][TxCount] & BIT(3))
2703 pwrinfo24g->ofdm_diff[rfPath][TxCount] |= 0xF0;
2705 pwrinfo24g->cck_diff[rfPath][TxCount] = (hwinfo[eeAddr] & 0x0f);
2706 if (pwrinfo24g->cck_diff[rfPath][TxCount] & BIT(3))
2707 pwrinfo24g->cck_diff[rfPath][TxCount] |= 0xF0;
2713 /*5G default value*/
2714 for (group = 0 ; group < MAX_CHNL_GROUP_5G; group++) {
2715 pwrinfo5g->index_bw40_base[rfPath][group] = hwinfo[eeAddr++];
2716 if (pwrinfo5g->index_bw40_base[rfPath][group] == 0xFF)
2717 pwrinfo5g->index_bw40_base[rfPath][group] = 0xFE;
2720 for (TxCount = 0; TxCount < MAX_TX_COUNT; TxCount++) {
2722 pwrinfo5g->bw40_diff[rfPath][TxCount] = 0;
2724 pwrinfo5g->bw20_diff[rfPath][0] = (hwinfo[eeAddr] & 0xf0) >> 4;
2725 if (pwrinfo5g->bw20_diff[rfPath][TxCount] & BIT(3))
2726 pwrinfo5g->bw20_diff[rfPath][TxCount] |= 0xF0;
2728 pwrinfo5g->ofdm_diff[rfPath][0] = (hwinfo[eeAddr] & 0x0f);
2729 if (pwrinfo5g->ofdm_diff[rfPath][TxCount] & BIT(3))
2730 pwrinfo5g->ofdm_diff[rfPath][TxCount] |= 0xF0;
2734 pwrinfo5g->bw40_diff[rfPath][TxCount] = (hwinfo[eeAddr] & 0xf0) >> 4;
2735 if (pwrinfo5g->bw40_diff[rfPath][TxCount] & BIT(3))
2736 pwrinfo5g->bw40_diff[rfPath][TxCount] |= 0xF0;
2738 pwrinfo5g->bw20_diff[rfPath][TxCount] = (hwinfo[eeAddr] & 0x0f);
2739 if (pwrinfo5g->bw20_diff[rfPath][TxCount] & BIT(3))
2740 pwrinfo5g->bw20_diff[rfPath][TxCount] |= 0xF0;
2746 pwrinfo5g->ofdm_diff[rfPath][1] = (hwinfo[eeAddr] & 0xf0) >> 4;
2747 pwrinfo5g->ofdm_diff[rfPath][2] = (hwinfo[eeAddr] & 0x0f);
2751 pwrinfo5g->ofdm_diff[rfPath][3] = (hwinfo[eeAddr] & 0x0f);
2755 for (TxCount = 1; TxCount < MAX_TX_COUNT; TxCount++) {
2756 if (pwrinfo5g->ofdm_diff[rfPath][TxCount] & BIT(3))
2757 pwrinfo5g->ofdm_diff[rfPath][TxCount] |= 0xF0;
2759 for (TxCount = 0; TxCount < MAX_TX_COUNT; TxCount++) {
2760 pwrinfo5g->bw80_diff[rfPath][TxCount] = (hwinfo[eeAddr] & 0xf0) >> 4;
2761 /* 4bit sign number to 8 bit sign number */
2762 if (pwrinfo5g->bw80_diff[rfPath][TxCount] & BIT(3))
2763 pwrinfo5g->bw80_diff[rfPath][TxCount] |= 0xF0;
2764 /* 4bit sign number to 8 bit sign number */
2765 pwrinfo5g->bw160_diff[rfPath][TxCount] = (hwinfo[eeAddr] & 0x0f);
2766 if (pwrinfo5g->bw160_diff[rfPath][TxCount] & BIT(3))
2767 pwrinfo5g->bw160_diff[rfPath][TxCount] |= 0xF0;
2774 static void _rtl8812ae_read_txpower_info_from_hwpg(struct ieee80211_hw *hw,
2778 struct rtl_priv *rtlpriv = rtl_priv(hw);
2779 struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
2780 struct txpower_info_2g pwrinfo24g;
2781 struct txpower_info_5g pwrinfo5g;
2785 _rtl8821ae_read_power_value_fromprom(hw, &pwrinfo24g,
2786 &pwrinfo5g, autoload_fail, hwinfo);
2788 for (rf_path = 0; rf_path < 2; rf_path++) {
2789 for (i = 0; i < CHANNEL_MAX_NUMBER_2G; i++) {
2790 index = _rtl8821ae_get_chnl_group(i + 1);
2792 if (i == CHANNEL_MAX_NUMBER_2G - 1) {
2793 rtlefuse->txpwrlevel_cck[rf_path][i] =
2794 pwrinfo24g.index_cck_base[rf_path][5];
2795 rtlefuse->txpwrlevel_ht40_1s[rf_path][i] =
2796 pwrinfo24g.index_bw40_base[rf_path][index];
2798 rtlefuse->txpwrlevel_cck[rf_path][i] =
2799 pwrinfo24g.index_cck_base[rf_path][index];
2800 rtlefuse->txpwrlevel_ht40_1s[rf_path][i] =
2801 pwrinfo24g.index_bw40_base[rf_path][index];
2805 for (i = 0; i < CHANNEL_MAX_NUMBER_5G; i++) {
2806 index = _rtl8821ae_get_chnl_group(channel5g[i]);
2807 rtlefuse->txpwr_5g_bw40base[rf_path][i] =
2808 pwrinfo5g.index_bw40_base[rf_path][index];
2810 for (i = 0; i < CHANNEL_MAX_NUMBER_5G_80M; i++) {
2812 index = _rtl8821ae_get_chnl_group(channel5g_80m[i]);
2813 upper = pwrinfo5g.index_bw40_base[rf_path][index];
2814 lower = pwrinfo5g.index_bw40_base[rf_path][index + 1];
2816 rtlefuse->txpwr_5g_bw80base[rf_path][i] = (upper + lower) / 2;
2818 for (i = 0; i < MAX_TX_COUNT; i++) {
2819 rtlefuse->txpwr_cckdiff[rf_path][i] =
2820 pwrinfo24g.cck_diff[rf_path][i];
2821 rtlefuse->txpwr_legacyhtdiff[rf_path][i] =
2822 pwrinfo24g.ofdm_diff[rf_path][i];
2823 rtlefuse->txpwr_ht20diff[rf_path][i] =
2824 pwrinfo24g.bw20_diff[rf_path][i];
2825 rtlefuse->txpwr_ht40diff[rf_path][i] =
2826 pwrinfo24g.bw40_diff[rf_path][i];
2828 rtlefuse->txpwr_5g_ofdmdiff[rf_path][i] =
2829 pwrinfo5g.ofdm_diff[rf_path][i];
2830 rtlefuse->txpwr_5g_bw20diff[rf_path][i] =
2831 pwrinfo5g.bw20_diff[rf_path][i];
2832 rtlefuse->txpwr_5g_bw40diff[rf_path][i] =
2833 pwrinfo5g.bw40_diff[rf_path][i];
2834 rtlefuse->txpwr_5g_bw80diff[rf_path][i] =
2835 pwrinfo5g.bw80_diff[rf_path][i];
2839 if (!autoload_fail) {
2840 rtlefuse->eeprom_regulatory =
2841 hwinfo[EEPROM_RF_BOARD_OPTION] & 0x07;/*bit0~2*/
2842 if (hwinfo[EEPROM_RF_BOARD_OPTION] == 0xFF)
2843 rtlefuse->eeprom_regulatory = 0;
2845 rtlefuse->eeprom_regulatory = 0;
2848 RTPRINT(rtlpriv, FINIT, INIT_TXPOWER,
2849 "eeprom_regulatory = 0x%x\n", rtlefuse->eeprom_regulatory);
2852 static void _rtl8821ae_read_txpower_info_from_hwpg(struct ieee80211_hw *hw,
2856 struct rtl_priv *rtlpriv = rtl_priv(hw);
2857 struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
2858 struct txpower_info_2g pwrinfo24g;
2859 struct txpower_info_5g pwrinfo5g;
2863 _rtl8821ae_read_power_value_fromprom(hw, &pwrinfo24g,
2864 &pwrinfo5g, autoload_fail, hwinfo);
2866 for (rf_path = 0; rf_path < 2; rf_path++) {
2867 for (i = 0; i < CHANNEL_MAX_NUMBER_2G; i++) {
2868 index = _rtl8821ae_get_chnl_group(i + 1);
2870 if (i == CHANNEL_MAX_NUMBER_2G - 1) {
2871 rtlefuse->txpwrlevel_cck[rf_path][i] =
2872 pwrinfo24g.index_cck_base[rf_path][5];
2873 rtlefuse->txpwrlevel_ht40_1s[rf_path][i] =
2874 pwrinfo24g.index_bw40_base[rf_path][index];
2876 rtlefuse->txpwrlevel_cck[rf_path][i] =
2877 pwrinfo24g.index_cck_base[rf_path][index];
2878 rtlefuse->txpwrlevel_ht40_1s[rf_path][i] =
2879 pwrinfo24g.index_bw40_base[rf_path][index];
2883 for (i = 0; i < CHANNEL_MAX_NUMBER_5G; i++) {
2884 index = _rtl8821ae_get_chnl_group(channel5g[i]);
2885 rtlefuse->txpwr_5g_bw40base[rf_path][i] =
2886 pwrinfo5g.index_bw40_base[rf_path][index];
2888 for (i = 0; i < CHANNEL_MAX_NUMBER_5G_80M; i++) {
2890 index = _rtl8821ae_get_chnl_group(channel5g_80m[i]);
2891 upper = pwrinfo5g.index_bw40_base[rf_path][index];
2892 lower = pwrinfo5g.index_bw40_base[rf_path][index + 1];
2894 rtlefuse->txpwr_5g_bw80base[rf_path][i] = (upper + lower) / 2;
2896 for (i = 0; i < MAX_TX_COUNT; i++) {
2897 rtlefuse->txpwr_cckdiff[rf_path][i] =
2898 pwrinfo24g.cck_diff[rf_path][i];
2899 rtlefuse->txpwr_legacyhtdiff[rf_path][i] =
2900 pwrinfo24g.ofdm_diff[rf_path][i];
2901 rtlefuse->txpwr_ht20diff[rf_path][i] =
2902 pwrinfo24g.bw20_diff[rf_path][i];
2903 rtlefuse->txpwr_ht40diff[rf_path][i] =
2904 pwrinfo24g.bw40_diff[rf_path][i];
2906 rtlefuse->txpwr_5g_ofdmdiff[rf_path][i] =
2907 pwrinfo5g.ofdm_diff[rf_path][i];
2908 rtlefuse->txpwr_5g_bw20diff[rf_path][i] =
2909 pwrinfo5g.bw20_diff[rf_path][i];
2910 rtlefuse->txpwr_5g_bw40diff[rf_path][i] =
2911 pwrinfo5g.bw40_diff[rf_path][i];
2912 rtlefuse->txpwr_5g_bw80diff[rf_path][i] =
2913 pwrinfo5g.bw80_diff[rf_path][i];
2917 if (!autoload_fail) {
2918 rtlefuse->eeprom_regulatory = hwinfo[EEPROM_RF_BOARD_OPTION] & 0x07;
2919 if (hwinfo[EEPROM_RF_BOARD_OPTION] == 0xFF)
2920 rtlefuse->eeprom_regulatory = 0;
2922 rtlefuse->eeprom_regulatory = 0;
2925 RTPRINT(rtlpriv, FINIT, INIT_TXPOWER,
2926 "eeprom_regulatory = 0x%x\n", rtlefuse->eeprom_regulatory);
2929 static void _rtl8812ae_read_pa_type(struct ieee80211_hw *hw, u8 *hwinfo,
2932 struct rtl_priv *rtlpriv = rtl_priv(hw);
2933 struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
2935 if (!autoload_fail) {
2936 rtlhal->pa_type_2g = hwinfo[0xBC];
2937 rtlhal->lna_type_2g = hwinfo[0xBD];
2938 if (rtlhal->pa_type_2g == 0xFF && rtlhal->lna_type_2g == 0xFF) {
2939 rtlhal->pa_type_2g = 0;
2940 rtlhal->lna_type_2g = 0;
2942 rtlhal->external_pa_2g = ((rtlhal->pa_type_2g & BIT(5)) &&
2943 (rtlhal->pa_type_2g & BIT(4))) ?
2945 rtlhal->external_lna_2g = ((rtlhal->lna_type_2g & BIT(7)) &&
2946 (rtlhal->lna_type_2g & BIT(3))) ?
2949 rtlhal->pa_type_5g = hwinfo[0xBC];
2950 rtlhal->lna_type_5g = hwinfo[0xBF];
2951 if (rtlhal->pa_type_5g == 0xFF && rtlhal->lna_type_5g == 0xFF) {
2952 rtlhal->pa_type_5g = 0;
2953 rtlhal->lna_type_5g = 0;
2955 rtlhal->external_pa_5g = ((rtlhal->pa_type_5g & BIT(1)) &&
2956 (rtlhal->pa_type_5g & BIT(0))) ?
2958 rtlhal->external_lna_5g = ((rtlhal->lna_type_5g & BIT(7)) &&
2959 (rtlhal->lna_type_5g & BIT(3))) ?
2962 rtlhal->external_pa_2g = 0;
2963 rtlhal->external_lna_2g = 0;
2964 rtlhal->external_pa_5g = 0;
2965 rtlhal->external_lna_5g = 0;
2969 static void _rtl8821ae_read_pa_type(struct ieee80211_hw *hw, u8 *hwinfo,
2972 struct rtl_priv *rtlpriv = rtl_priv(hw);
2973 struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
2975 if (!autoload_fail) {
2976 rtlhal->pa_type_2g = hwinfo[0xBC];
2977 rtlhal->lna_type_2g = hwinfo[0xBD];
2978 if (rtlhal->pa_type_2g == 0xFF && rtlhal->lna_type_2g == 0xFF) {
2979 rtlhal->pa_type_2g = 0;
2980 rtlhal->lna_type_2g = 0;
2982 rtlhal->external_pa_2g = (rtlhal->pa_type_2g & BIT(5)) ? 1 : 0;
2983 rtlhal->external_lna_2g = (rtlhal->lna_type_2g & BIT(7)) ? 1 : 0;
2985 rtlhal->pa_type_5g = hwinfo[0xBC];
2986 rtlhal->lna_type_5g = hwinfo[0xBF];
2987 if (rtlhal->pa_type_5g == 0xFF && rtlhal->lna_type_5g == 0xFF) {
2988 rtlhal->pa_type_5g = 0;
2989 rtlhal->lna_type_5g = 0;
2991 rtlhal->external_pa_5g = (rtlhal->pa_type_5g & BIT(1)) ? 1 : 0;
2992 rtlhal->external_lna_5g = (rtlhal->lna_type_5g & BIT(7)) ? 1 : 0;
2994 rtlhal->external_pa_2g = 0;
2995 rtlhal->external_lna_2g = 0;
2996 rtlhal->external_pa_5g = 0;
2997 rtlhal->external_lna_5g = 0;
3001 static void _rtl8821ae_read_rfe_type(struct ieee80211_hw *hw, u8 *hwinfo,
3004 struct rtl_priv *rtlpriv = rtl_priv(hw);
3005 struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
3007 if (!autoload_fail) {
3008 if (hwinfo[EEPROM_RFE_OPTION] & BIT(7)) {
3009 if (rtlhal->external_lna_5g) {
3010 if (rtlhal->external_pa_5g) {
3011 if (rtlhal->external_lna_2g &&
3012 rtlhal->external_pa_2g)
3013 rtlhal->rfe_type = 3;
3015 rtlhal->rfe_type = 0;
3017 rtlhal->rfe_type = 2;
3020 rtlhal->rfe_type = 4;
3023 rtlhal->rfe_type = hwinfo[EEPROM_RFE_OPTION] & 0x3F;
3025 if (rtlhal->rfe_type == 4 &&
3026 (rtlhal->external_pa_5g ||
3027 rtlhal->external_pa_2g ||
3028 rtlhal->external_lna_5g ||
3029 rtlhal->external_lna_2g)) {
3030 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE)
3031 rtlhal->rfe_type = 2;
3035 rtlhal->rfe_type = 0x04;
3038 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
3039 "RFE Type: 0x%2x\n", rtlhal->rfe_type);
3042 static void _rtl8812ae_read_bt_coexist_info_from_hwpg(struct ieee80211_hw *hw,
3043 bool auto_load_fail, u8 *hwinfo)
3045 struct rtl_priv *rtlpriv = rtl_priv(hw);
3048 if (!auto_load_fail) {
3049 value = *(u8 *)&hwinfo[EEPROM_RF_BOARD_OPTION];
3050 if (((value & 0xe0) >> 5) == 0x1)
3051 rtlpriv->btcoexist.btc_info.btcoexist = 1;
3053 rtlpriv->btcoexist.btc_info.btcoexist = 0;
3054 rtlpriv->btcoexist.btc_info.bt_type = BT_RTL8812A;
3056 value = hwinfo[EEPROM_RF_BT_SETTING];
3057 rtlpriv->btcoexist.btc_info.ant_num = (value & 0x1);
3059 rtlpriv->btcoexist.btc_info.btcoexist = 0;
3060 rtlpriv->btcoexist.btc_info.bt_type = BT_RTL8812A;
3061 rtlpriv->btcoexist.btc_info.ant_num = ANT_X2;
3063 /*move BT_InitHalVars() to init_sw_vars*/
3066 static void _rtl8821ae_read_bt_coexist_info_from_hwpg(struct ieee80211_hw *hw,
3067 bool auto_load_fail, u8 *hwinfo)
3069 struct rtl_priv *rtlpriv = rtl_priv(hw);
3073 if (!auto_load_fail) {
3074 tmpu_32 = rtl_read_dword(rtlpriv, REG_MULTI_FUNC_CTRL);
3075 if (tmpu_32 & BIT(18))
3076 rtlpriv->btcoexist.btc_info.btcoexist = 1;
3078 rtlpriv->btcoexist.btc_info.btcoexist = 0;
3079 rtlpriv->btcoexist.btc_info.bt_type = BT_RTL8821A;
3081 value = hwinfo[EEPROM_RF_BT_SETTING];
3082 rtlpriv->btcoexist.btc_info.ant_num = (value & 0x1);
3084 rtlpriv->btcoexist.btc_info.btcoexist = 0;
3085 rtlpriv->btcoexist.btc_info.bt_type = BT_RTL8821A;
3086 rtlpriv->btcoexist.btc_info.ant_num = ANT_X2;
3088 /*move BT_InitHalVars() to init_sw_vars*/
3091 static void _rtl8821ae_read_adapter_info(struct ieee80211_hw *hw, bool b_pseudo_test)
3093 struct rtl_priv *rtlpriv = rtl_priv(hw);
3094 struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
3095 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
3096 int params[] = {RTL_EEPROM_ID, EEPROM_VID, EEPROM_DID,
3097 EEPROM_SVID, EEPROM_SMID, EEPROM_MAC_ADDR,
3098 EEPROM_CHANNELPLAN, EEPROM_VERSION, EEPROM_CUSTOMER_ID,
3099 COUNTRY_CODE_WORLD_WIDE_13};
3102 if (b_pseudo_test) {
3106 hwinfo = kzalloc(HWSET_MAX_SIZE, GFP_KERNEL);
3110 if (rtl_get_hwinfo(hw, rtlpriv, HWSET_MAX_SIZE, hwinfo, params))
3113 _rtl8821ae_read_txpower_info_from_hwpg(hw, rtlefuse->autoload_failflag,
3116 if (rtlhal->hw_type == HARDWARE_TYPE_RTL8812AE) {
3117 _rtl8812ae_read_pa_type(hw, hwinfo, rtlefuse->autoload_failflag);
3118 _rtl8812ae_read_bt_coexist_info_from_hwpg(hw,
3119 rtlefuse->autoload_failflag, hwinfo);
3121 _rtl8821ae_read_pa_type(hw, hwinfo, rtlefuse->autoload_failflag);
3122 _rtl8821ae_read_bt_coexist_info_from_hwpg(hw,
3123 rtlefuse->autoload_failflag, hwinfo);
3126 _rtl8821ae_read_rfe_type(hw, hwinfo, rtlefuse->autoload_failflag);
3128 rtlefuse->board_type = ODM_BOARD_DEFAULT;
3129 if (rtlhal->external_lna_2g != 0)
3130 rtlefuse->board_type |= ODM_BOARD_EXT_LNA;
3131 if (rtlhal->external_lna_5g != 0)
3132 rtlefuse->board_type |= ODM_BOARD_EXT_LNA_5G;
3133 if (rtlhal->external_pa_2g != 0)
3134 rtlefuse->board_type |= ODM_BOARD_EXT_PA;
3135 if (rtlhal->external_pa_5g != 0)
3136 rtlefuse->board_type |= ODM_BOARD_EXT_PA_5G;
3138 if (rtlpriv->btcoexist.btc_info.btcoexist == 1)
3139 rtlefuse->board_type |= ODM_BOARD_BT;
3141 rtlhal->board_type = rtlefuse->board_type;
3142 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
3143 "board_type = 0x%x\n", rtlefuse->board_type);
3145 rtlefuse->eeprom_channelplan = *(u8 *)&hwinfo[EEPROM_CHANNELPLAN];
3146 if (rtlefuse->eeprom_channelplan == 0xff)
3147 rtlefuse->eeprom_channelplan = 0x7F;
3149 /* set channel plan from efuse */
3150 rtlefuse->channel_plan = rtlefuse->eeprom_channelplan;
3153 rtlefuse->crystalcap = hwinfo[EEPROM_XTAL_8821AE];
3154 if (rtlefuse->crystalcap == 0xFF)
3155 rtlefuse->crystalcap = 0x20;
3157 rtlefuse->eeprom_thermalmeter = *(u8 *)&hwinfo[EEPROM_THERMAL_METER];
3158 if ((rtlefuse->eeprom_thermalmeter == 0xff) ||
3159 rtlefuse->autoload_failflag) {
3160 rtlefuse->apk_thermalmeterignore = true;
3161 rtlefuse->eeprom_thermalmeter = 0xff;
3164 rtlefuse->thermalmeter[0] = rtlefuse->eeprom_thermalmeter;
3165 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
3166 "thermalmeter = 0x%x\n", rtlefuse->eeprom_thermalmeter);
3168 if (!rtlefuse->autoload_failflag) {
3169 rtlefuse->antenna_div_cfg =
3170 (hwinfo[EEPROM_RF_BOARD_OPTION] & 0x18) >> 3;
3171 if (hwinfo[EEPROM_RF_BOARD_OPTION] == 0xff)
3172 rtlefuse->antenna_div_cfg = 0;
3174 if (rtlpriv->btcoexist.btc_info.btcoexist == 1 &&
3175 rtlpriv->btcoexist.btc_info.ant_num == ANT_X1)
3176 rtlefuse->antenna_div_cfg = 0;
3178 rtlefuse->antenna_div_type = hwinfo[EEPROM_RF_ANTENNA_OPT_88E];
3179 if (rtlefuse->antenna_div_type == 0xff)
3180 rtlefuse->antenna_div_type = FIXED_HW_ANTDIV;
3182 rtlefuse->antenna_div_cfg = 0;
3183 rtlefuse->antenna_div_type = 0;
3186 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD,
3187 "SWAS: bHwAntDiv = %x, TRxAntDivType = %x\n",
3188 rtlefuse->antenna_div_cfg, rtlefuse->antenna_div_type);
3190 rtlpriv->ledctl.led_opendrain = true;
3192 if (rtlhal->oem_id == RT_CID_DEFAULT) {
3193 switch (rtlefuse->eeprom_oemid) {
3194 case RT_CID_DEFAULT:
3196 case EEPROM_CID_TOSHIBA:
3197 rtlhal->oem_id = RT_CID_TOSHIBA;
3199 case EEPROM_CID_CCX:
3200 rtlhal->oem_id = RT_CID_CCX;
3202 case EEPROM_CID_QMI:
3203 rtlhal->oem_id = RT_CID_819X_QMI;
3205 case EEPROM_CID_WHQL:
3215 /*static void _rtl8821ae_hal_customized_behavior(struct ieee80211_hw *hw)
3217 struct rtl_priv *rtlpriv = rtl_priv(hw);
3218 struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw);
3219 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
3221 rtlpriv->ledctl.led_opendrain = true;
3222 switch (rtlhal->oem_id) {
3223 case RT_CID_819X_HP:
3224 rtlpriv->ledctl.led_opendrain = true;
3226 case RT_CID_819X_LENOVO:
3227 case RT_CID_DEFAULT:
3228 case RT_CID_TOSHIBA:
3230 case RT_CID_819X_ACER:
3235 RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
3236 "RT Customized ID: 0x%02X\n", rtlhal->oem_id);
3239 void rtl8821ae_read_eeprom_info(struct ieee80211_hw *hw)
3241 struct rtl_priv *rtlpriv = rtl_priv(hw);
3242 struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
3243 struct rtl_phy *rtlphy = &rtlpriv->phy;
3244 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
3247 rtlhal->version = _rtl8821ae_read_chip_version(hw);
3248 if (get_rf_type(rtlphy) == RF_1T1R)
3249 rtlpriv->dm.rfpath_rxenable[0] = true;
3251 rtlpriv->dm.rfpath_rxenable[0] =
3252 rtlpriv->dm.rfpath_rxenable[1] = true;
3253 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "VersionID = 0x%4x\n",
3256 tmp_u1b = rtl_read_byte(rtlpriv, REG_9346CR);
3257 if (tmp_u1b & BIT(4)) {
3258 RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG, "Boot from EEPROM\n");
3259 rtlefuse->epromtype = EEPROM_93C46;
3261 RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG, "Boot from EFUSE\n");
3262 rtlefuse->epromtype = EEPROM_BOOT_EFUSE;
3265 if (tmp_u1b & BIT(5)) {
3266 RT_TRACE(rtlpriv, COMP_INIT, DBG_LOUD, "Autoload OK\n");
3267 rtlefuse->autoload_failflag = false;
3268 _rtl8821ae_read_adapter_info(hw, false);
3270 pr_err("Autoload ERR!!\n");
3272 /*hal_ReadRFType_8812A()*/
3273 /* _rtl8821ae_hal_customized_behavior(hw); */
3276 static void rtl8821ae_update_hal_rate_table(struct ieee80211_hw *hw,
3277 struct ieee80211_sta *sta)
3279 struct rtl_priv *rtlpriv = rtl_priv(hw);
3280 struct rtl_phy *rtlphy = &rtlpriv->phy;
3281 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
3282 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
3285 u8 b_nmode = mac->ht_enable;
3286 u8 mimo_ps = IEEE80211_SMPS_OFF;
3289 u8 curtxbw_40mhz = mac->bw_40;
3290 u8 b_curshortgi_40mhz = (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40) ?
3292 u8 b_curshortgi_20mhz = (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20) ?
3294 enum wireless_mode wirelessmode = mac->mode;
3296 if (rtlhal->current_bandtype == BAND_ON_5G)
3297 ratr_value = sta->supp_rates[1] << 4;
3299 ratr_value = sta->supp_rates[0];
3300 if (mac->opmode == NL80211_IFTYPE_ADHOC)
3302 ratr_value |= (sta->ht_cap.mcs.rx_mask[1] << 20 |
3303 sta->ht_cap.mcs.rx_mask[0] << 12);
3304 switch (wirelessmode) {
3305 case WIRELESS_MODE_B:
3306 if (ratr_value & 0x0000000c)
3307 ratr_value &= 0x0000000d;
3309 ratr_value &= 0x0000000f;
3311 case WIRELESS_MODE_G:
3312 ratr_value &= 0x00000FF5;
3314 case WIRELESS_MODE_N_24G:
3315 case WIRELESS_MODE_N_5G:
3317 if (mimo_ps == IEEE80211_SMPS_STATIC) {
3318 ratr_value &= 0x0007F005;
3322 if (get_rf_type(rtlphy) == RF_1T2R ||
3323 get_rf_type(rtlphy) == RF_1T1R)
3324 ratr_mask = 0x000ff005;
3326 ratr_mask = 0x0f0ff005;
3328 ratr_value &= ratr_mask;
3332 if (rtlphy->rf_type == RF_1T2R)
3333 ratr_value &= 0x000ff0ff;
3335 ratr_value &= 0x0f0ff0ff;
3340 if ((rtlpriv->btcoexist.bt_coexistence) &&
3341 (rtlpriv->btcoexist.bt_coexist_type == BT_CSR_BC4) &&
3342 (rtlpriv->btcoexist.bt_cur_state) &&
3343 (rtlpriv->btcoexist.bt_ant_isolation) &&
3344 ((rtlpriv->btcoexist.bt_service == BT_SCO) ||
3345 (rtlpriv->btcoexist.bt_service == BT_BUSY)))
3346 ratr_value &= 0x0fffcfc0;
3348 ratr_value &= 0x0FFFFFFF;
3350 if (b_nmode && ((curtxbw_40mhz &&
3351 b_curshortgi_40mhz) || (!curtxbw_40mhz &&
3352 b_curshortgi_20mhz))) {
3353 ratr_value |= 0x10000000;
3354 tmp_ratr_value = (ratr_value >> 12);
3356 for (shortgi_rate = 15; shortgi_rate > 0; shortgi_rate--) {
3357 if ((1 << shortgi_rate) & tmp_ratr_value)
3361 shortgi_rate = (shortgi_rate << 12) | (shortgi_rate << 8) |
3362 (shortgi_rate << 4) | (shortgi_rate);
3365 rtl_write_dword(rtlpriv, REG_ARFR0 + ratr_index * 4, ratr_value);
3367 RT_TRACE(rtlpriv, COMP_RATR, DBG_DMESG,
3368 "%x\n", rtl_read_dword(rtlpriv, REG_ARFR0));
3371 static u8 _rtl8821ae_mrate_idx_to_arfr_id(
3372 struct ieee80211_hw *hw, u8 rate_index,
3373 enum wireless_mode wirelessmode)
3375 struct rtl_priv *rtlpriv = rtl_priv(hw);
3376 struct rtl_phy *rtlphy = &rtlpriv->phy;
3378 switch (rate_index) {
3379 case RATR_INX_WIRELESS_NGB:
3380 if (rtlphy->rf_type == RF_1T1R)
3385 case RATR_INX_WIRELESS_N:
3386 case RATR_INX_WIRELESS_NG:
3387 if (rtlphy->rf_type == RF_1T1R)
3392 case RATR_INX_WIRELESS_NB:
3393 if (rtlphy->rf_type == RF_1T1R)
3398 case RATR_INX_WIRELESS_GB:
3401 case RATR_INX_WIRELESS_G:
3404 case RATR_INX_WIRELESS_B:
3407 case RATR_INX_WIRELESS_MC:
3408 if ((wirelessmode == WIRELESS_MODE_B)
3409 || (wirelessmode == WIRELESS_MODE_G)
3410 || (wirelessmode == WIRELESS_MODE_N_24G)
3411 || (wirelessmode == WIRELESS_MODE_AC_24G))
3415 case RATR_INX_WIRELESS_AC_5N:
3416 if (rtlphy->rf_type == RF_1T1R)
3421 case RATR_INX_WIRELESS_AC_24N:
3422 if (rtlphy->current_chan_bw == HT_CHANNEL_WIDTH_80) {
3423 if (rtlphy->rf_type == RF_1T1R)
3428 if (rtlphy->rf_type == RF_1T1R)
3440 static u32 _rtl8821ae_rate_to_bitmap_2ssvht(__le16 vht_rate)
3443 u32 rate_bitmap = 0;
3445 for (i = j = 0; i < 4; i += 2, j += 10) {
3446 tmp_rate = (le16_to_cpu(vht_rate) >> i) & 3;
3450 rate_bitmap = rate_bitmap | (0x03ff << j);
3453 rate_bitmap = rate_bitmap | (0x01ff << j);
3456 rate_bitmap = rate_bitmap | (0x00ff << j);
3466 static u32 _rtl8821ae_set_ra_vht_ratr_bitmap(struct ieee80211_hw *hw,
3467 enum wireless_mode wirelessmode,
3470 struct rtl_priv *rtlpriv = rtl_priv(hw);
3471 struct rtl_phy *rtlphy = &rtlpriv->phy;
3472 u32 ret_bitmap = ratr_bitmap;
3474 if (rtlphy->current_chan_bw == HT_CHANNEL_WIDTH_20_40
3475 || rtlphy->current_chan_bw == HT_CHANNEL_WIDTH_80)
3476 ret_bitmap = ratr_bitmap;
3477 else if (wirelessmode == WIRELESS_MODE_AC_5G
3478 || wirelessmode == WIRELESS_MODE_AC_24G) {
3479 if (rtlphy->rf_type == RF_1T1R)
3480 ret_bitmap = ratr_bitmap & (~BIT21);
3482 ret_bitmap = ratr_bitmap & (~(BIT31|BIT21));
3488 static u8 _rtl8821ae_get_vht_eni(enum wireless_mode wirelessmode,
3492 if (wirelessmode < WIRELESS_MODE_N_24G)
3494 else if (wirelessmode == WIRELESS_MODE_AC_24G) {
3495 if (ratr_bitmap & 0xfff00000) /* Mix , 2SS */
3499 } else if (wirelessmode == WIRELESS_MODE_AC_5G) {
3506 static u8 _rtl8821ae_get_ra_ldpc(struct ieee80211_hw *hw,
3507 u8 mac_id, struct rtl_sta_info *sta_entry,
3508 enum wireless_mode wirelessmode)
3511 /*not support ldpc, do not open*/
3515 static u8 _rtl8821ae_get_ra_rftype(struct ieee80211_hw *hw,
3516 enum wireless_mode wirelessmode,
3519 struct rtl_priv *rtlpriv = rtl_priv(hw);
3520 struct rtl_phy *rtlphy = &rtlpriv->phy;
3521 u8 rf_type = RF_1T1R;
3523 if (rtlphy->rf_type == RF_1T1R)
3525 else if (wirelessmode == WIRELESS_MODE_AC_5G
3526 || wirelessmode == WIRELESS_MODE_AC_24G
3527 || wirelessmode == WIRELESS_MODE_AC_ONLY) {
3528 if (ratr_bitmap & 0xffc00000)
3530 } else if (wirelessmode == WIRELESS_MODE_N_5G
3531 || wirelessmode == WIRELESS_MODE_N_24G) {
3532 if (ratr_bitmap & 0xfff00000)
3539 static bool _rtl8821ae_get_ra_shortgi(struct ieee80211_hw *hw, struct ieee80211_sta *sta,
3542 bool b_short_gi = false;
3543 u8 b_curshortgi_40mhz = (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40) ?
3545 u8 b_curshortgi_20mhz = (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20) ?
3547 u8 b_curshortgi_80mhz = 0;
3548 b_curshortgi_80mhz = (sta->vht_cap.cap &
3549 IEEE80211_VHT_CAP_SHORT_GI_80) ? 1 : 0;
3551 if (mac_id == MAC_ID_STATIC_FOR_BROADCAST_MULTICAST)
3554 if (b_curshortgi_40mhz || b_curshortgi_80mhz
3555 || b_curshortgi_20mhz)
3561 static void rtl8821ae_update_hal_rate_mask(struct ieee80211_hw *hw,
3562 struct ieee80211_sta *sta, u8 rssi_level)
3564 struct rtl_priv *rtlpriv = rtl_priv(hw);
3565 struct rtl_phy *rtlphy = &rtlpriv->phy;
3566 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
3567 struct rtl_sta_info *sta_entry = NULL;
3570 enum wireless_mode wirelessmode = 0;
3571 u8 curtxbw_40mhz = (sta->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40)
3573 bool b_shortgi = false;
3576 u8 mimo_ps = IEEE80211_SMPS_OFF;
3579 sta_entry = (struct rtl_sta_info *)sta->drv_priv;
3580 wirelessmode = sta_entry->wireless_mode;
3582 RT_TRACE(rtlpriv, COMP_RATR, DBG_LOUD,
3583 "wireless mode = 0x%x\n", wirelessmode);
3584 if (mac->opmode == NL80211_IFTYPE_STATION ||
3585 mac->opmode == NL80211_IFTYPE_MESH_POINT) {
3586 curtxbw_40mhz = mac->bw_40;
3587 } else if (mac->opmode == NL80211_IFTYPE_AP ||
3588 mac->opmode == NL80211_IFTYPE_ADHOC)
3589 macid = sta->aid + 1;
3590 if (wirelessmode == WIRELESS_MODE_N_5G ||
3591 wirelessmode == WIRELESS_MODE_AC_5G ||
3592 wirelessmode == WIRELESS_MODE_A)
3593 ratr_bitmap = sta->supp_rates[NL80211_BAND_5GHZ] << 4;
3595 ratr_bitmap = sta->supp_rates[NL80211_BAND_2GHZ];
3597 if (mac->opmode == NL80211_IFTYPE_ADHOC)
3598 ratr_bitmap = 0xfff;
3600 if (wirelessmode == WIRELESS_MODE_N_24G
3601 || wirelessmode == WIRELESS_MODE_N_5G)
3602 ratr_bitmap |= (sta->ht_cap.mcs.rx_mask[1] << 20 |
3603 sta->ht_cap.mcs.rx_mask[0] << 12);
3604 else if (wirelessmode == WIRELESS_MODE_AC_24G
3605 || wirelessmode == WIRELESS_MODE_AC_5G
3606 || wirelessmode == WIRELESS_MODE_AC_ONLY)
3607 ratr_bitmap |= _rtl8821ae_rate_to_bitmap_2ssvht(
3608 sta->vht_cap.vht_mcs.rx_mcs_map) << 12;
3610 b_shortgi = _rtl8821ae_get_ra_shortgi(hw, sta, macid);
3611 rf_type = _rtl8821ae_get_ra_rftype(hw, wirelessmode, ratr_bitmap);
3614 switch (wirelessmode) {
3615 case WIRELESS_MODE_B:
3616 ratr_index = RATR_INX_WIRELESS_B;
3617 if (ratr_bitmap & 0x0000000c)
3618 ratr_bitmap &= 0x0000000d;
3620 ratr_bitmap &= 0x0000000f;
3622 case WIRELESS_MODE_G:
3623 ratr_index = RATR_INX_WIRELESS_GB;
3625 if (rssi_level == 1)
3626 ratr_bitmap &= 0x00000f00;
3627 else if (rssi_level == 2)
3628 ratr_bitmap &= 0x00000ff0;
3630 ratr_bitmap &= 0x00000ff5;
3632 case WIRELESS_MODE_A:
3633 ratr_index = RATR_INX_WIRELESS_G;
3634 ratr_bitmap &= 0x00000ff0;
3636 case WIRELESS_MODE_N_24G:
3637 case WIRELESS_MODE_N_5G:
3638 if (wirelessmode == WIRELESS_MODE_N_24G)
3639 ratr_index = RATR_INX_WIRELESS_NGB;
3641 ratr_index = RATR_INX_WIRELESS_NG;
3643 if (mimo_ps == IEEE80211_SMPS_STATIC
3644 || mimo_ps == IEEE80211_SMPS_DYNAMIC) {
3645 if (rssi_level == 1)
3646 ratr_bitmap &= 0x000f0000;
3647 else if (rssi_level == 2)
3648 ratr_bitmap &= 0x000ff000;
3650 ratr_bitmap &= 0x000ff005;
3652 if (rf_type == RF_1T1R) {
3653 if (curtxbw_40mhz) {
3654 if (rssi_level == 1)
3655 ratr_bitmap &= 0x000f0000;
3656 else if (rssi_level == 2)
3657 ratr_bitmap &= 0x000ff000;
3659 ratr_bitmap &= 0x000ff015;
3661 if (rssi_level == 1)
3662 ratr_bitmap &= 0x000f0000;
3663 else if (rssi_level == 2)
3664 ratr_bitmap &= 0x000ff000;
3666 ratr_bitmap &= 0x000ff005;
3669 if (curtxbw_40mhz) {
3670 if (rssi_level == 1)
3671 ratr_bitmap &= 0x0fff0000;
3672 else if (rssi_level == 2)
3673 ratr_bitmap &= 0x0ffff000;
3675 ratr_bitmap &= 0x0ffff015;
3677 if (rssi_level == 1)
3678 ratr_bitmap &= 0x0fff0000;
3679 else if (rssi_level == 2)
3680 ratr_bitmap &= 0x0ffff000;
3682 ratr_bitmap &= 0x0ffff005;
3688 case WIRELESS_MODE_AC_24G:
3689 ratr_index = RATR_INX_WIRELESS_AC_24N;
3690 if (rssi_level == 1)
3691 ratr_bitmap &= 0xfc3f0000;
3692 else if (rssi_level == 2)
3693 ratr_bitmap &= 0xfffff000;
3695 ratr_bitmap &= 0xffffffff;
3698 case WIRELESS_MODE_AC_5G:
3699 ratr_index = RATR_INX_WIRELESS_AC_5N;
3701 if (rf_type == RF_1T1R) {
3702 if (rssi_level == 1) /*add by Gary for ac-series*/
3703 ratr_bitmap &= 0x003f8000;
3704 else if (rssi_level == 2)
3705 ratr_bitmap &= 0x003ff000;
3707 ratr_bitmap &= 0x003ff010;
3709 if (rssi_level == 1)
3710 ratr_bitmap &= 0xfe3f8000;
3711 else if (rssi_level == 2)
3712 ratr_bitmap &= 0xfffff000;
3714 ratr_bitmap &= 0xfffff010;
3719 ratr_index = RATR_INX_WIRELESS_NGB;
3721 if (rf_type == RF_1T2R)
3722 ratr_bitmap &= 0x000ff0ff;
3724 ratr_bitmap &= 0x0f8ff0ff;
3728 ratr_index = _rtl8821ae_mrate_idx_to_arfr_id(hw, ratr_index, wirelessmode);
3729 sta_entry->ratr_index = ratr_index;
3730 ratr_bitmap = _rtl8821ae_set_ra_vht_ratr_bitmap(hw, wirelessmode,
3733 RT_TRACE(rtlpriv, COMP_RATR, DBG_LOUD,
3734 "ratr_bitmap :%x\n", ratr_bitmap);
3736 /* *(u32 *)& rate_mask = EF4BYTE((ratr_bitmap & 0x0fffffff) |
3737 (ratr_index << 28)); */
3739 rate_mask[0] = macid;
3740 rate_mask[1] = ratr_index | (b_shortgi ? 0x80 : 0x00);
3741 rate_mask[2] = rtlphy->current_chan_bw
3742 | _rtl8821ae_get_vht_eni(wirelessmode, ratr_bitmap)
3743 | _rtl8821ae_get_ra_ldpc(hw, macid, sta_entry, wirelessmode);
3745 rate_mask[3] = (u8)(ratr_bitmap & 0x000000ff);
3746 rate_mask[4] = (u8)((ratr_bitmap & 0x0000ff00) >> 8);
3747 rate_mask[5] = (u8)((ratr_bitmap & 0x00ff0000) >> 16);
3748 rate_mask[6] = (u8)((ratr_bitmap & 0xff000000) >> 24);
3750 RT_TRACE(rtlpriv, COMP_RATR, DBG_DMESG,
3751 "Rate_index:%x, ratr_val:%x, %x:%x:%x:%x:%x:%x:%x\n",
3752 ratr_index, ratr_bitmap,
3753 rate_mask[0], rate_mask[1],
3754 rate_mask[2], rate_mask[3],
3755 rate_mask[4], rate_mask[5],
3757 rtl8821ae_fill_h2c_cmd(hw, H2C_8821AE_RA_MASK, 7, rate_mask);
3758 _rtl8821ae_set_bcn_ctrl_reg(hw, BIT(3), 0);
3761 void rtl8821ae_update_hal_rate_tbl(struct ieee80211_hw *hw,
3762 struct ieee80211_sta *sta, u8 rssi_level)
3764 struct rtl_priv *rtlpriv = rtl_priv(hw);
3765 if (rtlpriv->dm.useramask)
3766 rtl8821ae_update_hal_rate_mask(hw, sta, rssi_level);
3768 /*RT_TRACE(rtlpriv, COMP_RATR,DBG_LOUD,
3769 "rtl8821ae_update_hal_rate_tbl() Error! 8821ae FW RA Only\n");*/
3770 rtl8821ae_update_hal_rate_table(hw, sta);
3773 void rtl8821ae_update_channel_access_setting(struct ieee80211_hw *hw)
3775 struct rtl_priv *rtlpriv = rtl_priv(hw);
3776 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
3777 u16 wireless_mode = mac->mode;
3778 u8 sifs_timer, r2t_sifs;
3780 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SLOT_TIME,
3781 (u8 *)&mac->slot_time);
3782 if (wireless_mode == WIRELESS_MODE_G)
3786 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SIFS, (u8 *)&sifs_timer);
3790 if (wireless_mode == WIRELESS_MODE_AC_5G &&
3791 (mac->vht_ldpc_cap & LDPC_VHT_ENABLE_RX) &&
3792 (mac->vht_stbc_cap & STBC_VHT_ENABLE_RX)) {
3793 if (mac->vendor == PEER_ATH)
3797 } else if (wireless_mode == WIRELESS_MODE_AC_5G) {
3801 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_R2T_SIFS, (u8 *)&r2t_sifs);
3804 bool rtl8821ae_gpio_radio_on_off_checking(struct ieee80211_hw *hw, u8 *valid)
3806 struct rtl_priv *rtlpriv = rtl_priv(hw);
3807 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
3808 struct rtl_phy *rtlphy = &rtlpriv->phy;
3809 enum rf_pwrstate e_rfpowerstate_toset, cur_rfstate;
3811 bool b_actuallyset = false;
3813 if (rtlpriv->rtlhal.being_init_adapter)
3816 if (ppsc->swrf_processing)
3819 spin_lock(&rtlpriv->locks.rf_ps_lock);
3820 if (ppsc->rfchange_inprogress) {
3821 spin_unlock(&rtlpriv->locks.rf_ps_lock);
3824 ppsc->rfchange_inprogress = true;
3825 spin_unlock(&rtlpriv->locks.rf_ps_lock);
3828 cur_rfstate = ppsc->rfpwr_state;
3830 rtl_write_byte(rtlpriv, REG_GPIO_IO_SEL_2,
3831 rtl_read_byte(rtlpriv,
3832 REG_GPIO_IO_SEL_2) & ~(BIT(1)));
3834 u1tmp = rtl_read_byte(rtlpriv, REG_GPIO_PIN_CTRL_2);
3836 if (rtlphy->polarity_ctl)
3837 e_rfpowerstate_toset = (u1tmp & BIT(1)) ? ERFOFF : ERFON;
3839 e_rfpowerstate_toset = (u1tmp & BIT(1)) ? ERFON : ERFOFF;
3841 if ((ppsc->hwradiooff) && (e_rfpowerstate_toset == ERFON)) {
3842 RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG,
3843 "GPIOChangeRF - HW Radio ON, RF ON\n");
3845 e_rfpowerstate_toset = ERFON;
3846 ppsc->hwradiooff = false;
3847 b_actuallyset = true;
3848 } else if ((!ppsc->hwradiooff)
3849 && (e_rfpowerstate_toset == ERFOFF)) {
3850 RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG,
3851 "GPIOChangeRF - HW Radio OFF, RF OFF\n");
3853 e_rfpowerstate_toset = ERFOFF;
3854 ppsc->hwradiooff = true;
3855 b_actuallyset = true;
3858 if (b_actuallyset) {
3859 spin_lock(&rtlpriv->locks.rf_ps_lock);
3860 ppsc->rfchange_inprogress = false;
3861 spin_unlock(&rtlpriv->locks.rf_ps_lock);
3863 if (ppsc->reg_rfps_level & RT_RF_OFF_LEVL_HALT_NIC)
3864 RT_SET_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_HALT_NIC);
3866 spin_lock(&rtlpriv->locks.rf_ps_lock);
3867 ppsc->rfchange_inprogress = false;
3868 spin_unlock(&rtlpriv->locks.rf_ps_lock);
3872 return !ppsc->hwradiooff;
3875 void rtl8821ae_set_key(struct ieee80211_hw *hw, u32 key_index,
3876 u8 *p_macaddr, bool is_group, u8 enc_algo,
3877 bool is_wepkey, bool clear_all)
3879 struct rtl_priv *rtlpriv = rtl_priv(hw);
3880 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
3881 struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
3882 u8 *macaddr = p_macaddr;
3884 bool is_pairwise = false;
3886 static u8 cam_const_addr[4][6] = {
3887 {0x00, 0x00, 0x00, 0x00, 0x00, 0x00},
3888 {0x00, 0x00, 0x00, 0x00, 0x00, 0x01},
3889 {0x00, 0x00, 0x00, 0x00, 0x00, 0x02},
3890 {0x00, 0x00, 0x00, 0x00, 0x00, 0x03}
3892 static u8 cam_const_broad[] = {
3893 0xff, 0xff, 0xff, 0xff, 0xff, 0xff
3899 u8 clear_number = 5;
3901 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "clear_all\n");
3903 for (idx = 0; idx < clear_number; idx++) {
3904 rtl_cam_mark_invalid(hw, cam_offset + idx);
3905 rtl_cam_empty_entry(hw, cam_offset + idx);
3908 memset(rtlpriv->sec.key_buf[idx], 0,
3910 rtlpriv->sec.key_len[idx] = 0;
3915 case WEP40_ENCRYPTION:
3916 enc_algo = CAM_WEP40;
3918 case WEP104_ENCRYPTION:
3919 enc_algo = CAM_WEP104;
3921 case TKIP_ENCRYPTION:
3922 enc_algo = CAM_TKIP;
3924 case AESCCMP_ENCRYPTION:
3928 RT_TRACE(rtlpriv, COMP_ERR, DBG_LOUD,
3929 "switch case %#x not processed\n", enc_algo);
3930 enc_algo = CAM_TKIP;
3934 if (is_wepkey || rtlpriv->sec.use_defaultkey) {
3935 macaddr = cam_const_addr[key_index];
3936 entry_id = key_index;
3939 macaddr = cam_const_broad;
3940 entry_id = key_index;
3942 if (mac->opmode == NL80211_IFTYPE_AP) {
3943 entry_id = rtl_cam_get_free_entry(hw, p_macaddr);
3944 if (entry_id >= TOTAL_CAM_ENTRY) {
3945 pr_err("an not find free hwsecurity cam entry\n");
3949 entry_id = CAM_PAIRWISE_KEY_POSITION;
3952 key_index = PAIRWISE_KEYIDX;
3957 if (rtlpriv->sec.key_len[key_index] == 0) {
3958 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
3959 "delete one entry, entry_id is %d\n",
3961 if (mac->opmode == NL80211_IFTYPE_AP)
3962 rtl_cam_del_entry(hw, p_macaddr);
3963 rtl_cam_delete_one_entry(hw, p_macaddr, entry_id);
3965 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
3968 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
3969 "set Pairwise key\n");
3971 rtl_cam_add_one_entry(hw, macaddr, key_index,
3973 CAM_CONFIG_NO_USEDK,
3974 rtlpriv->sec.key_buf[key_index]);
3976 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
3979 if (mac->opmode == NL80211_IFTYPE_ADHOC) {
3980 rtl_cam_add_one_entry(hw,
3983 CAM_PAIRWISE_KEY_POSITION,
3985 CAM_CONFIG_NO_USEDK,
3986 rtlpriv->sec.key_buf
3990 rtl_cam_add_one_entry(hw, macaddr, key_index,
3992 CAM_CONFIG_NO_USEDK,
3993 rtlpriv->sec.key_buf[entry_id]);
3999 void rtl8821ae_bt_reg_init(struct ieee80211_hw *hw)
4001 struct rtl_priv *rtlpriv = rtl_priv(hw);
4003 /* 0:Low, 1:High, 2:From Efuse. */
4004 rtlpriv->btcoexist.reg_bt_iso = 2;
4005 /* 0:Idle, 1:None-SCO, 2:SCO, 3:From Counter. */
4006 rtlpriv->btcoexist.reg_bt_sco = 3;
4007 /* 0:Disable BT control A-MPDU, 1:Enable BT control A-MPDU. */
4008 rtlpriv->btcoexist.reg_bt_sco = 0;
4011 void rtl8821ae_bt_hw_init(struct ieee80211_hw *hw)
4013 struct rtl_priv *rtlpriv = rtl_priv(hw);
4015 if (rtlpriv->cfg->ops->get_btc_status())
4016 rtlpriv->btcoexist.btc_ops->btc_init_hw_config(rtlpriv);
4019 void rtl8821ae_suspend(struct ieee80211_hw *hw)
4023 void rtl8821ae_resume(struct ieee80211_hw *hw)
4027 /* Turn on AAP (RCR:bit 0) for promicuous mode. */
4028 void rtl8821ae_allow_all_destaddr(struct ieee80211_hw *hw,
4029 bool allow_all_da, bool write_into_reg)
4031 struct rtl_priv *rtlpriv = rtl_priv(hw);
4032 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
4034 if (allow_all_da) /* Set BIT0 */
4035 rtlpci->receive_config |= RCR_AAP;
4036 else /* Clear BIT0 */
4037 rtlpci->receive_config &= ~RCR_AAP;
4040 rtl_write_dword(rtlpriv, REG_RCR, rtlpci->receive_config);
4042 RT_TRACE(rtlpriv, COMP_TURBO | COMP_INIT, DBG_LOUD,
4043 "receive_config=0x%08X, write_into_reg=%d\n",
4044 rtlpci->receive_config, write_into_reg);
4047 /* WKFMCAMAddAllEntry8812 */
4048 void rtl8821ae_add_wowlan_pattern(struct ieee80211_hw *hw,
4049 struct rtl_wow_pattern *rtl_pattern,
4052 struct rtl_priv *rtlpriv = rtl_priv(hw);
4060 /* Count the WFCAM entry start offset. */
4062 /* RX page size = 128 byte */
4063 offset = MAX_RX_DMA_BUFFER_SIZE_8812 / 128;
4064 /* We should start from the boundry */
4065 cam_start = offset * 128;
4067 /* Enable Rx packet buffer access. */
4068 rtl_write_byte(rtlpriv, REG_PKT_BUFF_ACCESS_CTRL, RXPKT_BUF_SELECT);
4069 for (addr = 0; addr < WKFMCAM_ADDR_NUM; addr++) {
4070 /* Set Rx packet buffer offset.
4071 * RxBufer pointer increases 1,
4072 * we can access 8 bytes in Rx packet buffer.
4073 * CAM start offset (unit: 1 byte) = index*WKFMCAM_SIZE
4074 * RxBufer addr = (CAM start offset +
4075 * per entry offset of a WKFM CAM)/8
4076 * * index: The index of the wake up frame mask
4077 * * WKFMCAM_SIZE: the total size of one WKFM CAM
4078 * * per entry offset of a WKFM CAM: Addr*4 bytes
4080 rxbuf_addr = (cam_start + index * WKFMCAM_SIZE + addr * 4) >> 3;
4081 /* Set R/W start offset */
4082 rtl_write_word(rtlpriv, REG_PKTBUF_DBG_CTRL, rxbuf_addr);
4085 cam = BIT(31) | rtl_pattern->crc;
4087 if (rtl_pattern->type == UNICAST_PATTERN)
4089 else if (rtl_pattern->type == MULTICAST_PATTERN)
4091 else if (rtl_pattern->type == BROADCAST_PATTERN)
4094 rtl_write_dword(rtlpriv, REG_PKTBUF_DBG_DATA_L, cam);
4095 RT_TRACE(rtlpriv, COMP_POWER, DBG_TRACE,
4096 "WRITE entry[%d] 0x%x: %x\n", addr,
4097 REG_PKTBUF_DBG_DATA_L, cam);
4099 /* Write to Rx packet buffer. */
4100 rtl_write_word(rtlpriv, REG_RXPKTBUF_CTRL, 0x0f01);
4101 } else if (addr == 2 || addr == 4) {/* WKFM[127:0] */
4102 cam = rtl_pattern->mask[addr - 2];
4104 rtl_write_dword(rtlpriv, REG_PKTBUF_DBG_DATA_L, cam);
4105 RT_TRACE(rtlpriv, COMP_POWER, DBG_TRACE,
4106 "WRITE entry[%d] 0x%x: %x\n", addr,
4107 REG_PKTBUF_DBG_DATA_L, cam);
4109 rtl_write_word(rtlpriv, REG_RXPKTBUF_CTRL, 0x0f01);
4110 } else if (addr == 3 || addr == 5) {/* WKFM[127:0] */
4111 cam = rtl_pattern->mask[addr - 2];
4113 rtl_write_dword(rtlpriv, REG_PKTBUF_DBG_DATA_H, cam);
4114 RT_TRACE(rtlpriv, COMP_POWER, DBG_TRACE,
4115 "WRITE entry[%d] 0x%x: %x\n", addr,
4116 REG_PKTBUF_DBG_DATA_H, cam);
4118 rtl_write_word(rtlpriv, REG_RXPKTBUF_CTRL, 0xf001);
4123 tmp = rtl_read_byte(rtlpriv, REG_RXPKTBUF_CTRL);
4126 } while (tmp && count < 100);
4128 WARN_ONCE((count >= 100),
4129 "rtl8821ae: Write wake up frame mask FAIL %d value!\n",
4132 /* Disable Rx packet buffer access. */
4133 rtl_write_byte(rtlpriv, REG_PKT_BUFF_ACCESS_CTRL,
4134 DISABLE_TRXPKT_BUF_ACCESS);