drivers/staging/rtl8723bs/core/rtw_ioctl_set.c - linux - Git at Google

 // SPDX-License-Identifier: GPL-2.0
 /******************************************************************************
  *
  * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
  *
  ******************************************************************************/
 #define _RTW_IOCTL_SET_C_

 #include <drv_types.h>
 #include <rtw_debug.h>

 #define IS_MAC_ADDRESS_BROADCAST(addr) \
 (\
 	((addr[0] == 0xff) && (addr[1] == 0xff) && \
 		(addr[2] == 0xff) && (addr[3] == 0xff) && \
 		(addr[4] == 0xff) && (addr[5] == 0xff))  ? true : false \
 )

 u8 rtw_validate_bssid(u8 *bssid)
 {
 	u8 ret = true;

 	if (is_zero_mac_addr(bssid)
 		|| is_broadcast_mac_addr(bssid)
 		|| is_multicast_mac_addr(bssid)
 	) {
 		ret = false;
 	}

 	return ret;
 }

 u8 rtw_validate_ssid(struct ndis_802_11_ssid *ssid)
 {
 	u8 ret = true;

 	if (ssid->SsidLength > 32) {
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid length >32\n"));
 		ret = false;
 		goto exit;
 	}

 #ifdef CONFIG_VALIDATE_SSID
 	for (i = 0; i < ssid->SsidLength; i++) {
 		/* wifi, printable ascii code must be supported */
 		if (!((ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e))) {
 			RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid has nonprintabl ascii\n"));
 			ret = false;
 			break;
 		}
 	}
 #endif /* CONFIG_VALIDATE_SSID */

 exit:
 	return ret;
 }

 u8 rtw_do_join(struct adapter *padapter);
 u8 rtw_do_join(struct adapter *padapter)
 {
 	struct list_head	*plist, *phead;
 	u8 *pibss = NULL;
 	struct	mlme_priv *pmlmepriv = &(padapter->mlmepriv);
 	struct __queue	*queue	= &(pmlmepriv->scanned_queue);
 	u8 ret = _SUCCESS;

 	spin_lock_bh(&(pmlmepriv->scanned_queue.lock));
 	phead = get_list_head(queue);
 	plist = get_next(phead);

 	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("\n rtw_do_join: phead = %p; plist = %p\n\n\n", phead, plist));

 	pmlmepriv->cur_network.join_res = -2;

 	set_fwstate(pmlmepriv, _FW_UNDER_LINKING);

 	pmlmepriv->pscanned = plist;

 	pmlmepriv->to_join = true;

 	if (list_empty(&queue->queue)) {
 		spin_unlock_bh(&(pmlmepriv->scanned_queue.lock));
 		_clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING);

 		/* when set_ssid/set_bssid for rtw_do_join(), but scanning queue is empty */
 		/* we try to issue sitesurvey firstly */

 		if (pmlmepriv->LinkDetectInfo.bBusyTraffic == false
 			|| rtw_to_roam(padapter) > 0
 		) {
 			RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("rtw_do_join(): site survey if scanned_queue is empty\n."));
 			/*  submit site_survey_cmd */
 			ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0);
 			if (_SUCCESS != ret) {
 				pmlmepriv->to_join = false;
 				RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("rtw_do_join(): site survey return error\n."));
 			}
 		} else {
 			pmlmepriv->to_join = false;
 			ret = _FAIL;
 		}

 		goto exit;
 	} else {
 		int select_ret;
 		spin_unlock_bh(&(pmlmepriv->scanned_queue.lock));
 		select_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv);
 		if (select_ret == _SUCCESS) {
 			pmlmepriv->to_join = false;
 			_set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT);
 		} else {
 			if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) {
 				/*  submit createbss_cmd to change to a ADHOC_MASTER */

 				/* pmlmepriv->lock has been acquired by caller... */
 				struct wlan_bssid_ex    *pdev_network = &(padapter->registrypriv.dev_network);

 				pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;

 				pibss = padapter->registrypriv.dev_network.MacAddress;

 				memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(struct ndis_802_11_ssid));

 				rtw_update_registrypriv_dev_network(padapter);

 				rtw_generate_random_ibss(pibss);

 				if (rtw_createbss_cmd(padapter) != _SUCCESS) {
 					RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("***Error =>do_goin: rtw_createbss_cmd status FAIL***\n "));
 					ret =  false;
 					goto exit;
 				}

 				pmlmepriv->to_join = false;

 				RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("***Error => rtw_select_and_join_from_scanned_queue FAIL under STA_Mode***\n "));

 			} else {
 				/*  can't associate ; reset under-linking */
 				_clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING);

 				/* when set_ssid/set_bssid for rtw_do_join(), but there are no desired bss in scanning queue */
 				/* we try to issue sitesurvey firstly */
 				if (pmlmepriv->LinkDetectInfo.bBusyTraffic == false
 					|| rtw_to_roam(padapter) > 0
 				) {
 					/* DBG_871X("rtw_do_join() when   no desired bss in scanning queue\n"); */
 					ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0);
 					if (_SUCCESS != ret) {
 						pmlmepriv->to_join = false;
 						RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("do_join(): site survey return error\n."));
 					}
 				} else {
 					ret = _FAIL;
 					pmlmepriv->to_join = false;
 				}
 			}

 		}

 	}

 exit:
 	return ret;
 }

 u8 rtw_set_802_11_bssid(struct adapter *padapter, u8 *bssid)
 {
 	u8 status = _SUCCESS;

 	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;

 	DBG_871X_LEVEL(_drv_always_, "set bssid:%pM\n", bssid);

 	if ((bssid[0] == 0x00 && bssid[1] == 0x00 && bssid[2] == 0x00 && bssid[3] == 0x00 && bssid[4] == 0x00 && bssid[5] == 0x00) ||
 	    (bssid[0] == 0xFF && bssid[1] == 0xFF && bssid[2] == 0xFF && bssid[3] == 0xFF && bssid[4] == 0xFF && bssid[5] == 0xFF)) {
 		status = _FAIL;
 		goto exit;
 	}

 	spin_lock_bh(&pmlmepriv->lock);


 	DBG_871X("Set BSSID under fw_state = 0x%08x\n", get_fwstate(pmlmepriv));
 	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
 		goto handle_tkip_countermeasure;
 	} else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) {
 		goto release_mlme_lock;
 	}

 	if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) {
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n"));

 		if (!memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid, ETH_ALEN)) {
 			if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false)
 				goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */
 		} else {
 			RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("Set BSSID not the same bssid\n"));
 			RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid ="MAC_FMT"\n", MAC_ARG(bssid)));
 			RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("cur_bssid ="MAC_FMT"\n", MAC_ARG(pmlmepriv->cur_network.network.MacAddress)));

 			rtw_disassoc_cmd(padapter, 0, true);

 			if (check_fwstate(pmlmepriv, _FW_LINKED) == true)
 				rtw_indicate_disconnect(padapter);

 			rtw_free_assoc_resources(padapter, 1);

 			if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) {
 				_clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
 				set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
 			}
 		}
 	}

 handle_tkip_countermeasure:
 	if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) {
 		status = _FAIL;
 		goto release_mlme_lock;
 	}

 	memset(&pmlmepriv->assoc_ssid, 0, sizeof(struct ndis_802_11_ssid));
 	memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN);
 	pmlmepriv->assoc_by_bssid = true;

 	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
 		pmlmepriv->to_join = true;
 	} else {
 		status = rtw_do_join(padapter);
 	}

 release_mlme_lock:
 	spin_unlock_bh(&pmlmepriv->lock);

 exit:
 	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
 		("rtw_set_802_11_bssid: status =%d\n", status));

 	return status;
 }

 u8 rtw_set_802_11_ssid(struct adapter *padapter, struct ndis_802_11_ssid *ssid)
 {
 	u8 status = _SUCCESS;

 	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 	struct wlan_network *pnetwork = &pmlmepriv->cur_network;

 	DBG_871X_LEVEL(_drv_always_, "set ssid [%s] fw_state = 0x%08x\n",
 			ssid->Ssid, get_fwstate(pmlmepriv));

 	if (padapter->hw_init_completed == false) {
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
 			 ("set_ssid: hw_init_completed ==false =>exit!!!\n"));
 		status = _FAIL;
 		goto exit;
 	}

 	spin_lock_bh(&pmlmepriv->lock);

 	DBG_871X("Set SSID under fw_state = 0x%08x\n", get_fwstate(pmlmepriv));
 	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
 		goto handle_tkip_countermeasure;
 	} else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) {
 		goto release_mlme_lock;
 	}

 	if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) {
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
 			 ("set_ssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n"));

 		if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) &&
 		    (!memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid, ssid->SsidLength))) {
 			if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false)) {
 				RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
 					 ("Set SSID is the same ssid, fw_state = 0x%08x\n",
 					  get_fwstate(pmlmepriv)));

 				if (rtw_is_same_ibss(padapter, pnetwork) == false) {
 					/* if in WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE, create bss or rejoin again */
 					rtw_disassoc_cmd(padapter, 0, true);

 					if (check_fwstate(pmlmepriv, _FW_LINKED) == true)
 						rtw_indicate_disconnect(padapter);

 					rtw_free_assoc_resources(padapter, 1);

 					if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) {
 						_clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
 						set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
 					}
 				} else {
 					goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */
 				}
 			} else {
 				rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_JOINBSS, 1);
 			}
 		} else {
 			RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("Set SSID not the same ssid\n"));
 			RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_ssid =[%s] len = 0x%x\n", ssid->Ssid, (unsigned int)ssid->SsidLength));
 			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));

 			rtw_disassoc_cmd(padapter, 0, true);

 			if (check_fwstate(pmlmepriv, _FW_LINKED) == true)
 				rtw_indicate_disconnect(padapter);

 			rtw_free_assoc_resources(padapter, 1);

 			if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) {
 				_clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
 				set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
 			}
 		}
 	}

 handle_tkip_countermeasure:
 	if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) {
 		status = _FAIL;
 		goto release_mlme_lock;
 	}

 	if (rtw_validate_ssid(ssid) == false) {
 		status = _FAIL;
 		goto release_mlme_lock;
 	}

 	memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid));
 	pmlmepriv->assoc_by_bssid = false;

 	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
 		pmlmepriv->to_join = true;
 	} else {
 		status = rtw_do_join(padapter);
 	}

 release_mlme_lock:
 	spin_unlock_bh(&pmlmepriv->lock);

 exit:
 	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
 		("-rtw_set_802_11_ssid: status =%d\n", status));

 	return status;
 }

 u8 rtw_set_802_11_connect(struct adapter *padapter, u8 *bssid, struct ndis_802_11_ssid *ssid)
 {
 	u8 status = _SUCCESS;
 	bool bssid_valid = true;
 	bool ssid_valid = true;
 	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;

 	if (!ssid || rtw_validate_ssid(ssid) == false)
 		ssid_valid = false;

 	if (!bssid || rtw_validate_bssid(bssid) == false)
 		bssid_valid = false;

 	if (ssid_valid == false && bssid_valid == false) {
 		DBG_871X(FUNC_ADPT_FMT" ssid:%p, ssid_valid:%d, bssid:%p, bssid_valid:%d\n",
 			FUNC_ADPT_ARG(padapter), ssid, ssid_valid, bssid, bssid_valid);
 		status = _FAIL;
 		goto exit;
 	}

 	if (padapter->hw_init_completed == false) {
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
 			 ("set_ssid: hw_init_completed ==false =>exit!!!\n"));
 		status = _FAIL;
 		goto exit;
 	}

 	spin_lock_bh(&pmlmepriv->lock);

 	DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT"  fw_state = 0x%08x\n",
 		FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv));

 	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
 		goto handle_tkip_countermeasure;
 	} else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) {
 		goto release_mlme_lock;
 	}

 handle_tkip_countermeasure:
 	if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) {
 		status = _FAIL;
 		goto release_mlme_lock;
 	}

 	if (ssid && ssid_valid)
 		memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid));
 	else
 		memset(&pmlmepriv->assoc_ssid, 0, sizeof(struct ndis_802_11_ssid));

 	if (bssid && bssid_valid) {
 		memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN);
 		pmlmepriv->assoc_by_bssid = true;
 	} else {
 		pmlmepriv->assoc_by_bssid = false;
 	}

 	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
 		pmlmepriv->to_join = true;
 	} else {
 		status = rtw_do_join(padapter);
 	}

 release_mlme_lock:
 	spin_unlock_bh(&pmlmepriv->lock);

 exit:
 	return status;
 }

 u8 rtw_set_802_11_infrastructure_mode(struct adapter *padapter,
 	enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype)
 {
 	struct	mlme_priv *pmlmepriv = &padapter->mlmepriv;
 	struct	wlan_network	*cur_network = &pmlmepriv->cur_network;
 	enum NDIS_802_11_NETWORK_INFRASTRUCTURE *pold_state = &(cur_network->network.InfrastructureMode);

 	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_notice_,
 		 ("+rtw_set_802_11_infrastructure_mode: old =%d new =%d fw_state = 0x%08x\n",
 		  *pold_state, networktype, get_fwstate(pmlmepriv)));

 	if (*pold_state != networktype) {
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, (" change mode!"));
 		/* DBG_871X("change mode, old_mode =%d, new_mode =%d, fw_state = 0x%x\n", *pold_state, networktype, get_fwstate(pmlmepriv)); */

 		if (*pold_state == Ndis802_11APMode) {
 			/* change to other mode from Ndis802_11APMode */
 			cur_network->join_res = -1;

 			stop_ap_mode(padapter);
 		}

 		spin_lock_bh(&pmlmepriv->lock);

 		if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) || (*pold_state == Ndis802_11IBSS))
 			rtw_disassoc_cmd(padapter, 0, true);

 		if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) ||
 			(check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true))
 			rtw_free_assoc_resources(padapter, 1);

 		if ((*pold_state == Ndis802_11Infrastructure) || (*pold_state == Ndis802_11IBSS)) {
 			if (check_fwstate(pmlmepriv, _FW_LINKED) == true) {
 				rtw_indicate_disconnect(padapter); /* will clr Linked_state; before this function, we must have chked whether  issue dis-assoc_cmd or not */
 			}
 	       }

 		*pold_state = networktype;

 		_clr_fwstate_(pmlmepriv, ~WIFI_NULL_STATE);

 		switch (networktype) {
 		case Ndis802_11IBSS:
 			set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
 			break;

 		case Ndis802_11Infrastructure:
 			set_fwstate(pmlmepriv, WIFI_STATION_STATE);
 			break;

 		case Ndis802_11APMode:
 			set_fwstate(pmlmepriv, WIFI_AP_STATE);
 			start_ap_mode(padapter);
 			/* rtw_indicate_connect(padapter); */

 			break;

 		case Ndis802_11AutoUnknown:
 		case Ndis802_11InfrastructureMax:
 			break;
 		}

 		/* SecClearAllKeys(adapter); */

 		/* RT_TRACE(COMP_OID_SET, DBG_LOUD, ("set_infrastructure: fw_state:%x after changing mode\n", */
 		/* 									get_fwstate(pmlmepriv))); */

 		spin_unlock_bh(&pmlmepriv->lock);
 	}
 	return true;
 }


 u8 rtw_set_802_11_disassociate(struct adapter *padapter)
 {
 	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;

 	spin_lock_bh(&pmlmepriv->lock);

 	if (check_fwstate(pmlmepriv, _FW_LINKED) == true) {
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_disassociate: rtw_indicate_disconnect\n"));

 		rtw_disassoc_cmd(padapter, 0, true);
 		rtw_indicate_disconnect(padapter);
 		/* modify for CONFIG_IEEE80211W, none 11w can use it */
 		rtw_free_assoc_resources_cmd(padapter);
 		if (_FAIL == rtw_pwr_wakeup(padapter))
 			DBG_871X("%s(): rtw_pwr_wakeup fail !!!\n", __func__);
 	}

 	spin_unlock_bh(&pmlmepriv->lock);

 	return true;
 }

 u8 rtw_set_802_11_bssid_list_scan(struct adapter *padapter, struct ndis_802_11_ssid *pssid, int ssid_max_num)
 {
 	struct	mlme_priv 	*pmlmepriv = &padapter->mlmepriv;
 	u8 res = true;

 	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("+rtw_set_802_11_bssid_list_scan(), fw_state =%x\n", get_fwstate(pmlmepriv)));

 	if (padapter == NULL) {
 		res = false;
 		goto exit;
 	}
 	if (padapter->hw_init_completed == false) {
 		res = false;
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n ===rtw_set_802_11_bssid_list_scan:hw_init_completed ==false ===\n"));
 		goto exit;
 	}

 	if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) ||
 		(pmlmepriv->LinkDetectInfo.bBusyTraffic == true)) {
 		/*  Scan or linking is in progress, do nothing. */
 		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)));
 		res = true;

 		if (check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING)) == true) {
 			RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n###_FW_UNDER_SURVEY|_FW_UNDER_LINKING\n\n"));
 		} else {
 			RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n###pmlmepriv->sitesurveyctrl.traffic_busy ==true\n\n"));
 		}
 	} else {
 		if (rtw_is_scan_deny(padapter)) {
 			DBG_871X(FUNC_ADPT_FMT": scan deny\n", FUNC_ADPT_ARG(padapter));
 			indicate_wx_scan_complete_event(padapter);
 			return _SUCCESS;
 		}

 		spin_lock_bh(&pmlmepriv->lock);

 		res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, NULL, 0);

 		spin_unlock_bh(&pmlmepriv->lock);
 	}
 exit:

 	return res;
 }

 u8 rtw_set_802_11_authentication_mode(struct adapter *padapter, enum NDIS_802_11_AUTHENTICATION_MODE authmode)
 {
 	struct security_priv *psecuritypriv = &padapter->securitypriv;
 	int res;
 	u8 ret;

 	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_802_11_auth.mode(): mode =%x\n", authmode));

 	psecuritypriv->ndisauthtype = authmode;

 	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("rtw_set_802_11_authentication_mode:psecuritypriv->ndisauthtype =%d", psecuritypriv->ndisauthtype));

 	if (psecuritypriv->ndisauthtype > 3)
 		psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X;

 	res = rtw_set_auth(padapter, psecuritypriv);

 	if (res == _SUCCESS)
 		ret = true;
 	else
 		ret = false;

 	return ret;
 }

 u8 rtw_set_802_11_add_wep(struct adapter *padapter, struct ndis_802_11_wep *wep)
 {

 	sint		keyid, res;
 	struct security_priv *psecuritypriv = &(padapter->securitypriv);
 	u8 ret = _SUCCESS;

 	keyid = wep->KeyIndex & 0x3fffffff;

 	if (keyid >= 4) {
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("MgntActrtw_set_802_11_add_wep:keyid>4 =>fail\n"));
 		ret = false;
 		goto exit;
 	}

 	switch (wep->KeyLength) {
 	case 5:
 		psecuritypriv->dot11PrivacyAlgrthm = _WEP40_;
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength =5\n"));
 		break;
 	case 13:
 		psecuritypriv->dot11PrivacyAlgrthm = _WEP104_;
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength = 13\n"));
 		break;
 	default:
 		psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
 		RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength!=5 or 13\n"));
 		break;
 	}

 	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
 		 ("rtw_set_802_11_add_wep:before memcpy, wep->KeyLength = 0x%x wep->KeyIndex = 0x%x  keyid =%x\n",
 		  wep->KeyLength, wep->KeyIndex, keyid));

 	memcpy(&(psecuritypriv->dot11DefKey[keyid].skey[0]), &(wep->KeyMaterial), wep->KeyLength);

 	psecuritypriv->dot11DefKeylen[keyid] = wep->KeyLength;

 	psecuritypriv->dot11PrivacyKeyIndex = keyid;

 	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",
 		psecuritypriv->dot11DefKey[keyid].skey[0], psecuritypriv->dot11DefKey[keyid].skey[1], psecuritypriv->dot11DefKey[keyid].skey[2],
 		psecuritypriv->dot11DefKey[keyid].skey[3], psecuritypriv->dot11DefKey[keyid].skey[4], psecuritypriv->dot11DefKey[keyid].skey[5],
 		psecuritypriv->dot11DefKey[keyid].skey[6], psecuritypriv->dot11DefKey[keyid].skey[7], psecuritypriv->dot11DefKey[keyid].skey[8],
 		psecuritypriv->dot11DefKey[keyid].skey[9], psecuritypriv->dot11DefKey[keyid].skey[10], psecuritypriv->dot11DefKey[keyid].skey[11],
 		psecuritypriv->dot11DefKey[keyid].skey[12]));

 	res = rtw_set_key(padapter, psecuritypriv, keyid, 1, true);

 	if (res == _FAIL)
 		ret = false;
 exit:

 	return ret;
 }

 /*
 * rtw_get_cur_max_rate -
 * @adapter: pointer to struct adapter structure
 *
 * Return 0 or 100Kbps
 */
 u16 rtw_get_cur_max_rate(struct adapter *adapter)
 {
 	int	i = 0;
 	u16 rate = 0, max_rate = 0;
 	struct mlme_priv *pmlmepriv = &adapter->mlmepriv;
 	struct wlan_bssid_ex	*pcur_bss = &pmlmepriv->cur_network.network;
 	struct sta_info *psta = NULL;
 	u8 short_GI = 0;
 	u8 rf_type = 0;

 	if ((check_fwstate(pmlmepriv, _FW_LINKED) != true)
 		&& (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != true))
 		return 0;

 	psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv));
 	if (psta == NULL)
 		return 0;

 	short_GI = query_ra_short_GI(psta);

 	if (IsSupportedHT(psta->wireless_mode)) {
 		rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type));

 		max_rate = rtw_mcs_rate(
 			rf_type,
 			((psta->bw_mode == CHANNEL_WIDTH_40)?1:0),
 			short_GI,
 			psta->htpriv.ht_cap.supp_mcs_set
 		);
 	} else {
 		while ((pcur_bss->SupportedRates[i] != 0) && (pcur_bss->SupportedRates[i] != 0xFF)) {
 			rate = pcur_bss->SupportedRates[i]&0x7F;
 			if (rate > max_rate)
 				max_rate = rate;
 			i++;
 		}

 		max_rate = max_rate*10/2;
 	}

 	return max_rate;
 }
	// SPDX-License-Identifier: GPL-2.0
	/******************************************************************************
	*
	* Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
	*
	******************************************************************************/
	#define _RTW_IOCTL_SET_C_

	#include <drv_types.h>
	#include <rtw_debug.h>

	#define IS_MAC_ADDRESS_BROADCAST(addr) \
	(\
	((addr[0] == 0xff) && (addr[1] == 0xff) && \
	(addr[2] == 0xff) && (addr[3] == 0xff) && \
	(addr[4] == 0xff) && (addr[5] == 0xff)) ? true : false \
	)

	u8 rtw_validate_bssid(u8 *bssid)
	{
	u8 ret = true;

	if (is_zero_mac_addr(bssid)
	\|\| is_broadcast_mac_addr(bssid)
	\|\| is_multicast_mac_addr(bssid)
	) {
	ret = false;
	}

	return ret;
	}

	u8 rtw_validate_ssid(struct ndis_802_11_ssid *ssid)
	{
	u8 ret = true;

	if (ssid->SsidLength > 32) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid length >32\n"));
	ret = false;
	goto exit;
	}

	#ifdef CONFIG_VALIDATE_SSID
	for (i = 0; i < ssid->SsidLength; i++) {
	/* wifi, printable ascii code must be supported */
	if (!((ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e))) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid has nonprintabl ascii\n"));
	ret = false;
	break;
	}
	}
	#endif /* CONFIG_VALIDATE_SSID */

	exit:
	return ret;
	}

	u8 rtw_do_join(struct adapter *padapter);
	u8 rtw_do_join(struct adapter *padapter)
	{
	struct list_head plist, phead;
	u8 *pibss = NULL;
	struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
	struct __queue *queue = &(pmlmepriv->scanned_queue);
	u8 ret = _SUCCESS;

	spin_lock_bh(&(pmlmepriv->scanned_queue.lock));
	phead = get_list_head(queue);
	plist = get_next(phead);

	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("\n rtw_do_join: phead = %p; plist = %p\n\n\n", phead, plist));

	pmlmepriv->cur_network.join_res = -2;

	set_fwstate(pmlmepriv, _FW_UNDER_LINKING);

	pmlmepriv->pscanned = plist;

	pmlmepriv->to_join = true;

	if (list_empty(&queue->queue)) {
	spin_unlock_bh(&(pmlmepriv->scanned_queue.lock));
	_clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING);

	/* when set_ssid/set_bssid for rtw_do_join(), but scanning queue is empty */
	/* we try to issue sitesurvey firstly */

	if (pmlmepriv->LinkDetectInfo.bBusyTraffic == false
	\|\| rtw_to_roam(padapter) > 0
	) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("rtw_do_join(): site survey if scanned_queue is empty\n."));
	/* submit site_survey_cmd */
	ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0);
	if (_SUCCESS != ret) {
	pmlmepriv->to_join = false;
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("rtw_do_join(): site survey return error\n."));
	}
	} else {
	pmlmepriv->to_join = false;
	ret = _FAIL;
	}

	goto exit;
	} else {
	int select_ret;
	spin_unlock_bh(&(pmlmepriv->scanned_queue.lock));
	select_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv);
	if (select_ret == _SUCCESS) {
	pmlmepriv->to_join = false;
	_set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT);
	} else {
	if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) {
	/* submit createbss_cmd to change to a ADHOC_MASTER */

	/* pmlmepriv->lock has been acquired by caller... */
	struct wlan_bssid_ex *pdev_network = &(padapter->registrypriv.dev_network);

	pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;

	pibss = padapter->registrypriv.dev_network.MacAddress;

	memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(struct ndis_802_11_ssid));

	rtw_update_registrypriv_dev_network(padapter);

	rtw_generate_random_ibss(pibss);

	if (rtw_createbss_cmd(padapter) != _SUCCESS) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("*Error =>do_goin: rtw_createbss_cmd status FAIL*\n "));
	ret = false;
	goto exit;
	}

	pmlmepriv->to_join = false;

	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("*Error => rtw_select_and_join_from_scanned_queue FAIL under STA_Mode*\n "));

	} else {
	/* can't associate ; reset under-linking */
	_clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING);

	/* when set_ssid/set_bssid for rtw_do_join(), but there are no desired bss in scanning queue */
	/* we try to issue sitesurvey firstly */
	if (pmlmepriv->LinkDetectInfo.bBusyTraffic == false
	\|\| rtw_to_roam(padapter) > 0
	) {
	/* DBG_871X("rtw_do_join() when no desired bss in scanning queue\n"); */
	ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0);
	if (_SUCCESS != ret) {
	pmlmepriv->to_join = false;
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("do_join(): site survey return error\n."));
	}
	} else {
	ret = _FAIL;
	pmlmepriv->to_join = false;
	}
	}

	}

	}

	exit:
	return ret;
	}

	u8 rtw_set_802_11_bssid(struct adapter padapter, u8 bssid)
	{
	u8 status = _SUCCESS;

	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;

	DBG_871X_LEVEL(_drv_always_, "set bssid:%pM\n", bssid);

	if ((bssid[0] == 0x00 && bssid[1] == 0x00 && bssid[2] == 0x00 && bssid[3] == 0x00 && bssid[4] == 0x00 && bssid[5] == 0x00) \|\|
	(bssid[0] == 0xFF && bssid[1] == 0xFF && bssid[2] == 0xFF && bssid[3] == 0xFF && bssid[4] == 0xFF && bssid[5] == 0xFF)) {
	status = _FAIL;
	goto exit;
	}

	spin_lock_bh(&pmlmepriv->lock);


	DBG_871X("Set BSSID under fw_state = 0x%08x\n", get_fwstate(pmlmepriv));
	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
	goto handle_tkip_countermeasure;
	} else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) {
	goto release_mlme_lock;
	}

	if (check_fwstate(pmlmepriv, _FW_LINKED\|WIFI_ADHOC_MASTER_STATE) == true) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid: _FW_LINKED\|\|WIFI_ADHOC_MASTER_STATE\n"));

	if (!memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid, ETH_ALEN)) {
	if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false)
	goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */
	} else {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("Set BSSID not the same bssid\n"));
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid ="MAC_FMT"\n", MAC_ARG(bssid)));
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("cur_bssid ="MAC_FMT"\n", MAC_ARG(pmlmepriv->cur_network.network.MacAddress)));

	rtw_disassoc_cmd(padapter, 0, true);

	if (check_fwstate(pmlmepriv, _FW_LINKED) == true)
	rtw_indicate_disconnect(padapter);

	rtw_free_assoc_resources(padapter, 1);

	if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) {
	_clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
	set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
	}
	}
	}

	handle_tkip_countermeasure:
	if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) {
	status = _FAIL;
	goto release_mlme_lock;
	}

	memset(&pmlmepriv->assoc_ssid, 0, sizeof(struct ndis_802_11_ssid));
	memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN);
	pmlmepriv->assoc_by_bssid = true;

	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
	pmlmepriv->to_join = true;
	} else {
	status = rtw_do_join(padapter);
	}

	release_mlme_lock:
	spin_unlock_bh(&pmlmepriv->lock);

	exit:
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
	("rtw_set_802_11_bssid: status =%d\n", status));

	return status;
	}

	u8 rtw_set_802_11_ssid(struct adapter padapter, struct ndis_802_11_ssid ssid)
	{
	u8 status = _SUCCESS;

	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
	struct wlan_network *pnetwork = &pmlmepriv->cur_network;

	DBG_871X_LEVEL(_drv_always_, "set ssid [%s] fw_state = 0x%08x\n",
	ssid->Ssid, get_fwstate(pmlmepriv));

	if (padapter->hw_init_completed == false) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
	("set_ssid: hw_init_completed ==false =>exit!!!\n"));
	status = _FAIL;
	goto exit;
	}

	spin_lock_bh(&pmlmepriv->lock);

	DBG_871X("Set SSID under fw_state = 0x%08x\n", get_fwstate(pmlmepriv));
	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
	goto handle_tkip_countermeasure;
	} else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) {
	goto release_mlme_lock;
	}

	if (check_fwstate(pmlmepriv, _FW_LINKED\|WIFI_ADHOC_MASTER_STATE) == true) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
	("set_ssid: _FW_LINKED\|\|WIFI_ADHOC_MASTER_STATE\n"));

	if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) &&
	(!memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid, ssid->SsidLength))) {
	if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false)) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
	("Set SSID is the same ssid, fw_state = 0x%08x\n",
	get_fwstate(pmlmepriv)));

	if (rtw_is_same_ibss(padapter, pnetwork) == false) {
	/* if in WIFI_ADHOC_MASTER_STATE \| WIFI_ADHOC_STATE, create bss or rejoin again */
	rtw_disassoc_cmd(padapter, 0, true);

	if (check_fwstate(pmlmepriv, _FW_LINKED) == true)
	rtw_indicate_disconnect(padapter);

	rtw_free_assoc_resources(padapter, 1);

	if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) {
	_clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
	set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
	}
	} else {
	goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */
	}
	} else {
	rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_JOINBSS, 1);
	}
	} else {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("Set SSID not the same ssid\n"));
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_ssid =[%s] len = 0x%x\n", ssid->Ssid, (unsigned int)ssid->SsidLength));
	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));

	rtw_disassoc_cmd(padapter, 0, true);

	if (check_fwstate(pmlmepriv, _FW_LINKED) == true)
	rtw_indicate_disconnect(padapter);

	rtw_free_assoc_resources(padapter, 1);

	if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) {
	_clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
	set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
	}
	}
	}

	handle_tkip_countermeasure:
	if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) {
	status = _FAIL;
	goto release_mlme_lock;
	}

	if (rtw_validate_ssid(ssid) == false) {
	status = _FAIL;
	goto release_mlme_lock;
	}

	memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid));
	pmlmepriv->assoc_by_bssid = false;

	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
	pmlmepriv->to_join = true;
	} else {
	status = rtw_do_join(padapter);
	}

	release_mlme_lock:
	spin_unlock_bh(&pmlmepriv->lock);

	exit:
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
	("-rtw_set_802_11_ssid: status =%d\n", status));

	return status;
	}

	u8 rtw_set_802_11_connect(struct adapter padapter, u8 bssid, struct ndis_802_11_ssid *ssid)
	{
	u8 status = _SUCCESS;
	bool bssid_valid = true;
	bool ssid_valid = true;
	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;

	if (!ssid \|\| rtw_validate_ssid(ssid) == false)
	ssid_valid = false;

	if (!bssid \|\| rtw_validate_bssid(bssid) == false)
	bssid_valid = false;

	if (ssid_valid == false && bssid_valid == false) {
	DBG_871X(FUNC_ADPT_FMT" ssid:%p, ssid_valid:%d, bssid:%p, bssid_valid:%d\n",
	FUNC_ADPT_ARG(padapter), ssid, ssid_valid, bssid, bssid_valid);
	status = _FAIL;
	goto exit;
	}

	if (padapter->hw_init_completed == false) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
	("set_ssid: hw_init_completed ==false =>exit!!!\n"));
	status = _FAIL;
	goto exit;
	}

	spin_lock_bh(&pmlmepriv->lock);

	DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" fw_state = 0x%08x\n",
	FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv));

	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
	goto handle_tkip_countermeasure;
	} else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) {
	goto release_mlme_lock;
	}

	handle_tkip_countermeasure:
	if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) {
	status = _FAIL;
	goto release_mlme_lock;
	}

	if (ssid && ssid_valid)
	memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid));
	else
	memset(&pmlmepriv->assoc_ssid, 0, sizeof(struct ndis_802_11_ssid));

	if (bssid && bssid_valid) {
	memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN);
	pmlmepriv->assoc_by_bssid = true;
	} else {
	pmlmepriv->assoc_by_bssid = false;
	}

	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) {
	pmlmepriv->to_join = true;
	} else {
	status = rtw_do_join(padapter);
	}

	release_mlme_lock:
	spin_unlock_bh(&pmlmepriv->lock);

	exit:
	return status;
	}

	u8 rtw_set_802_11_infrastructure_mode(struct adapter *padapter,
	enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype)
	{
	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
	struct wlan_network *cur_network = &pmlmepriv->cur_network;
	enum NDIS_802_11_NETWORK_INFRASTRUCTURE *pold_state = &(cur_network->network.InfrastructureMode);

	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_notice_,
	("+rtw_set_802_11_infrastructure_mode: old =%d new =%d fw_state = 0x%08x\n",
	*pold_state, networktype, get_fwstate(pmlmepriv)));

	if (*pold_state != networktype) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, (" change mode!"));
	/* DBG_871X("change mode, old_mode =%d, new_mode =%d, fw_state = 0x%x\n", pold_state, networktype, get_fwstate(pmlmepriv)); /

	if (*pold_state == Ndis802_11APMode) {
	/* change to other mode from Ndis802_11APMode */
	cur_network->join_res = -1;

	stop_ap_mode(padapter);
	}

	spin_lock_bh(&pmlmepriv->lock);

	if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) \|\| (*pold_state == Ndis802_11IBSS))
	rtw_disassoc_cmd(padapter, 0, true);

	if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) \|\|
	(check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true))
	rtw_free_assoc_resources(padapter, 1);

	if ((pold_state == Ndis802_11Infrastructure) \|\| (pold_state == Ndis802_11IBSS)) {
	if (check_fwstate(pmlmepriv, _FW_LINKED) == true) {
	rtw_indicate_disconnect(padapter); /* will clr Linked_state; before this function, we must have chked whether issue dis-assoc_cmd or not */
	}
	}

	*pold_state = networktype;

	_clr_fwstate_(pmlmepriv, ~WIFI_NULL_STATE);

	switch (networktype) {
	case Ndis802_11IBSS:
	set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
	break;

	case Ndis802_11Infrastructure:
	set_fwstate(pmlmepriv, WIFI_STATION_STATE);
	break;

	case Ndis802_11APMode:
	set_fwstate(pmlmepriv, WIFI_AP_STATE);
	start_ap_mode(padapter);
	/* rtw_indicate_connect(padapter); */

	break;

	case Ndis802_11AutoUnknown:
	case Ndis802_11InfrastructureMax:
	break;
	}

	/* SecClearAllKeys(adapter); */

	/* RT_TRACE(COMP_OID_SET, DBG_LOUD, ("set_infrastructure: fw_state:%x after changing mode\n", */
	/* get_fwstate(pmlmepriv))); */

	spin_unlock_bh(&pmlmepriv->lock);
	}
	return true;
	}


	u8 rtw_set_802_11_disassociate(struct adapter *padapter)
	{
	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;

	spin_lock_bh(&pmlmepriv->lock);

	if (check_fwstate(pmlmepriv, _FW_LINKED) == true) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_disassociate: rtw_indicate_disconnect\n"));

	rtw_disassoc_cmd(padapter, 0, true);
	rtw_indicate_disconnect(padapter);
	/* modify for CONFIG_IEEE80211W, none 11w can use it */
	rtw_free_assoc_resources_cmd(padapter);
	if (_FAIL == rtw_pwr_wakeup(padapter))
	DBG_871X("%s(): rtw_pwr_wakeup fail !!!\n", __func__);
	}

	spin_unlock_bh(&pmlmepriv->lock);

	return true;
	}

	u8 rtw_set_802_11_bssid_list_scan(struct adapter padapter, struct ndis_802_11_ssid pssid, int ssid_max_num)
	{
	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
	u8 res = true;

	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("+rtw_set_802_11_bssid_list_scan(), fw_state =%x\n", get_fwstate(pmlmepriv)));

	if (padapter == NULL) {
	res = false;
	goto exit;
	}
	if (padapter->hw_init_completed == false) {
	res = false;
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n ===rtw_set_802_11_bssid_list_scan:hw_init_completed ==false ===\n"));
	goto exit;
	}

	if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY\|_FW_UNDER_LINKING) == true) \|\|
	(pmlmepriv->LinkDetectInfo.bBusyTraffic == true)) {
	/* Scan or linking is in progress, do nothing. */
	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)));
	res = true;

	if (check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY\|_FW_UNDER_LINKING)) == true) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n###_FW_UNDER_SURVEY\|_FW_UNDER_LINKING\n\n"));
	} else {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n###pmlmepriv->sitesurveyctrl.traffic_busy ==true\n\n"));
	}
	} else {
	if (rtw_is_scan_deny(padapter)) {
	DBG_871X(FUNC_ADPT_FMT": scan deny\n", FUNC_ADPT_ARG(padapter));
	indicate_wx_scan_complete_event(padapter);
	return _SUCCESS;
	}

	spin_lock_bh(&pmlmepriv->lock);

	res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, NULL, 0);

	spin_unlock_bh(&pmlmepriv->lock);
	}
	exit:

	return res;
	}

	u8 rtw_set_802_11_authentication_mode(struct adapter *padapter, enum NDIS_802_11_AUTHENTICATION_MODE authmode)
	{
	struct security_priv *psecuritypriv = &padapter->securitypriv;
	int res;
	u8 ret;

	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_802_11_auth.mode(): mode =%x\n", authmode));

	psecuritypriv->ndisauthtype = authmode;

	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("rtw_set_802_11_authentication_mode:psecuritypriv->ndisauthtype =%d", psecuritypriv->ndisauthtype));

	if (psecuritypriv->ndisauthtype > 3)
	psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X;

	res = rtw_set_auth(padapter, psecuritypriv);

	if (res == _SUCCESS)
	ret = true;
	else
	ret = false;

	return ret;
	}

	u8 rtw_set_802_11_add_wep(struct adapter padapter, struct ndis_802_11_wep wep)
	{

	sint keyid, res;
	struct security_priv *psecuritypriv = &(padapter->securitypriv);
	u8 ret = _SUCCESS;

	keyid = wep->KeyIndex & 0x3fffffff;

	if (keyid >= 4) {
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("MgntActrtw_set_802_11_add_wep:keyid>4 =>fail\n"));
	ret = false;
	goto exit;
	}

	switch (wep->KeyLength) {
	case 5:
	psecuritypriv->dot11PrivacyAlgrthm = _WEP40_;
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength =5\n"));
	break;
	case 13:
	psecuritypriv->dot11PrivacyAlgrthm = _WEP104_;
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength = 13\n"));
	break;
	default:
	psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength!=5 or 13\n"));
	break;
	}

	RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
	("rtw_set_802_11_add_wep:before memcpy, wep->KeyLength = 0x%x wep->KeyIndex = 0x%x keyid =%x\n",
	wep->KeyLength, wep->KeyIndex, keyid));

	memcpy(&(psecuritypriv->dot11DefKey[keyid].skey[0]), &(wep->KeyMaterial), wep->KeyLength);

	psecuritypriv->dot11DefKeylen[keyid] = wep->KeyLength;

	psecuritypriv->dot11PrivacyKeyIndex = keyid;

	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",
	psecuritypriv->dot11DefKey[keyid].skey[0], psecuritypriv->dot11DefKey[keyid].skey[1], psecuritypriv->dot11DefKey[keyid].skey[2],
	psecuritypriv->dot11DefKey[keyid].skey[3], psecuritypriv->dot11DefKey[keyid].skey[4], psecuritypriv->dot11DefKey[keyid].skey[5],
	psecuritypriv->dot11DefKey[keyid].skey[6], psecuritypriv->dot11DefKey[keyid].skey[7], psecuritypriv->dot11DefKey[keyid].skey[8],
	psecuritypriv->dot11DefKey[keyid].skey[9], psecuritypriv->dot11DefKey[keyid].skey[10], psecuritypriv->dot11DefKey[keyid].skey[11],
	psecuritypriv->dot11DefKey[keyid].skey[12]));

	res = rtw_set_key(padapter, psecuritypriv, keyid, 1, true);

	if (res == _FAIL)
	ret = false;
	exit:

	return ret;
	}

	/*
	* rtw_get_cur_max_rate -
	* @adapter: pointer to struct adapter structure
	*
	* Return 0 or 100Kbps
	*/
	u16 rtw_get_cur_max_rate(struct adapter *adapter)
	{
	int i = 0;
	u16 rate = 0, max_rate = 0;
	struct mlme_priv *pmlmepriv = &adapter->mlmepriv;
	struct wlan_bssid_ex *pcur_bss = &pmlmepriv->cur_network.network;
	struct sta_info *psta = NULL;
	u8 short_GI = 0;
	u8 rf_type = 0;

	if ((check_fwstate(pmlmepriv, _FW_LINKED) != true)
	&& (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != true))
	return 0;

	psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv));
	if (psta == NULL)
	return 0;

	short_GI = query_ra_short_GI(psta);

	if (IsSupportedHT(psta->wireless_mode)) {
	rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type));

	max_rate = rtw_mcs_rate(
	rf_type,
	((psta->bw_mode == CHANNEL_WIDTH_40)?1:0),
	short_GI,
	psta->htpriv.ht_cap.supp_mcs_set
	);
	} else {
	while ((pcur_bss->SupportedRates[i] != 0) && (pcur_bss->SupportedRates[i] != 0xFF)) {
	rate = pcur_bss->SupportedRates[i]&0x7F;
	if (rate > max_rate)
	max_rate = rate;
	i++;
	}

	max_rate = max_rate*10/2;
	}

	return max_rate;
	}