| /****************************************************************************** |
| * |
| * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. |
| * |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms of version 2 of the GNU General Public License as |
| * published by the Free Software Foundation. |
| * |
| * This program is distributed in the hope that it will be useful, but WITHOUT |
| * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| * more details. |
| * |
| ******************************************************************************/ |
| #define _RTW_IOCTL_SET_C_ |
| |
| #include <osdep_service.h> |
| #include <drv_types.h> |
| #include <rtw_ioctl_set.h> |
| #include <hal_intf.h> |
| |
| #include <usb_ops.h> |
| #include <linux/ieee80211.h> |
| |
| int rtw_do_join23a(struct rtw_adapter *padapter) |
| { |
| struct list_head *plist, *phead; |
| u8* pibss = NULL; |
| struct mlme_priv *pmlmepriv = &padapter->mlmepriv; |
| struct rtw_queue *queue = &pmlmepriv->scanned_queue; |
| int ret = _SUCCESS; |
| |
| spin_lock_bh(&pmlmepriv->scanned_queue.lock); |
| phead = get_list_head(queue); |
| plist = phead->next; |
| |
| RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, |
| ("\n rtw_do_join23a: phead = %p; plist = %p\n\n\n", |
| phead, plist)); |
| |
| pmlmepriv->cur_network.join_res = -2; |
| |
| set_fwstate(pmlmepriv, _FW_UNDER_LINKING); |
| |
| 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_join23a(), but |
| scanning queue is empty */ |
| /* we try to issue sitesurvey firstly */ |
| |
| if (pmlmepriv->LinkDetectInfo.bBusyTraffic == false || |
| padapter->mlmepriv.to_roaming > 0) { |
| RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, |
| ("rtw_do_join23a(): site survey if scanned_queue " |
| "is empty\n.")); |
| /* submit site_survey23a_cmd */ |
| ret = rtw_sitesurvey_cmd23a(padapter, |
| &pmlmepriv->assoc_ssid, 1, |
| NULL, 0); |
| if (ret != _SUCCESS) { |
| pmlmepriv->to_join = false; |
| RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, |
| ("rtw_do_join23a(): 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_queue23a(pmlmepriv); |
| if (select_ret == _SUCCESS) { |
| pmlmepriv->to_join = false; |
| mod_timer(&pmlmepriv->assoc_timer, |
| jiffies + msecs_to_jiffies(MAX_JOIN_TIMEOUT)); |
| } else { |
| if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { |
| struct wlan_bssid_ex *pdev_network; |
| /* submit createbss_cmd to change to a |
| ADHOC_MASTER */ |
| |
| /* pmlmepriv->lock has been acquired by |
| caller... */ |
| 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 cfg80211_ssid)); |
| |
| rtw_update_registrypriv_dev_network23a(padapter); |
| |
| rtw_generate_random_ibss23a(pibss); |
| |
| if (rtw_createbss_cmd23a(padapter) != _SUCCESS) { |
| RT_TRACE(_module_rtl871x_ioctl_set_c_, |
| _drv_err_, |
| ("***Error =>do_goin: rtw_creat" |
| "ebss_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_join23a(), |
| but there are no desired bss in scanning |
| queue */ |
| /* we try to issue sitesurvey firstly */ |
| if (pmlmepriv->LinkDetectInfo.bBusyTraffic == |
| false || padapter->mlmepriv.to_roaming > 0){ |
| /* DBG_8723A("rtw_do_join23a() when no " |
| "desired bss in scanning queue\n"); |
| */ |
| ret = rtw_sitesurvey_cmd23a(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); |
| if (ret != _SUCCESS) { |
| 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; |
| } |
| |
| int rtw_set_802_11_ssid23a(struct rtw_adapter* padapter, |
| struct cfg80211_ssid *ssid) |
| { |
| int status = _SUCCESS; |
| u32 cur_time = 0; |
| |
| struct mlme_priv *pmlmepriv = &padapter->mlmepriv; |
| struct wlan_network *pnetwork = &pmlmepriv->cur_network; |
| |
| |
| |
| DBG_8723A_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_8723A("Set SSID under fw_state = 0x%08x\n", get_fwstate(pmlmepriv)); |
| if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) |
| goto handle_tkip_countermeasure; |
| else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) |
| goto release_mlme_lock; |
| |
| if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE)) { |
| RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, |
| ("set_ssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n")); |
| |
| if ((pmlmepriv->assoc_ssid.ssid_len == ssid->ssid_len) && |
| !memcmp(&pmlmepriv->assoc_ssid.ssid, ssid->ssid, |
| ssid->ssid_len)) { |
| if (!check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { |
| 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_ibss23a(padapter, pnetwork) == false) |
| { |
| /* if in WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE, create bss or rejoin again */ |
| rtw_disassoc_cmd23a(padapter, 0, true); |
| |
| if (check_fwstate(pmlmepriv, _FW_LINKED)) |
| rtw_indicate_disconnect23a(padapter); |
| |
| rtw_free_assoc_resources23a(padapter, 1); |
| |
| if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) { |
| _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_cmd23a(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->ssid_len)); |
| 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.ssid_len)); |
| |
| rtw_disassoc_cmd23a(padapter, 0, true); |
| |
| if (check_fwstate(pmlmepriv, _FW_LINKED)) |
| rtw_indicate_disconnect23a(padapter); |
| |
| rtw_free_assoc_resources23a(padapter, 1); |
| |
| if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) { |
| _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); |
| set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); |
| } |
| } |
| } |
| |
| handle_tkip_countermeasure: |
| |
| if (padapter->securitypriv.btkip_countermeasure == true) { |
| cur_time = jiffies; |
| |
| if ((cur_time - padapter->securitypriv.btkip_countermeasure_time) > 60 * HZ) |
| { |
| padapter->securitypriv.btkip_countermeasure = false; |
| padapter->securitypriv.btkip_countermeasure_time = 0; |
| } |
| else |
| { |
| status = _FAIL; |
| goto release_mlme_lock; |
| } |
| } |
| |
| memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct cfg80211_ssid)); |
| pmlmepriv->assoc_by_bssid = false; |
| |
| if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) |
| pmlmepriv->to_join = true; |
| else |
| status = rtw_do_join23a(padapter); |
| |
| release_mlme_lock: |
| spin_unlock_bh(&pmlmepriv->lock); |
| |
| exit: |
| RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, |
| ("-rtw_set_802_11_ssid23a: status =%d\n", status)); |
| |
| |
| |
| return status; |
| } |
| |
| int rtw_set_802_11_bssid23a_list_scan(struct rtw_adapter *padapter, |
| struct cfg80211_ssid *pssid, |
| int ssid_max_num) |
| { |
| struct mlme_priv *pmlmepriv = &padapter->mlmepriv; |
| int res = _SUCCESS; |
| |
| RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, |
| ("+rtw_set_802_11_bssid23a_list_scan(), fw_state =%x\n", |
| get_fwstate(pmlmepriv))); |
| |
| if (!padapter) { |
| res = _FAIL; |
| goto exit; |
| } |
| if (padapter->hw_init_completed == false) { |
| res = _FAIL; |
| RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, |
| ("\n === rtw_set_802_11_bssid23a_list_scan:" |
| "hw_init_completed == false ===\n")); |
| goto exit; |
| } |
| |
| if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) || |
| (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_bssid23a_list_scan fail since fw_state " |
| "= %x\n", get_fwstate(pmlmepriv))); |
| |
| if (check_fwstate(pmlmepriv, |
| (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))) { |
| RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, |
| ("\n###_FW_UNDER_SURVEY|_FW_UNDER_LINKING\n")); |
| } else { |
| RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, |
| ("\n###pmlmepriv->sitesurveyctrl.traffic_" |
| "busy == true\n")); |
| } |
| } else { |
| if (rtw_is_scan_deny(padapter)) { |
| DBG_8723A("%s(%s): scan deny\n", |
| __func__, padapter->pnetdev->name); |
| return _SUCCESS; |
| } |
| |
| spin_lock_bh(&pmlmepriv->lock); |
| |
| res = rtw_sitesurvey_cmd23a(padapter, pssid, ssid_max_num, |
| NULL, 0); |
| |
| spin_unlock_bh(&pmlmepriv->lock); |
| } |
| exit: |
| return res; |
| } |
| |
| int rtw_set_802_11_authentication_mode23a(struct rtw_adapter* padapter, |
| enum ndis_802_11_auth_mode authmode) |
| { |
| struct security_priv *psecuritypriv = &padapter->securitypriv; |
| int res; |
| |
| 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_mode23a:" |
| "psecuritypriv->ndisauthtype =%d", |
| psecuritypriv->ndisauthtype)); |
| |
| if (psecuritypriv->ndisauthtype > 3) |
| psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; |
| |
| res = rtw_set_auth23a(padapter, psecuritypriv); |
| |
| return res; |
| } |
| |
| /* |
| * rtw_get_cur_max_rate23a - |
| * @adapter: pointer to _adapter structure |
| * |
| * Return 0 or 100Kbps |
| */ |
| u16 rtw_get_cur_max_rate23a(struct rtw_adapter *adapter) |
| { |
| int i = 0; |
| const u8 *p; |
| u16 rate = 0, max_rate = 0; |
| struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; |
| struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; |
| struct registry_priv *pregistrypriv = &adapter->registrypriv; |
| struct mlme_priv *pmlmepriv = &adapter->mlmepriv; |
| struct wlan_bssid_ex *pcur_bss = &pmlmepriv->cur_network.network; |
| struct ieee80211_ht_cap *pht_capie; |
| u8 rf_type = 0; |
| u8 bw_40MHz = 0, short_GI_20 = 0, short_GI_40 = 0; |
| u16 mcs_rate = 0; |
| |
| if (!check_fwstate(pmlmepriv, _FW_LINKED) && |
| !check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) |
| return 0; |
| |
| if (pmlmeext->cur_wireless_mode & (WIRELESS_11_24N|WIRELESS_11_5N)) { |
| p = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, |
| &pcur_bss->IEs[12], |
| pcur_bss->IELength - 12); |
| if (p && p[1] > 0) { |
| pht_capie = (struct ieee80211_ht_cap *)(p + 2); |
| |
| memcpy(&mcs_rate, &pht_capie->mcs, 2); |
| |
| /* bw_40MHz = (pht_capie->cap_info& |
| IEEE80211_HT_CAP_SUP_WIDTH_20_40) ? 1:0; */ |
| /* cur_bwmod is updated by beacon, pmlmeinfo is |
| updated by association response */ |
| bw_40MHz = (pmlmeext->cur_bwmode && |
| (IEEE80211_HT_PARAM_CHAN_WIDTH_ANY & |
| pmlmeinfo->HT_info.infos[0])) ? 1:0; |
| |
| /* short_GI = (pht_capie->cap_info & (IEEE80211_HT_CAP |
| _SGI_20|IEEE80211_HT_CAP_SGI_40)) ? 1 : 0; */ |
| short_GI_20 = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info&IEEE80211_HT_CAP_SGI_20) ? 1:0; |
| short_GI_40 = (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info&IEEE80211_HT_CAP_SGI_40) ? 1:0; |
| |
| rf_type = rtl8723a_get_rf_type(adapter); |
| max_rate = rtw_mcs_rate23a(rf_type, bw_40MHz & |
| pregistrypriv->cbw40_enable, |
| short_GI_20, short_GI_40, |
| pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate |
| ); |
| } |
| } 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; |
| } |