1 /******************************************************************************
3 * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of version 2 of the GNU General Public License as
7 * published by the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
19 ******************************************************************************/
20 #define _RTW_IOCTL_SET_C_
22 #include <drv_types.h>
26 extern void indicate_wx_scan_complete_event(_adapter *padapter);
28 #define IS_MAC_ADDRESS_BROADCAST(addr) \
30 ( (addr[0] == 0xff) && (addr[1] == 0xff) && \
31 (addr[2] == 0xff) && (addr[3] == 0xff) && \
32 (addr[4] == 0xff) && (addr[5] == 0xff) ) ? _TRUE : _FALSE \
35 u8 rtw_validate_bssid(u8 *bssid)
39 if (is_zero_mac_addr(bssid)
40 || is_broadcast_mac_addr(bssid)
41 || is_multicast_mac_addr(bssid)
49 u8 rtw_validate_ssid(NDIS_802_11_SSID *ssid)
56 if (ssid->SsidLength > 32) {
57 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid length >32\n"));
62 #ifdef CONFIG_VALIDATE_SSID
63 for(i = 0; i < ssid->SsidLength; i++)
65 //wifi, printable ascii code must be supported
66 if(!( (ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e) )){
67 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid has nonprintabl ascii\n"));
72 #endif /* CONFIG_VALIDATE_SSID */
81 u8 rtw_do_join(_adapter * padapter);
82 u8 rtw_do_join(_adapter * padapter)
87 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
88 _queue *queue = &(pmlmepriv->scanned_queue);
93 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
94 phead = get_list_head(queue);
95 plist = get_next(phead);
97 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("\n rtw_do_join: phead = %p; plist = %p \n\n\n", phead, plist));
99 pmlmepriv->cur_network.join_res = -2;
101 set_fwstate(pmlmepriv, _FW_UNDER_LINKING);
103 pmlmepriv->pscanned = plist;
105 pmlmepriv->to_join = _TRUE;
107 if(_rtw_queue_empty(queue)== _TRUE)
109 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
110 _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING);
112 //when set_ssid/set_bssid for rtw_do_join(), but scanning queue is empty
113 //we try to issue sitesurvey firstly
115 if (pmlmepriv->LinkDetectInfo.bBusyTraffic ==_FALSE
116 || rtw_to_roam(padapter) > 0
119 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_do_join(): site survey if scanned_queue is empty\n."));
120 // submit site_survey_cmd
121 if(_SUCCESS!=(ret=rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0)) ) {
122 pmlmepriv->to_join = _FALSE;
123 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_do_join(): site survey return error\n."));
128 pmlmepriv->to_join = _FALSE;
137 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
138 if((select_ret=rtw_select_and_join_from_scanned_queue(pmlmepriv))==_SUCCESS)
140 pmlmepriv->to_join = _FALSE;
141 _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT);
145 if(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==_TRUE)
147 // submit createbss_cmd to change to a ADHOC_MASTER
149 //pmlmepriv->lock has been acquired by caller...
150 WLAN_BSSID_EX *pdev_network = &(padapter->registrypriv.dev_network);
152 pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;
154 pibss = padapter->registrypriv.dev_network.MacAddress;
156 _rtw_memset(&pdev_network->Ssid, 0, sizeof(NDIS_802_11_SSID));
157 _rtw_memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID));
159 rtw_update_registrypriv_dev_network(padapter);
161 rtw_generate_random_ibss(pibss);
163 if (rtw_create_ibss_cmd(padapter, 0) != _SUCCESS) {
164 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("***Error=>do_goin: rtw_create_ibss_cmd status FAIL***\n"));
169 pmlmepriv->to_join = _FALSE;
171 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("***Error=> rtw_select_and_join_from_scanned_queue FAIL under STA_Mode*** \n "));
176 // can't associate ; reset under-linking
177 _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING);
180 if((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE))
182 if(_rtw_memcmp(pmlmepriv->cur_network.network.Ssid.Ssid, pmlmepriv->assoc_ssid.Ssid, pmlmepriv->assoc_ssid.SsidLength))
184 // for funk to do roaming
185 // funk will reconnect, but funk will not sitesurvey before reconnect
186 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("for funk to do roaming"));
187 if(pmlmepriv->sitesurveyctrl.traffic_busy==_FALSE)
188 rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0);
194 //when set_ssid/set_bssid for rtw_do_join(), but there are no desired bss in scanning queue
195 //we try to issue sitesurvey firstly
196 if(pmlmepriv->LinkDetectInfo.bBusyTraffic==_FALSE
197 || rtw_to_roam(padapter) > 0
200 //DBG_871X("rtw_do_join() when no desired bss in scanning queue \n");
201 if( _SUCCESS!=(ret=rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0)) ){
202 pmlmepriv->to_join = _FALSE;
203 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("do_join(): site survey return error\n."));
209 pmlmepriv->to_join = _FALSE;
224 #ifdef PLATFORM_WINDOWS
225 u8 rtw_pnp_set_power_wakeup(_adapter* padapter)
231 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("==>rtw_pnp_set_power_wakeup!!!\n"));
233 res = rtw_setstandby_cmd(padapter, 0);
235 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("<==rtw_pnp_set_power_wakeup!!!\n"));
242 u8 rtw_pnp_set_power_sleep(_adapter* padapter)
248 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("==>rtw_pnp_set_power_sleep!!!\n"));
249 //DbgPrint("+rtw_pnp_set_power_sleep\n");
251 res = rtw_setstandby_cmd(padapter, 1);
253 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("<==rtw_pnp_set_power_sleep!!!\n"));
260 u8 rtw_set_802_11_reload_defaults(_adapter * padapter, NDIS_802_11_RELOAD_DEFAULTS reloadDefaults)
264 switch( reloadDefaults)
266 case Ndis802_11ReloadWEPKeys:
267 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("SetInfo OID_802_11_RELOAD_DEFAULTS : Ndis802_11ReloadWEPKeys\n"));
271 // SecClearAllKeys(Adapter);
272 // 8711 CAM was not for En/Decrypt only
273 // so, we can't clear all keys.
274 // should we disable WPAcfg (ox0088) bit 1-2, instead of clear all CAM
283 u8 set_802_11_test(_adapter* padapter, NDIS_802_11_TEST *test)
292 NdisMIndicateStatus(padapter->hndis_adapter, NDIS_STATUS_MEDIA_SPECIFIC_INDICATION, (PVOID)&test->AuthenticationEvent, test->Length - 8);
293 NdisMIndicateStatusComplete(padapter->hndis_adapter);
297 NdisMIndicateStatus(padapter->hndis_adapter, NDIS_STATUS_MEDIA_SPECIFIC_INDICATION, (PVOID)&test->RssiTrigger, sizeof(NDIS_802_11_RSSI));
298 NdisMIndicateStatusComplete(padapter->hndis_adapter);
311 u8 rtw_set_802_11_pmkid(_adapter* padapter, NDIS_802_11_PMKID *pmkid)
320 u8 rtw_set_802_11_bssid(_adapter* padapter, u8 *bssid)
325 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
329 DBG_871X_LEVEL(_drv_always_, "set bssid:%pM\n", bssid);
331 if ((bssid[0]==0x00 && bssid[1]==0x00 && bssid[2]==0x00 && bssid[3]==0x00 && bssid[4]==0x00 &&bssid[5]==0x00) ||
332 (bssid[0]==0xFF && bssid[1]==0xFF && bssid[2]==0xFF && bssid[3]==0xFF && bssid[4]==0xFF &&bssid[5]==0xFF))
338 _enter_critical_bh(&pmlmepriv->lock, &irqL);
341 DBG_871X("Set BSSID under fw_state=0x%08x\n", get_fwstate(pmlmepriv));
342 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) {
343 goto handle_tkip_countermeasure;
344 } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) {
345 goto release_mlme_lock;
348 if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == _TRUE)
350 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n"));
352 if (_rtw_memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid, ETH_ALEN) == _TRUE)
354 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _FALSE)
355 goto release_mlme_lock;//it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again.
357 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("Set BSSID not the same bssid\n"));
358 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("set_bssid="MAC_FMT"\n", MAC_ARG(bssid) ));
359 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("cur_bssid="MAC_FMT"\n", MAC_ARG(pmlmepriv->cur_network.network.MacAddress) ));
361 rtw_disassoc_cmd(padapter, 0, _TRUE);
363 if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)
364 rtw_indicate_disconnect(padapter, 0, _FALSE);
366 rtw_free_assoc_resources(padapter, 1);
368 if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) {
369 _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
370 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
375 handle_tkip_countermeasure:
376 if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) {
378 goto release_mlme_lock;
381 _rtw_memset(&pmlmepriv->assoc_ssid, 0, sizeof(NDIS_802_11_SSID));
382 _rtw_memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN);
383 pmlmepriv->assoc_by_bssid=_TRUE;
385 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) {
386 pmlmepriv->to_join = _TRUE;
389 status = rtw_do_join(padapter);
393 _exit_critical_bh(&pmlmepriv->lock, &irqL);
396 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
397 ("rtw_set_802_11_bssid: status=%d\n", status));
404 u8 rtw_set_802_11_ssid(_adapter* padapter, NDIS_802_11_SSID *ssid)
407 u8 status = _SUCCESS;
410 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
411 struct wlan_network *pnetwork = &pmlmepriv->cur_network;
415 DBG_871X_LEVEL(_drv_always_, "set ssid [%s] fw_state=0x%08x\n",
416 ssid->Ssid, get_fwstate(pmlmepriv));
418 if (!rtw_is_hw_init_completed(padapter)) {
419 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
420 ("set_ssid: hw_init_completed==_FALSE=>exit!!!\n"));
425 _enter_critical_bh(&pmlmepriv->lock, &irqL);
427 DBG_871X("Set SSID under fw_state=0x%08x\n", get_fwstate(pmlmepriv));
428 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) {
429 goto handle_tkip_countermeasure;
430 } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) {
431 goto release_mlme_lock;
434 if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == _TRUE)
436 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
437 ("set_ssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n"));
439 if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) &&
440 (_rtw_memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid, ssid->SsidLength) == _TRUE))
442 if((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _FALSE))
444 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
445 ("Set SSID is the same ssid, fw_state=0x%08x\n",
446 get_fwstate(pmlmepriv)));
448 if(rtw_is_same_ibss(padapter, pnetwork) == _FALSE)
450 //if in WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE, create bss or rejoin again
451 rtw_disassoc_cmd(padapter, 0, _TRUE);
453 if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)
454 rtw_indicate_disconnect(padapter, 0, _FALSE);
456 rtw_free_assoc_resources(padapter, 1);
458 if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) {
459 _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
460 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
465 goto release_mlme_lock;//it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again.
470 rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_JOINBSS, 1);
476 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("Set SSID not the same ssid\n"));
477 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("set_ssid=[%s] len=0x%x\n", ssid->Ssid, (unsigned int)ssid->SsidLength));
478 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("assoc_ssid=[%s] len=0x%x\n", pmlmepriv->assoc_ssid.Ssid, (unsigned int)pmlmepriv->assoc_ssid.SsidLength));
480 rtw_disassoc_cmd(padapter, 0, _TRUE);
482 if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)
483 rtw_indicate_disconnect(padapter, 0, _FALSE);
485 rtw_free_assoc_resources(padapter, 1);
487 if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) {
488 _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
489 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
494 handle_tkip_countermeasure:
495 if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) {
497 goto release_mlme_lock;
500 if (rtw_validate_ssid(ssid) == _FALSE) {
502 goto release_mlme_lock;
505 _rtw_memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(NDIS_802_11_SSID));
506 pmlmepriv->assoc_by_bssid=_FALSE;
508 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) {
509 pmlmepriv->to_join = _TRUE;
512 status = rtw_do_join(padapter);
516 _exit_critical_bh(&pmlmepriv->lock, &irqL);
519 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
520 ("-rtw_set_802_11_ssid: status=%d\n", status));
528 u8 rtw_set_802_11_connect(_adapter* padapter, u8 *bssid, NDIS_802_11_SSID *ssid)
531 u8 status = _SUCCESS;
533 bool bssid_valid = _TRUE;
534 bool ssid_valid = _TRUE;
535 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
539 if (!ssid || rtw_validate_ssid(ssid) == _FALSE)
542 if (!bssid || rtw_validate_bssid(bssid) == _FALSE)
543 bssid_valid = _FALSE;
545 if (ssid_valid == _FALSE && bssid_valid == _FALSE) {
546 DBG_871X(FUNC_ADPT_FMT" ssid:%p, ssid_valid:%d, bssid:%p, bssid_valid:%d\n",
547 FUNC_ADPT_ARG(padapter), ssid, ssid_valid, bssid, bssid_valid);
552 if (!rtw_is_hw_init_completed(padapter)) {
553 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
554 ("set_ssid: hw_init_completed==_FALSE=>exit!!!\n"));
559 _enter_critical_bh(&pmlmepriv->lock, &irqL);
561 DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" fw_state=0x%08x\n",
562 FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv));
564 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) {
565 goto handle_tkip_countermeasure;
566 } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) {
567 goto release_mlme_lock;
570 handle_tkip_countermeasure:
571 if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) {
573 goto release_mlme_lock;
576 if (ssid && ssid_valid)
577 _rtw_memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(NDIS_802_11_SSID));
579 _rtw_memset(&pmlmepriv->assoc_ssid, 0, sizeof(NDIS_802_11_SSID));
581 if (bssid && bssid_valid) {
582 _rtw_memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN);
583 pmlmepriv->assoc_by_bssid = _TRUE;
585 pmlmepriv->assoc_by_bssid = _FALSE;
588 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) {
589 pmlmepriv->to_join = _TRUE;
592 status = rtw_do_join(padapter);
596 _exit_critical_bh(&pmlmepriv->lock, &irqL);
605 u8 rtw_set_802_11_infrastructure_mode(_adapter* padapter,
606 NDIS_802_11_NETWORK_INFRASTRUCTURE networktype)
609 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
610 struct wlan_network *cur_network = &pmlmepriv->cur_network;
611 NDIS_802_11_NETWORK_INFRASTRUCTURE* pold_state = &(cur_network->network.InfrastructureMode);
615 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_notice_,
616 ("+rtw_set_802_11_infrastructure_mode: old=%d new=%d fw_state=0x%08x\n",
617 *pold_state, networktype, get_fwstate(pmlmepriv)));
619 if(*pold_state != networktype)
621 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,(" change mode!"));
622 //DBG_871X("change mode, old_mode=%d, new_mode=%d, fw_state=0x%x\n", *pold_state, networktype, get_fwstate(pmlmepriv));
624 if(*pold_state==Ndis802_11APMode)
626 //change to other mode from Ndis802_11APMode
627 cur_network->join_res = -1;
629 #ifdef CONFIG_NATIVEAP_MLME
630 stop_ap_mode(padapter);
634 _enter_critical_bh(&pmlmepriv->lock, &irqL);
636 if((check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) ||(*pold_state==Ndis802_11IBSS))
637 rtw_disassoc_cmd(padapter, 0, _TRUE);
639 if((check_fwstate(pmlmepriv, _FW_LINKED)== _TRUE) ||
640 (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)== _TRUE) )
641 rtw_free_assoc_resources(padapter, 1);
643 if((*pold_state == Ndis802_11Infrastructure) ||(*pold_state == Ndis802_11IBSS))
645 if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)
647 rtw_indicate_disconnect(padapter, 0, _FALSE); /*will clr Linked_state; before this function, we must have checked whether issue dis-assoc_cmd or not*/
651 *pold_state = networktype;
653 _clr_fwstate_(pmlmepriv, ~WIFI_NULL_STATE);
658 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
661 case Ndis802_11Infrastructure:
662 set_fwstate(pmlmepriv, WIFI_STATION_STATE);
665 case Ndis802_11APMode:
666 set_fwstate(pmlmepriv, WIFI_AP_STATE);
667 #ifdef CONFIG_NATIVEAP_MLME
668 start_ap_mode(padapter);
669 //rtw_indicate_connect(padapter);
674 case Ndis802_11AutoUnknown:
675 case Ndis802_11InfrastructureMax:
677 case Ndis802_11Monitor:
678 set_fwstate(pmlmepriv, WIFI_MONITOR_STATE);
682 //SecClearAllKeys(adapter);
684 //RT_TRACE(COMP_OID_SET, DBG_LOUD, ("set_infrastructure: fw_state:%x after changing mode\n",
685 // get_fwstate(pmlmepriv) ));
687 _exit_critical_bh(&pmlmepriv->lock, &irqL);
696 u8 rtw_set_802_11_disassociate(_adapter *padapter)
699 struct mlme_priv * pmlmepriv = &padapter->mlmepriv;
703 _enter_critical_bh(&pmlmepriv->lock, &irqL);
705 if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)
707 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("MgntActrtw_set_802_11_disassociate: rtw_indicate_disconnect\n"));
709 rtw_disassoc_cmd(padapter, 0, _TRUE);
710 rtw_indicate_disconnect(padapter, 0, _FALSE);
711 //modify for CONFIG_IEEE80211W, none 11w can use it
712 rtw_free_assoc_resources_cmd(padapter);
713 if (_FAIL == rtw_pwr_wakeup(padapter))
714 DBG_871X("%s(): rtw_pwr_wakeup fail !!!\n",__FUNCTION__);
717 _exit_critical_bh(&pmlmepriv->lock, &irqL);
724 u8 rtw_set_802_11_bssid_list_scan(_adapter* padapter, NDIS_802_11_SSID *pssid, int ssid_max_num)
727 struct mlme_priv *pmlmepriv= &padapter->mlmepriv;
732 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("+rtw_set_802_11_bssid_list_scan(), fw_state=%x\n", get_fwstate(pmlmepriv)));
734 if (padapter == NULL) {
738 if (!rtw_is_hw_init_completed(padapter)) {
740 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n===rtw_set_802_11_bssid_list_scan:hw_init_completed==_FALSE===\n"));
744 if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == _TRUE) ||
745 (pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE))
747 // Scan or linking is in progress, do nothing.
748 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_bssid_list_scan fail since fw_state = %x\n", get_fwstate(pmlmepriv)));
751 if(check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))== _TRUE){
752 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n###_FW_UNDER_SURVEY|_FW_UNDER_LINKING\n\n"));
754 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n###pmlmepriv->sitesurveyctrl.traffic_busy==_TRUE\n\n"));
757 if (rtw_is_scan_deny(padapter)) {
758 DBG_871X(FUNC_ADPT_FMT": scan deny\n", FUNC_ADPT_ARG(padapter));
759 indicate_wx_scan_complete_event(padapter);
763 _enter_critical_bh(&pmlmepriv->lock, &irqL);
765 res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, NULL, 0);
767 _exit_critical_bh(&pmlmepriv->lock, &irqL);
776 u8 rtw_set_802_11_authentication_mode(_adapter* padapter, NDIS_802_11_AUTHENTICATION_MODE authmode)
778 struct security_priv *psecuritypriv = &padapter->securitypriv;
784 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("set_802_11_auth.mode(): mode=%x\n", authmode));
786 psecuritypriv->ndisauthtype=authmode;
788 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_authentication_mode:psecuritypriv->ndisauthtype=%d", psecuritypriv->ndisauthtype));
790 if(psecuritypriv->ndisauthtype>3)
791 psecuritypriv->dot11AuthAlgrthm=dot11AuthAlgrthm_8021X;
793 #ifdef CONFIG_WAPI_SUPPORT
794 if(psecuritypriv->ndisauthtype == 6)
795 psecuritypriv->dot11AuthAlgrthm=dot11AuthAlgrthm_WAPI;
798 res=rtw_set_auth(padapter,psecuritypriv);
810 u8 rtw_set_802_11_add_wep(_adapter* padapter, NDIS_802_11_WEP *wep){
815 struct security_priv* psecuritypriv=&(padapter->securitypriv);
820 bdefaultkey=(wep->KeyIndex & 0x40000000) > 0 ? _FALSE : _TRUE; //for ???
821 btransmitkey= (wep->KeyIndex & 0x80000000) > 0 ? _TRUE : _FALSE; //for ???
822 keyid=wep->KeyIndex & 0x3fffffff;
826 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("MgntActrtw_set_802_11_add_wep:keyid>4=>fail\n"));
831 switch(wep->KeyLength)
834 psecuritypriv->dot11PrivacyAlgrthm=_WEP40_;
835 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("MgntActrtw_set_802_11_add_wep:wep->KeyLength=5\n"));
838 psecuritypriv->dot11PrivacyAlgrthm=_WEP104_;
839 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("MgntActrtw_set_802_11_add_wep:wep->KeyLength=13\n"));
842 psecuritypriv->dot11PrivacyAlgrthm=_NO_PRIVACY_;
843 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("MgntActrtw_set_802_11_add_wep:wep->KeyLength!=5 or 13\n"));
847 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_wep:befor memcpy, wep->KeyLength=0x%x wep->KeyIndex=0x%x keyid =%x\n",wep->KeyLength,wep->KeyIndex,keyid));
849 _rtw_memcpy(&(psecuritypriv->dot11DefKey[keyid].skey[0]),&(wep->KeyMaterial),wep->KeyLength);
851 psecuritypriv->dot11DefKeylen[keyid]=wep->KeyLength;
853 psecuritypriv->dot11PrivacyKeyIndex=keyid;
855 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_wep:security key material : %x %x %x %x %x %x %x %x %x %x %x %x %x \n",
856 psecuritypriv->dot11DefKey[keyid].skey[0],psecuritypriv->dot11DefKey[keyid].skey[1],psecuritypriv->dot11DefKey[keyid].skey[2],
857 psecuritypriv->dot11DefKey[keyid].skey[3],psecuritypriv->dot11DefKey[keyid].skey[4],psecuritypriv->dot11DefKey[keyid].skey[5],
858 psecuritypriv->dot11DefKey[keyid].skey[6],psecuritypriv->dot11DefKey[keyid].skey[7],psecuritypriv->dot11DefKey[keyid].skey[8],
859 psecuritypriv->dot11DefKey[keyid].skey[9],psecuritypriv->dot11DefKey[keyid].skey[10],psecuritypriv->dot11DefKey[keyid].skey[11],
860 psecuritypriv->dot11DefKey[keyid].skey[12]));
862 res=rtw_set_key(padapter,psecuritypriv, keyid, 1, _TRUE);
874 u8 rtw_set_802_11_remove_wep(_adapter* padapter, u32 keyindex){
880 if (keyindex >= 0x80000000 || padapter == NULL){
889 struct security_priv* psecuritypriv=&(padapter->securitypriv);
892 _rtw_memset(&psecuritypriv->dot11DefKey[keyindex], 0, 16);
894 res=rtw_set_key(padapter,psecuritypriv,keyindex, 0, _TRUE);
896 psecuritypriv->dot11DefKeylen[keyindex]=0;
917 u8 rtw_set_802_11_add_key(_adapter* padapter, NDIS_802_11_KEY *key){
921 struct sta_info *stainfo;
923 u8 bgrouptkey = _FALSE;//can be remove later
928 if (((key->KeyIndex & 0x80000000) == 0) && ((key->KeyIndex & 0x40000000) > 0)){
930 // It is invalid to clear bit 31 and set bit 30. If the miniport driver encounters this combination,
931 // it must fail the request and return NDIS_STATUS_INVALID_DATA.
932 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_key: ((key->KeyIndex & 0x80000000) == 0)[=%d] ",(int)(key->KeyIndex & 0x80000000) == 0));
933 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_key:((key->KeyIndex & 0x40000000) > 0)[=%d]" , (int)(key->KeyIndex & 0x40000000) > 0));
934 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_info_,("rtw_set_802_11_add_key: key->KeyIndex=%d \n" ,(int)key->KeyIndex));
939 if(key->KeyIndex & 0x40000000)
943 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ Pairwise key +++++\n"));
945 pbssid=get_bssid(&padapter->mlmepriv);
946 stainfo=rtw_get_stainfo(&padapter->stapriv, pbssid);
948 if((stainfo!=NULL)&&(padapter->securitypriv.dot11AuthAlgrthm==dot11AuthAlgrthm_8021X)){
949 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY:( stainfo!=NULL)&&(Adapter->securitypriv.dot11AuthAlgrthm==dot11AuthAlgrthm_8021X)\n"));
950 encryptionalgo=stainfo->dot118021XPrivacy;
953 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: stainfo==NULL)||(Adapter->securitypriv.dot11AuthAlgrthm!=dot11AuthAlgrthm_8021X)\n"));
954 encryptionalgo=padapter->securitypriv.dot11PrivacyAlgrthm;
957 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_add_key: (encryptionalgo ==%d)!\n",encryptionalgo ));
958 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_add_key: (Adapter->securitypriv.dot11PrivacyAlgrthm ==%d)!\n",padapter->securitypriv.dot11PrivacyAlgrthm));
959 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_add_key: (Adapter->securitypriv.dot11AuthAlgrthm ==%d)!\n",padapter->securitypriv.dot11AuthAlgrthm));
962 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("rtw_set_802_11_add_key: (stainfo->dot118021XPrivacy ==%d)!\n", stainfo->dot118021XPrivacy));
965 if(key->KeyIndex & 0x000000FF){
966 // The key index is specified in the lower 8 bits by values of zero to 255.
967 // The key index should be set to zero for a Pairwise key, and the driver should fail with
968 // NDIS_STATUS_INVALID_DATA if the lower 8 bits is not zero
969 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,(" key->KeyIndex & 0x000000FF.\n"));
975 if (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == _TRUE){
977 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("MacAddr_isBcst(key->BSSID)\n"));
982 // Check key length for TKIP.
983 //if(encryptionAlgorithm == RT_ENC_TKIP_ENCRYPTION && key->KeyLength != 32)
984 if((encryptionalgo== _TKIP_)&& (key->KeyLength != 32)){
985 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("TKIP KeyLength:0x%x != 32\n", key->KeyLength));
991 // Check key length for AES.
992 if((encryptionalgo== _AES_)&& (key->KeyLength != 16)) {
993 // For our supplicant, EAPPkt9x.vxd, cannot differentiate TKIP and AES case.
994 if(key->KeyLength == 32) {
1002 /* Check key length for WEP. For NDTEST, 2005.01.27, by rcnjko. -> modify checking condition*/
1003 if (((encryptionalgo == _WEP40_) && (key->KeyLength != 5)) || ((encryptionalgo == _WEP104_) && (key->KeyLength != 13))) {
1004 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("WEP KeyLength:0x%x != 5 or 13\n", key->KeyLength));
1011 // Check the pairwise key. Added by Annie, 2005-07-06.
1012 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n"));
1013 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("[Pairwise Key set]\n"));
1014 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n"));
1015 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key index: 0x%8x(0x%8x)\n", key->KeyIndex,(key->KeyIndex&0x3)));
1016 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key Length: %d\n", key->KeyLength));
1017 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n"));
1022 // Group key - KeyIndex(BIT30==0)
1023 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ Group key +++++\n"));
1026 // when add wep key through add key and didn't assigned encryption type before
1027 if((padapter->securitypriv.ndisauthtype<=3)&&(padapter->securitypriv.dot118021XGrpPrivacy==0))
1029 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("keylen=%d( Adapter->securitypriv.dot11PrivacyAlgrthm=%x )padapter->securitypriv.dot118021XGrpPrivacy(%x)\n", key->KeyLength,padapter->securitypriv.dot11PrivacyAlgrthm,padapter->securitypriv.dot118021XGrpPrivacy));
1031 switch(key->KeyLength)
1034 padapter->securitypriv.dot11PrivacyAlgrthm=_WEP40_;
1035 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("Adapter->securitypriv.dot11PrivacyAlgrthm= %x key->KeyLength=%u\n", padapter->securitypriv.dot11PrivacyAlgrthm,key->KeyLength));
1038 padapter->securitypriv.dot11PrivacyAlgrthm=_WEP104_;
1039 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("Adapter->securitypriv.dot11PrivacyAlgrthm= %x key->KeyLength=%u\n", padapter->securitypriv.dot11PrivacyAlgrthm,key->KeyLength));
1042 padapter->securitypriv.dot11PrivacyAlgrthm=_NO_PRIVACY_;
1043 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("Adapter->securitypriv.dot11PrivacyAlgrthm= %x key->KeyLength=%u \n", padapter->securitypriv.dot11PrivacyAlgrthm,key->KeyLength));
1047 encryptionalgo=padapter->securitypriv.dot11PrivacyAlgrthm;
1049 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,(" Adapter->securitypriv.dot11PrivacyAlgrthm=%x\n", padapter->securitypriv.dot11PrivacyAlgrthm));
1054 encryptionalgo=padapter->securitypriv.dot118021XGrpPrivacy;
1055 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("( Adapter->securitypriv.dot11PrivacyAlgrthm=%x )encryptionalgo(%x)=padapter->securitypriv.dot118021XGrpPrivacy(%x)keylen=%d\n", padapter->securitypriv.dot11PrivacyAlgrthm,encryptionalgo,padapter->securitypriv.dot118021XGrpPrivacy,key->KeyLength));
1059 if((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE)==_TRUE) && (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == _FALSE)) {
1060 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,(" IBSS but BSSID is not Broadcast Address.\n"));
1065 // Check key length for TKIP
1066 if((encryptionalgo== _TKIP_) && (key->KeyLength != 32)) {
1068 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,(" TKIP GTK KeyLength:%u != 32\n", key->KeyLength));
1072 } else if(encryptionalgo== _AES_ && (key->KeyLength != 16 && key->KeyLength != 32) ) {
1074 // Check key length for AES
1075 // For NDTEST, we allow keylen=32 in this case. 2005.01.27, by rcnjko.
1076 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("<=== SetInfo, OID_802_11_ADD_KEY: AES GTK KeyLength:%u != 16 or 32\n", key->KeyLength));
1081 // Change the key length for EAPPkt9x.vxd. Added by Annie, 2005-11-03.
1082 if((encryptionalgo== _AES_) && (key->KeyLength == 32) ) {
1083 key->KeyLength = 16;
1084 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("AES key length changed: %u\n", key->KeyLength) );
1087 if(key->KeyIndex & 0x8000000) {//error ??? 0x8000_0000
1091 if((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE)==_TRUE)&&(check_fwstate(&padapter->mlmepriv, _FW_LINKED)==_TRUE))
1098 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n") );
1099 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("[Group Key set]\n") );
1100 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n")) ;
1101 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key index: 0x%8x(0x%8x)\n", key->KeyIndex,(key->KeyIndex&0x3)));
1102 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("key Length: %d\n", key->KeyLength)) ;
1103 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("------------------------------------------\n"));
1107 // If WEP encryption algorithm, just call rtw_set_802_11_add_wep().
1108 if((padapter->securitypriv.dot11AuthAlgrthm !=dot11AuthAlgrthm_8021X)&&(encryptionalgo== _WEP40_ || encryptionalgo== _WEP104_))
1112 u32 len = FIELD_OFFSET(NDIS_802_11_KEY, KeyMaterial) + key->KeyLength;
1113 NDIS_802_11_WEP *wep = &padapter->securitypriv.ndiswep;
1115 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ WEP key +++++\n"));
1118 keyindex = key->KeyIndex&0x7fffffff;
1119 wep->KeyIndex = keyindex ;
1120 wep->KeyLength = key->KeyLength;
1122 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY:Before memcpy \n"));
1124 _rtw_memcpy(wep->KeyMaterial, key->KeyMaterial, key->KeyLength);
1125 _rtw_memcpy(&(padapter->securitypriv.dot11DefKey[keyindex].skey[0]), key->KeyMaterial, key->KeyLength);
1127 padapter->securitypriv.dot11DefKeylen[keyindex]=key->KeyLength;
1128 padapter->securitypriv.dot11PrivacyKeyIndex=keyindex;
1130 ret = rtw_set_802_11_add_wep(padapter, wep);
1136 if(key->KeyIndex & 0x20000000){
1138 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("OID_802_11_ADD_KEY: +++++ SetRSC+++++\n"));
1141 NDIS_802_11_KEY_RSC keysrc=key->KeyRSC & 0x00FFFFFFFFFFFFULL;
1142 _rtw_memcpy(&padapter->securitypriv.dot11Grprxpn, &keysrc, 8);
1146 NDIS_802_11_KEY_RSC keysrc=key->KeyRSC & 0x00FFFFFFFFFFFFULL;
1147 _rtw_memcpy(&padapter->securitypriv.dot11Grptxpn, &keysrc, 8);
1152 // Indicate this key idx is used for TX
1153 // Save the key in KeyMaterial
1154 if(bgroup == _TRUE) // Group transmit key
1158 if(bgrouptkey == _TRUE)
1160 padapter->securitypriv.dot118021XGrpKeyid=(u8)key->KeyIndex;
1163 if((key->KeyIndex&0x3) == 0){
1168 _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], 0, 16);
1169 _rtw_memset(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16);
1170 _rtw_memset(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16);
1172 if((key->KeyIndex & 0x10000000))
1174 _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8);
1175 _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8);
1177 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rx mic :0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n",
1178 padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[0],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[1],
1179 padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[2],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[3],
1180 padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[4],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[5],
1181 padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[6],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[7]));
1182 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:set Group mic key!!!!!!!!\n"));
1187 _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8);
1188 _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8);
1190 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rx mic :0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x:0x%02x\n",
1191 padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[0],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[1],
1192 padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[2],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[3],
1193 padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[4],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[5],
1194 padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)].skey[6],padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex-1) & 0x03)].skey[7]));
1195 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:set Group mic key!!!!!!!!\n"));
1199 //set group key by index
1200 _rtw_memcpy(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial, key->KeyLength);
1202 key->KeyIndex=key->KeyIndex & 0x03;
1204 padapter->securitypriv.binstallGrpkey=_TRUE;
1206 padapter->securitypriv.bcheck_grpkey=_FALSE;
1208 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("reset group key"));
1210 res=rtw_set_key(padapter,&padapter->securitypriv, key->KeyIndex, 1, _TRUE);
1218 else // Pairwise Key
1222 pbssid=get_bssid(&padapter->mlmepriv);
1223 stainfo=rtw_get_stainfo(&padapter->stapriv , pbssid );
1227 _rtw_memset( &stainfo->dot118021x_UncstKey, 0, 16);// clear keybuffer
1229 _rtw_memcpy(&stainfo->dot118021x_UncstKey, key->KeyMaterial, 16);
1231 if(encryptionalgo== _TKIP_)
1233 padapter->securitypriv.busetkipkey=_FALSE;
1235 //_set_timer(&padapter->securitypriv.tkip_timer, 50);
1237 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n ==========_set_timer\n"));
1239 // if TKIP, save the Receive/Transmit MIC key in KeyMaterial[128-255]
1240 if((key->KeyIndex & 0x10000000)){
1241 _rtw_memcpy(&stainfo->dot11tkiptxmickey, key->KeyMaterial + 16, 8);
1242 _rtw_memcpy(&stainfo->dot11tkiprxmickey, key->KeyMaterial + 24, 8);
1245 _rtw_memcpy(&stainfo->dot11tkiptxmickey, key->KeyMaterial + 24, 8);
1246 _rtw_memcpy(&stainfo->dot11tkiprxmickey, key->KeyMaterial + 16, 8);
1251 else if(encryptionalgo == _AES_)
1257 //Set key to CAM through H2C command
1259 if(bgrouptkey)//never go to here
1261 res=rtw_setstakey_cmd(padapter, stainfo, GROUP_KEY, _TRUE);
1262 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rtw_setstakey_cmd(group)\n"));
1265 res=rtw_setstakey_cmd(padapter, stainfo, UNICAST_KEY, _TRUE);
1266 RT_TRACE(_module_rtl871x_ioctl_set_c_,_drv_err_,("\n rtw_set_802_11_add_key:rtw_setstakey_cmd(unicast)\n"));
1270 res = rtw_setstakey_cmd(padapter, stainfo, UNICAST_KEY, _TRUE);
1271 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n rtw_set_802_11_add_key:rtw_setstakey_cmd(unicast)\n"));
1288 u8 rtw_set_802_11_remove_key(_adapter* padapter, NDIS_802_11_REMOVE_KEY *key){
1290 uint encryptionalgo;
1292 struct sta_info *stainfo;
1293 u8 bgroup = (key->KeyIndex & 0x4000000) > 0 ? _FALSE: _TRUE;
1294 u8 keyIndex = (u8)key->KeyIndex & 0x03;
1299 if ((key->KeyIndex & 0xbffffffc) > 0) {
1304 if (bgroup == _TRUE) {
1305 encryptionalgo= padapter->securitypriv.dot118021XGrpPrivacy;
1306 // clear group key by index
1307 //NdisZeroMemory(Adapter->MgntInfo.SecurityInfo.KeyBuf[keyIndex], MAX_WEP_KEY_LEN);
1308 //Adapter->MgntInfo.SecurityInfo.KeyLen[keyIndex] = 0;
1310 _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[keyIndex], 0, 16);
1312 //! \todo Send a H2C Command to Firmware for removing this Key in CAM Entry.
1316 pbssid=get_bssid(&padapter->mlmepriv);
1317 stainfo=rtw_get_stainfo(&padapter->stapriv , pbssid );
1319 encryptionalgo=stainfo->dot118021XPrivacy;
1321 // clear key by BSSID
1322 _rtw_memset(&stainfo->dot118021x_UncstKey, 0, 16);
1324 //! \todo Send a H2C Command to Firmware for disable this Key in CAM Entry.
1342 * rtw_get_cur_max_rate -
1343 * @adapter: pointer to _adapter structure
1345 * Return 0 or 100Kbps
1347 u16 rtw_get_cur_max_rate(_adapter *adapter)
1350 u16 rate = 0, max_rate = 0;
1351 struct mlme_priv *pmlmepriv = &adapter->mlmepriv;
1352 WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network;
1353 struct sta_info *psta = NULL;
1355 #ifdef CONFIG_80211N_HT
1359 #ifdef CONFIG_MP_INCLUDED
1360 if (adapter->registrypriv.mp_mode == 1)
1362 if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE)
1367 if((check_fwstate(pmlmepriv, _FW_LINKED) != _TRUE)
1368 && (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != _TRUE))
1371 psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv));
1375 short_GI = query_ra_short_GI(psta);
1377 #ifdef CONFIG_80211N_HT
1378 if (IsSupportedHT(psta->wireless_mode)) {
1379 rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type));
1381 max_rate = rtw_mcs_rate(
1383 ((psta->bw_mode == CHANNEL_WIDTH_40)?1:0),
1385 psta->htpriv.ht_cap.supp_mcs_set
1388 #ifdef CONFIG_80211AC_VHT
1389 else if (IsSupportedVHT(psta->wireless_mode)) {
1390 max_rate = ((rtw_vht_mcs_to_data_rate(psta->bw_mode, short_GI, pmlmepriv->vhtpriv.vht_highest_rate) + 1) >> 1) * 10;
1392 #endif //CONFIG_80211AC_VHT
1394 #endif //CONFIG_80211N_HT
1396 while( (pcur_bss->SupportedRates[i]!=0) && (pcur_bss->SupportedRates[i]!=0xFF))
1398 rate = pcur_bss->SupportedRates[i]&0x7F;
1404 max_rate = max_rate*10/2;
1411 * rtw_set_scan_mode -
1412 * @adapter: pointer to _adapter structure
1415 * Return _SUCCESS or _FAIL
1417 int rtw_set_scan_mode(_adapter *adapter, RT_SCAN_TYPE scan_mode)
1419 if(scan_mode != SCAN_ACTIVE && scan_mode != SCAN_PASSIVE)
1422 adapter->mlmepriv.scan_mode = scan_mode;
1428 * rtw_set_channel_plan -
1429 * @adapter: pointer to _adapter structure
1432 * Return _SUCCESS or _FAIL
1434 int rtw_set_channel_plan(_adapter *adapter, u8 channel_plan)
1436 struct registry_priv *pregistrypriv = &adapter->registrypriv;
1437 struct mlme_priv *pmlmepriv = &adapter->mlmepriv;
1439 //handle by cmd_thread to sync with scan operation
1440 return rtw_set_chplan_cmd(adapter, RTW_CMDF_WAIT_ACK, channel_plan, 1);
1445 * @adapter: pointer to _adapter structure
1446 * @country_code: string of country code
1448 * Return _SUCCESS or _FAIL
1450 int rtw_set_country(_adapter *adapter, const char *country_code)
1452 #ifdef CONFIG_RTW_IOCTL_SET_COUNTRY
1453 return rtw_set_country_cmd(adapter, RTW_CMDF_WAIT_ACK, country_code, 1);
1461 * @adapter: pointer to _adapter structure
1462 * @band: band to set
1464 * Return _SUCCESS or _FAIL
1466 int rtw_set_band(_adapter *adapter, u8 band)
1468 if (rtw_band_valid(band)) {
1469 DBG_871X(FUNC_ADPT_FMT" band:%d\n", FUNC_ADPT_ARG(adapter), band);
1470 adapter->setband = band;
1474 DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" band:%d fail\n", FUNC_ADPT_ARG(adapter), band);