1 /******************************************************************************
3 * Copyright(c) 2009-2012 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 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
18 * The full GNU General Public License is included in this distribution in the
19 * file called LICENSE.
21 * Contact Information:
22 * wlanfae <wlanfae@realtek.com>
23 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
24 * Hsinchu 300, Taiwan.
26 * Larry Finger <Larry.Finger@lwfinger.net>
28 *****************************************************************************/
39 #include <linux/module.h>
42 *NOTICE!!!: This file will be very big, we should
43 *keep it clear under following roles:
45 *This file include following parts, so, if you add new
46 *functions into this file, please check which part it
47 *should includes. or check if you should add new part
50 *1) mac80211 init functions
51 *2) tx information functions
52 *3) functions called by core.c
53 *4) wq & timer callback functions
54 *5) frame process functions
60 /*********************************************************
62 * mac80211 init functions
64 *********************************************************/
65 static struct ieee80211_channel rtl_channeltable_2g
[] = {
66 {.center_freq
= 2412, .hw_value
= 1,},
67 {.center_freq
= 2417, .hw_value
= 2,},
68 {.center_freq
= 2422, .hw_value
= 3,},
69 {.center_freq
= 2427, .hw_value
= 4,},
70 {.center_freq
= 2432, .hw_value
= 5,},
71 {.center_freq
= 2437, .hw_value
= 6,},
72 {.center_freq
= 2442, .hw_value
= 7,},
73 {.center_freq
= 2447, .hw_value
= 8,},
74 {.center_freq
= 2452, .hw_value
= 9,},
75 {.center_freq
= 2457, .hw_value
= 10,},
76 {.center_freq
= 2462, .hw_value
= 11,},
77 {.center_freq
= 2467, .hw_value
= 12,},
78 {.center_freq
= 2472, .hw_value
= 13,},
79 {.center_freq
= 2484, .hw_value
= 14,},
82 static struct ieee80211_channel rtl_channeltable_5g
[] = {
83 {.center_freq
= 5180, .hw_value
= 36,},
84 {.center_freq
= 5200, .hw_value
= 40,},
85 {.center_freq
= 5220, .hw_value
= 44,},
86 {.center_freq
= 5240, .hw_value
= 48,},
87 {.center_freq
= 5260, .hw_value
= 52,},
88 {.center_freq
= 5280, .hw_value
= 56,},
89 {.center_freq
= 5300, .hw_value
= 60,},
90 {.center_freq
= 5320, .hw_value
= 64,},
91 {.center_freq
= 5500, .hw_value
= 100,},
92 {.center_freq
= 5520, .hw_value
= 104,},
93 {.center_freq
= 5540, .hw_value
= 108,},
94 {.center_freq
= 5560, .hw_value
= 112,},
95 {.center_freq
= 5580, .hw_value
= 116,},
96 {.center_freq
= 5600, .hw_value
= 120,},
97 {.center_freq
= 5620, .hw_value
= 124,},
98 {.center_freq
= 5640, .hw_value
= 128,},
99 {.center_freq
= 5660, .hw_value
= 132,},
100 {.center_freq
= 5680, .hw_value
= 136,},
101 {.center_freq
= 5700, .hw_value
= 140,},
102 {.center_freq
= 5745, .hw_value
= 149,},
103 {.center_freq
= 5765, .hw_value
= 153,},
104 {.center_freq
= 5785, .hw_value
= 157,},
105 {.center_freq
= 5805, .hw_value
= 161,},
106 {.center_freq
= 5825, .hw_value
= 165,},
109 static struct ieee80211_rate rtl_ratetable_2g
[] = {
110 {.bitrate
= 10, .hw_value
= 0x00,},
111 {.bitrate
= 20, .hw_value
= 0x01,},
112 {.bitrate
= 55, .hw_value
= 0x02,},
113 {.bitrate
= 110, .hw_value
= 0x03,},
114 {.bitrate
= 60, .hw_value
= 0x04,},
115 {.bitrate
= 90, .hw_value
= 0x05,},
116 {.bitrate
= 120, .hw_value
= 0x06,},
117 {.bitrate
= 180, .hw_value
= 0x07,},
118 {.bitrate
= 240, .hw_value
= 0x08,},
119 {.bitrate
= 360, .hw_value
= 0x09,},
120 {.bitrate
= 480, .hw_value
= 0x0a,},
121 {.bitrate
= 540, .hw_value
= 0x0b,},
124 static struct ieee80211_rate rtl_ratetable_5g
[] = {
125 {.bitrate
= 60, .hw_value
= 0x04,},
126 {.bitrate
= 90, .hw_value
= 0x05,},
127 {.bitrate
= 120, .hw_value
= 0x06,},
128 {.bitrate
= 180, .hw_value
= 0x07,},
129 {.bitrate
= 240, .hw_value
= 0x08,},
130 {.bitrate
= 360, .hw_value
= 0x09,},
131 {.bitrate
= 480, .hw_value
= 0x0a,},
132 {.bitrate
= 540, .hw_value
= 0x0b,},
135 static const struct ieee80211_supported_band rtl_band_2ghz
= {
136 .band
= IEEE80211_BAND_2GHZ
,
138 .channels
= rtl_channeltable_2g
,
139 .n_channels
= ARRAY_SIZE(rtl_channeltable_2g
),
141 .bitrates
= rtl_ratetable_2g
,
142 .n_bitrates
= ARRAY_SIZE(rtl_ratetable_2g
),
147 static struct ieee80211_supported_band rtl_band_5ghz
= {
148 .band
= IEEE80211_BAND_5GHZ
,
150 .channels
= rtl_channeltable_5g
,
151 .n_channels
= ARRAY_SIZE(rtl_channeltable_5g
),
153 .bitrates
= rtl_ratetable_5g
,
154 .n_bitrates
= ARRAY_SIZE(rtl_ratetable_5g
),
159 static const u8 tid_to_ac
[] = {
160 2, /* IEEE80211_AC_BE */
161 3, /* IEEE80211_AC_BK */
162 3, /* IEEE80211_AC_BK */
163 2, /* IEEE80211_AC_BE */
164 1, /* IEEE80211_AC_VI */
165 1, /* IEEE80211_AC_VI */
166 0, /* IEEE80211_AC_VO */
167 0, /* IEEE80211_AC_VO */
170 u8
rtl_tid_to_ac(struct ieee80211_hw
*hw
, u8 tid
)
172 return tid_to_ac
[tid
];
175 static void _rtl_init_hw_ht_capab(struct ieee80211_hw
*hw
,
176 struct ieee80211_sta_ht_cap
*ht_cap
)
178 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
179 struct rtl_phy
*rtlphy
= &(rtlpriv
->phy
);
181 ht_cap
->ht_supported
= true;
182 ht_cap
->cap
= IEEE80211_HT_CAP_SUP_WIDTH_20_40
|
183 IEEE80211_HT_CAP_SGI_40
|
184 IEEE80211_HT_CAP_SGI_20
|
185 IEEE80211_HT_CAP_DSSSCCK40
| IEEE80211_HT_CAP_MAX_AMSDU
;
187 if (rtlpriv
->rtlhal
.disable_amsdu_8k
)
188 ht_cap
->cap
&= ~IEEE80211_HT_CAP_MAX_AMSDU
;
191 *Maximum length of AMPDU that the STA can receive.
192 *Length = 2 ^ (13 + max_ampdu_length_exp) - 1 (octets)
194 ht_cap
->ampdu_factor
= IEEE80211_HT_MAX_AMPDU_64K
;
196 /*Minimum MPDU start spacing , */
197 ht_cap
->ampdu_density
= IEEE80211_HT_MPDU_DENSITY_16
;
199 ht_cap
->mcs
.tx_params
= IEEE80211_HT_MCS_TX_DEFINED
;
202 *hw->wiphy->bands[IEEE80211_BAND_2GHZ]
205 *if rx_ant =1 rx_mask[0]=0xff;==>MCS0-MCS7
206 *if rx_ant =2 rx_mask[1]=0xff;==>MCS8-MCS15
207 *if rx_ant >=3 rx_mask[2]=0xff;
208 *if BW_40 rx_mask[4]=0x01;
209 *highest supported RX rate
211 if (get_rf_type(rtlphy
) == RF_1T2R
|| get_rf_type(rtlphy
) == RF_2T2R
) {
213 RT_TRACE(rtlpriv
, COMP_INIT
, DBG_DMESG
, "1T2R or 2T2R\n");
215 ht_cap
->mcs
.rx_mask
[0] = 0xFF;
216 ht_cap
->mcs
.rx_mask
[1] = 0xFF;
217 ht_cap
->mcs
.rx_mask
[4] = 0x01;
219 ht_cap
->mcs
.rx_highest
= cpu_to_le16(MAX_BIT_RATE_40MHZ_MCS15
);
220 } else if (get_rf_type(rtlphy
) == RF_1T1R
) {
222 RT_TRACE(rtlpriv
, COMP_INIT
, DBG_DMESG
, "1T1R\n");
224 ht_cap
->mcs
.rx_mask
[0] = 0xFF;
225 ht_cap
->mcs
.rx_mask
[1] = 0x00;
226 ht_cap
->mcs
.rx_mask
[4] = 0x01;
228 ht_cap
->mcs
.rx_highest
= cpu_to_le16(MAX_BIT_RATE_40MHZ_MCS7
);
232 static void _rtl_init_mac80211(struct ieee80211_hw
*hw
)
234 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
235 struct rtl_hal
*rtlhal
= rtl_hal(rtlpriv
);
236 struct rtl_mac
*rtlmac
= rtl_mac(rtl_priv(hw
));
237 struct rtl_efuse
*rtlefuse
= rtl_efuse(rtl_priv(hw
));
238 struct ieee80211_supported_band
*sband
;
241 if (rtlhal
->macphymode
== SINGLEMAC_SINGLEPHY
&& rtlhal
->bandset
==
244 /* <1> use mac->bands as mem for hw->wiphy->bands */
245 sband
= &(rtlmac
->bands
[IEEE80211_BAND_2GHZ
]);
247 /* <2> set hw->wiphy->bands[IEEE80211_BAND_2GHZ]
248 * to default value(1T1R) */
249 memcpy(&(rtlmac
->bands
[IEEE80211_BAND_2GHZ
]), &rtl_band_2ghz
,
250 sizeof(struct ieee80211_supported_band
));
252 /* <3> init ht cap base on ant_num */
253 _rtl_init_hw_ht_capab(hw
, &sband
->ht_cap
);
255 /* <4> set mac->sband to wiphy->sband */
256 hw
->wiphy
->bands
[IEEE80211_BAND_2GHZ
] = sband
;
259 /* <1> use mac->bands as mem for hw->wiphy->bands */
260 sband
= &(rtlmac
->bands
[IEEE80211_BAND_5GHZ
]);
262 /* <2> set hw->wiphy->bands[IEEE80211_BAND_5GHZ]
263 * to default value(1T1R) */
264 memcpy(&(rtlmac
->bands
[IEEE80211_BAND_5GHZ
]), &rtl_band_5ghz
,
265 sizeof(struct ieee80211_supported_band
));
267 /* <3> init ht cap base on ant_num */
268 _rtl_init_hw_ht_capab(hw
, &sband
->ht_cap
);
270 /* <4> set mac->sband to wiphy->sband */
271 hw
->wiphy
->bands
[IEEE80211_BAND_5GHZ
] = sband
;
273 if (rtlhal
->current_bandtype
== BAND_ON_2_4G
) {
274 /* <1> use mac->bands as mem for hw->wiphy->bands */
275 sband
= &(rtlmac
->bands
[IEEE80211_BAND_2GHZ
]);
277 /* <2> set hw->wiphy->bands[IEEE80211_BAND_2GHZ]
278 * to default value(1T1R) */
279 memcpy(&(rtlmac
->bands
[IEEE80211_BAND_2GHZ
]),
281 sizeof(struct ieee80211_supported_band
));
283 /* <3> init ht cap base on ant_num */
284 _rtl_init_hw_ht_capab(hw
, &sband
->ht_cap
);
286 /* <4> set mac->sband to wiphy->sband */
287 hw
->wiphy
->bands
[IEEE80211_BAND_2GHZ
] = sband
;
288 } else if (rtlhal
->current_bandtype
== BAND_ON_5G
) {
289 /* <1> use mac->bands as mem for hw->wiphy->bands */
290 sband
= &(rtlmac
->bands
[IEEE80211_BAND_5GHZ
]);
292 /* <2> set hw->wiphy->bands[IEEE80211_BAND_5GHZ]
293 * to default value(1T1R) */
294 memcpy(&(rtlmac
->bands
[IEEE80211_BAND_5GHZ
]),
296 sizeof(struct ieee80211_supported_band
));
298 /* <3> init ht cap base on ant_num */
299 _rtl_init_hw_ht_capab(hw
, &sband
->ht_cap
);
301 /* <4> set mac->sband to wiphy->sband */
302 hw
->wiphy
->bands
[IEEE80211_BAND_5GHZ
] = sband
;
304 RT_TRACE(rtlpriv
, COMP_INIT
, DBG_EMERG
, "Err BAND %d\n",
305 rtlhal
->current_bandtype
);
308 /* <5> set hw caps */
309 hw
->flags
= IEEE80211_HW_SIGNAL_DBM
|
310 IEEE80211_HW_RX_INCLUDES_FCS
|
311 IEEE80211_HW_AMPDU_AGGREGATION
|
312 IEEE80211_HW_CONNECTION_MONITOR
|
313 /* IEEE80211_HW_SUPPORTS_CQM_RSSI | */
314 IEEE80211_HW_REPORTS_TX_ACK_STATUS
| 0;
316 /* swlps or hwlps has been set in diff chip in init_sw_vars */
317 if (rtlpriv
->psc
.swctrl_lps
)
318 hw
->flags
|= IEEE80211_HW_SUPPORTS_PS
|
319 IEEE80211_HW_PS_NULLFUNC_STACK
|
320 /* IEEE80211_HW_SUPPORTS_DYNAMIC_PS | */
323 hw
->wiphy
->interface_modes
=
324 BIT(NL80211_IFTYPE_AP
) |
325 BIT(NL80211_IFTYPE_STATION
) |
326 BIT(NL80211_IFTYPE_ADHOC
);
328 hw
->wiphy
->rts_threshold
= 2347;
331 hw
->extra_tx_headroom
= RTL_TX_HEADER_SIZE
;
333 /* TODO: Correct this value for our hw */
334 /* TODO: define these hard code value */
335 hw
->channel_change_time
= 100;
336 hw
->max_listen_interval
= 10;
337 hw
->max_rate_tries
= 4;
338 /* hw->max_rates = 1; */
339 hw
->sta_data_size
= sizeof(struct rtl_sta_info
);
341 /* <6> mac address */
342 if (is_valid_ether_addr(rtlefuse
->dev_addr
)) {
343 SET_IEEE80211_PERM_ADDR(hw
, rtlefuse
->dev_addr
);
345 u8 rtlmac1
[] = { 0x00, 0xe0, 0x4c, 0x81, 0x92, 0x00 };
346 get_random_bytes((rtlmac1
+ (ETH_ALEN
- 1)), 1);
347 SET_IEEE80211_PERM_ADDR(hw
, rtlmac1
);
352 static void _rtl_init_deferred_work(struct ieee80211_hw
*hw
)
354 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
357 init_timer(&rtlpriv
->works
.watchdog_timer
);
358 setup_timer(&rtlpriv
->works
.watchdog_timer
,
359 rtl_watch_dog_timer_callback
, (unsigned long)hw
);
362 rtlpriv
->works
.hw
= hw
;
363 rtlpriv
->works
.rtl_wq
= alloc_workqueue(rtlpriv
->cfg
->name
, 0, 0);
364 INIT_DELAYED_WORK(&rtlpriv
->works
.watchdog_wq
,
365 (void *)rtl_watchdog_wq_callback
);
366 INIT_DELAYED_WORK(&rtlpriv
->works
.ips_nic_off_wq
,
367 (void *)rtl_ips_nic_off_wq_callback
);
368 INIT_DELAYED_WORK(&rtlpriv
->works
.ps_work
,
369 (void *)rtl_swlps_wq_callback
);
370 INIT_DELAYED_WORK(&rtlpriv
->works
.ps_rfon_wq
,
371 (void *)rtl_swlps_rfon_wq_callback
);
375 void rtl_deinit_deferred_work(struct ieee80211_hw
*hw
)
377 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
379 del_timer_sync(&rtlpriv
->works
.watchdog_timer
);
381 cancel_delayed_work(&rtlpriv
->works
.watchdog_wq
);
382 cancel_delayed_work(&rtlpriv
->works
.ips_nic_off_wq
);
383 cancel_delayed_work(&rtlpriv
->works
.ps_work
);
384 cancel_delayed_work(&rtlpriv
->works
.ps_rfon_wq
);
387 void rtl_init_rfkill(struct ieee80211_hw
*hw
)
389 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
395 /*set init state to on */
396 rtlpriv
->rfkill
.rfkill_state
= true;
397 wiphy_rfkill_set_hw_state(hw
->wiphy
, 0);
399 radio_state
= rtlpriv
->cfg
->ops
->radio_onoff_checking(hw
, &valid
);
402 pr_info("wireless switch is %s\n",
403 rtlpriv
->rfkill
.rfkill_state
? "on" : "off");
405 rtlpriv
->rfkill
.rfkill_state
= radio_state
;
407 blocked
= (rtlpriv
->rfkill
.rfkill_state
== 1) ? 0 : 1;
408 wiphy_rfkill_set_hw_state(hw
->wiphy
, blocked
);
411 wiphy_rfkill_start_polling(hw
->wiphy
);
413 EXPORT_SYMBOL(rtl_init_rfkill
);
415 void rtl_deinit_rfkill(struct ieee80211_hw
*hw
)
417 wiphy_rfkill_stop_polling(hw
->wiphy
);
420 int rtl_init_core(struct ieee80211_hw
*hw
)
422 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
423 struct rtl_mac
*rtlmac
= rtl_mac(rtl_priv(hw
));
425 /* <1> init mac80211 */
426 _rtl_init_mac80211(hw
);
429 /* <2> rate control register */
430 hw
->rate_control_algorithm
= "rtl_rc";
433 * <3> init CRDA must come after init
434 * mac80211 hw in _rtl_init_mac80211.
436 if (rtl_regd_init(hw
, rtl_reg_notifier
)) {
437 RT_TRACE(rtlpriv
, COMP_ERR
, DBG_EMERG
, "REGD init failed\n");
440 /* CRDA regd hint must after init CRDA */
441 if (regulatory_hint(hw
->wiphy
, rtlpriv
->regd
.alpha2
)) {
442 RT_TRACE(rtlpriv
, COMP_ERR
, DBG_WARNING
,
443 "regulatory_hint fail\n");
448 mutex_init(&rtlpriv
->locks
.conf_mutex
);
449 mutex_init(&rtlpriv
->locks
.ps_mutex
);
450 spin_lock_init(&rtlpriv
->locks
.ips_lock
);
451 spin_lock_init(&rtlpriv
->locks
.irq_th_lock
);
452 spin_lock_init(&rtlpriv
->locks
.h2c_lock
);
453 spin_lock_init(&rtlpriv
->locks
.rf_ps_lock
);
454 spin_lock_init(&rtlpriv
->locks
.rf_lock
);
455 spin_lock_init(&rtlpriv
->locks
.waitq_lock
);
456 spin_lock_init(&rtlpriv
->locks
.cck_and_rw_pagea_lock
);
458 rtlmac
->link_state
= MAC80211_NOLINK
;
460 /* <5> init deferred work */
461 _rtl_init_deferred_work(hw
);
466 void rtl_deinit_core(struct ieee80211_hw
*hw
)
470 void rtl_init_rx_config(struct ieee80211_hw
*hw
)
472 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
473 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
475 rtlpriv
->cfg
->ops
->get_hw_reg(hw
, HW_VAR_RCR
, (u8
*) (&mac
->rx_conf
));
478 /*********************************************************
480 * tx information functions
482 *********************************************************/
483 static void _rtl_qurey_shortpreamble_mode(struct ieee80211_hw
*hw
,
484 struct rtl_tcb_desc
*tcb_desc
,
485 struct ieee80211_tx_info
*info
)
487 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
488 u8 rate_flag
= info
->control
.rates
[0].flags
;
490 tcb_desc
->use_shortpreamble
= false;
492 /* 1M can only use Long Preamble. 11B spec */
493 if (tcb_desc
->hw_rate
== rtlpriv
->cfg
->maps
[RTL_RC_CCK_RATE1M
])
495 else if (rate_flag
& IEEE80211_TX_RC_USE_SHORT_PREAMBLE
)
496 tcb_desc
->use_shortpreamble
= true;
501 static void _rtl_query_shortgi(struct ieee80211_hw
*hw
,
502 struct ieee80211_sta
*sta
,
503 struct rtl_tcb_desc
*tcb_desc
,
504 struct ieee80211_tx_info
*info
)
506 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
507 u8 rate_flag
= info
->control
.rates
[0].flags
;
508 u8 sgi_40
= 0, sgi_20
= 0, bw_40
= 0;
509 tcb_desc
->use_shortgi
= false;
514 sgi_40
= sta
->ht_cap
.cap
& IEEE80211_HT_CAP_SGI_40
;
515 sgi_20
= sta
->ht_cap
.cap
& IEEE80211_HT_CAP_SGI_20
;
517 if (!(sta
->ht_cap
.ht_supported
))
520 if (!sgi_40
&& !sgi_20
)
523 if (mac
->opmode
== NL80211_IFTYPE_STATION
)
525 else if (mac
->opmode
== NL80211_IFTYPE_AP
||
526 mac
->opmode
== NL80211_IFTYPE_ADHOC
)
527 bw_40
= sta
->ht_cap
.cap
& IEEE80211_HT_CAP_SUP_WIDTH_20_40
;
530 tcb_desc
->use_shortgi
= true;
531 else if ((bw_40
== false) && sgi_20
)
532 tcb_desc
->use_shortgi
= true;
534 if (!(rate_flag
& IEEE80211_TX_RC_SHORT_GI
))
535 tcb_desc
->use_shortgi
= false;
538 static void _rtl_query_protection_mode(struct ieee80211_hw
*hw
,
539 struct rtl_tcb_desc
*tcb_desc
,
540 struct ieee80211_tx_info
*info
)
542 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
543 u8 rate_flag
= info
->control
.rates
[0].flags
;
545 /* Common Settings */
546 tcb_desc
->rts_stbc
= false;
547 tcb_desc
->cts_enable
= false;
548 tcb_desc
->rts_sc
= 0;
549 tcb_desc
->rts_bw
= false;
550 tcb_desc
->rts_use_shortpreamble
= false;
551 tcb_desc
->rts_use_shortgi
= false;
553 if (rate_flag
& IEEE80211_TX_RC_USE_CTS_PROTECT
) {
554 /* Use CTS-to-SELF in protection mode. */
555 tcb_desc
->rts_enable
= true;
556 tcb_desc
->cts_enable
= true;
557 tcb_desc
->rts_rate
= rtlpriv
->cfg
->maps
[RTL_RC_OFDM_RATE24M
];
558 } else if (rate_flag
& IEEE80211_TX_RC_USE_RTS_CTS
) {
559 /* Use RTS-CTS in protection mode. */
560 tcb_desc
->rts_enable
= true;
561 tcb_desc
->rts_rate
= rtlpriv
->cfg
->maps
[RTL_RC_OFDM_RATE24M
];
565 static void _rtl_txrate_selectmode(struct ieee80211_hw
*hw
,
566 struct ieee80211_sta
*sta
,
567 struct rtl_tcb_desc
*tcb_desc
)
569 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
570 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
571 struct rtl_sta_info
*sta_entry
= NULL
;
575 sta_entry
= (struct rtl_sta_info
*) sta
->drv_priv
;
576 ratr_index
= sta_entry
->ratr_index
;
578 if (!tcb_desc
->disable_ratefallback
|| !tcb_desc
->use_driver_rate
) {
579 if (mac
->opmode
== NL80211_IFTYPE_STATION
) {
580 tcb_desc
->ratr_index
= 0;
581 } else if (mac
->opmode
== NL80211_IFTYPE_ADHOC
) {
582 if (tcb_desc
->multicast
|| tcb_desc
->broadcast
) {
584 rtlpriv
->cfg
->maps
[RTL_RC_CCK_RATE2M
];
585 tcb_desc
->use_driver_rate
= 1;
589 tcb_desc
->ratr_index
= ratr_index
;
590 } else if (mac
->opmode
== NL80211_IFTYPE_AP
) {
591 tcb_desc
->ratr_index
= ratr_index
;
595 if (rtlpriv
->dm
.useramask
) {
596 /* TODO we will differentiate adhoc and station futrue */
597 if (mac
->opmode
== NL80211_IFTYPE_STATION
) {
598 tcb_desc
->mac_id
= 0;
600 if (mac
->mode
== WIRELESS_MODE_N_24G
)
601 tcb_desc
->ratr_index
= RATR_INX_WIRELESS_NGB
;
602 else if (mac
->mode
== WIRELESS_MODE_N_5G
)
603 tcb_desc
->ratr_index
= RATR_INX_WIRELESS_NG
;
604 else if (mac
->mode
& WIRELESS_MODE_G
)
605 tcb_desc
->ratr_index
= RATR_INX_WIRELESS_GB
;
606 else if (mac
->mode
& WIRELESS_MODE_B
)
607 tcb_desc
->ratr_index
= RATR_INX_WIRELESS_B
;
608 else if (mac
->mode
& WIRELESS_MODE_A
)
609 tcb_desc
->ratr_index
= RATR_INX_WIRELESS_G
;
610 } else if (mac
->opmode
== NL80211_IFTYPE_AP
||
611 mac
->opmode
== NL80211_IFTYPE_ADHOC
) {
614 tcb_desc
->mac_id
= sta
->aid
+ 1;
616 tcb_desc
->mac_id
= 1;
618 tcb_desc
->mac_id
= 0;
625 static void _rtl_query_bandwidth_mode(struct ieee80211_hw
*hw
,
626 struct ieee80211_sta
*sta
,
627 struct rtl_tcb_desc
*tcb_desc
)
629 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
630 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
632 tcb_desc
->packet_bw
= false;
635 if (mac
->opmode
== NL80211_IFTYPE_AP
||
636 mac
->opmode
== NL80211_IFTYPE_ADHOC
) {
637 if (!(sta
->ht_cap
.ht_supported
) ||
638 !(sta
->ht_cap
.cap
& IEEE80211_HT_CAP_SUP_WIDTH_20_40
))
640 } else if (mac
->opmode
== NL80211_IFTYPE_STATION
) {
641 if (!mac
->bw_40
|| !(sta
->ht_cap
.ht_supported
))
644 if (tcb_desc
->multicast
|| tcb_desc
->broadcast
)
647 /*use legency rate, shall use 20MHz */
648 if (tcb_desc
->hw_rate
<= rtlpriv
->cfg
->maps
[RTL_RC_OFDM_RATE54M
])
651 tcb_desc
->packet_bw
= true;
654 static u8
_rtl_get_highest_n_rate(struct ieee80211_hw
*hw
)
656 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
657 struct rtl_phy
*rtlphy
= &(rtlpriv
->phy
);
660 if (get_rf_type(rtlphy
) == RF_2T2R
)
661 hw_rate
= rtlpriv
->cfg
->maps
[RTL_RC_HT_RATEMCS15
];
663 hw_rate
= rtlpriv
->cfg
->maps
[RTL_RC_HT_RATEMCS7
];
668 /* mac80211's rate_idx is like this:
670 * 2.4G band:rx_status->band == IEEE80211_BAND_2GHZ
673 * (rx_status->flag & RX_FLAG_HT) = 0,
674 * DESC92_RATE1M-->DESC92_RATE54M ==> idx is 0-->11,
677 * (rx_status->flag & RX_FLAG_HT) = 1,
678 * DESC92_RATEMCS0-->DESC92_RATEMCS15 ==> idx is 0-->15
680 * 5G band:rx_status->band == IEEE80211_BAND_5GHZ
682 * (rx_status->flag & RX_FLAG_HT) = 0,
683 * DESC92_RATE6M-->DESC92_RATE54M ==> idx is 0-->7,
686 * (rx_status->flag & RX_FLAG_HT) = 1,
687 * DESC92_RATEMCS0-->DESC92_RATEMCS15 ==> idx is 0-->15
689 int rtlwifi_rate_mapping(struct ieee80211_hw
*hw
,
690 bool isht
, u8 desc_rate
, bool first_ampdu
)
695 if (IEEE80211_BAND_2GHZ
== hw
->conf
.channel
->band
) {
703 case DESC92_RATE5_5M
:
772 case DESC92_RATEMCS0
:
775 case DESC92_RATEMCS1
:
778 case DESC92_RATEMCS2
:
781 case DESC92_RATEMCS3
:
784 case DESC92_RATEMCS4
:
787 case DESC92_RATEMCS5
:
790 case DESC92_RATEMCS6
:
793 case DESC92_RATEMCS7
:
796 case DESC92_RATEMCS8
:
799 case DESC92_RATEMCS9
:
802 case DESC92_RATEMCS10
:
805 case DESC92_RATEMCS11
:
808 case DESC92_RATEMCS12
:
811 case DESC92_RATEMCS13
:
814 case DESC92_RATEMCS14
:
817 case DESC92_RATEMCS15
:
827 EXPORT_SYMBOL(rtlwifi_rate_mapping
);
829 void rtl_get_tcb_desc(struct ieee80211_hw
*hw
,
830 struct ieee80211_tx_info
*info
,
831 struct ieee80211_sta
*sta
,
832 struct sk_buff
*skb
, struct rtl_tcb_desc
*tcb_desc
)
834 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
835 struct rtl_mac
*rtlmac
= rtl_mac(rtl_priv(hw
));
836 struct ieee80211_hdr
*hdr
= rtl_get_hdr(skb
);
837 struct ieee80211_rate
*txrate
;
838 __le16 fc
= hdr
->frame_control
;
840 txrate
= ieee80211_get_tx_rate(hw
, info
);
842 tcb_desc
->hw_rate
= txrate
->hw_value
;
844 tcb_desc
->hw_rate
= 0;
846 if (ieee80211_is_data(fc
)) {
848 *we set data rate INX 0
849 *in rtl_rc.c if skb is special data or
850 *mgt which need low data rate.
854 *So tcb_desc->hw_rate is just used for
855 *special data and mgt frames
857 if (info
->control
.rates
[0].idx
== 0 ||
858 ieee80211_is_nullfunc(fc
)) {
859 tcb_desc
->use_driver_rate
= true;
860 tcb_desc
->ratr_index
= RATR_INX_WIRELESS_MC
;
862 tcb_desc
->disable_ratefallback
= 1;
865 *because hw will nerver use hw_rate
866 *when tcb_desc->use_driver_rate = false
867 *so we never set highest N rate here,
868 *and N rate will all be controlled by FW
869 *when tcb_desc->use_driver_rate = false
871 if (sta
&& (sta
->ht_cap
.ht_supported
)) {
872 tcb_desc
->hw_rate
= _rtl_get_highest_n_rate(hw
);
874 if (rtlmac
->mode
== WIRELESS_MODE_B
) {
876 rtlpriv
->cfg
->maps
[RTL_RC_CCK_RATE11M
];
879 rtlpriv
->cfg
->maps
[RTL_RC_OFDM_RATE54M
];
884 if (is_multicast_ether_addr(ieee80211_get_DA(hdr
)))
885 tcb_desc
->multicast
= 1;
886 else if (is_broadcast_ether_addr(ieee80211_get_DA(hdr
)))
887 tcb_desc
->broadcast
= 1;
889 _rtl_txrate_selectmode(hw
, sta
, tcb_desc
);
890 _rtl_query_bandwidth_mode(hw
, sta
, tcb_desc
);
891 _rtl_qurey_shortpreamble_mode(hw
, tcb_desc
, info
);
892 _rtl_query_shortgi(hw
, sta
, tcb_desc
, info
);
893 _rtl_query_protection_mode(hw
, tcb_desc
, info
);
895 tcb_desc
->use_driver_rate
= true;
896 tcb_desc
->ratr_index
= RATR_INX_WIRELESS_MC
;
897 tcb_desc
->disable_ratefallback
= 1;
898 tcb_desc
->mac_id
= 0;
899 tcb_desc
->packet_bw
= false;
902 EXPORT_SYMBOL(rtl_get_tcb_desc
);
904 bool rtl_action_proc(struct ieee80211_hw
*hw
, struct sk_buff
*skb
, u8 is_tx
)
906 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
907 struct ieee80211_hdr
*hdr
= rtl_get_hdr(skb
);
908 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
909 __le16 fc
= hdr
->frame_control
;
910 u8
*act
= (u8
*) (((u8
*) skb
->data
+ MAC80211_3ADDR_LEN
));
913 if (!ieee80211_is_action(fc
))
922 if (mac
->act_scanning
)
925 RT_TRACE(rtlpriv
, (COMP_SEND
| COMP_RECV
), DBG_DMESG
,
926 "%s ACT_ADDBAREQ From :%pM\n",
927 is_tx
? "Tx" : "Rx", hdr
->addr2
);
930 RT_TRACE(rtlpriv
, (COMP_SEND
| COMP_RECV
), DBG_DMESG
,
931 "%s ACT_ADDBARSP From :%pM\n",
932 is_tx
? "Tx" : "Rx", hdr
->addr2
);
935 RT_TRACE(rtlpriv
, (COMP_SEND
| COMP_RECV
), DBG_DMESG
,
936 "ACT_ADDBADEL From :%pM\n", hdr
->addr2
);
947 /*should call before software enc*/
948 u8
rtl_is_special_data(struct ieee80211_hw
*hw
, struct sk_buff
*skb
, u8 is_tx
)
950 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
951 struct rtl_ps_ctl
*ppsc
= rtl_psc(rtl_priv(hw
));
952 __le16 fc
= rtl_get_fc(skb
);
954 u8 mac_hdr_len
= ieee80211_get_hdrlen_from_skb(skb
);
955 const struct iphdr
*ip
;
957 if (!ieee80211_is_data(fc
))
961 ip
= (struct iphdr
*)((u8
*) skb
->data
+ mac_hdr_len
+
962 SNAP_SIZE
+ PROTOC_TYPE_SIZE
);
963 ether_type
= *(u16
*) ((u8
*) skb
->data
+ mac_hdr_len
+ SNAP_SIZE
);
964 /* ether_type = ntohs(ether_type); */
966 if (ETH_P_IP
== ether_type
) {
967 if (IPPROTO_UDP
== ip
->protocol
) {
968 struct udphdr
*udp
= (struct udphdr
*)((u8
*) ip
+
970 if (((((u8
*) udp
)[1] == 68) &&
971 (((u8
*) udp
)[3] == 67)) ||
972 ((((u8
*) udp
)[1] == 67) &&
973 (((u8
*) udp
)[3] == 68))) {
975 * 68 : UDP BOOTP client
976 * 67 : UDP BOOTP server
978 RT_TRACE(rtlpriv
, (COMP_SEND
| COMP_RECV
),
979 DBG_DMESG
, "dhcp %s !!\n",
980 is_tx
? "Tx" : "Rx");
984 ppsc
->last_delaylps_stamp_jiffies
=
991 } else if (ETH_P_ARP
== ether_type
) {
994 ppsc
->last_delaylps_stamp_jiffies
= jiffies
;
998 } else if (ETH_P_PAE
== ether_type
) {
999 RT_TRACE(rtlpriv
, (COMP_SEND
| COMP_RECV
), DBG_DMESG
,
1000 "802.1X %s EAPOL pkt!!\n", is_tx
? "Tx" : "Rx");
1004 ppsc
->last_delaylps_stamp_jiffies
= jiffies
;
1008 } else if (ETH_P_IPV6
== ether_type
) {
1016 /*********************************************************
1018 * functions called by core.c
1020 *********************************************************/
1021 int rtl_tx_agg_start(struct ieee80211_hw
*hw
,
1022 struct ieee80211_sta
*sta
, u16 tid
, u16
*ssn
)
1024 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1025 struct rtl_tid_data
*tid_data
;
1026 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
1027 struct rtl_sta_info
*sta_entry
= NULL
;
1032 if (unlikely(tid
>= MAX_TID_COUNT
))
1035 sta_entry
= (struct rtl_sta_info
*)sta
->drv_priv
;
1038 tid_data
= &sta_entry
->tids
[tid
];
1040 RT_TRACE(rtlpriv
, COMP_SEND
, DBG_DMESG
, "on ra = %pM tid = %d seq:%d\n",
1041 sta
->addr
, tid
, tid_data
->seq_number
);
1043 *ssn
= tid_data
->seq_number
;
1044 tid_data
->agg
.agg_state
= RTL_AGG_START
;
1046 ieee80211_start_tx_ba_cb_irqsafe(mac
->vif
, sta
->addr
, tid
);
1051 int rtl_tx_agg_stop(struct ieee80211_hw
*hw
,
1052 struct ieee80211_sta
*sta
, u16 tid
)
1054 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1055 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
1056 struct rtl_sta_info
*sta_entry
= NULL
;
1062 RT_TRACE(rtlpriv
, COMP_ERR
, DBG_EMERG
, "ra = NULL\n");
1066 RT_TRACE(rtlpriv
, COMP_SEND
, DBG_DMESG
, "on ra = %pM tid = %d\n",
1069 if (unlikely(tid
>= MAX_TID_COUNT
))
1072 sta_entry
= (struct rtl_sta_info
*)sta
->drv_priv
;
1073 sta_entry
->tids
[tid
].agg
.agg_state
= RTL_AGG_STOP
;
1075 ieee80211_stop_tx_ba_cb_irqsafe(mac
->vif
, sta
->addr
, tid
);
1080 int rtl_tx_agg_oper(struct ieee80211_hw
*hw
,
1081 struct ieee80211_sta
*sta
, u16 tid
)
1083 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1084 struct rtl_sta_info
*sta_entry
= NULL
;
1090 RT_TRACE(rtlpriv
, COMP_ERR
, DBG_EMERG
, "ra = NULL\n");
1094 RT_TRACE(rtlpriv
, COMP_SEND
, DBG_DMESG
, "on ra = %pM tid = %d\n",
1097 if (unlikely(tid
>= MAX_TID_COUNT
))
1100 sta_entry
= (struct rtl_sta_info
*)sta
->drv_priv
;
1101 sta_entry
->tids
[tid
].agg
.agg_state
= RTL_AGG_OPERATIONAL
;
1106 /*********************************************************
1108 * wq & timer callback functions
1110 *********************************************************/
1111 void rtl_watchdog_wq_callback(void *data
)
1113 struct rtl_works
*rtlworks
= container_of_dwork_rtl(data
,
1116 struct ieee80211_hw
*hw
= rtlworks
->hw
;
1117 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1118 struct rtl_hal
*rtlhal
= rtl_hal(rtl_priv(hw
));
1119 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
1120 bool busytraffic
= false;
1121 bool higher_busytraffic
= false;
1122 bool higher_busyrxtraffic
= false;
1124 u32 rx_cnt_inp4eriod
= 0;
1125 u32 tx_cnt_inp4eriod
= 0;
1126 u32 aver_rx_cnt_inperiod
= 0;
1127 u32 aver_tx_cnt_inperiod
= 0;
1128 u32 aver_tidtx_inperiod
[MAX_TID_COUNT
] = {0};
1129 u32 tidtx_inp4eriod
[MAX_TID_COUNT
] = {0};
1130 bool enter_ps
= false;
1132 if (is_hal_stop(rtlhal
))
1135 /* <1> Determine if action frame is allowed */
1136 if (mac
->link_state
> MAC80211_NOLINK
) {
1137 if (mac
->cnt_after_linked
< 20)
1138 mac
->cnt_after_linked
++;
1140 mac
->cnt_after_linked
= 0;
1144 *<2> to check if traffic busy, if
1145 * busytraffic we don't change channel
1147 if (mac
->link_state
>= MAC80211_LINKED
) {
1149 /* (1) get aver_rx_cnt_inperiod & aver_tx_cnt_inperiod */
1150 for (idx
= 0; idx
<= 2; idx
++) {
1151 rtlpriv
->link_info
.num_rx_in4period
[idx
] =
1152 rtlpriv
->link_info
.num_rx_in4period
[idx
+ 1];
1153 rtlpriv
->link_info
.num_tx_in4period
[idx
] =
1154 rtlpriv
->link_info
.num_tx_in4period
[idx
+ 1];
1156 rtlpriv
->link_info
.num_rx_in4period
[3] =
1157 rtlpriv
->link_info
.num_rx_inperiod
;
1158 rtlpriv
->link_info
.num_tx_in4period
[3] =
1159 rtlpriv
->link_info
.num_tx_inperiod
;
1160 for (idx
= 0; idx
<= 3; idx
++) {
1162 rtlpriv
->link_info
.num_rx_in4period
[idx
];
1164 rtlpriv
->link_info
.num_tx_in4period
[idx
];
1166 aver_rx_cnt_inperiod
= rx_cnt_inp4eriod
/ 4;
1167 aver_tx_cnt_inperiod
= tx_cnt_inp4eriod
/ 4;
1169 /* (2) check traffic busy */
1170 if (aver_rx_cnt_inperiod
> 100 || aver_tx_cnt_inperiod
> 100)
1173 /* Higher Tx/Rx data. */
1174 if (aver_rx_cnt_inperiod
> 4000 ||
1175 aver_tx_cnt_inperiod
> 4000) {
1176 higher_busytraffic
= true;
1178 /* Extremely high Rx data. */
1179 if (aver_rx_cnt_inperiod
> 5000)
1180 higher_busyrxtraffic
= true;
1183 /* check every tid's tx traffic */
1184 for (tid
= 0; tid
<= 7; tid
++) {
1185 for (idx
= 0; idx
<= 2; idx
++)
1186 rtlpriv
->link_info
.tidtx_in4period
[tid
][idx
] =
1187 rtlpriv
->link_info
.tidtx_in4period
[tid
]
1189 rtlpriv
->link_info
.tidtx_in4period
[tid
][3] =
1190 rtlpriv
->link_info
.tidtx_inperiod
[tid
];
1192 for (idx
= 0; idx
<= 3; idx
++)
1193 tidtx_inp4eriod
[tid
] +=
1194 rtlpriv
->link_info
.tidtx_in4period
[tid
][idx
];
1195 aver_tidtx_inperiod
[tid
] = tidtx_inp4eriod
[tid
] / 4;
1196 if (aver_tidtx_inperiod
[tid
] > 5000)
1197 rtlpriv
->link_info
.higher_busytxtraffic
[tid
] =
1200 rtlpriv
->link_info
.higher_busytxtraffic
[tid
] =
1204 if (((rtlpriv
->link_info
.num_rx_inperiod
+
1205 rtlpriv
->link_info
.num_tx_inperiod
) > 8) ||
1206 (rtlpriv
->link_info
.num_rx_inperiod
> 2))
1211 /* LeisurePS only work in infra mode. */
1218 rtlpriv
->link_info
.num_rx_inperiod
= 0;
1219 rtlpriv
->link_info
.num_tx_inperiod
= 0;
1220 for (tid
= 0; tid
<= 7; tid
++)
1221 rtlpriv
->link_info
.tidtx_inperiod
[tid
] = 0;
1223 rtlpriv
->link_info
.busytraffic
= busytraffic
;
1224 rtlpriv
->link_info
.higher_busytraffic
= higher_busytraffic
;
1225 rtlpriv
->link_info
.higher_busyrxtraffic
= higher_busyrxtraffic
;
1228 rtlpriv
->cfg
->ops
->dm_watchdog(hw
);
1231 void rtl_watch_dog_timer_callback(unsigned long data
)
1233 struct ieee80211_hw
*hw
= (struct ieee80211_hw
*)data
;
1234 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1236 queue_delayed_work(rtlpriv
->works
.rtl_wq
,
1237 &rtlpriv
->works
.watchdog_wq
, 0);
1239 mod_timer(&rtlpriv
->works
.watchdog_timer
,
1240 jiffies
+ MSECS(RTL_WATCH_DOG_TIME
));
1243 /*********************************************************
1245 * frame process functions
1247 *********************************************************/
1248 u8
*rtl_find_ie(u8
*data
, unsigned int len
, u8 ie
)
1250 struct ieee80211_mgmt
*mgmt
= (void *)data
;
1253 pos
= (u8
*)mgmt
->u
.beacon
.variable
;
1256 if (pos
+ 2 + pos
[1] > end
)
1267 /* when we use 2 rx ants we send IEEE80211_SMPS_OFF */
1268 /* when we use 1 rx ant we send IEEE80211_SMPS_STATIC */
1269 static struct sk_buff
*rtl_make_smps_action(struct ieee80211_hw
*hw
,
1270 enum ieee80211_smps_mode smps
, u8
*da
, u8
*bssid
)
1272 struct rtl_efuse
*rtlefuse
= rtl_efuse(rtl_priv(hw
));
1273 struct sk_buff
*skb
;
1274 struct ieee80211_mgmt
*action_frame
;
1276 /* 27 = header + category + action + smps mode */
1277 skb
= dev_alloc_skb(27 + hw
->extra_tx_headroom
);
1281 skb_reserve(skb
, hw
->extra_tx_headroom
);
1282 action_frame
= (void *)skb_put(skb
, 27);
1283 memset(action_frame
, 0, 27);
1284 memcpy(action_frame
->da
, da
, ETH_ALEN
);
1285 memcpy(action_frame
->sa
, rtlefuse
->dev_addr
, ETH_ALEN
);
1286 memcpy(action_frame
->bssid
, bssid
, ETH_ALEN
);
1287 action_frame
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
1288 IEEE80211_STYPE_ACTION
);
1289 action_frame
->u
.action
.category
= WLAN_CATEGORY_HT
;
1290 action_frame
->u
.action
.u
.ht_smps
.action
= WLAN_HT_ACTION_SMPS
;
1292 case IEEE80211_SMPS_AUTOMATIC
:/* 0 */
1293 case IEEE80211_SMPS_NUM_MODES
:/* 4 */
1295 case IEEE80211_SMPS_OFF
:/* 1 */ /*MIMO_PS_NOLIMIT*/
1296 action_frame
->u
.action
.u
.ht_smps
.smps_control
=
1297 WLAN_HT_SMPS_CONTROL_DISABLED
;/* 0 */
1299 case IEEE80211_SMPS_STATIC
:/* 2 */ /*MIMO_PS_STATIC*/
1300 action_frame
->u
.action
.u
.ht_smps
.smps_control
=
1301 WLAN_HT_SMPS_CONTROL_STATIC
;/* 1 */
1303 case IEEE80211_SMPS_DYNAMIC
:/* 3 */ /*MIMO_PS_DYNAMIC*/
1304 action_frame
->u
.action
.u
.ht_smps
.smps_control
=
1305 WLAN_HT_SMPS_CONTROL_DYNAMIC
;/* 3 */
1312 int rtl_send_smps_action(struct ieee80211_hw
*hw
,
1313 struct ieee80211_sta
*sta
, u8
*da
, u8
*bssid
,
1314 enum ieee80211_smps_mode smps
)
1316 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1317 struct rtl_hal
*rtlhal
= rtl_hal(rtl_priv(hw
));
1318 struct rtl_ps_ctl
*ppsc
= rtl_psc(rtl_priv(hw
));
1319 struct sk_buff
*skb
= rtl_make_smps_action(hw
, smps
, da
, bssid
);
1320 struct rtl_tcb_desc tcb_desc
;
1321 memset(&tcb_desc
, 0, sizeof(struct rtl_tcb_desc
));
1323 if (rtlpriv
->mac80211
.act_scanning
)
1329 if (unlikely(is_hal_stop(rtlhal
) || ppsc
->rfpwr_state
!= ERFON
))
1332 if (!test_bit(RTL_STATUS_INTERFACE_START
, &rtlpriv
->status
))
1335 /* this is a type = mgmt * stype = action frame */
1337 struct ieee80211_tx_info
*info
= IEEE80211_SKB_CB(skb
);
1338 struct rtl_sta_info
*sta_entry
=
1339 (struct rtl_sta_info
*) sta
->drv_priv
;
1340 sta_entry
->mimo_ps
= smps
;
1341 rtlpriv
->cfg
->ops
->update_rate_tbl(hw
, sta
, 0);
1343 info
->control
.rates
[0].idx
= 0;
1344 info
->control
.sta
= sta
;
1345 info
->band
= hw
->conf
.channel
->band
;
1346 rtlpriv
->intf_ops
->adapter_tx(hw
, skb
, &tcb_desc
);
1352 /*********************************************************
1356 *********************************************************/
1357 static bool rtl_chk_vendor_ouisub(struct ieee80211_hw
*hw
,
1358 struct octet_string vendor_ie
)
1360 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1361 bool matched
= false;
1362 static u8 athcap_1
[] = { 0x00, 0x03, 0x7F };
1363 static u8 athcap_2
[] = { 0x00, 0x13, 0x74 };
1364 static u8 broadcap_1
[] = { 0x00, 0x10, 0x18 };
1365 static u8 broadcap_2
[] = { 0x00, 0x0a, 0xf7 };
1366 static u8 broadcap_3
[] = { 0x00, 0x05, 0xb5 };
1367 static u8 racap
[] = { 0x00, 0x0c, 0x43 };
1368 static u8 ciscocap
[] = { 0x00, 0x40, 0x96 };
1369 static u8 marvcap
[] = { 0x00, 0x50, 0x43 };
1371 if (memcmp(vendor_ie
.octet
, athcap_1
, 3) == 0 ||
1372 memcmp(vendor_ie
.octet
, athcap_2
, 3) == 0) {
1373 rtlpriv
->mac80211
.vendor
= PEER_ATH
;
1375 } else if (memcmp(vendor_ie
.octet
, broadcap_1
, 3) == 0 ||
1376 memcmp(vendor_ie
.octet
, broadcap_2
, 3) == 0 ||
1377 memcmp(vendor_ie
.octet
, broadcap_3
, 3) == 0) {
1378 rtlpriv
->mac80211
.vendor
= PEER_BROAD
;
1380 } else if (memcmp(vendor_ie
.octet
, racap
, 3) == 0) {
1381 rtlpriv
->mac80211
.vendor
= PEER_RAL
;
1383 } else if (memcmp(vendor_ie
.octet
, ciscocap
, 3) == 0) {
1384 rtlpriv
->mac80211
.vendor
= PEER_CISCO
;
1386 } else if (memcmp(vendor_ie
.octet
, marvcap
, 3) == 0) {
1387 rtlpriv
->mac80211
.vendor
= PEER_MARV
;
1394 static bool rtl_find_221_ie(struct ieee80211_hw
*hw
, u8
*data
,
1397 struct ieee80211_mgmt
*mgmt
= (void *)data
;
1398 struct octet_string vendor_ie
;
1401 pos
= (u8
*)mgmt
->u
.beacon
.variable
;
1404 if (pos
[0] == 221) {
1405 vendor_ie
.length
= pos
[1];
1406 vendor_ie
.octet
= &pos
[2];
1407 if (rtl_chk_vendor_ouisub(hw
, vendor_ie
))
1411 if (pos
+ 2 + pos
[1] > end
)
1419 void rtl_recognize_peer(struct ieee80211_hw
*hw
, u8
*data
, unsigned int len
)
1421 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1422 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
1423 struct ieee80211_hdr
*hdr
= (void *)data
;
1424 u32 vendor
= PEER_UNKNOWN
;
1426 static u8 ap3_1
[3] = { 0x00, 0x14, 0xbf };
1427 static u8 ap3_2
[3] = { 0x00, 0x1a, 0x70 };
1428 static u8 ap3_3
[3] = { 0x00, 0x1d, 0x7e };
1429 static u8 ap4_1
[3] = { 0x00, 0x90, 0xcc };
1430 static u8 ap4_2
[3] = { 0x00, 0x0e, 0x2e };
1431 static u8 ap4_3
[3] = { 0x00, 0x18, 0x02 };
1432 static u8 ap4_4
[3] = { 0x00, 0x17, 0x3f };
1433 static u8 ap4_5
[3] = { 0x00, 0x1c, 0xdf };
1434 static u8 ap5_1
[3] = { 0x00, 0x1c, 0xf0 };
1435 static u8 ap5_2
[3] = { 0x00, 0x21, 0x91 };
1436 static u8 ap5_3
[3] = { 0x00, 0x24, 0x01 };
1437 static u8 ap5_4
[3] = { 0x00, 0x15, 0xe9 };
1438 static u8 ap5_5
[3] = { 0x00, 0x17, 0x9A };
1439 static u8 ap5_6
[3] = { 0x00, 0x18, 0xE7 };
1440 static u8 ap6_1
[3] = { 0x00, 0x17, 0x94 };
1441 static u8 ap7_1
[3] = { 0x00, 0x14, 0xa4 };
1443 if (mac
->opmode
!= NL80211_IFTYPE_STATION
)
1446 if (mac
->link_state
== MAC80211_NOLINK
) {
1447 mac
->vendor
= PEER_UNKNOWN
;
1451 if (mac
->cnt_after_linked
> 2)
1454 /* check if this really is a beacon */
1455 if (!ieee80211_is_beacon(hdr
->frame_control
))
1458 /* min. beacon length + FCS_LEN */
1459 if (len
<= 40 + FCS_LEN
)
1462 /* and only beacons from the associated BSSID, please */
1463 if (!ether_addr_equal(hdr
->addr3
, rtlpriv
->mac80211
.bssid
))
1466 if (rtl_find_221_ie(hw
, data
, len
))
1467 vendor
= mac
->vendor
;
1469 if ((memcmp(mac
->bssid
, ap5_1
, 3) == 0) ||
1470 (memcmp(mac
->bssid
, ap5_2
, 3) == 0) ||
1471 (memcmp(mac
->bssid
, ap5_3
, 3) == 0) ||
1472 (memcmp(mac
->bssid
, ap5_4
, 3) == 0) ||
1473 (memcmp(mac
->bssid
, ap5_5
, 3) == 0) ||
1474 (memcmp(mac
->bssid
, ap5_6
, 3) == 0) ||
1475 vendor
== PEER_ATH
) {
1477 RT_TRACE(rtlpriv
, COMP_MAC80211
, DBG_LOUD
, "=>ath find\n");
1478 } else if ((memcmp(mac
->bssid
, ap4_4
, 3) == 0) ||
1479 (memcmp(mac
->bssid
, ap4_5
, 3) == 0) ||
1480 (memcmp(mac
->bssid
, ap4_1
, 3) == 0) ||
1481 (memcmp(mac
->bssid
, ap4_2
, 3) == 0) ||
1482 (memcmp(mac
->bssid
, ap4_3
, 3) == 0) ||
1483 vendor
== PEER_RAL
) {
1484 RT_TRACE(rtlpriv
, COMP_MAC80211
, DBG_LOUD
, "=>ral find\n");
1486 } else if (memcmp(mac
->bssid
, ap6_1
, 3) == 0 ||
1487 vendor
== PEER_CISCO
) {
1488 vendor
= PEER_CISCO
;
1489 RT_TRACE(rtlpriv
, COMP_MAC80211
, DBG_LOUD
, "=>cisco find\n");
1490 } else if ((memcmp(mac
->bssid
, ap3_1
, 3) == 0) ||
1491 (memcmp(mac
->bssid
, ap3_2
, 3) == 0) ||
1492 (memcmp(mac
->bssid
, ap3_3
, 3) == 0) ||
1493 vendor
== PEER_BROAD
) {
1494 RT_TRACE(rtlpriv
, COMP_MAC80211
, DBG_LOUD
, "=>broad find\n");
1495 vendor
= PEER_BROAD
;
1496 } else if (memcmp(mac
->bssid
, ap7_1
, 3) == 0 ||
1497 vendor
== PEER_MARV
) {
1499 RT_TRACE(rtlpriv
, COMP_MAC80211
, DBG_LOUD
, "=>marv find\n");
1502 mac
->vendor
= vendor
;
1505 /*********************************************************
1509 *********************************************************/
1510 static ssize_t
rtl_show_debug_level(struct device
*d
,
1511 struct device_attribute
*attr
, char *buf
)
1513 struct ieee80211_hw
*hw
= dev_get_drvdata(d
);
1514 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1516 return sprintf(buf
, "0x%08X\n", rtlpriv
->dbg
.global_debuglevel
);
1519 static ssize_t
rtl_store_debug_level(struct device
*d
,
1520 struct device_attribute
*attr
,
1521 const char *buf
, size_t count
)
1523 struct ieee80211_hw
*hw
= dev_get_drvdata(d
);
1524 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1528 ret
= strict_strtoul(buf
, 0, &val
);
1530 printk(KERN_DEBUG
"%s is not in hex or decimal form.\n", buf
);
1532 rtlpriv
->dbg
.global_debuglevel
= val
;
1533 printk(KERN_DEBUG
"debuglevel:%x\n",
1534 rtlpriv
->dbg
.global_debuglevel
);
1537 return strnlen(buf
, count
);
1540 static DEVICE_ATTR(debug_level
, S_IWUSR
| S_IRUGO
,
1541 rtl_show_debug_level
, rtl_store_debug_level
);
1543 static struct attribute
*rtl_sysfs_entries
[] = {
1545 &dev_attr_debug_level
.attr
,
1551 * "name" is folder name witch will be
1552 * put in device directory like :
1553 * sys/devices/pci0000:00/0000:00:1c.4/
1554 * 0000:06:00.0/rtl_sysfs
1556 struct attribute_group rtl_attribute_group
= {
1558 .attrs
= rtl_sysfs_entries
,
1561 MODULE_AUTHOR("lizhaoming <chaoming_li@realsil.com.cn>");
1562 MODULE_AUTHOR("Realtek WlanFAE <wlanfae@realtek.com>");
1563 MODULE_AUTHOR("Larry Finger <Larry.FInger@lwfinger.net>");
1564 MODULE_LICENSE("GPL");
1565 MODULE_DESCRIPTION("Realtek 802.11n PCI wireless core");
1567 static int __init
rtl_core_module_init(void)
1569 if (rtl_rate_control_register())
1570 pr_err("Unable to register rtl_rc, use default RC !!\n");
1575 static void __exit
rtl_core_module_exit(void)
1578 rtl_rate_control_unregister();
1581 module_init(rtl_core_module_init
);
1582 module_exit(rtl_core_module_exit
);