1 /******************************************************************************
\r
3 * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
\r
5 * This program is free software; you can redistribute it and/or modify it
\r
6 * under the terms of version 2 of the GNU General Public License as
\r
7 * published by the Free Software Foundation.
\r
9 * This program is distributed in the hope that it will be useful, but WITHOUT
\r
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
\r
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
\r
14 * You should have received a copy of the GNU General Public License along with
\r
15 * this program; if not, write to the Free Software Foundation, Inc.,
\r
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
\r
19 ******************************************************************************/
\r
22 #include <drv_types.h>
\r
25 #ifdef CONFIG_AP_MODE
\r
27 extern unsigned char RTW_WPA_OUI[];
\r
28 extern unsigned char WMM_OUI[];
\r
29 extern unsigned char WPS_OUI[];
\r
30 extern unsigned char P2P_OUI[];
\r
31 extern unsigned char WFD_OUI[];
\r
33 void init_mlme_ap_info(_adapter *padapter)
\r
35 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
\r
36 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
37 struct sta_priv *pstapriv = &padapter->stapriv;
\r
38 struct wlan_acl_pool *pacl_list = &pstapriv->acl_list;
\r
41 _rtw_spinlock_init(&pmlmepriv->bcn_update_lock);
\r
44 _rtw_init_queue(&pacl_list->acl_node_q);
\r
46 //pmlmeext->bstart_bss = _FALSE;
\r
48 start_ap_mode(padapter);
\r
51 void free_mlme_ap_info(_adapter *padapter)
\r
54 struct sta_info *psta=NULL;
\r
55 struct sta_priv *pstapriv = &padapter->stapriv;
\r
56 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
57 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
\r
58 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
60 //stop_ap_mode(padapter);
\r
62 pmlmepriv->update_bcn = _FALSE;
\r
63 pmlmeext->bstart_bss = _FALSE;
\r
65 rtw_sta_flush(padapter);
\r
67 pmlmeinfo->state = _HW_STATE_NOLINK_;
\r
69 //free_assoc_sta_resources
\r
70 rtw_free_all_stainfo(padapter);
\r
72 //free bc/mc sta_info
\r
73 psta = rtw_get_bcmc_stainfo(padapter);
\r
74 //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
\r
75 rtw_free_stainfo(padapter, psta);
\r
76 //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
\r
79 _rtw_spinlock_free(&pmlmepriv->bcn_update_lock);
\r
83 static void update_BCNTIM(_adapter *padapter)
\r
85 struct sta_priv *pstapriv = &padapter->stapriv;
\r
86 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
\r
87 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
88 WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network);
\r
89 unsigned char *pie = pnetwork_mlmeext->IEs;
\r
91 //DBG_871X("%s\n", __FUNCTION__);
\r
94 //if(pstapriv->tim_bitmap)
\r
97 u8 *p, *dst_ie, *premainder_ie=NULL, *pbackup_remainder_ie=NULL;
\r
99 uint offset, tmp_len, tim_ielen, tim_ie_offset, remainder_ielen;
\r
101 tim_bitmap_le = cpu_to_le16(pstapriv->tim_bitmap);
\r
103 p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, _TIM_IE_, &tim_ielen, pnetwork_mlmeext->IELength - _FIXED_IE_LENGTH_);
\r
104 if (p != NULL && tim_ielen>0)
\r
108 premainder_ie = p+tim_ielen;
\r
110 tim_ie_offset = (sint)(p -pie);
\r
112 remainder_ielen = pnetwork_mlmeext->IELength - tim_ie_offset - tim_ielen;
\r
114 //append TIM IE from dst_ie offset
\r
121 //calucate head_len
\r
122 offset = _FIXED_IE_LENGTH_;
\r
124 /* get ssid_ie len */
\r
125 p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SSID_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_));
\r
127 offset += tmp_len+2;
\r
129 // get supported rates len
\r
130 p = rtw_get_ie(pie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &tmp_len, (pnetwork_mlmeext->IELength - _BEACON_IE_OFFSET_));
\r
133 offset += tmp_len+2;
\r
136 //DS Parameter Set IE, len=3
\r
139 premainder_ie = pie + offset;
\r
141 remainder_ielen = pnetwork_mlmeext->IELength - offset - tim_ielen;
\r
143 //append TIM IE from offset
\r
144 dst_ie = pie + offset;
\r
149 if(remainder_ielen>0)
\r
151 pbackup_remainder_ie = rtw_malloc(remainder_ielen);
\r
152 if(pbackup_remainder_ie && premainder_ie)
\r
153 _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen);
\r
156 *dst_ie++=_TIM_IE_;
\r
158 if((pstapriv->tim_bitmap&0xff00) && (pstapriv->tim_bitmap&0x00fe))
\r
163 *dst_ie++= tim_ielen;
\r
165 *dst_ie++=0;//DTIM count
\r
166 *dst_ie++=1;//DTIM peroid
\r
168 if(pstapriv->tim_bitmap&BIT(0))//for bc/mc frames
\r
169 *dst_ie++ = BIT(0);//bitmap ctrl
\r
177 if(pstapriv->tim_bitmap&0x00fe)
\r
178 pvb = (u8)tim_bitmap_le;
\r
179 else if(pstapriv->tim_bitmap&0xff00)
\r
180 pvb = (u8)(tim_bitmap_le>>8);
\r
182 pvb = (u8)tim_bitmap_le;
\r
187 else if(tim_ielen==5)
\r
189 _rtw_memcpy(dst_ie, &tim_bitmap_le, 2);
\r
193 //copy remainder IE
\r
194 if(pbackup_remainder_ie)
\r
196 _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen);
\r
198 rtw_mfree(pbackup_remainder_ie, remainder_ielen);
\r
201 offset = (uint)(dst_ie - pie);
\r
202 pnetwork_mlmeext->IELength = offset + remainder_ielen;
\r
207 void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len)
\r
209 PNDIS_802_11_VARIABLE_IEs pIE;
\r
210 u8 bmatch = _FALSE;
\r
211 u8 *pie = pnetwork->IEs;
\r
212 u8 *p=NULL, *dst_ie=NULL, *premainder_ie=NULL, *pbackup_remainder_ie=NULL;
\r
213 u32 i, offset, ielen, ie_offset, remainder_ielen = 0;
\r
215 for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pnetwork->IELength;)
\r
217 pIE = (PNDIS_802_11_VARIABLE_IEs)(pnetwork->IEs + i);
\r
219 if (pIE->ElementID > index)
\r
223 else if(pIE->ElementID == index) // already exist the same IE
\r
226 ielen = pIE->Length;
\r
232 ielen = pIE->Length;
\r
233 i += (pIE->Length + 2);
\r
236 if (p != NULL && ielen>0)
\r
240 premainder_ie = p+ielen;
\r
242 ie_offset = (sint)(p -pie);
\r
244 remainder_ielen = pnetwork->IELength - ie_offset - ielen;
\r
249 dst_ie = (p+ielen);
\r
255 if(remainder_ielen>0)
\r
257 pbackup_remainder_ie = rtw_malloc(remainder_ielen);
\r
258 if(pbackup_remainder_ie && premainder_ie)
\r
259 _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen);
\r
265 _rtw_memcpy(dst_ie, data, len);
\r
268 //copy remainder IE
\r
269 if(pbackup_remainder_ie)
\r
271 _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen);
\r
273 rtw_mfree(pbackup_remainder_ie, remainder_ielen);
\r
276 offset = (uint)(dst_ie - pie);
\r
277 pnetwork->IELength = offset + remainder_ielen;
\r
280 void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index)
\r
282 u8 *p, *dst_ie=NULL, *premainder_ie=NULL, *pbackup_remainder_ie=NULL;
\r
283 uint offset, ielen, ie_offset, remainder_ielen = 0;
\r
284 u8 *pie = pnetwork->IEs;
\r
286 p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, index, &ielen, pnetwork->IELength - _FIXED_IE_LENGTH_);
\r
287 if (p != NULL && ielen>0)
\r
291 premainder_ie = p+ielen;
\r
293 ie_offset = (sint)(p -pie);
\r
295 remainder_ielen = pnetwork->IELength - ie_offset - ielen;
\r
303 if(remainder_ielen>0)
\r
305 pbackup_remainder_ie = rtw_malloc(remainder_ielen);
\r
306 if(pbackup_remainder_ie && premainder_ie)
\r
307 _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen);
\r
310 //copy remainder IE
\r
311 if(pbackup_remainder_ie)
\r
313 _rtw_memcpy(dst_ie, pbackup_remainder_ie, remainder_ielen);
\r
315 rtw_mfree(pbackup_remainder_ie, remainder_ielen);
\r
318 offset = (uint)(dst_ie - pie);
\r
319 pnetwork->IELength = offset + remainder_ielen;
\r
323 u8 chk_sta_is_alive(struct sta_info *psta);
\r
324 u8 chk_sta_is_alive(struct sta_info *psta)
\r
327 #ifdef DBG_EXPIRATION_CHK
\r
328 DBG_871X("sta:"MAC_FMT", rssi:%d, rx:"STA_PKTS_FMT", expire_to:%u, %s%ssq_len:%u\n"
\r
329 , MAC_ARG(psta->hwaddr)
\r
330 , psta->rssi_stat.UndecoratedSmoothedPWDB
\r
331 //, STA_RX_PKTS_ARG(psta)
\r
332 , STA_RX_PKTS_DIFF_ARG(psta)
\r
334 , psta->state&WIFI_SLEEP_STATE?"PS, ":""
\r
335 , psta->state&WIFI_STA_ALIVE_CHK_STATE?"SAC, ":""
\r
340 //if(sta_last_rx_pkts(psta) == sta_rx_pkts(psta))
\r
341 if((psta->sta_stats.last_rx_data_pkts + psta->sta_stats.last_rx_ctrl_pkts) == (psta->sta_stats.rx_data_pkts + psta->sta_stats.rx_ctrl_pkts))
\r
344 if(psta->state&WIFI_SLEEP_STATE)
\r
353 sta_update_last_rx_pkts(psta);
\r
358 void expire_timeout_chk(_adapter *padapter)
\r
361 _list *phead, *plist;
\r
362 u8 updated = _FALSE;
\r
363 struct sta_info *psta=NULL;
\r
364 struct sta_priv *pstapriv = &padapter->stapriv;
\r
365 u8 chk_alive_num = 0;
\r
366 char chk_alive_list[NUM_STA];
\r
370 _enter_critical_bh(&pstapriv->auth_list_lock, &irqL);
\r
372 phead = &pstapriv->auth_list;
\r
373 plist = get_next(phead);
\r
376 #ifdef DBG_EXPIRATION_CHK
\r
377 if (rtw_end_of_queue_search(phead, plist) == _FALSE) {
\r
378 DBG_871X(FUNC_NDEV_FMT" auth_list, cnt:%u\n"
\r
379 , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->auth_list_cnt);
\r
382 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
\r
384 psta = LIST_CONTAINOR(plist, struct sta_info, auth_list);
\r
386 plist = get_next(plist);
\r
389 #ifdef CONFIG_ATMEL_RC_PATCH
\r
390 if (_TRUE == _rtw_memcmp((void *)(pstapriv->atmel_rc_pattern), (void *)(psta->hwaddr), ETH_ALEN))
\r
392 if (psta->flag_atmel_rc)
\r
395 if(psta->expire_to>0)
\r
398 if (psta->expire_to == 0)
\r
400 rtw_list_delete(&psta->auth_list);
\r
401 pstapriv->auth_list_cnt--;
\r
403 DBG_871X("auth expire %02X%02X%02X%02X%02X%02X\n",
\r
404 psta->hwaddr[0],psta->hwaddr[1],psta->hwaddr[2],psta->hwaddr[3],psta->hwaddr[4],psta->hwaddr[5]);
\r
406 _exit_critical_bh(&pstapriv->auth_list_lock, &irqL);
\r
408 //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
\r
409 rtw_free_stainfo(padapter, psta);
\r
410 //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
\r
412 _enter_critical_bh(&pstapriv->auth_list_lock, &irqL);
\r
418 _exit_critical_bh(&pstapriv->auth_list_lock, &irqL);
\r
422 _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
424 phead = &pstapriv->asoc_list;
\r
425 plist = get_next(phead);
\r
428 #ifdef DBG_EXPIRATION_CHK
\r
429 if (rtw_end_of_queue_search(phead, plist) == _FALSE) {
\r
430 DBG_871X(FUNC_NDEV_FMT" asoc_list, cnt:%u\n"
\r
431 , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->asoc_list_cnt);
\r
434 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
\r
436 psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list);
\r
437 plist = get_next(plist);
\r
438 #ifdef CONFIG_ATMEL_RC_PATCH
\r
439 DBG_871X("%s:%d psta=%p, %02x,%02x||%02x,%02x \n\n", __func__, __LINE__,
\r
440 psta,pstapriv->atmel_rc_pattern[0], pstapriv->atmel_rc_pattern[5], psta->hwaddr[0], psta->hwaddr[5]);
\r
441 if (_TRUE == _rtw_memcmp((void *)pstapriv->atmel_rc_pattern, (void *)(psta->hwaddr), ETH_ALEN))
\r
443 if (psta->flag_atmel_rc)
\r
445 DBG_871X("%s: debug line:%d \n", __func__, __LINE__);
\r
447 #ifdef CONFIG_AUTO_AP_MODE
\r
451 if (chk_sta_is_alive(psta) || !psta->expire_to) {
\r
452 psta->expire_to = pstapriv->expire_to;
\r
453 psta->keep_alive_trycnt = 0;
\r
454 #ifdef CONFIG_TX_MCAST2UNI
\r
455 psta->under_exist_checking = 0;
\r
456 #endif // CONFIG_TX_MCAST2UNI
\r
461 #ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK
\r
462 #ifdef CONFIG_80211N_HT
\r
463 #ifdef CONFIG_TX_MCAST2UNI
\r
464 if ( (psta->flags & WLAN_STA_HT) && (psta->htpriv.agg_enable_bitmap || psta->under_exist_checking) ) {
\r
465 // check sta by delba(addba) for 11n STA
\r
466 // ToDo: use CCX report to check for all STAs
\r
467 //DBG_871X("asoc check by DELBA/ADDBA! (pstapriv->expire_to=%d s)(psta->expire_to=%d s), [%02x, %d]\n", pstapriv->expire_to*2, psta->expire_to*2, psta->htpriv.agg_enable_bitmap, psta->under_exist_checking);
\r
469 if ( psta->expire_to <= (pstapriv->expire_to - 50 ) ) {
\r
470 DBG_871X("asoc expire by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to-psta->expire_to)*2);
\r
471 psta->under_exist_checking = 0;
\r
472 psta->expire_to = 0;
\r
473 } else if ( psta->expire_to <= (pstapriv->expire_to - 3) && (psta->under_exist_checking==0)) {
\r
474 DBG_871X("asoc check by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to-psta->expire_to)*2);
\r
475 psta->under_exist_checking = 1;
\r
476 //tear down TX AMPDU
\r
477 send_delba(padapter, 1, psta->hwaddr);// // originator
\r
478 psta->htpriv.agg_enable_bitmap = 0x0;//reset
\r
479 psta->htpriv.candidate_tid_bitmap = 0x0;//reset
\r
482 #endif //CONFIG_TX_MCAST2UNI
\r
483 #endif //CONFIG_80211N_HT
\r
484 #endif //CONFIG_ACTIVE_KEEP_ALIVE_CHECK
\r
486 if (psta->expire_to <= 0)
\r
488 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
\r
490 if (padapter->registrypriv.wifi_spec == 1)
\r
492 psta->expire_to = pstapriv->expire_to;
\r
496 #ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK
\r
497 #ifdef CONFIG_80211N_HT
\r
499 #define KEEP_ALIVE_TRYCNT (3)
\r
501 if(psta->keep_alive_trycnt > 0 && psta->keep_alive_trycnt <= KEEP_ALIVE_TRYCNT)
\r
503 if(psta->state & WIFI_STA_ALIVE_CHK_STATE)
\r
504 psta->state ^= WIFI_STA_ALIVE_CHK_STATE;
\r
506 psta->keep_alive_trycnt = 0;
\r
509 else if((psta->keep_alive_trycnt > KEEP_ALIVE_TRYCNT) && !(psta->state & WIFI_STA_ALIVE_CHK_STATE))
\r
511 psta->keep_alive_trycnt = 0;
\r
513 if((psta->htpriv.ht_option==_TRUE) && (psta->htpriv.ampdu_enable==_TRUE))
\r
515 uint priority = 1; //test using BK
\r
518 //issued = (psta->htpriv.agg_enable_bitmap>>priority)&0x1;
\r
519 issued |= (psta->htpriv.candidate_tid_bitmap>>priority)&0x1;
\r
523 if (!(psta->state & WIFI_STA_ALIVE_CHK_STATE))
\r
525 psta->htpriv.candidate_tid_bitmap |= BIT((u8)priority);
\r
527 if (psta->state & WIFI_SLEEP_STATE)
\r
528 psta->expire_to = 2; // 2x2=4 sec
\r
530 psta->expire_to = 1; // 2 sec
\r
532 psta->state |= WIFI_STA_ALIVE_CHK_STATE;
\r
534 //add_ba_hdl(padapter, (u8*)paddbareq_parm);
\r
536 DBG_871X("issue addba_req to check if sta alive, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt);
\r
538 issue_addba_req(padapter, psta->hwaddr, (u8)priority);
\r
540 _set_timer(&psta->addba_retry_timer, ADDBA_TO);
\r
542 psta->keep_alive_trycnt++;
\r
548 if(psta->keep_alive_trycnt > 0 && psta->state & WIFI_STA_ALIVE_CHK_STATE)
\r
550 psta->keep_alive_trycnt = 0;
\r
551 psta->state ^= WIFI_STA_ALIVE_CHK_STATE;
\r
552 DBG_871X("change to another methods to check alive if staion is at ps mode\n");
\r
555 #endif //CONFIG_80211N_HT
\r
556 #endif //CONFIG_ACTIVE_KEEP_ALIVE_CHECK
\r
557 if (psta->state & WIFI_SLEEP_STATE) {
\r
558 if (!(psta->state & WIFI_STA_ALIVE_CHK_STATE)) {
\r
559 //to check if alive by another methods if staion is at ps mode.
\r
560 psta->expire_to = pstapriv->expire_to;
\r
561 psta->state |= WIFI_STA_ALIVE_CHK_STATE;
\r
563 //DBG_871X("alive chk, sta:" MAC_FMT " is at ps mode!\n", MAC_ARG(psta->hwaddr));
\r
565 //to update bcn with tim_bitmap for this station
\r
566 pstapriv->tim_bitmap |= BIT(psta->aid);
\r
567 update_beacon(padapter, _TIM_IE_, NULL, _TRUE);
\r
569 if(!pmlmeext->active_keep_alive_check)
\r
573 #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK
\r
574 if (pmlmeext->active_keep_alive_check) {
\r
575 int stainfo_offset;
\r
577 stainfo_offset = rtw_stainfo_offset(pstapriv, psta);
\r
578 if (stainfo_offset_valid(stainfo_offset)) {
\r
579 chk_alive_list[chk_alive_num++] = stainfo_offset;
\r
584 #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */
\r
585 rtw_list_delete(&psta->asoc_list);
\r
586 pstapriv->asoc_list_cnt--;
\r
587 DBG_871X("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state);
\r
588 updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING);
\r
592 /* TODO: Aging mechanism to digest frames in sleep_q to avoid running out of xmitframe */
\r
593 if (psta->sleepq_len > (NR_XMITFRAME/pstapriv->asoc_list_cnt)
\r
594 && padapter->xmitpriv.free_xmitframe_cnt < ((NR_XMITFRAME/pstapriv->asoc_list_cnt)/2)
\r
596 DBG_871X("%s sta:"MAC_FMT", sleepq_len:%u, free_xmitframe_cnt:%u, asoc_list_cnt:%u, clear sleep_q\n", __func__
\r
597 , MAC_ARG(psta->hwaddr)
\r
598 , psta->sleepq_len, padapter->xmitpriv.free_xmitframe_cnt, pstapriv->asoc_list_cnt);
\r
599 wakeup_sta_to_xmit(padapter, psta);
\r
604 _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
606 #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK
\r
607 if (chk_alive_num) {
\r
609 u8 backup_oper_channel=0;
\r
610 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
\r
611 /* switch to correct channel of current network before issue keep-alive frames */
\r
612 if (rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) {
\r
613 backup_oper_channel = rtw_get_oper_ch(padapter);
\r
614 SelectChannel(padapter, pmlmeext->cur_channel);
\r
617 /* issue null data to check sta alive*/
\r
618 for (i = 0; i < chk_alive_num; i++) {
\r
621 psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]);
\r
622 #ifdef CONFIG_ATMEL_RC_PATCH
\r
623 if (_TRUE == _rtw_memcmp( pstapriv->atmel_rc_pattern, psta->hwaddr, ETH_ALEN))
\r
625 if (psta->flag_atmel_rc)
\r
628 if(!(psta->state &_FW_LINKED))
\r
631 if (psta->state & WIFI_SLEEP_STATE)
\r
632 ret = issue_nulldata(padapter, psta->hwaddr, 0, 1, 50);
\r
634 ret = issue_nulldata(padapter, psta->hwaddr, 0, 3, 50);
\r
636 psta->keep_alive_trycnt++;
\r
637 if (ret == _SUCCESS)
\r
639 DBG_871X("asoc check, sta(" MAC_FMT ") is alive\n", MAC_ARG(psta->hwaddr));
\r
640 psta->expire_to = pstapriv->expire_to;
\r
641 psta->keep_alive_trycnt = 0;
\r
644 else if (psta->keep_alive_trycnt <= 3)
\r
646 DBG_871X("ack check for asoc expire, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt);
\r
647 psta->expire_to = 1;
\r
651 psta->keep_alive_trycnt = 0;
\r
652 DBG_871X("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state);
\r
653 _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
654 if (rtw_is_list_empty(&psta->asoc_list)==_FALSE) {
\r
655 rtw_list_delete(&psta->asoc_list);
\r
656 pstapriv->asoc_list_cnt--;
\r
657 updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING);
\r
659 _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
663 if (backup_oper_channel>0) /* back to the original operation channel */
\r
664 SelectChannel(padapter, backup_oper_channel);
\r
666 #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */
\r
668 associated_clients_update(padapter, updated);
\r
671 void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level)
\r
675 unsigned char sta_band = 0, shortGIrate = _FALSE;
\r
676 unsigned int tx_ra_bitmap=0;
\r
677 struct ht_priv *psta_ht = NULL;
\r
678 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
679 WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network;
\r
681 #ifdef CONFIG_80211N_HT
\r
683 psta_ht = &psta->htpriv;
\r
686 #endif //CONFIG_80211N_HT
\r
688 if(!(psta->state & _FW_LINKED))
\r
692 if(get_rf_mimo_mode(padapter) == RTL8712_RF_2T2R)
\r
694 //is this a 2r STA?
\r
695 if((pstat->tx_ra_bitmap & 0x0ff00000) != 0 && !(priv->pshare->has_2r_sta & BIT(pstat->aid)))
\r
697 priv->pshare->has_2r_sta |= BIT(pstat->aid);
\r
698 if(rtw_read16(padapter, 0x102501f6) != 0xffff)
\r
700 rtw_write16(padapter, 0x102501f6, 0xffff);
\r
701 reset_1r_sta_RA(priv, 0xffff);
\r
702 Switch_1SS_Antenna(priv, 3);
\r
705 else// bg or 1R STA?
\r
707 if((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) && pstat->ht_cap_len && priv->pshare->has_2r_sta == 0)
\r
709 if(rtw_read16(padapter, 0x102501f6) != 0x7777)
\r
711 rtw_write16(padapter, 0x102501f6,0x7777);
\r
712 reset_1r_sta_RA(priv, 0x7777);
\r
713 Switch_1SS_Antenna(priv, 2);
\r
720 if ((pstat->rssi_level < 1) || (pstat->rssi_level > 3))
\r
722 if (pstat->rssi >= priv->pshare->rf_ft_var.raGoDownUpper)
\r
723 pstat->rssi_level = 1;
\r
724 else if ((pstat->rssi >= priv->pshare->rf_ft_var.raGoDown20MLower) ||
\r
725 ((priv->pshare->is_40m_bw) && (pstat->ht_cap_len) &&
\r
726 (pstat->rssi >= priv->pshare->rf_ft_var.raGoDown40MLower) &&
\r
727 (pstat->ht_cap_buf.ht_cap_info & cpu_to_le16(_HTCAP_SUPPORT_CH_WDTH_))))
\r
728 pstat->rssi_level = 2;
\r
730 pstat->rssi_level = 3;
\r
733 // rate adaptive by rssi
\r
734 if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) && pstat->ht_cap_len)
\r
736 if ((get_rf_mimo_mode(priv) == MIMO_1T2R) || (get_rf_mimo_mode(priv) == MIMO_1T1R))
\r
738 switch (pstat->rssi_level) {
\r
740 pstat->tx_ra_bitmap &= 0x100f0000;
\r
743 pstat->tx_ra_bitmap &= 0x100ff000;
\r
746 if (priv->pshare->is_40m_bw)
\r
747 pstat->tx_ra_bitmap &= 0x100ff005;
\r
749 pstat->tx_ra_bitmap &= 0x100ff001;
\r
756 switch (pstat->rssi_level) {
\r
758 pstat->tx_ra_bitmap &= 0x1f0f0000;
\r
761 pstat->tx_ra_bitmap &= 0x1f0ff000;
\r
764 if (priv->pshare->is_40m_bw)
\r
765 pstat->tx_ra_bitmap &= 0x000ff005;
\r
767 pstat->tx_ra_bitmap &= 0x000ff001;
\r
772 // Don't need to mask high rates due to new rate adaptive parameters
\r
773 //if (pstat->is_broadcom_sta) // use MCS12 as the highest rate vs. Broadcom sta
\r
774 // pstat->tx_ra_bitmap &= 0x81ffffff;
\r
776 // NIC driver will report not supporting MCS15 and MCS14 in asoc req
\r
777 //if (pstat->is_rtl8190_sta && !pstat->is_2t_mimo_sta)
\r
778 // pstat->tx_ra_bitmap &= 0x83ffffff; // if Realtek 1x2 sta, don't use MCS15 and MCS14
\r
781 else if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) && isErpSta(pstat))
\r
783 switch (pstat->rssi_level) {
\r
785 pstat->tx_ra_bitmap &= 0x00000f00;
\r
788 pstat->tx_ra_bitmap &= 0x00000ff0;
\r
791 pstat->tx_ra_bitmap &= 0x00000ff5;
\r
797 pstat->tx_ra_bitmap &= 0x0000000d;
\r
800 // disable tx short GI when station cannot rx MCS15(AP is 2T2R)
\r
801 // disable tx short GI when station cannot rx MCS7 (AP is 1T2R or 1T1R)
\r
802 // if there is only 1r STA and we are 2T2R, DO NOT mask SGI rate
\r
803 if ((!(pstat->tx_ra_bitmap & 0x8000000) && (priv->pshare->has_2r_sta > 0) && (get_rf_mimo_mode(padapter) == RTL8712_RF_2T2R)) ||
\r
804 (!(pstat->tx_ra_bitmap & 0x80000) && (get_rf_mimo_mode(padapter) != RTL8712_RF_2T2R)))
\r
806 pstat->tx_ra_bitmap &= ~BIT(28);
\r
810 rtw_hal_update_sta_rate_mask(padapter, psta);
\r
811 tx_ra_bitmap = psta->ra_mask;
\r
813 shortGIrate = query_ra_short_GI(psta);
\r
815 if ( pcur_network->Configuration.DSConfig > 14 ) {
\r
817 if (tx_ra_bitmap & 0xffff000)
\r
818 sta_band |= WIRELESS_11_5N ;
\r
820 if (tx_ra_bitmap & 0xff0)
\r
821 sta_band |= WIRELESS_11A;
\r
824 #ifdef CONFIG_80211AC_VHT
\r
825 if (psta->vhtpriv.vht_option) {
\r
826 sta_band = WIRELESS_11_5AC;
\r
831 if (tx_ra_bitmap & 0xffff000)
\r
832 sta_band |= WIRELESS_11_24N;
\r
834 if (tx_ra_bitmap & 0xff0)
\r
835 sta_band |= WIRELESS_11G;
\r
837 if (tx_ra_bitmap & 0x0f)
\r
838 sta_band |= WIRELESS_11B;
\r
841 psta->wireless_mode = sta_band;
\r
842 psta->raid = rtw_hal_networktype_to_raid(padapter, psta);
\r
844 if (psta->aid < NUM_STA)
\r
848 arg[0] = psta->mac_id;
\r
849 arg[1] = psta->raid;
\r
850 arg[2] = shortGIrate;
\r
851 arg[3] = psta->init_rate;
\r
853 DBG_871X("%s=> mac_id:%d , raid:%d , shortGIrate=%d, bitmap=0x%x\n",
\r
854 __FUNCTION__ , psta->mac_id, psta->raid ,shortGIrate, tx_ra_bitmap);
\r
856 rtw_hal_add_ra_tid(padapter, tx_ra_bitmap, arg, rssi_level);
\r
860 DBG_871X("station aid %d exceed the max number\n", psta->aid);
\r
865 void update_bmc_sta(_adapter *padapter)
\r
868 unsigned char network_type;
\r
869 int supportRateNum = 0;
\r
870 unsigned int tx_ra_bitmap=0;
\r
871 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
872 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
\r
873 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
874 WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network;
\r
875 struct sta_info *psta = rtw_get_bcmc_stainfo(padapter);
\r
879 psta->aid = 0;//default set to 0
\r
881 pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta;
\r
883 psta->qos_option = 0;
\r
884 #ifdef CONFIG_80211N_HT
\r
885 psta->htpriv.ht_option = _FALSE;
\r
886 #endif //CONFIG_80211N_HT
\r
888 psta->ieee8021x_blocked = 0;
\r
890 _rtw_memset((void*)&psta->sta_stats, 0, sizeof(struct stainfo_stats));
\r
892 //psta->dot118021XPrivacy = _NO_PRIVACY_;//!!! remove it, because it has been set before this.
\r
894 //prepare for add_RATid
\r
895 supportRateNum = rtw_get_rateset_len((u8*)&pcur_network->SupportedRates);
\r
896 network_type = rtw_check_network_type((u8*)&pcur_network->SupportedRates, supportRateNum, pcur_network->Configuration.DSConfig);
\r
897 if (IsSupportedTxCCK(network_type)) {
\r
898 network_type = WIRELESS_11B;
\r
900 else if (network_type == WIRELESS_INVALID) { // error handling
\r
901 if ( pcur_network->Configuration.DSConfig > 14 )
\r
902 network_type = WIRELESS_11A;
\r
904 network_type = WIRELESS_11B;
\r
906 update_sta_basic_rate(psta, network_type);
\r
907 psta->wireless_mode = network_type;
\r
909 rtw_hal_update_sta_rate_mask(padapter, psta);
\r
910 tx_ra_bitmap = psta->ra_mask;
\r
912 psta->raid = rtw_hal_networktype_to_raid(padapter,psta);
\r
915 rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE);
\r
917 //if(pHalData->fw_ractrl == _TRUE)
\r
921 arg[0] = psta->mac_id;
\r
922 arg[1] = psta->raid;
\r
924 arg[3] = psta->init_rate;
\r
926 DBG_871X("%s=> mac_id:%d , raid:%d , bitmap=0x%x\n",
\r
927 __FUNCTION__ , psta->mac_id, psta->raid , tx_ra_bitmap);
\r
929 rtw_hal_add_ra_tid(padapter, tx_ra_bitmap, arg, 0);
\r
932 rtw_sta_media_status_rpt(padapter, psta, 1);
\r
934 _enter_critical_bh(&psta->lock, &irqL);
\r
935 psta->state = _FW_LINKED;
\r
936 _exit_critical_bh(&psta->lock, &irqL);
\r
941 DBG_871X("add_RATid_bmc_sta error!\n");
\r
947 //AID: 1~MAX for sta and 0 for bc/mc in ap/adhoc mode
\r
948 //MAC_ID = AID+1 for sta in ap/adhoc mode
\r
949 //MAC_ID = 1 for bc/mc for sta/ap/adhoc
\r
950 //MAC_ID = 0 for bssid for sta/ap/adhoc
\r
951 //CAM_ID = //0~3 for default key, cmd_id=macid + 3, macid=aid+1;
\r
953 void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta)
\r
956 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
957 struct security_priv *psecuritypriv = &padapter->securitypriv;
\r
958 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
\r
959 #ifdef CONFIG_80211N_HT
\r
960 struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv;
\r
961 struct ht_priv *phtpriv_sta = &psta->htpriv;
\r
962 #endif //CONFIG_80211N_HT
\r
963 u8 cur_ldpc_cap=0, cur_stbc_cap=0, cur_beamform_cap=0;
\r
964 //set intf_tag to if1
\r
965 //psta->intf_tag = 0;
\r
967 DBG_871X("%s\n",__FUNCTION__);
\r
969 //psta->mac_id = psta->aid+4;
\r
970 //psta->mac_id = psta->aid+1;//alloc macid when call rtw_alloc_stainfo(),
\r
971 //release macid when call rtw_free_stainfo()
\r
974 rtw_hal_set_odm_var(padapter,HAL_ODM_STA_INFO,psta,_TRUE);
\r
976 if(psecuritypriv->dot11AuthAlgrthm==dot11AuthAlgrthm_8021X)
\r
977 psta->ieee8021x_blocked = _TRUE;
\r
979 psta->ieee8021x_blocked = _FALSE;
\r
985 VCS_update(padapter, psta);
\r
986 #ifdef CONFIG_80211N_HT
\r
988 if(phtpriv_sta->ht_option)
\r
990 //check if sta supports rx ampdu
\r
991 phtpriv_sta->ampdu_enable = phtpriv_ap->ampdu_enable;
\r
993 phtpriv_sta->rx_ampdu_min_spacing = (phtpriv_sta->ht_cap.ampdu_params_info&IEEE80211_HT_CAP_AMPDU_DENSITY)>>2;
\r
996 if((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH))
\r
998 psta->bw_mode = CHANNEL_WIDTH_40;
\r
1002 psta->bw_mode = CHANNEL_WIDTH_20;
\r
1005 if(pmlmeext->cur_bwmode < psta->bw_mode)
\r
1007 psta->bw_mode = pmlmeext->cur_bwmode;
\r
1010 phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset;
\r
1013 //check if sta support s Short GI 20M
\r
1014 if((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20))
\r
1016 phtpriv_sta->sgi_20m = _TRUE;
\r
1019 //check if sta support s Short GI 40M
\r
1020 if((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_40))
\r
1022 if(psta->bw_mode == CHANNEL_WIDTH_40) //according to psta->bw_mode
\r
1023 phtpriv_sta->sgi_40m = _TRUE;
\r
1025 phtpriv_sta->sgi_40m = _FALSE;
\r
1028 psta->qos_option = _TRUE;
\r
1030 // B0 Config LDPC Coding Capability
\r
1031 if (TEST_FLAG(phtpriv_ap->ldpc_cap, LDPC_HT_ENABLE_TX) &&
\r
1032 GET_HT_CAP_ELE_LDPC_CAP((u8 *)(&phtpriv_sta->ht_cap)))
\r
1034 SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX));
\r
1035 DBG_871X("Enable HT Tx LDPC for STA(%d)\n",psta->aid);
\r
1038 // B7 B8 B9 Config STBC setting
\r
1039 if (TEST_FLAG(phtpriv_ap->stbc_cap, STBC_HT_ENABLE_TX) &&
\r
1040 GET_HT_CAP_ELE_RX_STBC((u8 *)(&phtpriv_sta->ht_cap)))
\r
1042 SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX) );
\r
1043 DBG_871X("Enable HT Tx STBC for STA(%d)\n",psta->aid);
\r
1046 #ifdef CONFIG_BEAMFORMING
\r
1047 // Config Tx beamforming setting
\r
1048 if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) &&
\r
1049 GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP((u8 *)(&phtpriv_sta->ht_cap)))
\r
1051 SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE);
\r
1054 if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) &&
\r
1055 GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP((u8 *)(&phtpriv_sta->ht_cap)))
\r
1057 SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE);
\r
1060 if (cur_beamform_cap) {
\r
1061 DBG_871X("Client STA(%d) HT Beamforming Cap = 0x%02X\n", psta->aid, cur_beamform_cap);
\r
1063 #endif //CONFIG_BEAMFORMING
\r
1067 phtpriv_sta->ampdu_enable = _FALSE;
\r
1069 phtpriv_sta->sgi_20m = _FALSE;
\r
1070 phtpriv_sta->sgi_40m = _FALSE;
\r
1071 psta->bw_mode = CHANNEL_WIDTH_20;
\r
1072 phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
\r
1075 phtpriv_sta->ldpc_cap = cur_ldpc_cap;
\r
1076 phtpriv_sta->stbc_cap = cur_stbc_cap;
\r
1077 phtpriv_sta->beamform_cap = cur_beamform_cap;
\r
1080 send_delba(padapter, 0, psta->hwaddr);// recipient
\r
1083 send_delba(padapter, 1, psta->hwaddr);// // originator
\r
1084 phtpriv_sta->agg_enable_bitmap = 0x0;//reset
\r
1085 phtpriv_sta->candidate_tid_bitmap = 0x0;//reset
\r
1086 #endif //CONFIG_80211N_HT
\r
1088 #ifdef CONFIG_80211AC_VHT
\r
1089 update_sta_vht_info_apmode(padapter, psta);
\r
1092 update_ldpc_stbc_cap(psta);
\r
1094 //todo: init other variables
\r
1096 _rtw_memset((void*)&psta->sta_stats, 0, sizeof(struct stainfo_stats));
\r
1100 //add_RATid(padapter, psta);//move to ap_sta_info_defer_update()
\r
1103 _enter_critical_bh(&psta->lock, &irqL);
\r
1104 psta->state |= _FW_LINKED;
\r
1105 _exit_critical_bh(&psta->lock, &irqL);
\r
1110 static void update_ap_info(_adapter *padapter, struct sta_info *psta)
\r
1112 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
1113 WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network;
\r
1114 struct security_priv *psecuritypriv = &padapter->securitypriv;
\r
1115 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
\r
1116 #ifdef CONFIG_80211N_HT
\r
1117 struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv;
\r
1118 #endif //CONFIG_80211N_HT
\r
1121 psta->wireless_mode = pmlmeext->cur_wireless_mode;
\r
1123 psta->bssratelen = rtw_get_rateset_len(pnetwork->SupportedRates);
\r
1124 _rtw_memcpy(psta->bssrateset, pnetwork->SupportedRates, psta->bssratelen);
\r
1126 #ifdef CONFIG_80211N_HT
\r
1128 if(phtpriv_ap->ht_option)
\r
1130 //check if sta supports rx ampdu
\r
1131 //phtpriv_ap->ampdu_enable = phtpriv_ap->ampdu_enable;
\r
1133 //check if sta support s Short GI 20M
\r
1134 if((phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_20))
\r
1136 phtpriv_ap->sgi_20m = _TRUE;
\r
1138 //check if sta support s Short GI 40M
\r
1139 if((phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_40))
\r
1141 phtpriv_ap->sgi_40m = _TRUE;
\r
1144 psta->qos_option = _TRUE;
\r
1148 phtpriv_ap->ampdu_enable = _FALSE;
\r
1150 phtpriv_ap->sgi_20m = _FALSE;
\r
1151 phtpriv_ap->sgi_40m = _FALSE;
\r
1154 psta->bw_mode = pmlmeext->cur_bwmode;
\r
1155 phtpriv_ap->ch_offset = pmlmeext->cur_ch_offset;
\r
1157 phtpriv_ap->agg_enable_bitmap = 0x0;//reset
\r
1158 phtpriv_ap->candidate_tid_bitmap = 0x0;//reset
\r
1160 _rtw_memcpy(&psta->htpriv, &pmlmepriv->htpriv, sizeof(struct ht_priv));
\r
1162 #ifdef CONFIG_80211AC_VHT
\r
1163 _rtw_memcpy(&psta->vhtpriv, &pmlmepriv->vhtpriv, sizeof(struct vht_priv));
\r
1164 #endif //CONFIG_80211AC_VHT
\r
1166 #endif //CONFIG_80211N_HT
\r
1169 static void update_hw_ht_param(_adapter *padapter)
\r
1171 unsigned char max_AMPDU_len;
\r
1172 unsigned char min_MPDU_spacing;
\r
1173 struct registry_priv *pregpriv = &padapter->registrypriv;
\r
1174 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
\r
1175 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
1177 DBG_871X("%s\n", __FUNCTION__);
\r
1180 //handle A-MPDU parameter field
\r
1182 AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k
\r
1183 AMPDU_para [4:2]:Min MPDU Start Spacing
\r
1185 max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03;
\r
1187 min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2;
\r
1189 rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing));
\r
1191 rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len));
\r
1194 // Config SM Power Save setting
\r
1196 pmlmeinfo->SM_PS = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & 0x0C) >> 2;
\r
1197 if(pmlmeinfo->SM_PS == WLAN_HT_CAP_SM_PS_STATIC)
\r
1200 //update the MCS rates
\r
1201 for (i = 0; i < 16; i++)
\r
1203 pmlmeinfo->HT_caps.HT_cap_element.MCS_rate[i] &= MCS_rate_1R[i];
\r
1205 DBG_871X("%s(): WLAN_HT_CAP_SM_PS_STATIC\n",__FUNCTION__);
\r
1209 // Config current HT Protection mode.
\r
1211 //pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3;
\r
1215 void start_bss_network(_adapter *padapter, u8 *pbuf)
\r
1218 u8 val8, cur_channel, cur_bwmode, cur_ch_offset;
\r
1222 struct registry_priv *pregpriv = &padapter->registrypriv;
\r
1223 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
1224 struct security_priv* psecuritypriv=&(padapter->securitypriv);
\r
1225 WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network;
\r
1226 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
\r
1227 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
1228 WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network);
\r
1229 struct HT_info_element *pht_info=NULL;
\r
1231 struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
\r
1232 #endif //CONFIG_P2P
\r
1233 u8 cbw40_enable=0;
\r
1234 u8 change_band = _FALSE;
\r
1236 //DBG_871X("%s\n", __FUNCTION__);
\r
1238 bcn_interval = (u16)pnetwork->Configuration.BeaconPeriod;
\r
1239 cur_channel = pnetwork->Configuration.DSConfig;
\r
1240 cur_bwmode = CHANNEL_WIDTH_20;
\r
1241 cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
\r
1244 //check if there is wps ie,
\r
1245 //if there is wpsie in beacon, the hostapd will update beacon twice when stating hostapd,
\r
1246 //and at first time the security ie ( RSN/WPA IE) will not include in beacon.
\r
1247 if(NULL == rtw_get_wps_ie(pnetwork->IEs+_FIXED_IE_LENGTH_, pnetwork->IELength-_FIXED_IE_LENGTH_, NULL, NULL))
\r
1249 pmlmeext->bstart_bss = _TRUE;
\r
1252 //todo: update wmm, ht cap
\r
1253 //pmlmeinfo->WMM_enable;
\r
1254 //pmlmeinfo->HT_enable;
\r
1255 if(pmlmepriv->qospriv.qos_option)
\r
1256 pmlmeinfo->WMM_enable = _TRUE;
\r
1257 #ifdef CONFIG_80211N_HT
\r
1258 if(pmlmepriv->htpriv.ht_option)
\r
1260 pmlmeinfo->WMM_enable = _TRUE;
\r
1261 pmlmeinfo->HT_enable = _TRUE;
\r
1262 //pmlmeinfo->HT_info_enable = _TRUE;
\r
1263 //pmlmeinfo->HT_caps_enable = _TRUE;
\r
1265 update_hw_ht_param(padapter);
\r
1267 #endif //#CONFIG_80211N_HT
\r
1269 #ifdef CONFIG_80211AC_VHT
\r
1270 if(pmlmepriv->vhtpriv.vht_option) {
\r
1271 pmlmeinfo->VHT_enable = _TRUE;
\r
1272 update_hw_vht_param(padapter);
\r
1274 #endif //CONFIG_80211AC_VHT
\r
1276 if(pmlmepriv->cur_network.join_res != _TRUE) //setting only at first time
\r
1278 //WEP Key will be set before this function, do not clear CAM.
\r
1279 if ((psecuritypriv->dot11PrivacyAlgrthm != _WEP40_) && (psecuritypriv->dot11PrivacyAlgrthm != _WEP104_))
\r
1280 flush_all_cam_entry(padapter); //clear CAM
\r
1283 //set MSR to AP_Mode
\r
1284 Set_MSR(padapter, _HW_STATE_AP_);
\r
1287 rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pnetwork->MacAddress);
\r
1289 //Set EDCA param reg
\r
1290 #ifdef CONFIG_CONCURRENT_MODE
\r
1291 acparm = 0x005ea42b;
\r
1293 acparm = 0x002F3217; // VO
\r
1295 rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm));
\r
1296 acparm = 0x005E4317; // VI
\r
1297 rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm));
\r
1298 //acparm = 0x00105320; // BE
\r
1299 acparm = 0x005ea42b;
\r
1300 rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm));
\r
1301 acparm = 0x0000A444; // BK
\r
1302 rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm));
\r
1305 val8 = (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)? 0xcc: 0xcf;
\r
1306 rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8));
\r
1308 //Beacon Control related register
\r
1309 rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&bcn_interval));
\r
1311 rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK, NULL);
\r
1314 if(pmlmepriv->cur_network.join_res != _TRUE) //setting only at first time
\r
1316 //u32 initialgain;
\r
1318 //initialgain = 0x1e;
\r
1321 //disable dynamic functions, such as high power, DIG
\r
1322 //Save_DM_Func_Flag(padapter);
\r
1323 //Switch_DM_Func(padapter, DYNAMIC_FUNC_DISABLE, _FALSE);
\r
1325 //turn on all dynamic functions
\r
1326 /* Switch_DM_Func(padapter, DYNAMIC_ALL_FUNC_ENABLE, _TRUE);*/
\r
1328 //rtw_hal_set_hwreg(padapter, HW_VAR_INITIAL_GAIN, (u8 *)(&initialgain));
\r
1332 #ifdef CONFIG_80211N_HT
\r
1333 //set channel, bwmode
\r
1334 p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs)));
\r
1337 pht_info = (struct HT_info_element *)(p+2);
\r
1339 if (cur_channel > 14) {
\r
1340 if ((pregpriv->bw_mode & 0xf0) > 0)
\r
1343 if ((pregpriv->bw_mode & 0x0f) > 0)
\r
1347 if ((cbw40_enable) && (pht_info->infos[0] & BIT(2)))
\r
1349 //switch to the 40M Hz mode
\r
1350 //pmlmeext->cur_bwmode = CHANNEL_WIDTH_40;
\r
1351 cur_bwmode = CHANNEL_WIDTH_40;
\r
1352 switch (pht_info->infos[0] & 0x3)
\r
1355 //pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER;
\r
1356 cur_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER;
\r
1360 //pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER;
\r
1361 cur_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER;
\r
1365 //pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
\r
1366 cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
\r
1373 #endif //CONFIG_80211N_HT
\r
1375 #ifdef CONFIG_80211AC_VHT
\r
1376 p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_VHTOperation, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs)));
\r
1379 if(GET_VHT_OPERATION_ELE_CHL_WIDTH(p+2) >= 1) {
\r
1380 cur_bwmode = CHANNEL_WIDTH_80;
\r
1385 #ifdef CONFIG_CONCURRENT_MODE
\r
1386 //TODO: need to judge the phy parameters on concurrent mode for single phy
\r
1387 concurrent_set_ap_chbw(padapter, cur_channel, cur_ch_offset, cur_bwmode);
\r
1388 #else //!CONFIG_CONCURRENT_MODE
\r
1389 set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode);
\r
1390 DBG_871X("CH=%d, BW=%d, offset=%d\n", cur_channel, cur_bwmode, cur_ch_offset);
\r
1391 pmlmeext->cur_channel = cur_channel;
\r
1392 pmlmeext->cur_bwmode = cur_bwmode;
\r
1393 pmlmeext->cur_ch_offset = cur_ch_offset;
\r
1394 #endif //!CONFIG_CONCURRENT_MODE
\r
1396 pmlmeext->cur_wireless_mode = pmlmepriv->cur_network.network_type;
\r
1398 //let pnetwork_mlmeext == pnetwork_mlme.
\r
1399 _rtw_memcpy(pnetwork_mlmeext, pnetwork, pnetwork->Length);
\r
1401 //update cur_wireless_mode
\r
1402 update_wireless_mode(padapter);
\r
1404 //update RRSR after set channel and bandwidth
\r
1405 UpdateBrateTbl(padapter, pnetwork->SupportedRates);
\r
1406 rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, pnetwork->SupportedRates);
\r
1408 //udpate capability after cur_wireless_mode updated
\r
1409 update_capinfo(padapter, rtw_get_capability((WLAN_BSSID_EX *)pnetwork));
\r
1413 _rtw_memcpy(pwdinfo->p2p_group_ssid, pnetwork->Ssid.Ssid, pnetwork->Ssid.SsidLength);
\r
1414 pwdinfo->p2p_group_ssid_len = pnetwork->Ssid.SsidLength;
\r
1415 #endif //CONFIG_P2P
\r
1417 if(_TRUE == pmlmeext->bstart_bss)
\r
1419 update_beacon(padapter, _TIM_IE_, NULL, _TRUE);
\r
1421 #ifndef CONFIG_INTERRUPT_BASED_TXBCN //other case will tx beacon when bcn interrupt coming in.
\r
1422 #if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)
\r
1423 //issue beacon frame
\r
1424 if(send_beacon(padapter)==_FAIL)
\r
1426 DBG_871X("issue_beacon, fail!\n");
\r
1429 #endif //!CONFIG_INTERRUPT_BASED_TXBCN
\r
1434 //update bc/mc sta_info
\r
1435 update_bmc_sta(padapter);
\r
1437 //pmlmeext->bstart_bss = _TRUE;
\r
1441 int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len)
\r
1445 u8 *pHT_caps_ie=NULL;
\r
1446 u8 *pHT_info_ie=NULL;
\r
1447 struct sta_info *psta = NULL;
\r
1448 u16 cap, ht_cap=_FALSE;
\r
1450 int group_cipher, pairwise_cipher;
\r
1451 u8 channel, network_type, supportRate[NDIS_802_11_LENGTH_RATES_EX];
\r
1452 int supportRateNum = 0;
\r
1453 u8 OUI1[] = {0x00, 0x50, 0xf2,0x01};
\r
1454 u8 wps_oui[4]={0x0,0x50,0xf2,0x04};
\r
1455 u8 WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01};
\r
1456 struct registry_priv *pregistrypriv = &padapter->registrypriv;
\r
1457 struct security_priv *psecuritypriv = &padapter->securitypriv;
\r
1458 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
1459 WLAN_BSSID_EX *pbss_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network;
\r
1460 struct sta_priv *pstapriv = &padapter->stapriv;
\r
1461 u8 *ie = pbss_network->IEs;
\r
1462 u8 vht_cap=_FALSE;
\r
1465 /* Supported rates */
\r
1467 /* WLAN_EID_COUNTRY */
\r
1468 /* ERP Information element */
\r
1469 /* Extended supported rates */
\r
1471 /* Wi-Fi Wireless Multimedia Extensions */
\r
1472 /* ht_capab, ht_oper */
\r
1475 DBG_871X("%s, len=%d\n", __FUNCTION__, len);
\r
1477 if(check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
\r
1484 pbss_network->IELength = len;
\r
1486 _rtw_memset(ie, 0, MAX_IE_SZ);
\r
1488 _rtw_memcpy(ie, pbuf, pbss_network->IELength);
\r
1491 if(pbss_network->InfrastructureMode!=Ndis802_11APMode)
\r
1494 pbss_network->Rssi = 0;
\r
1496 _rtw_memcpy(pbss_network->MacAddress, adapter_mac_addr(padapter), ETH_ALEN);
\r
1499 p = rtw_get_beacon_interval_from_ie(ie);//ie + 8; // 8: TimeStamp, 2: Beacon Interval 2:Capability
\r
1500 //pbss_network->Configuration.BeaconPeriod = le16_to_cpu(*(unsigned short*)p);
\r
1501 pbss_network->Configuration.BeaconPeriod = RTW_GET_LE16(p);
\r
1504 //cap = *(unsigned short *)rtw_get_capability_from_ie(ie);
\r
1505 //cap = le16_to_cpu(cap);
\r
1506 cap = RTW_GET_LE16(ie);
\r
1509 p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SSID_IE_, &ie_len, (pbss_network->IELength -_BEACON_IE_OFFSET_));
\r
1512 _rtw_memset(&pbss_network->Ssid, 0, sizeof(NDIS_802_11_SSID));
\r
1513 _rtw_memcpy(pbss_network->Ssid.Ssid, (p + 2), ie_len);
\r
1514 pbss_network->Ssid.SsidLength = ie_len;
\r
1519 pbss_network->Configuration.Length = 0;
\r
1520 p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _DSSET_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_));
\r
1522 channel = *(p + 2);
\r
1524 pbss_network->Configuration.DSConfig = channel;
\r
1527 _rtw_memset(supportRate, 0, NDIS_802_11_LENGTH_RATES_EX);
\r
1528 // get supported rates
\r
1529 p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_));
\r
1532 _rtw_memcpy(supportRate, p+2, ie_len);
\r
1533 supportRateNum = ie_len;
\r
1536 //get ext_supported rates
\r
1537 p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ie_len, pbss_network->IELength - _BEACON_IE_OFFSET_);
\r
1540 _rtw_memcpy(supportRate+supportRateNum, p+2, ie_len);
\r
1541 supportRateNum += ie_len;
\r
1545 network_type = rtw_check_network_type(supportRate, supportRateNum, channel);
\r
1547 rtw_set_supported_rate(pbss_network->SupportedRates, network_type);
\r
1551 p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_));
\r
1554 ERP_IE_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)p);
\r
1557 //update privacy/security
\r
1559 pbss_network->Privacy = 1;
\r
1561 pbss_network->Privacy = 0;
\r
1563 psecuritypriv->wpa_psk = 0;
\r
1566 group_cipher = 0; pairwise_cipher = 0;
\r
1567 psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_;
\r
1568 psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_;
\r
1569 p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_));
\r
1572 if(rtw_parse_wpa2_ie(p, ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS)
\r
1574 psecuritypriv->dot11AuthAlgrthm= dot11AuthAlgrthm_8021X;
\r
1576 psecuritypriv->dot8021xalg = 1;//psk, todo:802.1x
\r
1577 psecuritypriv->wpa_psk |= BIT(1);
\r
1579 psecuritypriv->wpa2_group_cipher = group_cipher;
\r
1580 psecuritypriv->wpa2_pairwise_cipher = pairwise_cipher;
\r
1582 switch(group_cipher)
\r
1584 case WPA_CIPHER_NONE:
\r
1585 psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_;
\r
1587 case WPA_CIPHER_WEP40:
\r
1588 psecuritypriv->wpa2_group_cipher = _WEP40_;
\r
1590 case WPA_CIPHER_TKIP:
\r
1591 psecuritypriv->wpa2_group_cipher = _TKIP_;
\r
1593 case WPA_CIPHER_CCMP:
\r
1594 psecuritypriv->wpa2_group_cipher = _AES_;
\r
1596 case WPA_CIPHER_WEP104:
\r
1597 psecuritypriv->wpa2_group_cipher = _WEP104_;
\r
1601 switch(pairwise_cipher)
\r
1603 case WPA_CIPHER_NONE:
\r
1604 psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_;
\r
1606 case WPA_CIPHER_WEP40:
\r
1607 psecuritypriv->wpa2_pairwise_cipher = _WEP40_;
\r
1609 case WPA_CIPHER_TKIP:
\r
1610 psecuritypriv->wpa2_pairwise_cipher = _TKIP_;
\r
1612 case WPA_CIPHER_CCMP:
\r
1613 psecuritypriv->wpa2_pairwise_cipher = _AES_;
\r
1615 case WPA_CIPHER_WEP104:
\r
1616 psecuritypriv->wpa2_pairwise_cipher = _WEP104_;
\r
1626 group_cipher = 0; pairwise_cipher = 0;
\r
1627 psecuritypriv->wpa_group_cipher = _NO_PRIVACY_;
\r
1628 psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_;
\r
1629 for (p = ie + _BEACON_IE_OFFSET_; ;p += (ie_len + 2))
\r
1631 p = rtw_get_ie(p, _SSN_IE_1_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2)));
\r
1632 if ((p) && (_rtw_memcmp(p+2, OUI1, 4)))
\r
1634 if(rtw_parse_wpa_ie(p, ie_len+2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS)
\r
1636 psecuritypriv->dot11AuthAlgrthm= dot11AuthAlgrthm_8021X;
\r
1638 psecuritypriv->dot8021xalg = 1;//psk, todo:802.1x
\r
1640 psecuritypriv->wpa_psk |= BIT(0);
\r
1642 psecuritypriv->wpa_group_cipher = group_cipher;
\r
1643 psecuritypriv->wpa_pairwise_cipher = pairwise_cipher;
\r
1646 switch(group_cipher)
\r
1648 case WPA_CIPHER_NONE:
\r
1649 psecuritypriv->wpa_group_cipher = _NO_PRIVACY_;
\r
1651 case WPA_CIPHER_WEP40:
\r
1652 psecuritypriv->wpa_group_cipher = _WEP40_;
\r
1654 case WPA_CIPHER_TKIP:
\r
1655 psecuritypriv->wpa_group_cipher = _TKIP_;
\r
1657 case WPA_CIPHER_CCMP:
\r
1658 psecuritypriv->wpa_group_cipher = _AES_;
\r
1660 case WPA_CIPHER_WEP104:
\r
1661 psecuritypriv->wpa_group_cipher = _WEP104_;
\r
1665 switch(pairwise_cipher)
\r
1667 case WPA_CIPHER_NONE:
\r
1668 psecuritypriv->wpa_pairwise_cipher = _NO_PRIVACY_;
\r
1670 case WPA_CIPHER_WEP40:
\r
1671 psecuritypriv->wpa_pairwise_cipher = _WEP40_;
\r
1673 case WPA_CIPHER_TKIP:
\r
1674 psecuritypriv->wpa_pairwise_cipher = _TKIP_;
\r
1676 case WPA_CIPHER_CCMP:
\r
1677 psecuritypriv->wpa_pairwise_cipher = _AES_;
\r
1679 case WPA_CIPHER_WEP104:
\r
1680 psecuritypriv->wpa_pairwise_cipher = _WEP104_;
\r
1690 if ((p == NULL) || (ie_len == 0))
\r
1699 pmlmepriv->qospriv.qos_option = 0;
\r
1700 if(pregistrypriv->wmm_enable)
\r
1702 for (p = ie + _BEACON_IE_OFFSET_; ;p += (ie_len + 2))
\r
1704 p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2)));
\r
1705 if((p) && _rtw_memcmp(p+2, WMM_PARA_IE, 6))
\r
1707 pmlmepriv->qospriv.qos_option = 1;
\r
1709 *(p+8) |= BIT(7);//QoS Info, support U-APSD
\r
1711 /* disable all ACM bits since the WMM admission control is not supported */
\r
1712 *(p + 10) &= ~BIT(4); /* BE */
\r
1713 *(p + 14) &= ~BIT(4); /* BK */
\r
1714 *(p + 18) &= ~BIT(4); /* VI */
\r
1715 *(p + 22) &= ~BIT(4); /* VO */
\r
1720 if ((p == NULL) || (ie_len == 0))
\r
1726 #ifdef CONFIG_80211N_HT
\r
1727 //parsing HT_CAP_IE
\r
1728 p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_));
\r
1732 HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor=MAX_AMPDU_FACTOR_64K;
\r
1733 struct rtw_ieee80211_ht_cap *pht_cap = (struct rtw_ieee80211_ht_cap *)(p+2);
\r
1736 DBG_871X(FUNC_ADPT_FMT" HT_CAP_IE from upper layer:\n", FUNC_ADPT_ARG(padapter));
\r
1737 dump_ht_cap_ie_content(RTW_DBGDUMP, p+2, ie_len);
\r
1743 network_type |= WIRELESS_11_24N;
\r
1745 rtw_ht_use_default_setting(padapter);
\r
1747 /* Update HT Capabilities Info field */
\r
1748 if (pmlmepriv->htpriv.sgi_20m == _FALSE)
\r
1749 pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_20);
\r
1751 if (pmlmepriv->htpriv.sgi_40m == _FALSE)
\r
1752 pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_40);
\r
1754 if (!TEST_FLAG(pmlmepriv->htpriv.ldpc_cap, LDPC_HT_ENABLE_RX))
\r
1756 pht_cap->cap_info &= ~(IEEE80211_HT_CAP_LDPC_CODING);
\r
1759 if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_TX))
\r
1761 pht_cap->cap_info &= ~(IEEE80211_HT_CAP_TX_STBC);
\r
1764 if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_RX))
\r
1766 pht_cap->cap_info &= ~(IEEE80211_HT_CAP_RX_STBC_3R);
\r
1769 /* Update A-MPDU Parameters field */
\r
1770 pht_cap->ampdu_params_info &= ~(IEEE80211_HT_CAP_AMPDU_FACTOR|IEEE80211_HT_CAP_AMPDU_DENSITY);
\r
1772 if((psecuritypriv->wpa_pairwise_cipher & WPA_CIPHER_CCMP) ||
\r
1773 (psecuritypriv->wpa2_pairwise_cipher & WPA_CIPHER_CCMP))
\r
1775 pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&(0x07<<2));
\r
1779 pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY&0x00);
\r
1782 rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor);
\r
1783 pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_FACTOR & max_rx_ampdu_factor); //set Max Rx AMPDU size to 64K
\r
1785 /* Update Supported MCS Set field */
\r
1789 rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type));
\r
1791 /* RX MCS Bitmask */
\r
1796 set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_1R);
\r
1799 set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_2R);
\r
1802 set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_3R);
\r
1805 DBG_871X("[warning] rf_type %d is not expected\n", rf_type);
\r
1807 for (i = 0; i < 10; i++)
\r
1808 *(HT_CAP_ELE_RX_MCS_MAP(pht_cap)+i) &= padapter->mlmeextpriv.default_supported_mcs_set[i];
\r
1811 #ifdef CONFIG_BEAMFORMING
\r
1812 // Use registry value to enable HT Beamforming.
\r
1813 // ToDo: use configure file to set these capability.
\r
1814 pht_cap->tx_BF_cap_info = 0;
\r
1817 if(TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE))
\r
1819 // Transmit NDP Capable
\r
1820 SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(pht_cap, 1);
\r
1821 // Explicit Compressed Steering Capable
\r
1822 SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pht_cap, 1);
\r
1823 // Compressed Steering Number Antennas
\r
1824 SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pht_cap, 1);
\r
1828 if(TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE))
\r
1830 // Receive NDP Capable
\r
1831 SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(pht_cap, 1);
\r
1832 // Explicit Compressed Beamforming Feedback Capable
\r
1833 SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pht_cap, 2);
\r
1835 #endif //CONFIG_BEAMFORMING
\r
1837 _rtw_memcpy(&pmlmepriv->htpriv.ht_cap, p+2, ie_len);
\r
1840 DBG_871X(FUNC_ADPT_FMT" HT_CAP_IE driver masked:\n", FUNC_ADPT_ARG(padapter));
\r
1841 dump_ht_cap_ie_content(RTW_DBGDUMP, p+2, ie_len);
\r
1845 //parsing HT_INFO_IE
\r
1846 p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_));
\r
1851 #endif //CONFIG_80211N_HT
\r
1852 switch(network_type)
\r
1854 case WIRELESS_11B:
\r
1855 pbss_network->NetworkTypeInUse = Ndis802_11DS;
\r
1857 case WIRELESS_11G:
\r
1858 case WIRELESS_11BG:
\r
1859 case WIRELESS_11G_24N:
\r
1860 case WIRELESS_11BG_24N:
\r
1861 pbss_network->NetworkTypeInUse = Ndis802_11OFDM24;
\r
1863 case WIRELESS_11A:
\r
1864 pbss_network->NetworkTypeInUse = Ndis802_11OFDM5;
\r
1867 pbss_network->NetworkTypeInUse = Ndis802_11OFDM24;
\r
1871 pmlmepriv->cur_network.network_type = network_type;
\r
1873 #ifdef CONFIG_80211N_HT
\r
1874 pmlmepriv->htpriv.ht_option = _FALSE;
\r
1876 if( (psecuritypriv->wpa2_pairwise_cipher&WPA_CIPHER_TKIP) ||
\r
1877 (psecuritypriv->wpa_pairwise_cipher&WPA_CIPHER_TKIP))
\r
1880 //ht_cap = _FALSE;
\r
1884 if(pregistrypriv->ht_enable && ht_cap==_TRUE)
\r
1886 pmlmepriv->htpriv.ht_option = _TRUE;
\r
1887 pmlmepriv->qospriv.qos_option = 1;
\r
1889 if(pregistrypriv->ampdu_enable==1)
\r
1891 pmlmepriv->htpriv.ampdu_enable = _TRUE;
\r
1894 HT_caps_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_caps_ie);
\r
1896 HT_info_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)pHT_info_ie);
\r
1900 #ifdef CONFIG_80211AC_VHT
\r
1902 //Parsing VHT CAP IE
\r
1903 p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTCapability, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_));
\r
1908 //Parsing VHT OPERATION IE
\r
1911 pmlmepriv->vhtpriv.vht_option = _FALSE;
\r
1912 // if channel in 5G band, then add vht ie .
\r
1913 if ((pbss_network->Configuration.DSConfig > 14) &&
\r
1914 (pmlmepriv->htpriv.ht_option == _TRUE) &&
\r
1915 (pregistrypriv->vht_enable))
\r
1917 if(vht_cap == _TRUE)
\r
1919 pmlmepriv->vhtpriv.vht_option = _TRUE;
\r
1921 else if(pregistrypriv->vht_enable == 2) // auto enabled
\r
1923 u8 cap_len, operation_len;
\r
1925 rtw_vht_use_default_setting(padapter);
\r
1927 // VHT Capabilities element
\r
1928 cap_len = rtw_build_vht_cap_ie(padapter, pbss_network->IEs + pbss_network->IELength);
\r
1929 pbss_network->IELength += cap_len;
\r
1931 // VHT Operation element
\r
1932 operation_len = rtw_build_vht_operation_ie(padapter, pbss_network->IEs + pbss_network->IELength, pbss_network->Configuration.DSConfig);
\r
1933 pbss_network->IELength += operation_len;
\r
1935 pmlmepriv->vhtpriv.vht_option = _TRUE;
\r
1938 #endif //CONFIG_80211AC_VHT
\r
1940 pbss_network->Length = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX *)pbss_network);
\r
1942 //issue beacon to start bss network
\r
1943 //start_bss_network(padapter, (u8*)pbss_network);
\r
1944 rtw_startbss_cmd(padapter, RTW_CMDF_WAIT_ACK);
\r
1947 //alloc sta_info for ap itself
\r
1948 psta = rtw_get_stainfo(&padapter->stapriv, pbss_network->MacAddress);
\r
1951 psta = rtw_alloc_stainfo(&padapter->stapriv, pbss_network->MacAddress);
\r
1952 if (psta == NULL)
\r
1958 // update AP's sta info
\r
1959 update_ap_info(padapter, psta);
\r
1961 psta->state |= WIFI_AP_STATE; //Aries, add,fix bug of flush_cam_entry at STOP AP mode , 0724
\r
1962 rtw_indicate_connect( padapter);
\r
1964 pmlmepriv->cur_network.join_res = _TRUE;//for check if already set beacon
\r
1966 //update bc/mc sta_info
\r
1967 //update_bmc_sta(padapter);
\r
1973 void rtw_set_macaddr_acl(_adapter *padapter, int mode)
\r
1975 struct sta_priv *pstapriv = &padapter->stapriv;
\r
1976 struct wlan_acl_pool *pacl_list = &pstapriv->acl_list;
\r
1978 DBG_871X("%s, mode=%d\n", __func__, mode);
\r
1980 pacl_list->mode = mode;
\r
1983 int rtw_acl_add_sta(_adapter *padapter, u8 *addr)
\r
1986 _list *plist, *phead;
\r
1987 u8 added = _FALSE;
\r
1989 struct rtw_wlan_acl_node *paclnode;
\r
1990 struct sta_priv *pstapriv = &padapter->stapriv;
\r
1991 struct wlan_acl_pool *pacl_list = &pstapriv->acl_list;
\r
1992 _queue *pacl_node_q =&pacl_list->acl_node_q;
\r
1994 DBG_871X("%s(acl_num=%d)=" MAC_FMT "\n", __func__, pacl_list->num, MAC_ARG(addr));
\r
1996 if((NUM_ACL-1) < pacl_list->num)
\r
2000 _enter_critical_bh(&(pacl_node_q->lock), &irqL);
\r
2002 phead = get_list_head(pacl_node_q);
\r
2003 plist = get_next(phead);
\r
2005 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
\r
2007 paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list);
\r
2008 plist = get_next(plist);
\r
2010 if(_rtw_memcmp(paclnode->addr, addr, ETH_ALEN))
\r
2012 if(paclnode->valid == _TRUE)
\r
2015 DBG_871X("%s, sta has been added\n", __func__);
\r
2021 _exit_critical_bh(&(pacl_node_q->lock), &irqL);
\r
2024 if(added == _TRUE)
\r
2028 _enter_critical_bh(&(pacl_node_q->lock), &irqL);
\r
2030 for(i=0; i< NUM_ACL; i++)
\r
2032 paclnode = &pacl_list->aclnode[i];
\r
2034 if(paclnode->valid == _FALSE)
\r
2036 _rtw_init_listhead(&paclnode->list);
\r
2038 _rtw_memcpy(paclnode->addr, addr, ETH_ALEN);
\r
2040 paclnode->valid = _TRUE;
\r
2042 rtw_list_insert_tail(&paclnode->list, get_list_head(pacl_node_q));
\r
2050 DBG_871X("%s, acl_num=%d\n", __func__, pacl_list->num);
\r
2052 _exit_critical_bh(&(pacl_node_q->lock), &irqL);
\r
2057 int rtw_acl_remove_sta(_adapter *padapter, u8 *addr)
\r
2060 _list *plist, *phead;
\r
2062 struct rtw_wlan_acl_node *paclnode;
\r
2063 struct sta_priv *pstapriv = &padapter->stapriv;
\r
2064 struct wlan_acl_pool *pacl_list = &pstapriv->acl_list;
\r
2065 _queue *pacl_node_q =&pacl_list->acl_node_q;
\r
2066 u8 baddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; //Baddr is used for clearing acl_list
\r
2068 DBG_871X("%s(acl_num=%d)=" MAC_FMT "\n", __func__, pacl_list->num, MAC_ARG(addr));
\r
2070 _enter_critical_bh(&(pacl_node_q->lock), &irqL);
\r
2072 phead = get_list_head(pacl_node_q);
\r
2073 plist = get_next(phead);
\r
2075 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
\r
2077 paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list);
\r
2078 plist = get_next(plist);
\r
2080 if(_rtw_memcmp(paclnode->addr, addr, ETH_ALEN) || _rtw_memcmp(baddr, addr, ETH_ALEN))
\r
2082 if(paclnode->valid == _TRUE)
\r
2084 paclnode->valid = _FALSE;
\r
2086 rtw_list_delete(&paclnode->list);
\r
2093 _exit_critical_bh(&(pacl_node_q->lock), &irqL);
\r
2095 DBG_871X("%s, acl_num=%d\n", __func__, pacl_list->num);
\r
2101 u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta)
\r
2103 struct cmd_obj* ph2c;
\r
2104 struct set_stakey_parm *psetstakey_para;
\r
2105 struct cmd_priv *pcmdpriv=&padapter->cmdpriv;
\r
2108 ph2c = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj));
\r
2109 if ( ph2c == NULL){
\r
2114 psetstakey_para = (struct set_stakey_parm*)rtw_zmalloc(sizeof(struct set_stakey_parm));
\r
2115 if(psetstakey_para==NULL){
\r
2116 rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj));
\r
2121 init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_);
\r
2124 psetstakey_para->algorithm = (u8)psta->dot118021XPrivacy;
\r
2126 _rtw_memcpy(psetstakey_para->addr, psta->hwaddr, ETH_ALEN);
\r
2128 _rtw_memcpy(psetstakey_para->key, &psta->dot118021x_UncstKey, 16);
\r
2131 res = rtw_enqueue_cmd(pcmdpriv, ph2c);
\r
2139 static int rtw_ap_set_key(_adapter *padapter, u8 *key, u8 alg, int keyid, u8 set_tx)
\r
2142 struct cmd_obj* pcmd;
\r
2143 struct setkey_parm *psetkeyparm;
\r
2144 struct cmd_priv *pcmdpriv=&(padapter->cmdpriv);
\r
2147 //DBG_871X("%s\n", __FUNCTION__);
\r
2149 pcmd = (struct cmd_obj*)rtw_zmalloc(sizeof(struct cmd_obj));
\r
2154 psetkeyparm=(struct setkey_parm*)rtw_zmalloc(sizeof(struct setkey_parm));
\r
2155 if(psetkeyparm==NULL){
\r
2156 rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj));
\r
2161 _rtw_memset(psetkeyparm, 0, sizeof(struct setkey_parm));
\r
2163 psetkeyparm->keyid=(u8)keyid;
\r
2164 if (is_wep_enc(alg))
\r
2165 padapter->securitypriv.key_mask |= BIT(psetkeyparm->keyid);
\r
2167 psetkeyparm->algorithm = alg;
\r
2169 psetkeyparm->set_tx = set_tx;
\r
2180 case _TKIP_WTMIC_:
\r
2186 _rtw_memcpy(&(psetkeyparm->key[0]), key, keylen);
\r
2188 pcmd->cmdcode = _SetKey_CMD_;
\r
2189 pcmd->parmbuf = (u8 *)psetkeyparm;
\r
2190 pcmd->cmdsz = (sizeof(struct setkey_parm));
\r
2195 _rtw_init_listhead(&pcmd->list);
\r
2197 res = rtw_enqueue_cmd(pcmdpriv, pcmd);
\r
2204 int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid)
\r
2206 DBG_871X("%s\n", __FUNCTION__);
\r
2208 return rtw_ap_set_key(padapter, key, alg, keyid, 1);
\r
2211 int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx)
\r
2224 alg =_NO_PRIVACY_;
\r
2227 DBG_871X("%s\n", __FUNCTION__);
\r
2229 return rtw_ap_set_key(padapter, key, alg, keyid, set_tx);
\r
2232 #ifdef CONFIG_NATIVEAP_MLME
\r
2234 static void update_bcn_fixed_ie(_adapter *padapter)
\r
2236 DBG_871X("%s\n", __FUNCTION__);
\r
2240 static void update_bcn_erpinfo_ie(_adapter *padapter)
\r
2242 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
2243 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
\r
2244 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
2245 WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network);
\r
2246 unsigned char *p, *ie = pnetwork->IEs;
\r
2249 DBG_871X("%s, ERP_enable=%d\n", __FUNCTION__, pmlmeinfo->ERP_enable);
\r
2251 if(!pmlmeinfo->ERP_enable)
\r
2255 p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &len, (pnetwork->IELength - _BEACON_IE_OFFSET_));
\r
2258 PNDIS_802_11_VARIABLE_IEs pIE = (PNDIS_802_11_VARIABLE_IEs)p;
\r
2260 if (pmlmepriv->num_sta_non_erp == 1)
\r
2261 pIE->data[0] |= RTW_ERP_INFO_NON_ERP_PRESENT|RTW_ERP_INFO_USE_PROTECTION;
\r
2263 pIE->data[0] &= ~(RTW_ERP_INFO_NON_ERP_PRESENT|RTW_ERP_INFO_USE_PROTECTION);
\r
2265 if(pmlmepriv->num_sta_no_short_preamble > 0)
\r
2266 pIE->data[0] |= RTW_ERP_INFO_BARKER_PREAMBLE_MODE;
\r
2268 pIE->data[0] &= ~(RTW_ERP_INFO_BARKER_PREAMBLE_MODE);
\r
2270 ERP_IE_handler(padapter, pIE);
\r
2275 static void update_bcn_htcap_ie(_adapter *padapter)
\r
2277 DBG_871X("%s\n", __FUNCTION__);
\r
2281 static void update_bcn_htinfo_ie(_adapter *padapter)
\r
2283 DBG_871X("%s\n", __FUNCTION__);
\r
2287 static void update_bcn_rsn_ie(_adapter *padapter)
\r
2289 DBG_871X("%s\n", __FUNCTION__);
\r
2293 static void update_bcn_wpa_ie(_adapter *padapter)
\r
2295 DBG_871X("%s\n", __FUNCTION__);
\r
2299 static void update_bcn_wmm_ie(_adapter *padapter)
\r
2301 DBG_871X("%s\n", __FUNCTION__);
\r
2305 static void update_bcn_wps_ie(_adapter *padapter)
\r
2307 u8 *pwps_ie=NULL, *pwps_ie_src, *premainder_ie, *pbackup_remainder_ie=NULL;
\r
2308 uint wps_ielen=0, wps_offset, remainder_ielen;
\r
2309 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
2310 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
\r
2311 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
2312 WLAN_BSSID_EX *pnetwork = &(pmlmeinfo->network);
\r
2313 unsigned char *ie = pnetwork->IEs;
\r
2314 u32 ielen = pnetwork->IELength;
\r
2317 DBG_871X("%s\n", __FUNCTION__);
\r
2319 pwps_ie = rtw_get_wps_ie(ie+_FIXED_IE_LENGTH_, ielen-_FIXED_IE_LENGTH_, NULL, &wps_ielen);
\r
2321 if(pwps_ie==NULL || wps_ielen==0)
\r
2324 pwps_ie_src = pmlmepriv->wps_beacon_ie;
\r
2325 if(pwps_ie_src == NULL)
\r
2328 wps_offset = (uint)(pwps_ie-ie);
\r
2330 premainder_ie = pwps_ie + wps_ielen;
\r
2332 remainder_ielen = ielen - wps_offset - wps_ielen;
\r
2334 if(remainder_ielen>0)
\r
2336 pbackup_remainder_ie = rtw_malloc(remainder_ielen);
\r
2337 if(pbackup_remainder_ie)
\r
2338 _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen);
\r
2341 wps_ielen = (uint)pwps_ie_src[1];//to get ie data len
\r
2342 if((wps_offset+wps_ielen+2+remainder_ielen)<=MAX_IE_SZ)
\r
2344 _rtw_memcpy(pwps_ie, pwps_ie_src, wps_ielen+2);
\r
2345 pwps_ie += (wps_ielen+2);
\r
2347 if(pbackup_remainder_ie)
\r
2348 _rtw_memcpy(pwps_ie, pbackup_remainder_ie, remainder_ielen);
\r
2351 pnetwork->IELength = wps_offset + (wps_ielen+2) + remainder_ielen;
\r
2354 if(pbackup_remainder_ie)
\r
2355 rtw_mfree(pbackup_remainder_ie, remainder_ielen);
\r
2357 // deal with the case without set_tx_beacon_cmd() in update_beacon()
\r
2358 #if defined( CONFIG_INTERRUPT_BASED_TXBCN ) || defined( CONFIG_PCI_HCI )
\r
2359 if( (pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)
\r
2362 rtw_get_wps_attr_content(pwps_ie_src, wps_ielen, WPS_ATTR_SELECTED_REGISTRAR, (u8*)(&sr), NULL);
\r
2365 set_fwstate(pmlmepriv, WIFI_UNDER_WPS);
\r
2366 DBG_871X("%s, set WIFI_UNDER_WPS\n", __func__);
\r
2372 static void update_bcn_p2p_ie(_adapter *padapter)
\r
2377 static void update_bcn_vendor_spec_ie(_adapter *padapter, u8*oui)
\r
2379 DBG_871X("%s\n", __FUNCTION__);
\r
2381 if(_rtw_memcmp(RTW_WPA_OUI, oui, 4))
\r
2383 update_bcn_wpa_ie(padapter);
\r
2385 else if(_rtw_memcmp(WMM_OUI, oui, 4))
\r
2387 update_bcn_wmm_ie(padapter);
\r
2389 else if(_rtw_memcmp(WPS_OUI, oui, 4))
\r
2391 update_bcn_wps_ie(padapter);
\r
2393 else if(_rtw_memcmp(P2P_OUI, oui, 4))
\r
2395 update_bcn_p2p_ie(padapter);
\r
2399 DBG_871X("unknown OUI type!\n");
\r
2405 void _update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx, const char *tag)
\r
2408 struct mlme_priv *pmlmepriv;
\r
2409 struct mlme_ext_priv *pmlmeext;
\r
2410 //struct mlme_ext_info *pmlmeinfo;
\r
2412 //DBG_871X("%s\n", __FUNCTION__);
\r
2417 pmlmepriv = &(padapter->mlmepriv);
\r
2418 pmlmeext = &(padapter->mlmeextpriv);
\r
2419 //pmlmeinfo = &(pmlmeext->mlmext_info);
\r
2421 if(_FALSE == pmlmeext->bstart_bss)
\r
2424 _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL);
\r
2430 update_bcn_fixed_ie(padapter);//8: TimeStamp, 2: Beacon Interval 2:Capability
\r
2436 update_BCNTIM(padapter);
\r
2440 case _ERPINFO_IE_:
\r
2442 update_bcn_erpinfo_ie(padapter);
\r
2446 case _HT_CAPABILITY_IE_:
\r
2448 update_bcn_htcap_ie(padapter);
\r
2454 update_bcn_rsn_ie(padapter);
\r
2458 case _HT_ADD_INFO_IE_:
\r
2460 update_bcn_htinfo_ie(padapter);
\r
2464 case _VENDOR_SPECIFIC_IE_:
\r
2466 update_bcn_vendor_spec_ie(padapter, oui);
\r
2474 pmlmepriv->update_bcn = _TRUE;
\r
2476 _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL);
\r
2478 #ifndef CONFIG_INTERRUPT_BASED_TXBCN
\r
2479 #if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)
\r
2482 //send_beacon(padapter);//send_beacon must execute on TSR level
\r
2484 DBG_871X(FUNC_ADPT_FMT" ie_id:%u - %s\n", FUNC_ADPT_ARG(padapter), ie_id, tag);
\r
2485 set_tx_beacon_cmd(padapter);
\r
2489 //PCI will issue beacon when BCN interrupt occurs.
\r
2492 #endif //!CONFIG_INTERRUPT_BASED_TXBCN
\r
2496 #ifdef CONFIG_80211N_HT
\r
2500 Set to 0 (HT pure) under the followign conditions
\r
2501 - all STAs in the BSS are 20/40 MHz HT in 20/40 MHz BSS or
\r
2502 - all STAs in the BSS are 20 MHz HT in 20 MHz BSS
\r
2503 Set to 1 (HT non-member protection) if there may be non-HT STAs
\r
2504 in both the primary and the secondary channel
\r
2505 Set to 2 if only HT STAs are associated in BSS,
\r
2506 however and at least one 20 MHz HT STA is associated
\r
2507 Set to 3 (HT mixed mode) when one or more non-HT STAs are associated
\r
2508 (currently non-GF HT station is considered as non-HT STA also)
\r
2510 static int rtw_ht_operation_update(_adapter *padapter)
\r
2512 u16 cur_op_mode, new_op_mode;
\r
2513 int op_mode_changes = 0;
\r
2514 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
2515 struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv;
\r
2517 if(pmlmepriv->htpriv.ht_option == _TRUE)
\r
2520 //if (!iface->conf->ieee80211n || iface->conf->ht_op_mode_fixed)
\r
2523 DBG_871X("%s current operation mode=0x%X\n",
\r
2524 __FUNCTION__, pmlmepriv->ht_op_mode);
\r
2526 if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT)
\r
2527 && pmlmepriv->num_sta_ht_no_gf) {
\r
2528 pmlmepriv->ht_op_mode |=
\r
2529 HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT;
\r
2530 op_mode_changes++;
\r
2531 } else if ((pmlmepriv->ht_op_mode &
\r
2532 HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT) &&
\r
2533 pmlmepriv->num_sta_ht_no_gf == 0) {
\r
2534 pmlmepriv->ht_op_mode &=
\r
2535 ~HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT;
\r
2536 op_mode_changes++;
\r
2539 if (!(pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) &&
\r
2540 (pmlmepriv->num_sta_no_ht || pmlmepriv->olbc_ht)) {
\r
2541 pmlmepriv->ht_op_mode |= HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT;
\r
2542 op_mode_changes++;
\r
2543 } else if ((pmlmepriv->ht_op_mode &
\r
2544 HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT) &&
\r
2545 (pmlmepriv->num_sta_no_ht == 0 && !pmlmepriv->olbc_ht)) {
\r
2546 pmlmepriv->ht_op_mode &=
\r
2547 ~HT_INFO_OPERATION_MODE_NON_HT_STA_PRESENT;
\r
2548 op_mode_changes++;
\r
2551 /* Note: currently we switch to the MIXED op mode if HT non-greenfield
\r
2552 * station is associated. Probably it's a theoretical case, since
\r
2553 * it looks like all known HT STAs support greenfield.
\r
2556 if (pmlmepriv->num_sta_no_ht ||
\r
2557 (pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_NON_GF_DEVS_PRESENT))
\r
2558 new_op_mode = OP_MODE_MIXED;
\r
2559 else if ((phtpriv_ap->ht_cap.cap_info & IEEE80211_HT_CAP_SUP_WIDTH)
\r
2560 && pmlmepriv->num_sta_ht_20mhz)
\r
2561 new_op_mode = OP_MODE_20MHZ_HT_STA_ASSOCED;
\r
2562 else if (pmlmepriv->olbc_ht)
\r
2563 new_op_mode = OP_MODE_MAY_BE_LEGACY_STAS;
\r
2565 new_op_mode = OP_MODE_PURE;
\r
2567 cur_op_mode = pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_OP_MODE_MASK;
\r
2568 if (cur_op_mode != new_op_mode) {
\r
2569 pmlmepriv->ht_op_mode &= ~HT_INFO_OPERATION_MODE_OP_MODE_MASK;
\r
2570 pmlmepriv->ht_op_mode |= new_op_mode;
\r
2571 op_mode_changes++;
\r
2574 DBG_871X("%s new operation mode=0x%X changes=%d\n",
\r
2575 __FUNCTION__, pmlmepriv->ht_op_mode, op_mode_changes);
\r
2577 return op_mode_changes;
\r
2581 #endif /* CONFIG_80211N_HT */
\r
2583 void associated_clients_update(_adapter *padapter, u8 updated)
\r
2585 //update associcated stations cap.
\r
2586 if(updated == _TRUE)
\r
2589 _list *phead, *plist;
\r
2590 struct sta_info *psta=NULL;
\r
2591 struct sta_priv *pstapriv = &padapter->stapriv;
\r
2593 _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
2595 phead = &pstapriv->asoc_list;
\r
2596 plist = get_next(phead);
\r
2598 //check asoc_queue
\r
2599 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
\r
2601 psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list);
\r
2603 plist = get_next(plist);
\r
2605 VCS_update(padapter, psta);
\r
2608 _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
2614 /* called > TSR LEVEL for USB or SDIO Interface*/
\r
2615 void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta)
\r
2617 u8 beacon_updated = _FALSE;
\r
2618 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
2619 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
\r
2623 if (!(psta->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) &&
\r
2624 !psta->no_short_preamble_set) {
\r
2625 psta->no_short_preamble_set = 1;
\r
2626 pmlmepriv->num_sta_no_short_preamble++;
\r
2627 if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) &&
\r
2628 (pmlmepriv->num_sta_no_short_preamble == 1))
\r
2629 ieee802_11_set_beacons(hapd->iface);
\r
2634 if(!(psta->flags & WLAN_STA_SHORT_PREAMBLE))
\r
2636 if(!psta->no_short_preamble_set)
\r
2638 psta->no_short_preamble_set = 1;
\r
2640 pmlmepriv->num_sta_no_short_preamble++;
\r
2642 if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) &&
\r
2643 (pmlmepriv->num_sta_no_short_preamble == 1))
\r
2645 beacon_updated = _TRUE;
\r
2646 update_beacon(padapter, 0xFF, NULL, _TRUE);
\r
2653 if(psta->no_short_preamble_set)
\r
2655 psta->no_short_preamble_set = 0;
\r
2657 pmlmepriv->num_sta_no_short_preamble--;
\r
2659 if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) &&
\r
2660 (pmlmepriv->num_sta_no_short_preamble == 0))
\r
2662 beacon_updated = _TRUE;
\r
2663 update_beacon(padapter, 0xFF, NULL, _TRUE);
\r
2670 if (psta->flags & WLAN_STA_NONERP && !psta->nonerp_set) {
\r
2671 psta->nonerp_set = 1;
\r
2672 pmlmepriv->num_sta_non_erp++;
\r
2673 if (pmlmepriv->num_sta_non_erp == 1)
\r
2674 ieee802_11_set_beacons(hapd->iface);
\r
2678 if(psta->flags & WLAN_STA_NONERP)
\r
2680 if(!psta->nonerp_set)
\r
2682 psta->nonerp_set = 1;
\r
2684 pmlmepriv->num_sta_non_erp++;
\r
2686 if (pmlmepriv->num_sta_non_erp == 1)
\r
2688 beacon_updated = _TRUE;
\r
2689 update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE);
\r
2696 if(psta->nonerp_set)
\r
2698 psta->nonerp_set = 0;
\r
2700 pmlmepriv->num_sta_non_erp--;
\r
2702 if (pmlmepriv->num_sta_non_erp == 0)
\r
2704 beacon_updated = _TRUE;
\r
2705 update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE);
\r
2713 if (!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT) &&
\r
2714 !psta->no_short_slot_time_set) {
\r
2715 psta->no_short_slot_time_set = 1;
\r
2716 pmlmepriv->num_sta_no_short_slot_time++;
\r
2717 if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) &&
\r
2718 (pmlmepriv->num_sta_no_short_slot_time == 1))
\r
2719 ieee802_11_set_beacons(hapd->iface);
\r
2723 if(!(psta->capability & WLAN_CAPABILITY_SHORT_SLOT))
\r
2725 if(!psta->no_short_slot_time_set)
\r
2727 psta->no_short_slot_time_set = 1;
\r
2729 pmlmepriv->num_sta_no_short_slot_time++;
\r
2731 if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) &&
\r
2732 (pmlmepriv->num_sta_no_short_slot_time == 1))
\r
2734 beacon_updated = _TRUE;
\r
2735 update_beacon(padapter, 0xFF, NULL, _TRUE);
\r
2742 if(psta->no_short_slot_time_set)
\r
2744 psta->no_short_slot_time_set = 0;
\r
2746 pmlmepriv->num_sta_no_short_slot_time--;
\r
2748 if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) &&
\r
2749 (pmlmepriv->num_sta_no_short_slot_time == 0))
\r
2751 beacon_updated = _TRUE;
\r
2752 update_beacon(padapter, 0xFF, NULL, _TRUE);
\r
2757 #ifdef CONFIG_80211N_HT
\r
2759 if (psta->flags & WLAN_STA_HT)
\r
2761 u16 ht_capab = le16_to_cpu(psta->htpriv.ht_cap.cap_info);
\r
2763 DBG_871X("HT: STA " MAC_FMT " HT Capabilities "
\r
2764 "Info: 0x%04x\n", MAC_ARG(psta->hwaddr), ht_capab);
\r
2766 if (psta->no_ht_set) {
\r
2767 psta->no_ht_set = 0;
\r
2768 pmlmepriv->num_sta_no_ht--;
\r
2771 if ((ht_capab & IEEE80211_HT_CAP_GRN_FLD) == 0) {
\r
2772 if (!psta->no_ht_gf_set) {
\r
2773 psta->no_ht_gf_set = 1;
\r
2774 pmlmepriv->num_sta_ht_no_gf++;
\r
2776 DBG_871X("%s STA " MAC_FMT " - no "
\r
2777 "greenfield, num of non-gf stations %d\n",
\r
2778 __FUNCTION__, MAC_ARG(psta->hwaddr),
\r
2779 pmlmepriv->num_sta_ht_no_gf);
\r
2782 if ((ht_capab & IEEE80211_HT_CAP_SUP_WIDTH) == 0) {
\r
2783 if (!psta->ht_20mhz_set) {
\r
2784 psta->ht_20mhz_set = 1;
\r
2785 pmlmepriv->num_sta_ht_20mhz++;
\r
2787 DBG_871X("%s STA " MAC_FMT " - 20 MHz HT, "
\r
2788 "num of 20MHz HT STAs %d\n",
\r
2789 __FUNCTION__, MAC_ARG(psta->hwaddr),
\r
2790 pmlmepriv->num_sta_ht_20mhz);
\r
2796 if (!psta->no_ht_set) {
\r
2797 psta->no_ht_set = 1;
\r
2798 pmlmepriv->num_sta_no_ht++;
\r
2800 if(pmlmepriv->htpriv.ht_option == _TRUE) {
\r
2801 DBG_871X("%s STA " MAC_FMT
\r
2802 " - no HT, num of non-HT stations %d\n",
\r
2803 __FUNCTION__, MAC_ARG(psta->hwaddr),
\r
2804 pmlmepriv->num_sta_no_ht);
\r
2808 if (rtw_ht_operation_update(padapter) > 0)
\r
2810 update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE);
\r
2811 update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE);
\r
2814 #endif /* CONFIG_80211N_HT */
\r
2816 //update associcated stations cap.
\r
2817 associated_clients_update(padapter, beacon_updated);
\r
2819 DBG_871X("%s, updated=%d\n", __func__, beacon_updated);
\r
2823 u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta)
\r
2825 u8 beacon_updated = _FALSE;
\r
2826 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
2827 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
\r
2830 return beacon_updated;
\r
2832 if (psta->no_short_preamble_set) {
\r
2833 psta->no_short_preamble_set = 0;
\r
2834 pmlmepriv->num_sta_no_short_preamble--;
\r
2835 if (pmlmeext->cur_wireless_mode > WIRELESS_11B
\r
2836 && pmlmepriv->num_sta_no_short_preamble == 0)
\r
2838 beacon_updated = _TRUE;
\r
2839 update_beacon(padapter, 0xFF, NULL, _TRUE);
\r
2843 if (psta->nonerp_set) {
\r
2844 psta->nonerp_set = 0;
\r
2845 pmlmepriv->num_sta_non_erp--;
\r
2846 if (pmlmepriv->num_sta_non_erp == 0)
\r
2848 beacon_updated = _TRUE;
\r
2849 update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE);
\r
2853 if (psta->no_short_slot_time_set) {
\r
2854 psta->no_short_slot_time_set = 0;
\r
2855 pmlmepriv->num_sta_no_short_slot_time--;
\r
2856 if (pmlmeext->cur_wireless_mode > WIRELESS_11B
\r
2857 && pmlmepriv->num_sta_no_short_slot_time == 0)
\r
2859 beacon_updated = _TRUE;
\r
2860 update_beacon(padapter, 0xFF, NULL, _TRUE);
\r
2864 #ifdef CONFIG_80211N_HT
\r
2866 if (psta->no_ht_gf_set) {
\r
2867 psta->no_ht_gf_set = 0;
\r
2868 pmlmepriv->num_sta_ht_no_gf--;
\r
2871 if (psta->no_ht_set) {
\r
2872 psta->no_ht_set = 0;
\r
2873 pmlmepriv->num_sta_no_ht--;
\r
2876 if (psta->ht_20mhz_set) {
\r
2877 psta->ht_20mhz_set = 0;
\r
2878 pmlmepriv->num_sta_ht_20mhz--;
\r
2881 if (rtw_ht_operation_update(padapter) > 0)
\r
2883 update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE);
\r
2884 update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE);
\r
2887 #endif /* CONFIG_80211N_HT */
\r
2889 //update associcated stations cap.
\r
2890 //associated_clients_update(padapter, beacon_updated); //move it to avoid deadlock
\r
2892 DBG_871X("%s, updated=%d\n", __func__, beacon_updated);
\r
2894 return beacon_updated;
\r
2898 u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reason)
\r
2901 u8 beacon_updated = _FALSE;
\r
2902 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
2903 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
\r
2904 struct sta_priv *pstapriv = &padapter->stapriv;
\r
2907 return beacon_updated;
\r
2909 if (active == _TRUE)
\r
2911 #ifdef CONFIG_80211N_HT
\r
2912 //tear down Rx AMPDU
\r
2913 send_delba(padapter, 0, psta->hwaddr);// recipient
\r
2915 //tear down TX AMPDU
\r
2916 send_delba(padapter, 1, psta->hwaddr);// // originator
\r
2918 #endif //CONFIG_80211N_HT
\r
2920 issue_deauth(padapter, psta->hwaddr, reason);
\r
2923 #ifdef CONFIG_BEAMFORMING
\r
2924 beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_LEAVE, psta->hwaddr, ETH_ALEN, 1);
\r
2927 psta->htpriv.agg_enable_bitmap = 0x0;//reset
\r
2928 psta->htpriv.candidate_tid_bitmap = 0x0;//reset
\r
2931 //report_del_sta_event(padapter, psta->hwaddr, reason);
\r
2933 //clear cam entry / key
\r
2934 rtw_clearstakey_cmd(padapter, psta, _TRUE);
\r
2937 _enter_critical_bh(&psta->lock, &irqL);
\r
2938 psta->state &= ~_FW_LINKED;
\r
2939 _exit_critical_bh(&psta->lock, &irqL);
\r
2941 #ifdef CONFIG_IOCTL_CFG80211
\r
2943 #ifdef COMPAT_KERNEL_RELEASE
\r
2944 rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason);
\r
2945 #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER)
\r
2946 rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason);
\r
2947 #else //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER)
\r
2948 /* will call rtw_cfg80211_indicate_sta_disassoc() in cmd_thread for old API context */
\r
2949 #endif //(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER)
\r
2951 #endif //CONFIG_IOCTL_CFG80211
\r
2953 rtw_indicate_sta_disassoc_event(padapter, psta);
\r
2956 report_del_sta_event(padapter, psta->hwaddr, reason);
\r
2958 beacon_updated = bss_cap_update_on_sta_leave(padapter, psta);
\r
2960 //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
\r
2961 rtw_free_stainfo(padapter, psta);
\r
2962 //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
\r
2965 return beacon_updated;
\r
2969 int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset)
\r
2972 _list *phead, *plist;
\r
2974 struct sta_info *psta = NULL;
\r
2975 struct sta_priv *pstapriv = &padapter->stapriv;
\r
2976 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
\r
2977 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
2978 u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff};
\r
2980 if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE)
\r
2983 DBG_871X(FUNC_NDEV_FMT" with ch:%u, offset:%u\n",
\r
2984 FUNC_NDEV_ARG(padapter->pnetdev), new_ch, ch_offset);
\r
2986 _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
2987 phead = &pstapriv->asoc_list;
\r
2988 plist = get_next(phead);
\r
2990 /* for each sta in asoc_queue */
\r
2991 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
\r
2993 psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list);
\r
2994 plist = get_next(plist);
\r
2996 issue_action_spct_ch_switch(padapter, psta->hwaddr, new_ch, ch_offset);
\r
2997 psta->expire_to = ((pstapriv->expire_to * 2) > 5) ? 5 : (pstapriv->expire_to * 2);
\r
2999 _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
3001 issue_action_spct_ch_switch(padapter, bc_addr, new_ch, ch_offset);
\r
3006 int rtw_sta_flush(_adapter *padapter)
\r
3009 _list *phead, *plist;
\r
3011 struct sta_info *psta = NULL;
\r
3012 struct sta_priv *pstapriv = &padapter->stapriv;
\r
3013 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
\r
3014 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
3015 u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff};
\r
3017 if((pmlmeinfo->state&0x03) != WIFI_FW_AP_STATE)
\r
3020 DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev));
\r
3021 _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
3022 phead = &pstapriv->asoc_list;
\r
3023 plist = get_next(phead);
\r
3025 //free sta asoc_queue
\r
3026 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
\r
3028 psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list);
\r
3030 plist = get_next(plist);
\r
3032 rtw_list_delete(&psta->asoc_list);
\r
3033 pstapriv->asoc_list_cnt--;
\r
3035 //_exit_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
3036 ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING);
\r
3037 //_enter_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
3039 _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
3042 issue_deauth(padapter, bc_addr, WLAN_REASON_DEAUTH_LEAVING);
\r
3044 associated_clients_update(padapter, _TRUE);
\r
3050 /* called > TSR LEVEL for USB or SDIO Interface*/
\r
3051 void sta_info_update(_adapter *padapter, struct sta_info *psta)
\r
3053 int flags = psta->flags;
\r
3054 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
3058 if(WLAN_STA_WME&flags)
\r
3059 psta->qos_option = 1;
\r
3061 psta->qos_option = 0;
\r
3063 if(pmlmepriv->qospriv.qos_option == 0)
\r
3064 psta->qos_option = 0;
\r
3067 #ifdef CONFIG_80211N_HT
\r
3068 //update 802.11n ht cap.
\r
3069 if(WLAN_STA_HT&flags)
\r
3071 psta->htpriv.ht_option = _TRUE;
\r
3072 psta->qos_option = 1;
\r
3076 psta->htpriv.ht_option = _FALSE;
\r
3079 if(pmlmepriv->htpriv.ht_option == _FALSE)
\r
3080 psta->htpriv.ht_option = _FALSE;
\r
3083 #ifdef CONFIG_80211AC_VHT
\r
3084 //update 802.11AC vht cap.
\r
3085 if(WLAN_STA_VHT&flags)
\r
3087 psta->vhtpriv.vht_option = _TRUE;
\r
3091 psta->vhtpriv.vht_option = _FALSE;
\r
3094 if(pmlmepriv->vhtpriv.vht_option == _FALSE)
\r
3095 psta->vhtpriv.vht_option = _FALSE;
\r
3099 update_sta_info_apmode(padapter, psta);
\r
3104 /* called >= TSR LEVEL for USB or SDIO Interface*/
\r
3105 void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta)
\r
3107 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
\r
3108 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
3110 if(psta->state & _FW_LINKED)
\r
3112 pmlmeinfo->FW_sta_info[psta->mac_id].psta = psta;
\r
3115 add_RATid(padapter, psta, 0);//DM_RATR_STA_INIT
\r
3118 /* restore hw setting from sw data structures */
\r
3119 void rtw_ap_restore_network(_adapter *padapter)
\r
3121 struct mlme_priv *mlmepriv = &padapter->mlmepriv;
\r
3122 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
\r
3123 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
3124 struct sta_priv * pstapriv = &padapter->stapriv;
\r
3125 struct sta_info *psta;
\r
3126 struct security_priv* psecuritypriv=&(padapter->securitypriv);
\r
3128 _list *phead, *plist;
\r
3129 u8 chk_alive_num = 0;
\r
3130 char chk_alive_list[NUM_STA];
\r
3133 rtw_setopmode_cmd(padapter, Ndis802_11APMode,_FALSE);
\r
3135 set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode);
\r
3137 start_bss_network(padapter, (u8*)&mlmepriv->cur_network.network);
\r
3139 if((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) ||
\r
3140 (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_))
\r
3142 /* restore group key, WEP keys is restored in ips_leave() */
\r
3143 rtw_set_key(padapter, psecuritypriv, psecuritypriv->dot118021XGrpKeyid, 0,_FALSE);
\r
3146 _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
3148 phead = &pstapriv->asoc_list;
\r
3149 plist = get_next(phead);
\r
3151 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) {
\r
3152 int stainfo_offset;
\r
3154 psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list);
\r
3155 plist = get_next(plist);
\r
3157 stainfo_offset = rtw_stainfo_offset(pstapriv, psta);
\r
3158 if (stainfo_offset_valid(stainfo_offset)) {
\r
3159 chk_alive_list[chk_alive_num++] = stainfo_offset;
\r
3163 _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL);
\r
3165 for (i = 0; i < chk_alive_num; i++) {
\r
3166 psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]);
\r
3168 if (psta == NULL) {
\r
3169 DBG_871X(FUNC_ADPT_FMT" sta_info is null\n", FUNC_ADPT_ARG(padapter));
\r
3170 } else if (psta->state &_FW_LINKED) {
\r
3171 rtw_sta_media_status_rpt(padapter, psta, 1);
\r
3172 Update_RA_Entry(padapter, psta);
\r
3174 /* per sta pairwise key and settings */
\r
3175 if( (padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) ||
\r
3176 (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_))
\r
3178 rtw_setstakey_cmd(padapter, psta, UNICAST_KEY,_FALSE);
\r
3185 void start_ap_mode(_adapter *padapter)
\r
3188 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
3189 struct sta_priv *pstapriv = &padapter->stapriv;
\r
3190 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
\r
3191 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
\r
3192 struct wlan_acl_pool *pacl_list = &pstapriv->acl_list;
\r
3194 pmlmepriv->update_bcn = _FALSE;
\r
3196 //init_mlme_ap_info(padapter);
\r
3197 pmlmeext->bstart_bss = _FALSE;
\r
3199 pmlmepriv->num_sta_non_erp = 0;
\r
3201 pmlmepriv->num_sta_no_short_slot_time = 0;
\r
3203 pmlmepriv->num_sta_no_short_preamble = 0;
\r
3205 pmlmepriv->num_sta_ht_no_gf = 0;
\r
3206 #ifdef CONFIG_80211N_HT
\r
3207 pmlmepriv->num_sta_no_ht = 0;
\r
3208 #endif //CONFIG_80211N_HT
\r
3209 pmlmeinfo->HT_info_enable =0;
\r
3210 pmlmeinfo->HT_caps_enable=0;
\r
3211 pmlmeinfo->HT_enable=0;
\r
3213 pmlmepriv->num_sta_ht_20mhz = 0;
\r
3214 pmlmepriv->olbc = _FALSE;
\r
3215 pmlmepriv->olbc_ht = _FALSE;
\r
3217 #ifdef CONFIG_80211N_HT
\r
3218 pmlmepriv->ht_op_mode = 0;
\r
3221 for(i=0; i<NUM_STA; i++)
\r
3222 pstapriv->sta_aid[i] = NULL;
\r
3224 /* to avoid memory leak issue, don't set to NULL directly
\r
3225 pmlmepriv->wps_beacon_ie = NULL;
\r
3226 pmlmepriv->wps_probe_resp_ie = NULL;
\r
3227 pmlmepriv->wps_assoc_resp_ie = NULL;
\r
3229 pmlmepriv->p2p_beacon_ie = NULL;
\r
3230 pmlmepriv->p2p_probe_resp_ie = NULL;
\r
3234 _rtw_init_listhead(&(pacl_list->acl_node_q.queue));
\r
3235 pacl_list->num = 0;
\r
3236 pacl_list->mode = 0;
\r
3237 for(i = 0; i < NUM_ACL; i++)
\r
3239 _rtw_init_listhead(&pacl_list->aclnode[i].list);
\r
3240 pacl_list->aclnode[i].valid = _FALSE;
\r
3245 void stop_ap_mode(_adapter *padapter)
\r
3248 _list *phead, *plist;
\r
3249 struct rtw_wlan_acl_node *paclnode;
\r
3250 struct sta_info *psta=NULL;
\r
3251 struct sta_priv *pstapriv = &padapter->stapriv;
\r
3252 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
3253 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
\r
3254 struct wlan_acl_pool *pacl_list = &pstapriv->acl_list;
\r
3255 _queue *pacl_node_q =&pacl_list->acl_node_q;
\r
3257 pmlmepriv->update_bcn = _FALSE;
\r
3258 pmlmeext->bstart_bss = _FALSE;
\r
3259 padapter->netif_up = _FALSE;
\r
3260 //_rtw_spinlock_free(&pmlmepriv->bcn_update_lock);
\r
3262 //reset and init security priv , this can refine with rtw_reset_securitypriv
\r
3263 _rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv));
\r
3264 padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen;
\r
3265 padapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled;
\r
3268 _enter_critical_bh(&(pacl_node_q->lock), &irqL);
\r
3269 phead = get_list_head(pacl_node_q);
\r
3270 plist = get_next(phead);
\r
3271 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
\r
3273 paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list);
\r
3274 plist = get_next(plist);
\r
3276 if(paclnode->valid == _TRUE)
\r
3278 paclnode->valid = _FALSE;
\r
3280 rtw_list_delete(&paclnode->list);
\r
3282 pacl_list->num--;
\r
3285 _exit_critical_bh(&(pacl_node_q->lock), &irqL);
\r
3287 DBG_871X("%s, free acl_node_queue, num=%d\n", __func__, pacl_list->num);
\r
3289 rtw_sta_flush(padapter);
\r
3291 //free_assoc_sta_resources
\r
3292 rtw_free_all_stainfo(padapter);
\r
3294 psta = rtw_get_bcmc_stainfo(padapter);
\r
3295 //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
\r
3296 rtw_free_stainfo(padapter, psta);
\r
3297 //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);
\r
3299 rtw_init_bcmc_stainfo(padapter);
\r
3301 rtw_free_mlme_priv_ie_data(pmlmepriv);
\r
3303 #ifdef CONFIG_BT_COEXIST
\r
3304 rtw_btcoex_MediaStatusNotify(padapter, 0); //disconnect
\r
3309 #endif //CONFIG_NATIVEAP_MLME
\r
3311 #ifdef CONFIG_CONCURRENT_MODE
\r
3312 void concurrent_set_ap_chbw(_adapter *padapter, u8 channel, u8 channel_offset, u8 bwmode)
\r
3316 u8 cur_channel, cur_bwmode, cur_ch_offset, change_band;
\r
3317 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
\r
3318 WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network;
\r
3319 struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
\r
3320 struct HT_info_element *pht_info=NULL;
\r
3322 cur_channel = channel;
\r
3323 cur_bwmode = bwmode;
\r
3324 cur_ch_offset = channel_offset;
\r
3325 change_band = _FALSE;
\r
3327 p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _HT_ADD_INFO_IE_, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs)));
\r
3330 pht_info = (struct HT_info_element *)(p+2);
\r
3334 if(!check_buddy_fwstate(padapter, _FW_LINKED|_FW_UNDER_LINKING|_FW_UNDER_SURVEY))
\r
3336 set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode);
\r
3338 else if(check_buddy_fwstate(padapter, _FW_LINKED)==_TRUE)
\r
3340 _adapter *pbuddy_adapter = padapter->pbuddy_adapter;
\r
3341 struct mlme_ext_priv *pbuddy_mlmeext = &pbuddy_adapter->mlmeextpriv;
\r
3343 //To sync cur_channel/cur_bwmode/cur_ch_offset with buddy adapter
\r
3344 DBG_871X(ADPT_FMT" is at linked state\n", ADPT_ARG(pbuddy_adapter));
\r
3345 DBG_871X(ADPT_FMT": CH=%d, BW=%d, offset=%d\n", ADPT_ARG(pbuddy_adapter), pbuddy_mlmeext->cur_channel, pbuddy_mlmeext->cur_bwmode, pbuddy_mlmeext->cur_ch_offset);
\r
3346 DBG_871X(ADPT_FMT": CH=%d, BW=%d, offset=%d\n", ADPT_ARG(padapter), cur_channel, cur_bwmode, cur_ch_offset);
\r
3348 if((cur_channel <= 14 && pbuddy_mlmeext->cur_channel >= 36) ||
\r
3349 (cur_channel >= 36 && pbuddy_mlmeext->cur_channel <= 14))
\r
3350 change_band = _TRUE;
\r
3352 cur_channel = pbuddy_mlmeext->cur_channel;
\r
3354 #ifdef CONFIG_80211AC_VHT
\r
3355 if(cur_bwmode == CHANNEL_WIDTH_80)
\r
3357 u8 *pvht_cap_ie, *pvht_op_ie;
\r
3358 int vht_cap_ielen, vht_op_ielen;
\r
3360 pvht_cap_ie = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_VHTCapability, &vht_cap_ielen, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs)));
\r
3361 pvht_op_ie = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), EID_VHTOperation, &vht_op_ielen, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs)));
\r
3363 if(pbuddy_mlmeext->cur_channel <= 14) // downgrade to 20/40Mhz
\r
3365 //modify vht cap ie
\r
3366 if( pvht_cap_ie && vht_cap_ielen)
\r
3368 SET_VHT_CAPABILITY_ELE_SHORT_GI80M(pvht_cap_ie+2, 0);
\r
3371 //modify vht op ie
\r
3372 if( pvht_op_ie && vht_op_ielen)
\r
3374 SET_VHT_OPERATION_ELE_CHL_WIDTH(pvht_op_ie+2, 0); //change to 20/40Mhz
\r
3375 SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(pvht_op_ie+2, 0);
\r
3376 SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(pvht_op_ie+2, 0);
\r
3377 //SET_VHT_OPERATION_ELE_BASIC_MCS_SET(p+2, 0xFFFF);
\r
3378 cur_bwmode = CHANNEL_WIDTH_40;
\r
3385 cur_bwmode = CHANNEL_WIDTH_80;
\r
3387 if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40 ||
\r
3388 pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_80)
\r
3390 cur_ch_offset = pbuddy_mlmeext->cur_ch_offset;
\r
3392 else if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_20)
\r
3394 cur_ch_offset = rtw_get_offset_by_ch(cur_channel);
\r
3397 //modify ht info ie
\r
3399 pht_info->infos[0] &= ~HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK;
\r
3401 switch(cur_ch_offset)
\r
3403 case HAL_PRIME_CHNL_OFFSET_LOWER:
\r
3405 pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE;
\r
3406 //cur_bwmode = CHANNEL_WIDTH_40;
\r
3408 case HAL_PRIME_CHNL_OFFSET_UPPER:
\r
3410 pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW;
\r
3411 //cur_bwmode = CHANNEL_WIDTH_40;
\r
3413 case HAL_PRIME_CHNL_OFFSET_DONT_CARE:
\r
3416 pht_info->infos[0] &= ~HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK;
\r
3417 cur_bwmode = CHANNEL_WIDTH_20;
\r
3418 cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
\r
3422 //modify vht op ie
\r
3423 center_freq = rtw_get_center_ch(cur_channel, cur_bwmode, HAL_PRIME_CHNL_OFFSET_LOWER);
\r
3424 if( pvht_op_ie && vht_op_ielen)
\r
3425 SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(pvht_op_ie+2, center_freq);
\r
3427 set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode);
\r
3432 #endif //CONFIG_80211AC_VHT
\r
3434 if(cur_bwmode == CHANNEL_WIDTH_40)
\r
3437 pht_info->infos[0] &= ~HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK;
\r
3439 if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_40 ||
\r
3440 pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_80)
\r
3442 cur_ch_offset = pbuddy_mlmeext->cur_ch_offset;
\r
3444 //to update cur_ch_offset value in beacon
\r
3447 switch(cur_ch_offset)
\r
3449 case HAL_PRIME_CHNL_OFFSET_LOWER:
\r
3450 pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE;
\r
3452 case HAL_PRIME_CHNL_OFFSET_UPPER:
\r
3453 pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW;
\r
3455 case HAL_PRIME_CHNL_OFFSET_DONT_CARE:
\r
3462 else if(pbuddy_mlmeext->cur_bwmode == CHANNEL_WIDTH_20)
\r
3464 cur_ch_offset = rtw_get_offset_by_ch(cur_channel);
\r
3466 switch(cur_ch_offset)
\r
3468 case HAL_PRIME_CHNL_OFFSET_LOWER:
\r
3470 pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE;
\r
3471 cur_bwmode = CHANNEL_WIDTH_40;
\r
3473 case HAL_PRIME_CHNL_OFFSET_UPPER:
\r
3475 pht_info->infos[0] |= HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW;
\r
3476 cur_bwmode = CHANNEL_WIDTH_40;
\r
3478 case HAL_PRIME_CHNL_OFFSET_DONT_CARE:
\r
3481 pht_info->infos[0] &= ~HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK;
\r
3482 cur_bwmode = CHANNEL_WIDTH_20;
\r
3483 cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
\r
3489 set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode);
\r
3494 set_channel_bwmode(padapter, cur_channel, pbuddy_mlmeext->cur_ch_offset, pbuddy_mlmeext->cur_bwmode);
\r
3497 // to update channel value in beacon
\r
3498 pnetwork->Configuration.DSConfig = cur_channel;
\r
3499 p = rtw_get_ie((pnetwork->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (pnetwork->IELength - sizeof(NDIS_802_11_FIXED_IEs)));
\r
3501 *(p + 2) = cur_channel;
\r
3504 pht_info->primary_channel = cur_channel;
\r
3507 DBG_871X(FUNC_ADPT_FMT" CH=%d, BW=%d, offset=%d\n", FUNC_ADPT_ARG(padapter), cur_channel, cur_bwmode, cur_ch_offset);
\r
3509 pmlmeext->cur_channel = cur_channel;
\r
3510 pmlmeext->cur_bwmode = cur_bwmode;
\r
3511 pmlmeext->cur_ch_offset = cur_ch_offset;
\r
3513 //buddy interface band is different from current interface, update ERP, support rate, ext support rate IE
\r
3514 if(change_band == _TRUE)
\r
3515 change_band_update_ie(padapter, pnetwork);
\r
3518 #endif //CONFIG_CONCURRENT_MODE
\r
3520 #endif //CONFIG_AP_MODE
\r
projects / firefly-linux-kernel-4.4.55.git / blob