mirrors/rtl8812au
1
0
Fork 0
mirror of https://github.com/aircrack-ng/rtl8812au.git synced 2024-11-10 08:07:05 +00:00
Code Releases Activity
4d95fe8727
rtl8812au/os_dep/linux/ioctl_linux.c
Christian Bremvåg 8f04e62ca7
Fix incorrect response to SIOCGIWESSID 
When not associated with an AP, wifi device drivers should respond to the
SIOCGIWESSID ioctl with a zero-length string for the SSID, which is the
behavior expected by dhcpcd.

Currently, this driver returns an error code (-1) from the ioctl call,
which causes dhcpcd to assume that the device is not a wireless interface
and therefore it fails to work correctly with it thereafter.

When not associated with an AP, other wifi device drivers respond to the SIOCGIWESSID ioctl with a zero-length string for the SSID; this is the behaviour expected by dhcpcd.

This driver returns an error code (-1) from the ioctl call - this causes dhcpcd to assume that the device is not a wireless interface and therefore it fails to work correctly with it thereafter.

It would be good if the behaviour of this driver could be brought into line with that of other drivers for similar devices; that is for the response to SIOCGIWESSID to be a zero-length string and a success code rather than an error.
2019-08-16 22:53:33 +02:00

11577 lines
325 KiB
C
Raw Blame History

/******************************************************************************
*
* Copyright(c) 2007 - 2017 Realtek Corporation.
*
* 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 _IOCTL_LINUX_C_
#include <drv_types.h>
#include <rtw_mp.h>
#include <rtw_mp_ioctl.h>
#include "../../hal/phydm/phydm_precomp.h"
#ifdef RTW_HALMAC
#include "../../hal/hal_halmac.h"
#endif
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 27))
#define iwe_stream_add_event(a, b, c, d, e) iwe_stream_add_event(b, c, d, e)
#define iwe_stream_add_point(a, b, c, d, e) iwe_stream_add_point(b, c, d, e)
#endif
#ifdef CONFIG_80211N_HT
extern int rtw_ht_enable;
#endif
#define RTL_IOCTL_WPA_SUPPLICANT (SIOCIWFIRSTPRIV+30)
#define SCAN_ITEM_SIZE 768
#define MAX_CUSTOM_LEN 64
#define RATE_COUNT 4
#define MAX_SCAN_BUFFER_LEN 65535
#ifdef CONFIG_GLOBAL_UI_PID
extern int ui_pid[3];
#endif
/* combo scan */
#define WEXT_CSCAN_AMOUNT 9
#define WEXT_CSCAN_BUF_LEN 360
#define WEXT_CSCAN_HEADER "CSCAN S\x01\x00\x00S\x00"
#define WEXT_CSCAN_HEADER_SIZE 12
#define WEXT_CSCAN_SSID_SECTION 'S'
#define WEXT_CSCAN_CHANNEL_SECTION 'C'
#define WEXT_CSCAN_NPROBE_SECTION 'N'
#define WEXT_CSCAN_ACTV_DWELL_SECTION 'A'
#define WEXT_CSCAN_PASV_DWELL_SECTION 'P'
#define WEXT_CSCAN_HOME_DWELL_SECTION 'H'
#define WEXT_CSCAN_TYPE_SECTION 'T'
extern u8 key_2char2num(u8 hch, u8 lch);
extern u8 str_2char2num(u8 hch, u8 lch);
extern void macstr2num(u8 *dst, u8 *src);
extern u8 convert_ip_addr(u8 hch, u8 mch, u8 lch);
u32 rtw_rates[] = {1000000, 2000000, 5500000, 11000000,
6000000, 9000000, 12000000, 18000000, 24000000, 36000000, 48000000, 54000000};
static const char *const iw_operation_mode[] = {
"Auto", "Ad-Hoc", "Managed", "Master", "Repeater", "Secondary", "Monitor"
};
/**
* hwaddr_aton - Convert ASCII string to MAC address
* @txt: MAC address as a string (e.g., "00:11:22:33:44:55")
* @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
* Returns: 0 on success, -1 on failure (e.g., string not a MAC address)
*/
static int hwaddr_aton_i(const char *txt, u8 *addr)
{
int i;
for (i = 0; i < 6; i++) {
int a, b;
a = hex2num_i(*txt++);
if (a < 0)
return -1;
b = hex2num_i(*txt++);
if (b < 0)
return -1;
*addr++ = (a << 4) | b;
if (i < 5 && *txt++ != ':')
return -1;
}
return 0;
}
static void indicate_wx_custom_event(_adapter *padapter, char *msg)
{
u8 *buff;
union iwreq_data wrqu;
if (strlen(msg) > IW_CUSTOM_MAX) {
RTW_INFO("%s strlen(msg):%zu > IW_CUSTOM_MAX:%u\n", __FUNCTION__ , strlen(msg), IW_CUSTOM_MAX);
return;
}
buff = rtw_zmalloc(IW_CUSTOM_MAX + 1);
if (!buff)
return;
_rtw_memcpy(buff, msg, strlen(msg));
_rtw_memset(&wrqu, 0, sizeof(wrqu));
wrqu.data.length = strlen(msg);
RTW_INFO("%s %s\n", __FUNCTION__, buff);
#ifndef CONFIG_IOCTL_CFG80211
wireless_send_event(padapter->pnetdev, IWEVCUSTOM, &wrqu, buff);
#endif
rtw_mfree(buff, IW_CUSTOM_MAX + 1);
}
static void request_wps_pbc_event(_adapter *padapter)
{
u8 *buff, *p;
union iwreq_data wrqu;
buff = rtw_malloc(IW_CUSTOM_MAX);
if (!buff)
return;
_rtw_memset(buff, 0, IW_CUSTOM_MAX);
p = buff;
p += sprintf(p, "WPS_PBC_START.request=TRUE");
_rtw_memset(&wrqu, 0, sizeof(wrqu));
wrqu.data.length = p - buff;
wrqu.data.length = (wrqu.data.length < IW_CUSTOM_MAX) ? wrqu.data.length : IW_CUSTOM_MAX;
RTW_INFO("%s\n", __FUNCTION__);
#ifndef CONFIG_IOCTL_CFG80211
wireless_send_event(padapter->pnetdev, IWEVCUSTOM, &wrqu, buff);
#endif
if (buff)
rtw_mfree(buff, IW_CUSTOM_MAX);
}
#ifdef CONFIG_SUPPORT_HW_WPS_PBC
void rtw_request_wps_pbc_event(_adapter *padapter)
{
#ifdef RTK_DMP_PLATFORM
#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12))
kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_NET_PBC);
#else
kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_NET_PBC);
#endif
#else
if (padapter->pid[0] == 0) {
/* 0 is the default value and it means the application monitors the HW PBC doesn't privde its pid to driver. */
return;
}
#endif
rtw_led_control(padapter, LED_CTL_START_WPS_BOTTON);
}
#endif/* #ifdef CONFIG_SUPPORT_HW_WPS_PBC */
void indicate_wx_scan_complete_event(_adapter *padapter)
{
union iwreq_data wrqu;
_rtw_memset(&wrqu, 0, sizeof(union iwreq_data));
/* RTW_INFO("+rtw_indicate_wx_scan_complete_event\n"); */
#ifndef CONFIG_IOCTL_CFG80211
wireless_send_event(padapter->pnetdev, SIOCGIWSCAN, &wrqu, NULL);
#endif
}
void rtw_indicate_wx_assoc_event(_adapter *padapter)
{
union iwreq_data wrqu;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network));
_rtw_memset(&wrqu, 0, sizeof(union iwreq_data));
wrqu.ap_addr.sa_family = ARPHRD_ETHER;
if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)
_rtw_memcpy(wrqu.ap_addr.sa_data, pnetwork->MacAddress, ETH_ALEN);
else
_rtw_memcpy(wrqu.ap_addr.sa_data, pmlmepriv->cur_network.network.MacAddress, ETH_ALEN);
RTW_PRINT("assoc success\n");
#ifndef CONFIG_IOCTL_CFG80211
wireless_send_event(padapter->pnetdev, SIOCGIWAP, &wrqu, NULL);
#endif
}
void rtw_indicate_wx_disassoc_event(_adapter *padapter)
{
union iwreq_data wrqu;
_rtw_memset(&wrqu, 0, sizeof(union iwreq_data));
wrqu.ap_addr.sa_family = ARPHRD_ETHER;
_rtw_memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
#ifndef CONFIG_IOCTL_CFG80211
RTW_PRINT("indicate disassoc\n");
wireless_send_event(padapter->pnetdev, SIOCGIWAP, &wrqu, NULL);
#endif
}
/*
uint rtw_is_cckrates_included(u8 *rate)
{
u32 i = 0;
while(rate[i]!=0)
{
if ( (((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) ||
(((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22) )
return _TRUE;
i++;
}
return _FALSE;
}
uint rtw_is_cckratesonly_included(u8 *rate)
{
u32 i = 0;
while(rate[i]!=0)
{
if ( (((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) &&
(((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22) )
return _FALSE;
i++;
}
return _TRUE;
}
*/
static int search_p2p_wfd_ie(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop)
{
#ifdef CONFIG_P2P
struct wifidirect_info *pwdinfo = &padapter->wdinfo;
#ifdef CONFIG_WFD
if (SCAN_RESULT_ALL == pwdinfo->wfd_info->scan_result_type) {
} else if ((SCAN_RESULT_P2P_ONLY == pwdinfo->wfd_info->scan_result_type) ||
(SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type))
#endif /* CONFIG_WFD */
{
if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) {
u32 blnGotP2PIE = _FALSE;
/* User is doing the P2P device discovery */
/* The prefix of SSID should be "DIRECT-" and the IE should contains the P2P IE. */
/* If not, the driver should ignore this AP and go to the next AP. */
/* Verifying the SSID */
if (_rtw_memcmp(pnetwork->network.Ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN)) {
u32 p2pielen = 0;
/* Verifying the P2P IE */
if (rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen))
blnGotP2PIE = _TRUE;
}
if (blnGotP2PIE == _FALSE)
return _FALSE;
}
}
#ifdef CONFIG_WFD
if (SCAN_RESULT_WFD_TYPE == pwdinfo->wfd_info->scan_result_type) {
u32 blnGotWFD = _FALSE;
u8 *wfd_ie;
uint wfd_ielen = 0;
wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen);
if (wfd_ie) {
u8 *wfd_devinfo;
uint wfd_devlen;
wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen);
if (wfd_devinfo) {
if (pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_PSINK) {
/* the first two bits will indicate the WFD device type */
if ((wfd_devinfo[1] & 0x03) == WFD_DEVINFO_SOURCE) {
/* If this device is Miracast PSink device, the scan reuslt should just provide the Miracast source. */
blnGotWFD = _TRUE;
}
} else if (pwdinfo->wfd_info->wfd_device_type == WFD_DEVINFO_SOURCE) {
/* the first two bits will indicate the WFD device type */
if ((wfd_devinfo[1] & 0x03) == WFD_DEVINFO_PSINK) {
/* If this device is Miracast source device, the scan reuslt should just provide the Miracast PSink. */
/* Todo: How about the SSink?! */
blnGotWFD = _TRUE;
}
}
}
}
if (blnGotWFD == _FALSE)
return _FALSE;
}
#endif /* CONFIG_WFD */
#endif /* CONFIG_P2P */
return _TRUE;
}
static inline char *iwe_stream_mac_addr_proess(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe)
{
/* AP MAC address */
iwe->cmd = SIOCGIWAP;
iwe->u.ap_addr.sa_family = ARPHRD_ETHER;
_rtw_memcpy(iwe->u.ap_addr.sa_data, pnetwork->network.MacAddress, ETH_ALEN);
start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_ADDR_LEN);
return start;
}
static inline char *iwe_stream_essid_proess(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe)
{
/* Add the ESSID */
iwe->cmd = SIOCGIWESSID;
iwe->u.data.flags = 1;
iwe->u.data.length = min((u16)pnetwork->network.Ssid.SsidLength, (u16)32);
start = iwe_stream_add_point(info, start, stop, iwe, pnetwork->network.Ssid.Ssid);
return start;
}
static inline char *iwe_stream_chan_process(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe)
{
if (pnetwork->network.Configuration.DSConfig < 1 /*|| pnetwork->network.Configuration.DSConfig>14*/)
pnetwork->network.Configuration.DSConfig = 1;
/* Add frequency/channel */
iwe->cmd = SIOCGIWFREQ;
iwe->u.freq.m = rtw_ch2freq(pnetwork->network.Configuration.DSConfig) * 100000;
iwe->u.freq.e = 1;
iwe->u.freq.i = pnetwork->network.Configuration.DSConfig;
start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_FREQ_LEN);
return start;
}
static inline char *iwe_stream_mode_process(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe, u16 cap)
{
/* Add mode */
if (cap & (WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_BSS)) {
iwe->cmd = SIOCGIWMODE;
if (cap & WLAN_CAPABILITY_BSS)
iwe->u.mode = IW_MODE_MASTER;
else
iwe->u.mode = IW_MODE_ADHOC;
start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_UINT_LEN);
}
return start;
}
static inline char *iwe_stream_encryption_process(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe, u16 cap)
{
/* Add encryption capability */
iwe->cmd = SIOCGIWENCODE;
if (cap & WLAN_CAPABILITY_PRIVACY)
iwe->u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
else
iwe->u.data.flags = IW_ENCODE_DISABLED;
iwe->u.data.length = 0;
start = iwe_stream_add_point(info, start, stop, iwe, pnetwork->network.Ssid.Ssid);
return start;
}
static inline char *iwe_stream_protocol_process(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe)
{
u16 ht_cap = _FALSE, vht_cap = _FALSE;
u32 ht_ielen = 0, vht_ielen = 0;
char *p;
u8 ie_offset = (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ ? 0 : 12); /* Probe Request */
#ifdef CONFIG_80211N_HT
/* parsing HT_CAP_IE */
if(padapter->registrypriv.ht_enable && is_supported_ht(padapter->registrypriv.wireless_mode)) {
p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - ie_offset);
if (p && ht_ielen > 0)
ht_cap = _TRUE;
}
#endif
#ifdef CONFIG_80211AC_VHT
/* parsing VHT_CAP_IE */
if(padapter->registrypriv.wireless_mode & WIRELESS_11AC) {
p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength - ie_offset);
if (p && vht_ielen > 0)
vht_cap = _TRUE;
}
#endif
/* Add the protocol name */
iwe->cmd = SIOCGIWNAME;
if ((rtw_is_cckratesonly_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) {
if (ht_cap == _TRUE)
snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bn");
else
snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11b");
} else if ((rtw_is_cckrates_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) {
if (ht_cap == _TRUE)
snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bgn");
else
snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11bg");
} else {
if (pnetwork->network.Configuration.DSConfig > 14) {
#ifdef CONFIG_80211AC_VHT
if (vht_cap == _TRUE)
snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11AC");
else
#endif
{
if (ht_cap == _TRUE)
snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11an");
else
snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11a");
}
} else {
if (ht_cap == _TRUE)
snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11gn");
else
snprintf(iwe->u.name, IFNAMSIZ, "IEEE 802.11g");
}
}
start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_CHAR_LEN);
return start;
}
static inline char *iwe_stream_rate_process(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe)
{
u32 ht_ielen = 0, vht_ielen = 0;
char *p;
u16 max_rate = 0, rate, ht_cap = _FALSE, vht_cap = _FALSE;
u32 i = 0;
u8 bw_40MHz = 0, short_GI = 0, bw_160MHz = 0, vht_highest_rate = 0;
u16 mcs_rate = 0, vht_data_rate = 0;
char custom[MAX_CUSTOM_LEN] = {0};
u8 ie_offset = (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ ? 0 : 12); /* Probe Request */
/* parsing HT_CAP_IE */
if(is_supported_ht(padapter->registrypriv.wireless_mode)) {
p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - ie_offset);
if (p && ht_ielen > 0) {
struct rtw_ieee80211_ht_cap *pht_capie;
ht_cap = _TRUE;
pht_capie = (struct rtw_ieee80211_ht_cap *)(p + 2);
_rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2);
bw_40MHz = (pht_capie->cap_info & IEEE80211_HT_CAP_SUP_WIDTH) ? 1 : 0;
short_GI = (pht_capie->cap_info & (IEEE80211_HT_CAP_SGI_20 | IEEE80211_HT_CAP_SGI_40)) ? 1 : 0;
}
}
#ifdef CONFIG_80211AC_VHT
/* parsing VHT_CAP_IE */
if(padapter->registrypriv.wireless_mode & WIRELESS_11AC){
p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength - ie_offset);
if (p && vht_ielen > 0) {
u8 mcs_map[2];
vht_cap = _TRUE;
bw_160MHz = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p + 2);
if (bw_160MHz)
short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI160M(p + 2);
else
short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI80M(p + 2);
_rtw_memcpy(mcs_map, GET_VHT_CAPABILITY_ELE_TX_MCS(p + 2), 2);
vht_highest_rate = rtw_get_vht_highest_rate(mcs_map);
vht_data_rate = rtw_vht_mcs_to_data_rate(CHANNEL_WIDTH_80, short_GI, vht_highest_rate);
}
}
#endif
/*Add basic and extended rates */
p = custom;
p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): ");
while (pnetwork->network.SupportedRates[i] != 0) {
rate = pnetwork->network.SupportedRates[i] & 0x7F;
if (rate > max_rate)
max_rate = rate;
p += snprintf(p, MAX_CUSTOM_LEN - (p - custom),
"%d%s ", rate >> 1, (rate & 1) ? ".5" : "");
i++;
}
#ifdef CONFIG_80211AC_VHT
if (vht_cap == _TRUE)
max_rate = vht_data_rate;
else
#endif
if (ht_cap == _TRUE) {
if (mcs_rate & 0x8000) /* MCS15 */
max_rate = (bw_40MHz) ? ((short_GI) ? 300 : 270) : ((short_GI) ? 144 : 130);
else if (mcs_rate & 0x0080) /* MCS7 */
max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65);
else { /* default MCS7 */
/* RTW_INFO("wx_get_scan, mcs_rate_bitmap=0x%x\n", mcs_rate); */
max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65);
}
max_rate = max_rate * 2; /* Mbps/2; */
}
iwe->cmd = SIOCGIWRATE;
iwe->u.bitrate.fixed = iwe->u.bitrate.disabled = 0;
iwe->u.bitrate.value = max_rate * 500000;
start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_PARAM_LEN);
return start ;
}
static inline char *iwe_stream_wpa_wpa2_process(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe)
{
int buf_size = MAX_WPA_IE_LEN * 2;
/* u8 pbuf[buf_size]={0}; */
u8 *pbuf = rtw_zmalloc(buf_size);
u8 wpa_ie[255] = {0}, rsn_ie[255] = {0};
u16 i, wpa_len = 0, rsn_len = 0;
u8 *p;
sint out_len = 0;
if (pbuf) {
p = pbuf;
/* parsing WPA/WPA2 IE */
if (pnetwork->network.Reserved[0] != BSS_TYPE_PROB_REQ) { /* Probe Request */
out_len = rtw_get_sec_ie(pnetwork->network.IEs , pnetwork->network.IELength, rsn_ie, &rsn_len, wpa_ie, &wpa_len);
if (wpa_len > 0) {
_rtw_memset(pbuf, 0, buf_size);
p += sprintf(p, "wpa_ie=");
for (i = 0; i < wpa_len; i++)
p += sprintf(p, "%02x", wpa_ie[i]);
if (wpa_len > 100) {
printk("-----------------Len %d----------------\n", wpa_len);
for (i = 0; i < wpa_len; i++)
printk("%02x ", wpa_ie[i]);
printk("\n");
printk("-----------------Len %d----------------\n", wpa_len);
}
_rtw_memset(iwe, 0, sizeof(*iwe));
iwe->cmd = IWEVCUSTOM;
iwe->u.data.length = strlen(pbuf);
start = iwe_stream_add_point(info, start, stop, iwe, pbuf);
_rtw_memset(iwe, 0, sizeof(*iwe));
iwe->cmd = IWEVGENIE;
iwe->u.data.length = wpa_len;
start = iwe_stream_add_point(info, start, stop, iwe, wpa_ie);
}
if (rsn_len > 0) {
_rtw_memset(pbuf, 0, buf_size);
p += sprintf(p, "rsn_ie=");
for (i = 0; i < rsn_len; i++)
p += sprintf(p, "%02x", rsn_ie[i]);
_rtw_memset(iwe, 0, sizeof(*iwe));
iwe->cmd = IWEVCUSTOM;
iwe->u.data.length = strlen(pbuf);
start = iwe_stream_add_point(info, start, stop, iwe, pbuf);
_rtw_memset(iwe, 0, sizeof(*iwe));
iwe->cmd = IWEVGENIE;
iwe->u.data.length = rsn_len;
start = iwe_stream_add_point(info, start, stop, iwe, rsn_ie);
}
}
rtw_mfree(pbuf, buf_size);
}
return start;
}
static inline char *iwe_stream_wps_process(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe)
{
/* parsing WPS IE */
uint cnt = 0, total_ielen;
u8 *wpsie_ptr = NULL;
uint wps_ielen = 0;
u8 ie_offset = (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ ? 0 : 12);
u8 *ie_ptr = pnetwork->network.IEs + ie_offset;
total_ielen = pnetwork->network.IELength - ie_offset;
if (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ) { /* Probe Request */
ie_ptr = pnetwork->network.IEs;
total_ielen = pnetwork->network.IELength;
} else { /* Beacon or Probe Respones */
ie_ptr = pnetwork->network.IEs + _FIXED_IE_LENGTH_;
total_ielen = pnetwork->network.IELength - _FIXED_IE_LENGTH_;
}
while (cnt < total_ielen) {
if (rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen > 2)) {
wpsie_ptr = &ie_ptr[cnt];
iwe->cmd = IWEVGENIE;
iwe->u.data.length = (u16)wps_ielen;
start = iwe_stream_add_point(info, start, stop, iwe, wpsie_ptr);
}
cnt += ie_ptr[cnt + 1] + 2; /* goto next */
}
return start;
}
static inline char *iwe_stream_wapi_process(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe)
{
#ifdef CONFIG_WAPI_SUPPORT
char *p;
if (pnetwork->network.Reserved[0] != BSS_TYPE_PROB_REQ) { /* Probe Request */
sint out_len_wapi = 0;
/* here use static for stack size */
static u8 buf_wapi[MAX_WAPI_IE_LEN * 2] = {0};
static u8 wapi_ie[MAX_WAPI_IE_LEN] = {0};
u16 wapi_len = 0;
u16 i;
out_len_wapi = rtw_get_wapi_ie(pnetwork->network.IEs , pnetwork->network.IELength, wapi_ie, &wapi_len);
RTW_INFO("rtw_wx_get_scan: %s ", pnetwork->network.Ssid.Ssid);
RTW_INFO("rtw_wx_get_scan: ssid = %d ", wapi_len);
if (wapi_len > 0) {
p = buf_wapi;
/* _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN*2); */
p += sprintf(p, "wapi_ie=");
for (i = 0; i < wapi_len; i++)
p += sprintf(p, "%02x", wapi_ie[i]);
_rtw_memset(iwe, 0, sizeof(*iwe));
iwe->cmd = IWEVCUSTOM;
iwe->u.data.length = strlen(buf_wapi);
start = iwe_stream_add_point(info, start, stop, iwe, buf_wapi);
_rtw_memset(iwe, 0, sizeof(*iwe));
iwe->cmd = IWEVGENIE;
iwe->u.data.length = wapi_len;
start = iwe_stream_add_point(info, start, stop, iwe, wapi_ie);
}
}
#endif/* #ifdef CONFIG_WAPI_SUPPORT */
return start;
}
static inline char *iwe_stream_rssi_process(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe)
{
u8 ss, sq;
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
#ifdef CONFIG_BACKGROUND_NOISE_MONITOR
s16 noise = 0;
#endif
/* Add quality statistics */
iwe->cmd = IWEVQUAL;
iwe->u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED
#ifdef CONFIG_BACKGROUND_NOISE_MONITOR
| IW_QUAL_NOISE_UPDATED
#else
| IW_QUAL_NOISE_INVALID
#endif
#ifdef CONFIG_SIGNAL_DISPLAY_DBM
| IW_QUAL_DBM
#endif
;
if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE &&
is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) {
ss = padapter->recvpriv.signal_strength;
sq = padapter->recvpriv.signal_qual;
} else {
ss = pnetwork->network.PhyInfo.SignalStrength;
sq = pnetwork->network.PhyInfo.SignalQuality;
}
#ifdef CONFIG_SIGNAL_DISPLAY_DBM
iwe->u.qual.level = (u8) translate_percentage_to_dbm(ss); /* dbm */
#else
iwe->u.qual.level = (u8)ss; /* % */
#endif
iwe->u.qual.qual = (u8)sq; /* signal quality */
#ifdef CONFIG_PLATFORM_ROCKCHIPS
iwe->u.qual.noise = -100; /* noise level suggest by zhf@rockchips */
#else
#ifdef CONFIG_BACKGROUND_NOISE_MONITOR
if (IS_NM_ENABLE(padapter)) {
noise = rtw_noise_query_by_chan_num(padapter, pnetwork->network.Configuration.DSConfig);
#ifndef CONFIG_SIGNAL_DISPLAY_DBM
noise = translate_dbm_to_percentage(noise);/*percentage*/
#endif
iwe->u.qual.noise = noise;
}
#else
iwe->u.qual.noise = 0; /* noise level */
#endif
#endif /* CONFIG_PLATFORM_ROCKCHIPS */
/* RTW_INFO("iqual=%d, ilevel=%d, inoise=%d, iupdated=%d\n", iwe.u.qual.qual, iwe.u.qual.level , iwe.u.qual.noise, iwe.u.qual.updated); */
start = iwe_stream_add_event(info, start, stop, iwe, IW_EV_QUAL_LEN);
return start;
}
static inline char *iwe_stream_net_rsv_process(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop, struct iw_event *iwe)
{
u8 buf[32] = {0};
u8 *p, *pos;
p = buf;
pos = pnetwork->network.Reserved;
p += sprintf(p, "fm=%02X%02X", pos[1], pos[0]);
_rtw_memset(iwe, 0, sizeof(*iwe));
iwe->cmd = IWEVCUSTOM;
iwe->u.data.length = strlen(buf);
start = iwe_stream_add_point(info, start, stop, iwe, buf);
return start;
}
static char *translate_scan(_adapter *padapter,
struct iw_request_info *info, struct wlan_network *pnetwork,
char *start, char *stop)
{
struct iw_event iwe;
u16 cap = 0;
_rtw_memset(&iwe, 0, sizeof(iwe));
if (_FALSE == search_p2p_wfd_ie(padapter, info, pnetwork, start, stop))
return start;
start = iwe_stream_mac_addr_proess(padapter, info, pnetwork, start, stop, &iwe);
start = iwe_stream_essid_proess(padapter, info, pnetwork, start, stop, &iwe);
start = iwe_stream_protocol_process(padapter, info, pnetwork, start, stop, &iwe);
if (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ) /* Probe Request */
cap = 0;
else {
_rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2);
cap = le16_to_cpu(cap);
}
start = iwe_stream_mode_process(padapter, info, pnetwork, start, stop, &iwe, cap);
start = iwe_stream_chan_process(padapter, info, pnetwork, start, stop, &iwe);
start = iwe_stream_encryption_process(padapter, info, pnetwork, start, stop, &iwe, cap);
start = iwe_stream_rate_process(padapter, info, pnetwork, start, stop, &iwe);
start = iwe_stream_wpa_wpa2_process(padapter, info, pnetwork, start, stop, &iwe);
start = iwe_stream_wps_process(padapter, info, pnetwork, start, stop, &iwe);
start = iwe_stream_wapi_process(padapter, info, pnetwork, start, stop, &iwe);
start = iwe_stream_rssi_process(padapter, info, pnetwork, start, stop, &iwe);
start = iwe_stream_net_rsv_process(padapter, info, pnetwork, start, stop, &iwe);
return start;
}
static int wpa_set_auth_algs(struct net_device *dev, u32 value)
{
_adapter *padapter = (_adapter *) rtw_netdev_priv(dev);
int ret = 0;
if ((value & AUTH_ALG_SHARED_KEY) && (value & AUTH_ALG_OPEN_SYSTEM)) {
RTW_INFO("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY and AUTH_ALG_OPEN_SYSTEM [value:0x%x]\n", value);
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch;
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto;
} else if (value & AUTH_ALG_SHARED_KEY) {
RTW_INFO("wpa_set_auth_algs, AUTH_ALG_SHARED_KEY [value:0x%x]\n", value);
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
#ifdef CONFIG_PLATFORM_MT53XX
padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch;
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto;
#else
padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeShared;
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Shared;
#endif
} else if (value & AUTH_ALG_OPEN_SYSTEM) {
RTW_INFO("wpa_set_auth_algs, AUTH_ALG_OPEN_SYSTEM\n");
/* padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled; */
if (padapter->securitypriv.ndisauthtype < Ndis802_11AuthModeWPAPSK) {
#ifdef CONFIG_PLATFORM_MT53XX
padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeAutoSwitch;
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto;
#else
padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen;
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open;
#endif
}
} else if (value & AUTH_ALG_LEAP)
RTW_INFO("wpa_set_auth_algs, AUTH_ALG_LEAP\n");
else {
RTW_INFO("wpa_set_auth_algs, error!\n");
ret = -EINVAL;
}
return ret;
}
static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len)
{
int ret = 0;
u32 wep_key_idx, wep_key_len;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct security_priv *psecuritypriv = &padapter->securitypriv;
#ifdef CONFIG_P2P
struct wifidirect_info *pwdinfo = &padapter->wdinfo;
#endif /* CONFIG_P2P */
param->u.crypt.err = 0;
param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0';
if (param_len < (u32)((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) {
ret = -EINVAL;
goto exit;
}
if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) {
if (param->u.crypt.idx >= WEP_KEYS
#ifdef CONFIG_IEEE80211W
&& param->u.crypt.idx > BIP_MAX_KEYID
#endif /* CONFIG_IEEE80211W */
) {
ret = -EINVAL;
goto exit;
}
} else {
#ifdef CONFIG_WAPI_SUPPORT
if (strcmp(param->u.crypt.alg, "SMS4"))
#endif
{
ret = -EINVAL;
goto exit;
}
}
if (strcmp(param->u.crypt.alg, "WEP") == 0) {
RTW_INFO("wpa_set_encryption, crypt.alg = WEP\n");
wep_key_idx = param->u.crypt.idx;
wep_key_len = param->u.crypt.key_len;
if ((wep_key_idx >= WEP_KEYS) || (wep_key_len <= 0)) {
ret = -EINVAL;
goto exit;
}
if (psecuritypriv->bWepDefaultKeyIdxSet == 0) {
/* wep default key has not been set, so use this key index as default key.*/
wep_key_len = wep_key_len <= 5 ? 5 : 13;
psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled;
psecuritypriv->dot11PrivacyAlgrthm = _WEP40_;
psecuritypriv->dot118021XGrpPrivacy = _WEP40_;
if (wep_key_len == 13) {
psecuritypriv->dot11PrivacyAlgrthm = _WEP104_;
psecuritypriv->dot118021XGrpPrivacy = _WEP104_;
}
psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx;
}
_rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), param->u.crypt.key, wep_key_len);
psecuritypriv->dot11DefKeylen[wep_key_idx] = wep_key_len;
psecuritypriv->key_mask |= BIT(wep_key_idx);
padapter->mlmeextpriv.mlmext_info.key_index = wep_key_idx;
goto exit;
}
if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { /* 802_1x */
struct sta_info *psta, *pbcmc_sta;
struct sta_priv *pstapriv = &padapter->stapriv;
if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == _TRUE) { /* sta mode */
psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv));
if (psta == NULL) {
/* DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail\n")); */
} else {
/* Jeff: don't disable ieee8021x_blocked while clearing key */
if (strcmp(param->u.crypt.alg, "none") != 0)
psta->ieee8021x_blocked = _FALSE;
if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled) ||
(padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled))
psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm;
if (param->u.crypt.set_tx == 1) { /* pairwise key */
RTW_INFO(FUNC_ADPT_FMT" set %s PTK idx:%u, len:%u\n"
, FUNC_ADPT_ARG(padapter), param->u.crypt.alg, param->u.crypt.idx, param->u.crypt.key_len);
_rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len));
if (strcmp(param->u.crypt.alg, "TKIP") == 0) { /* set mic key */
_rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8);
_rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8);
padapter->securitypriv.busetkipkey = _FALSE;
}
psta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq);
psta->dot11rxpn.val = RTW_GET_LE64(param->u.crypt.seq);
psta->bpairwise_key_installed = _TRUE;
rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _TRUE);
} else { /* group key */
if (strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0) {
RTW_INFO(FUNC_ADPT_FMT" set %s GTK idx:%u, len:%u\n"
, FUNC_ADPT_ARG(padapter), param->u.crypt.alg, param->u.crypt.idx, param->u.crypt.key_len);
_rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key,
(param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len));
/* only TKIP group key need to install this */
if (param->u.crypt.key_len > 16) {
_rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8);
_rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8);
}
padapter->securitypriv.binstallGrpkey = _TRUE;
if (param->u.crypt.idx < 4)
_rtw_memcpy(padapter->securitypriv.iv_seq[param->u.crypt.idx], param->u.crypt.seq, 8);
padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx;
rtw_set_key(padapter, &padapter->securitypriv, param->u.crypt.idx, 1, _TRUE);
#ifdef CONFIG_IEEE80211W
} else if (strcmp(param->u.crypt.alg, "BIP") == 0) {
RTW_INFO(FUNC_ADPT_FMT" set IGTK idx:%u, len:%u\n"
, FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len);
_rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key,
(param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len));
psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx;
psecuritypriv->dot11wBIPrxpn.val = RTW_GET_LE64(param->u.crypt.seq);
psecuritypriv->binstallBIPkey = _TRUE;
#endif /* CONFIG_IEEE80211W */
}
#ifdef CONFIG_P2P
if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING))
rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE);
#endif /* CONFIG_P2P */
/* WPA/WPA2 key-handshake has completed */
clr_fwstate(pmlmepriv, WIFI_UNDER_KEY_HANDSHAKE);
}
}
pbcmc_sta = rtw_get_bcmc_stainfo(padapter);
if (pbcmc_sta == NULL) {
/* DEBUG_ERR( ("Set OID_802_11_ADD_KEY: bcmc stainfo is null\n")); */
} else {
/* Jeff: don't disable ieee8021x_blocked while clearing key */
if (strcmp(param->u.crypt.alg, "none") != 0)
pbcmc_sta->ieee8021x_blocked = _FALSE;
if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled) ||
(padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled))
pbcmc_sta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm;
}
} else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) { /* adhoc mode */
}
}
#ifdef CONFIG_WAPI_SUPPORT
if (strcmp(param->u.crypt.alg, "SMS4") == 0)
rtw_wapi_set_set_encryption(padapter, param);
#endif
exit:
return ret;
}
static int rtw_set_wpa_ie(_adapter *padapter, char *pie, unsigned short ielen)
{
u8 *buf = NULL, *pos = NULL;
int group_cipher = 0, pairwise_cipher = 0;
u8 mfp_opt = MFP_NO;
int ret = 0;
u8 null_addr[] = {0, 0, 0, 0, 0, 0};
#ifdef CONFIG_P2P
struct wifidirect_info *pwdinfo = &padapter->wdinfo;
#endif /* CONFIG_P2P */
if ((ielen > MAX_WPA_IE_LEN) || (pie == NULL)) {
_clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS);
if (pie == NULL)
return ret;
else
return -EINVAL;
}
if (ielen) {
buf = rtw_zmalloc(ielen);
if (buf == NULL) {
ret = -ENOMEM;
goto exit;
}
_rtw_memcpy(buf, pie , ielen);
/* dump */
{
int i;
RTW_INFO("\n wpa_ie(length:%d):\n", ielen);
for (i = 0; i < ielen; i = i + 8)
RTW_INFO("0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x\n", buf[i], buf[i + 1], buf[i + 2], buf[i + 3], buf[i + 4], buf[i + 5], buf[i + 6], buf[i + 7]);
}
pos = buf;
if (ielen < RSN_HEADER_LEN) {
ret = -1;
goto exit;
}
if (rtw_parse_wpa_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) {
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X;
padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK;
_rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen);
}
if (rtw_parse_wpa2_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL, &mfp_opt) == _SUCCESS) {
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X;
padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK;
_rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen);
}
if (group_cipher == 0)
group_cipher = WPA_CIPHER_NONE;
if (pairwise_cipher == 0)
pairwise_cipher = WPA_CIPHER_NONE;
switch (group_cipher) {
case WPA_CIPHER_NONE:
padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_;
padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled;
break;
case WPA_CIPHER_WEP40:
padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_;
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
break;
case WPA_CIPHER_TKIP:
padapter->securitypriv.dot118021XGrpPrivacy = _TKIP_;
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled;
break;
case WPA_CIPHER_CCMP:
padapter->securitypriv.dot118021XGrpPrivacy = _AES_;
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled;
break;
case WPA_CIPHER_WEP104:
padapter->securitypriv.dot118021XGrpPrivacy = _WEP104_;
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
break;
}
switch (pairwise_cipher) {
case WPA_CIPHER_NONE:
padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_;
padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled;
break;
case WPA_CIPHER_WEP40:
padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_;
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
break;
case WPA_CIPHER_TKIP:
padapter->securitypriv.dot11PrivacyAlgrthm = _TKIP_;
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled;
break;
case WPA_CIPHER_CCMP:
padapter->securitypriv.dot11PrivacyAlgrthm = _AES_;
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled;
break;
case WPA_CIPHER_WEP104:
padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_;
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
break;
}
if (mfp_opt == MFP_INVALID) {
RTW_INFO(FUNC_ADPT_FMT" invalid MFP setting\n", FUNC_ADPT_ARG(padapter));
ret = -EINVAL;
goto exit;
}
padapter->securitypriv.mfp_opt = mfp_opt;
_clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS);
{/* set wps_ie */
u16 cnt = 0;
u8 eid, wps_oui[4] = {0x0, 0x50, 0xf2, 0x04};
while (cnt < ielen) {
eid = buf[cnt];
if ((eid == _VENDOR_SPECIFIC_IE_) && (_rtw_memcmp(&buf[cnt + 2], wps_oui, 4) == _TRUE)) {
RTW_INFO("SET WPS_IE\n");
padapter->securitypriv.wps_ie_len = ((buf[cnt + 1] + 2) < MAX_WPS_IE_LEN) ? (buf[cnt + 1] + 2) : MAX_WPS_IE_LEN;
_rtw_memcpy(padapter->securitypriv.wps_ie, &buf[cnt], padapter->securitypriv.wps_ie_len);
set_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS);
#ifdef CONFIG_P2P
if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_OK))
rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_ING);
#endif /* CONFIG_P2P */
cnt += buf[cnt + 1] + 2;
break;
} else {
cnt += buf[cnt + 1] + 2; /* goto next */
}
}
}
}
/* TKIP and AES disallow multicast packets until installing group key */
if (padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_
|| padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_WTMIC_
|| padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)
/* WPS open need to enable multicast
* || check_fwstate(&padapter->mlmepriv, WIFI_UNDER_WPS) == _TRUE) */
rtw_hal_set_hwreg(padapter, HW_VAR_OFF_RCR_AM, null_addr);
exit:
if (buf)
rtw_mfree(buf, ielen);
return ret;
}
static int rtw_wx_get_name(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u32 ht_ielen = 0;
char *p;
u8 ht_cap = _FALSE, vht_cap = _FALSE;
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network;
NDIS_802_11_RATES_EX *prates = NULL;
if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE) == _TRUE) {
/* parsing HT_CAP_IE */
if( is_supported_ht(padapter->registrypriv.wireless_mode)&&(padapter->registrypriv.ht_enable)) {
p = rtw_get_ie(&pcur_bss->IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pcur_bss->IELength - 12);
if (p && ht_ielen > 0 )
ht_cap = _TRUE;
}
#ifdef CONFIG_80211AC_VHT
if ((padapter->registrypriv.wireless_mode & WIRELESS_11AC) &&
(pmlmepriv->vhtpriv.vht_option == _TRUE))
vht_cap = _TRUE;
#endif
prates = &pcur_bss->SupportedRates;
if (rtw_is_cckratesonly_included((u8 *)prates) == _TRUE) {
if (ht_cap == _TRUE)
snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bn");
else
snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11b");
} else if ((rtw_is_cckrates_included((u8 *)prates)) == _TRUE) {
if (ht_cap == _TRUE)
snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bgn");
else {
if(padapter->registrypriv.wireless_mode & WIRELESS_11G)
snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bg");
else
snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11b");
}
} else {
if (pcur_bss->Configuration.DSConfig > 14) {
#ifdef CONFIG_80211AC_VHT
if (vht_cap == _TRUE)
snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11AC");
else
#endif
{
if (ht_cap == _TRUE)
snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11an");
else
snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11a");
}
} else {
if (ht_cap == _TRUE)
snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11gn");
else
snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g");
}
}
} else {
/* prates = &padapter->registrypriv.dev_network.SupportedRates; */
/* snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11g"); */
snprintf(wrqu->name, IFNAMSIZ, "unassociated");
}
return 0;
}
static int rtw_wx_set_freq(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
int exp = 1, freq = 0, div = 0;
rtw_ps_deny(padapter, PS_DENY_IOCTL);
if (rtw_pwr_wakeup(padapter) == _FALSE)
goto exit;
if (wrqu->freq.m <= 1000) {
if (wrqu->freq.flags == IW_FREQ_AUTO) {
if (rtw_chset_search_ch(adapter_to_chset(padapter), wrqu->freq.m) > 0) {
padapter->mlmeextpriv.cur_channel = wrqu->freq.m;
RTW_INFO("%s: channel is auto, set to channel %d\n", __func__, wrqu->freq.m);
} else {
padapter->mlmeextpriv.cur_channel = 1;
RTW_INFO("%s: channel is auto, Channel Plan don't match just set to channel 1\n", __func__);
}
} else {
padapter->mlmeextpriv.cur_channel = wrqu->freq.m;
RTW_INFO("%s: set to channel %d\n", __func__, padapter->mlmeextpriv.cur_channel);
}
} else {
while (wrqu->freq.e) {
exp *= 10;
wrqu->freq.e--;
}
freq = wrqu->freq.m;
while (!(freq % 10)) {
freq /= 10;
exp *= 10;
}
/* freq unit is MHz here */
div = 1000000 / exp;
if (div)
freq /= div;
else {
div = exp / 1000000;
freq *= div;
}
/* If freq is invalid, rtw_freq2ch() will return channel 1 */
padapter->mlmeextpriv.cur_channel = rtw_freq2ch(freq);
RTW_INFO("%s: set to channel %d\n", __func__, padapter->mlmeextpriv.cur_channel);
}
set_channel_bwmode(padapter, padapter->mlmeextpriv.cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20);
exit:
rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL);
return 0;
}
static int rtw_wx_get_freq(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network;
if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) != _TRUE) {
wrqu->freq.m = rtw_ch2freq(pcur_bss->Configuration.DSConfig) * 100000;
wrqu->freq.e = 1;
wrqu->freq.i = pcur_bss->Configuration.DSConfig;
} else {
wrqu->freq.m = rtw_ch2freq(padapter->mlmeextpriv.cur_channel) * 100000;
wrqu->freq.e = 1;
wrqu->freq.i = padapter->mlmeextpriv.cur_channel;
}
return 0;
}
static int rtw_wx_set_mode(struct net_device *dev, struct iw_request_info *a,
union iwreq_data *wrqu, char *b)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
NDIS_802_11_NETWORK_INFRASTRUCTURE networkType ;
int ret = 0;
if (_FAIL == rtw_pwr_wakeup(padapter)) {
ret = -EPERM;
goto exit;
}
if (!rtw_is_hw_init_completed(padapter)) {
ret = -EPERM;
goto exit;
}
/* initial default type */
dev->type = ARPHRD_ETHER;
if (wrqu->mode == IW_MODE_MONITOR) {
rtw_ps_deny(padapter, PS_DENY_MONITOR_MODE);
LeaveAllPowerSaveMode(padapter);
} else {
rtw_ps_deny_cancel(padapter, PS_DENY_MONITOR_MODE);
}
switch (wrqu->mode) {
case IW_MODE_MONITOR:
networkType = Ndis802_11Monitor;
#if 0
dev->type = ARPHRD_IEEE80211; /* IEEE 802.11 : 801 */
#endif
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24))
dev->type = ARPHRD_IEEE80211_RADIOTAP; /* IEEE 802.11 + radiotap header : 803 */
RTW_INFO("set_mode = IW_MODE_MONITOR\n");
#else
RTW_INFO("kernel version < 2.6.24 not support IW_MODE_MONITOR\n");
#endif
break;
case IW_MODE_AUTO:
networkType = Ndis802_11AutoUnknown;
RTW_INFO("set_mode = IW_MODE_AUTO\n");
break;
case IW_MODE_ADHOC:
networkType = Ndis802_11IBSS;
RTW_INFO("set_mode = IW_MODE_ADHOC\n");
break;
case IW_MODE_MASTER:
networkType = Ndis802_11APMode;
RTW_INFO("set_mode = IW_MODE_MASTER\n");
break;
case IW_MODE_INFRA:
networkType = Ndis802_11Infrastructure;
RTW_INFO("set_mode = IW_MODE_INFRA\n");
break;
default:
ret = -EINVAL;;
goto exit;
}
if (rtw_set_802_11_infrastructure_mode(padapter, networkType, 0) == _FALSE) {
ret = -EPERM;
goto exit;
}
rtw_setopmode_cmd(padapter, networkType, RTW_CMDF_WAIT_ACK);
if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) == _TRUE)
rtw_indicate_connect(padapter);
exit:
return ret;
}
static int rtw_wx_get_mode(struct net_device *dev, struct iw_request_info *a,
union iwreq_data *wrqu, char *b)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)
wrqu->mode = IW_MODE_INFRA;
else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) ||
(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE))
wrqu->mode = IW_MODE_ADHOC;
else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE)
wrqu->mode = IW_MODE_MASTER;
else if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) == _TRUE)
wrqu->mode = IW_MODE_MONITOR;
else
wrqu->mode = IW_MODE_AUTO;
return 0;
}
static int rtw_wx_set_pmkid(struct net_device *dev,
struct iw_request_info *a,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u8 j, blInserted = _FALSE;
int intReturn = _FALSE;
struct security_priv *psecuritypriv = &padapter->securitypriv;
struct iw_pmksa *pPMK = (struct iw_pmksa *) extra;
u8 strZeroMacAddress[ETH_ALEN] = { 0x00 };
u8 strIssueBssid[ETH_ALEN] = { 0x00 };
#if 0
struct iw_pmksa {
__u32 cmd;
struct sockaddr bssid;
__u8 pmkid[IW_PMKID_LEN]; /* IW_PMKID_LEN=16 */
}
There are the BSSID information in the bssid.sa_data array.
If cmd is IW_PMKSA_FLUSH, it means the wpa_suppplicant wants to clear all the PMKID information.
If cmd is IW_PMKSA_ADD, it means the wpa_supplicant wants to add a PMKID / BSSID to driver.
If cmd is IW_PMKSA_REMOVE, it means the wpa_supplicant wants to remove a PMKID / BSSID from driver.
#endif
_rtw_memcpy(strIssueBssid, pPMK->bssid.sa_data, ETH_ALEN);
if (pPMK->cmd == IW_PMKSA_ADD) {
RTW_INFO("[rtw_wx_set_pmkid] IW_PMKSA_ADD!\n");
if (_rtw_memcmp(strIssueBssid, strZeroMacAddress, ETH_ALEN) == _TRUE)
return intReturn ;
else
intReturn = _TRUE;
blInserted = _FALSE;
/* overwrite PMKID */
for (j = 0 ; j < NUM_PMKID_CACHE; j++) {
if (_rtw_memcmp(psecuritypriv->PMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) == _TRUE) {
/* BSSID is matched, the same AP => rewrite with new PMKID. */
RTW_INFO("[rtw_wx_set_pmkid] BSSID exists in the PMKList.\n");
_rtw_memcpy(psecuritypriv->PMKIDList[j].PMKID, pPMK->pmkid, IW_PMKID_LEN);
psecuritypriv->PMKIDList[j].bUsed = _TRUE;
psecuritypriv->PMKIDIndex = j + 1;
blInserted = _TRUE;
break;
}
}
if (!blInserted) {
/* Find a new entry */
RTW_INFO("[rtw_wx_set_pmkid] Use the new entry index = %d for this PMKID.\n",
psecuritypriv->PMKIDIndex);
_rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, strIssueBssid, ETH_ALEN);
_rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, pPMK->pmkid, IW_PMKID_LEN);
psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = _TRUE;
psecuritypriv->PMKIDIndex++ ;
if (psecuritypriv->PMKIDIndex == 16)
psecuritypriv->PMKIDIndex = 0;
}
} else if (pPMK->cmd == IW_PMKSA_REMOVE) {
RTW_INFO("[rtw_wx_set_pmkid] IW_PMKSA_REMOVE!\n");
intReturn = _TRUE;
for (j = 0 ; j < NUM_PMKID_CACHE; j++) {
if (_rtw_memcmp(psecuritypriv->PMKIDList[j].Bssid, strIssueBssid, ETH_ALEN) == _TRUE) {
/* BSSID is matched, the same AP => Remove this PMKID information and reset it. */
_rtw_memset(psecuritypriv->PMKIDList[j].Bssid, 0x00, ETH_ALEN);
psecuritypriv->PMKIDList[j].bUsed = _FALSE;
break;
}
}
} else if (pPMK->cmd == IW_PMKSA_FLUSH) {
RTW_INFO("[rtw_wx_set_pmkid] IW_PMKSA_FLUSH!\n");
_rtw_memset(&psecuritypriv->PMKIDList[0], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
psecuritypriv->PMKIDIndex = 0;
intReturn = _TRUE;
}
return intReturn ;
}
static int rtw_wx_get_sens(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
#ifdef CONFIG_PLATFORM_ROCKCHIPS
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
/*
* 20110311 Commented by Jeff
* For rockchip platform's wpa_driver_wext_get_rssi
*/
if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) {
/* wrqu->sens.value=-padapter->recvpriv.signal_strength; */
wrqu->sens.value = -padapter->recvpriv.rssi;
/* RTW_INFO("%s: %d\n", __FUNCTION__, wrqu->sens.value); */
wrqu->sens.fixed = 0; /* no auto select */
} else
#endif
{
wrqu->sens.value = 0;
wrqu->sens.fixed = 0; /* no auto select */
wrqu->sens.disabled = 1;
}
return 0;
}
static int rtw_wx_get_range(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
struct iw_range *range = (struct iw_range *)extra;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter);
u16 val;
int i;
wrqu->data.length = sizeof(*range);
_rtw_memset(range, 0, sizeof(*range));
/* Let's try to keep this struct in the same order as in
* linux/include/wireless.h
*/
/* TODO: See what values we can set, and remove the ones we can't
* set, or fill them with some default data.
*/
/* ~5 Mb/s real (802.11b) */
range->throughput = 5 * 1000 * 1000;
/* TODO: Not used in 802.11b?
* range->min_nwid; Minimal NWID we are able to set */
/* TODO: Not used in 802.11b?
* range->max_nwid; Maximal NWID we are able to set */
/* Old Frequency (backward compat - moved lower ) */
/* range->old_num_channels;
* range->old_num_frequency;
* range->old_freq[6]; Filler to keep "version" at the same offset */
/* signal level threshold range */
/* Quality of link & SNR stuff */
/* Quality range (link, level, noise)
* If the quality is absolute, it will be in the range [0 ; max_qual],
* if the quality is dBm, it will be in the range [max_qual ; 0].
* Don't forget that we use 8 bit arithmetics...
*
* If percentage range is 0~100
* Signal strength dbm range logical is -100 ~ 0
* but usually value is -90 ~ -20
*/
range->max_qual.qual = 100;
#ifdef CONFIG_SIGNAL_DISPLAY_DBM
range->max_qual.level = (u8)-100;
range->max_qual.noise = (u8)-100;
range->max_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */
range->max_qual.updated |= IW_QUAL_DBM;
#else /* !CONFIG_SIGNAL_DISPLAY_DBM */
/* percent values between 0 and 100. */
range->max_qual.level = 100;
range->max_qual.noise = 100;
range->max_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */
#endif /* !CONFIG_SIGNAL_DISPLAY_DBM */
/* This should contain the average/typical values of the quality
* indicator. This should be the threshold between a "good" and
* a "bad" link (example : monitor going from green to orange).
* Currently, user space apps like quality monitors don't have any
* way to calibrate the measurement. With this, they can split
* the range between 0 and max_qual in different quality level
* (using a geometric subdivision centered on the average).
* I expect that people doing the user space apps will feedback
* us on which value we need to put in each driver... */
range->avg_qual.qual = 92; /* > 8% missed beacons is 'bad' */
#ifdef CONFIG_SIGNAL_DISPLAY_DBM
/* TODO: Find real 'good' to 'bad' threshold value for RSSI */
range->avg_qual.level = (u8)-70;
range->avg_qual.noise = 0;
range->avg_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */
range->avg_qual.updated |= IW_QUAL_DBM;
#else /* !CONFIG_SIGNAL_DISPLAY_DBM */
/* TODO: Find real 'good' to 'bad' threshol value for RSSI */
range->avg_qual.level = 30;
range->avg_qual.noise = 100;
range->avg_qual.updated = IW_QUAL_ALL_UPDATED; /* Updated all three */
#endif /* !CONFIG_SIGNAL_DISPLAY_DBM */
range->num_bitrates = RATE_COUNT;
for (i = 0; i < RATE_COUNT && i < IW_MAX_BITRATES; i++)
range->bitrate[i] = rtw_rates[i];
range->min_frag = MIN_FRAG_THRESHOLD;
range->max_frag = MAX_FRAG_THRESHOLD;
range->pm_capa = 0;
range->we_version_compiled = WIRELESS_EXT;
range->we_version_source = 16;
/* range->retry_capa; What retry options are supported
* range->retry_flags; How to decode max/min retry limit
* range->r_time_flags; How to decode max/min retry life
* range->min_retry; Minimal number of retries
* range->max_retry; Maximal number of retries
* range->min_r_time; Minimal retry lifetime
* range->max_r_time; Maximal retry lifetime */
for (i = 0, val = 0; i < rfctl->max_chan_nums; i++) {
/* Include only legal frequencies for some countries */
if (rfctl->channel_set[i].ChannelNum != 0) {
range->freq[val].i = rfctl->channel_set[i].ChannelNum;
range->freq[val].m = rtw_ch2freq(rfctl->channel_set[i].ChannelNum) * 100000;
range->freq[val].e = 1;
val++;
}
if (val == IW_MAX_FREQUENCIES)
break;
}
range->num_channels = val;
range->num_frequency = val;
/* Commented by Albert 2009/10/13
* The following code will proivde the security capability to network manager.
* If the driver doesn't provide this capability to network manager,
* the WPA/WPA2 routers can't be choosen in the network manager. */
/*
#define IW_SCAN_CAPA_NONE 0x00
#define IW_SCAN_CAPA_ESSID 0x01
#define IW_SCAN_CAPA_BSSID 0x02
#define IW_SCAN_CAPA_CHANNEL 0x04
#define IW_SCAN_CAPA_MODE 0x08
#define IW_SCAN_CAPA_RATE 0x10
#define IW_SCAN_CAPA_TYPE 0x20
#define IW_SCAN_CAPA_TIME 0x40
*/
#if WIRELESS_EXT > 17
range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
#endif
#ifdef IW_SCAN_CAPA_ESSID /* WIRELESS_EXT > 21 */
range->scan_capa = IW_SCAN_CAPA_ESSID | IW_SCAN_CAPA_TYPE | IW_SCAN_CAPA_BSSID |
IW_SCAN_CAPA_CHANNEL | IW_SCAN_CAPA_MODE | IW_SCAN_CAPA_RATE;
#endif
return 0;
}
/* set bssid flow
* s1. rtw_set_802_11_infrastructure_mode()
* s2. rtw_set_802_11_authentication_mode()
* s3. set_802_11_encryption_mode()
* s4. rtw_set_802_11_bssid() */
static int rtw_wx_set_wap(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *awrq,
char *extra)
{
_irqL irqL;
uint ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct sockaddr *temp = (struct sockaddr *)awrq;
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
_list *phead;
u8 *dst_bssid, *src_bssid;
_queue *queue = &(pmlmepriv->scanned_queue);
struct wlan_network *pnetwork = NULL;
NDIS_802_11_AUTHENTICATION_MODE authmode;
/*
#ifdef CONFIG_CONCURRENT_MODE
if(padapter->adapter_type > PRIMARY_IFACE)
{
ret = -EINVAL;
goto exit;
}
#endif
*/
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) {
RTW_INFO("set bssid, but buddy_intf is under scanning or linking\n");
ret = -EINVAL;
goto exit;
}
#endif
rtw_ps_deny(padapter, PS_DENY_JOIN);
if (_FAIL == rtw_pwr_wakeup(padapter)) {
ret = -1;
goto cancel_ps_deny;
}
if (!padapter->bup) {
ret = -1;
goto cancel_ps_deny;
}
if (temp->sa_family != ARPHRD_ETHER) {
ret = -EINVAL;
goto cancel_ps_deny;
}
authmode = padapter->securitypriv.ndisauthtype;
_enter_critical_bh(&queue->lock, &irqL);
phead = get_list_head(queue);
pmlmepriv->pscanned = get_next(phead);
while (1) {
if ((rtw_end_of_queue_search(phead, pmlmepriv->pscanned)) == _TRUE) {
#if 0
ret = -EINVAL;
goto cancel_ps_deny;
if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) {
rtw_set_802_11_bssid(padapter, temp->sa_data);
goto cancel_ps_deny;
} else {
ret = -EINVAL;
goto cancel_ps_deny;
}
#endif
break;
}
pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list);
pmlmepriv->pscanned = get_next(pmlmepriv->pscanned);
dst_bssid = pnetwork->network.MacAddress;
src_bssid = temp->sa_data;
if ((_rtw_memcmp(dst_bssid, src_bssid, ETH_ALEN)) == _TRUE) {
if (!rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode, 0)) {
ret = -1;
_exit_critical_bh(&queue->lock, &irqL);
goto cancel_ps_deny;
}
break;
}
}
_exit_critical_bh(&queue->lock, &irqL);
rtw_set_802_11_authentication_mode(padapter, authmode);
/* set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); */
if (rtw_set_802_11_bssid(padapter, temp->sa_data) == _FALSE) {
ret = -1;
goto cancel_ps_deny;
}
cancel_ps_deny:
rtw_ps_deny_cancel(padapter, PS_DENY_JOIN);
exit:
return ret;
}
static int rtw_wx_get_wap(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network;
wrqu->ap_addr.sa_family = ARPHRD_ETHER;
_rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN);
if (((check_fwstate(pmlmepriv, _FW_LINKED)) == _TRUE) ||
((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) == _TRUE) ||
((check_fwstate(pmlmepriv, WIFI_AP_STATE)) == _TRUE))
_rtw_memcpy(wrqu->ap_addr.sa_data, pcur_bss->MacAddress, ETH_ALEN);
else
_rtw_memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN);
return 0;
}
static int rtw_wx_set_mlme(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
#if 0
/* SIOCSIWMLME data */
struct iw_mlme {
__u16 cmd; /* IW_MLME_* */
__u16 reason_code;
struct sockaddr addr;
};
#endif
int ret = 0;
u16 reason;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct iw_mlme *mlme = (struct iw_mlme *) extra;
if (mlme == NULL)
return -1;
RTW_INFO("%s\n", __FUNCTION__);
reason = cpu_to_le16(mlme->reason_code);
RTW_INFO("%s, cmd=%d, reason=%d\n", __FUNCTION__, mlme->cmd, reason);
switch (mlme->cmd) {
case IW_MLME_DEAUTH:
if (!rtw_set_802_11_disassociate(padapter))
ret = -1;
break;
case IW_MLME_DISASSOC:
if (!rtw_set_802_11_disassociate(padapter))
ret = -1;
break;
default:
return -EOPNOTSUPP;
}
#ifdef CONFIG_RTW_REPEATER_SON
rtw_rson_do_disconnect(padapter);
#endif
return ret;
}
static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a,
union iwreq_data *wrqu, char *extra)
{
u8 _status = _FALSE;
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
/*struct mlme_priv *pmlmepriv = &padapter->mlmepriv;*/
struct sitesurvey_parm parm;
u8 ssc_chk;
#ifdef CONFIG_P2P
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
#endif /* CONFIG_P2P */
#ifdef DBG_IOCTL
RTW_INFO("DBG_IOCTL %s:%d\n", __FUNCTION__, __LINE__);
#endif
#if 1
ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE);
#ifdef CONFIG_DOSCAN_IN_BUSYTRAFFIC
if ((ssc_chk != SS_ALLOW) && (ssc_chk != SS_DENY_BUSY_TRAFFIC))
#else
/* When Busy Traffic, driver do not site survey. So driver return success. */
/* wpa_supplicant will not issue SIOCSIWSCAN cmd again after scan timeout. */
/* modify by thomas 2011-02-22. */
if (ssc_chk != SS_ALLOW)
#endif
{
if (ssc_chk == SS_DENY_MP_MODE)
ret = -EPERM;
#ifdef DBG_LA_MODE
else if (ssc_chk == SS_DENY_LA_MODE)
ret = -EPERM;
#endif
else
indicate_wx_scan_complete_event(padapter);
goto exit;
} else
RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter));
rtw_ps_deny(padapter, PS_DENY_SCAN);
if (_FAIL == rtw_pwr_wakeup(padapter)) {
ret = -1;
goto cancel_ps_deny;
}
if (!rtw_is_adapter_up(padapter)) {
ret = -1;
goto cancel_ps_deny;
}
#else
#ifdef CONFIG_MP_INCLUDED
if (rtw_mp_mode_check(padapter)) {
RTW_INFO("MP mode block Scan request\n");
ret = -EPERM;
goto exit;
}
#endif
if (rtw_is_scan_deny(padapter)) {
indicate_wx_scan_complete_event(padapter);
goto exit;
}
rtw_ps_deny(padapter, PS_DENY_SCAN);
if (_FAIL == rtw_pwr_wakeup(padapter)) {
ret = -1;
goto cancel_ps_deny;
}
if (!rtw_is_adapter_up(padapter)) {
ret = -1;
goto cancel_ps_deny;
}
#ifndef CONFIG_DOSCAN_IN_BUSYTRAFFIC
/* When Busy Traffic, driver do not site survey. So driver return success. */
/* wpa_supplicant will not issue SIOCSIWSCAN cmd again after scan timeout. */
/* modify by thomas 2011-02-22. */
if (rtw_mi_busy_traffic_check(padapter, _FALSE)) {
indicate_wx_scan_complete_event(padapter);
goto cancel_ps_deny;
}
#endif
#ifdef CONFIG_RTW_REPEATER_SON
if (padapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) {
RTW_INFO(FUNC_ADPT_FMT" blocking scan for under rson scanning process\n", FUNC_ADPT_ARG(padapter));
indicate_wx_scan_complete_event(padapter);
goto cancel_ps_deny;
}
#endif
if (check_fwstate(pmlmepriv, WIFI_AP_STATE) && check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) {
RTW_INFO("AP mode process WPS\n");
indicate_wx_scan_complete_event(padapter);
goto cancel_ps_deny;
}
if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) == _TRUE) {
indicate_wx_scan_complete_event(padapter);
goto cancel_ps_deny;
}
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_buddy_check_fwstate(padapter,
_FW_UNDER_SURVEY | _FW_UNDER_LINKING | WIFI_UNDER_WPS)) {
indicate_wx_scan_complete_event(padapter);
goto cancel_ps_deny;
}
#endif
#endif
#ifdef CONFIG_P2P
if (pwdinfo->p2p_state != P2P_STATE_NONE) {
rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo));
rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH);
rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_FULL);
rtw_free_network_queue(padapter, _TRUE);
}
#endif /* CONFIG_P2P */
#if WIRELESS_EXT >= 17
if (wrqu->data.length == sizeof(struct iw_scan_req)) {
struct iw_scan_req *req = (struct iw_scan_req *)extra;
if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
int len = min((int)req->essid_len, IW_ESSID_MAX_SIZE);
rtw_init_sitesurvey_parm(padapter, &parm);
_rtw_memcpy(&parm.ssid[0].Ssid, &req->essid, len);
parm.ssid[0].SsidLength = len;
parm.ssid_num = 1;
RTW_INFO("IW_SCAN_THIS_ESSID, ssid=%s, len=%d\n", req->essid, req->essid_len);
_status = rtw_set_802_11_bssid_list_scan(padapter, &parm);
} else if (req->scan_type == IW_SCAN_TYPE_PASSIVE)
RTW_INFO("rtw_wx_set_scan, req->scan_type == IW_SCAN_TYPE_PASSIVE\n");
} else
#endif
if (wrqu->data.length >= WEXT_CSCAN_HEADER_SIZE
&& _rtw_memcmp(extra, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == _TRUE
) {
int len = wrqu->data.length - WEXT_CSCAN_HEADER_SIZE;
char *pos = extra + WEXT_CSCAN_HEADER_SIZE;
char section;
char sec_len;
int ssid_index = 0;
/* RTW_INFO("%s COMBO_SCAN header is recognized\n", __FUNCTION__); */
rtw_init_sitesurvey_parm(padapter, &parm);
while (len >= 1) {
section = *(pos++);
len -= 1;
switch (section) {
case WEXT_CSCAN_SSID_SECTION:
/* RTW_INFO("WEXT_CSCAN_SSID_SECTION\n"); */
if (len < 1) {
len = 0;
break;
}
sec_len = *(pos++);
len -= 1;
if (sec_len > 0 && sec_len <= len) {
parm.ssid[ssid_index].SsidLength = sec_len;
_rtw_memcpy(&parm.ssid[ssid_index].Ssid, pos, sec_len);
/* RTW_INFO("%s COMBO_SCAN with specific parm.ssid:%s, %d\n", __FUNCTION__ */
/* , parm.ssid[ssid_index].Ssid, parm.ssid[ssid_index].SsidLength); */
ssid_index++;
}
pos += sec_len;
len -= sec_len;
break;
case WEXT_CSCAN_CHANNEL_SECTION:
/* RTW_INFO("WEXT_CSCAN_CHANNEL_SECTION\n"); */
pos += 1;
len -= 1;
break;
case WEXT_CSCAN_ACTV_DWELL_SECTION:
/* RTW_INFO("WEXT_CSCAN_ACTV_DWELL_SECTION\n"); */
pos += 2;
len -= 2;
break;
case WEXT_CSCAN_PASV_DWELL_SECTION:
/* RTW_INFO("WEXT_CSCAN_PASV_DWELL_SECTION\n"); */
pos += 2;
len -= 2;
break;
case WEXT_CSCAN_HOME_DWELL_SECTION:
/* RTW_INFO("WEXT_CSCAN_HOME_DWELL_SECTION\n"); */
pos += 2;
len -= 2;
break;
case WEXT_CSCAN_TYPE_SECTION:
/* RTW_INFO("WEXT_CSCAN_TYPE_SECTION\n"); */
pos += 1;
len -= 1;
break;
#if 0
case WEXT_CSCAN_NPROBE_SECTION:
RTW_INFO("WEXT_CSCAN_NPROBE_SECTION\n");
break;
#endif
default:
/* RTW_INFO("Unknown CSCAN section %c\n", section); */
len = 0; /* stop parsing */
}
/* RTW_INFO("len:%d\n", len); */
}
parm.ssid_num = ssid_index;
/* jeff: it has still some scan paramater to parse, we only do this now... */
_status = rtw_set_802_11_bssid_list_scan(padapter, &parm);
} else
_status = rtw_set_802_11_bssid_list_scan(padapter, NULL);
if (_status == _FALSE)
ret = -1;
cancel_ps_deny:
rtw_ps_deny_cancel(padapter, PS_DENY_SCAN);
exit:
#ifdef DBG_IOCTL
RTW_INFO("DBG_IOCTL %s:%d return %d\n", __FUNCTION__, __LINE__, ret);
#endif
return ret;
}
static int rtw_wx_get_scan(struct net_device *dev, struct iw_request_info *a,
union iwreq_data *wrqu, char *extra)
{
_irqL irqL;
_list *plist, *phead;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter);
RT_CHANNEL_INFO *chset = rfctl->channel_set;
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
_queue *queue = &(pmlmepriv->scanned_queue);
struct wlan_network *pnetwork = NULL;
char *ev = extra;
char *stop = ev + wrqu->data.length;
u32 ret = 0;
u32 wait_for_surveydone;
sint wait_status;
u8 ch;
#ifdef CONFIG_P2P
struct wifidirect_info *pwdinfo = &padapter->wdinfo;
#endif /* CONFIG_P2P */
#ifdef DBG_IOCTL
RTW_INFO("DBG_IOCTL %s:%d\n", __FUNCTION__, __LINE__);
#endif
if (adapter_to_pwrctl(padapter)->brfoffbyhw && rtw_is_drv_stopped(padapter)) {
ret = -EINVAL;
goto exit;
}
#ifdef CONFIG_P2P
if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE))
wait_for_surveydone = 200;
else {
/* P2P is disabled */
wait_for_surveydone = 100;
}
#else
{
wait_for_surveydone = 100;
}
#endif /* CONFIG_P2P */
#if 1 /* Wireless Extension use EAGAIN to try */
wait_status = _FW_UNDER_SURVEY
#ifndef CONFIG_ANDROID
| _FW_UNDER_LINKING
#endif
;
while (check_fwstate(pmlmepriv, wait_status) == _TRUE)
return -EAGAIN;
#else
wait_status = _FW_UNDER_SURVEY
#ifndef CONFIG_ANDROID
| _FW_UNDER_LINKING
#endif
;
while (check_fwstate(pmlmepriv, wait_status) == _TRUE) {
rtw_msleep_os(30);
cnt++;
if (cnt > wait_for_surveydone)
break;
}
#endif
_enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
phead = get_list_head(queue);
plist = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, plist) == _TRUE)
break;
if ((stop - ev) < SCAN_ITEM_SIZE) {
if(wrqu->data.length == MAX_SCAN_BUFFER_LEN){ /*max buffer len defined by iwlist*/
ret = 0;
RTW_INFO("%s: Scan results incomplete\n", __FUNCTION__);
break;
}
ret = -E2BIG;
break;
}
pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
ch = pnetwork->network.Configuration.DSConfig;
/* report network only if the current channel set contains the channel to which this network belongs */
if (rtw_chset_search_ch(chset, ch) >= 0
&& rtw_mlme_band_check(padapter, ch) == _TRUE
&& _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid))
&& (!IS_DFS_SLAVE_WITH_RD(rfctl)
|| rtw_odm_dfs_domain_unknown(rfctl_to_dvobj(rfctl))
|| !rtw_chset_is_ch_non_ocp(chset, ch))
)
ev = translate_scan(padapter, a, pnetwork, ev, stop);
plist = get_next(plist);
}
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
wrqu->data.length = ev - extra;
wrqu->data.flags = 0;
exit:
#ifdef DBG_IOCTL
RTW_INFO("DBG_IOCTL %s:%d return %d\n", __FUNCTION__, __LINE__, ret);
#endif
return ret ;
}
/* set ssid flow
* s1. rtw_set_802_11_infrastructure_mode()
* s2. set_802_11_authenticaion_mode()
* s3. set_802_11_encryption_mode()
* s4. rtw_set_802_11_ssid() */
static int rtw_wx_set_essid(struct net_device *dev,
struct iw_request_info *a,
union iwreq_data *wrqu, char *extra)
{
_irqL irqL;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
_queue *queue = &pmlmepriv->scanned_queue;
_list *phead;
struct wlan_network *pnetwork = NULL;
NDIS_802_11_AUTHENTICATION_MODE authmode;
NDIS_802_11_SSID ndis_ssid;
u8 *dst_ssid, *src_ssid;
uint ret = 0, len;
#ifdef DBG_IOCTL
RTW_INFO("DBG_IOCTL %s:%d\n", __FUNCTION__, __LINE__);
#endif
#ifdef CONFIG_WEXT_DONT_JOIN_BYSSID
RTW_INFO("%s: CONFIG_WEXT_DONT_JOIN_BYSSID be defined!! only allow bssid joining\n", __func__);
return -EPERM;
#endif
#if WIRELESS_EXT <= 20
if ((wrqu->essid.length - 1) > IW_ESSID_MAX_SIZE) {
#else
if (wrqu->essid.length > IW_ESSID_MAX_SIZE) {
#endif
ret = -E2BIG;
goto exit;
}
rtw_ps_deny(padapter, PS_DENY_JOIN);
if (_FAIL == rtw_pwr_wakeup(padapter)) {
ret = -1;
goto cancel_ps_deny;
}
if (!padapter->bup) {
ret = -1;
goto cancel_ps_deny;
}
if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) {
ret = -1;
goto cancel_ps_deny;
}
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_SURVEY | _FW_UNDER_LINKING)) {
RTW_INFO("set ssid, but buddy_intf is under scanning or linking\n");
ret = -EINVAL;
goto cancel_ps_deny;
}
#endif
authmode = padapter->securitypriv.ndisauthtype;
RTW_INFO("=>%s\n", __FUNCTION__);
if (wrqu->essid.flags && wrqu->essid.length) {
/* Commented by Albert 20100519 */
/* We got the codes in "set_info" function of iwconfig source code. */
/* ========================================= */
/* wrq.u.essid.length = strlen(essid) + 1; */
/* if(we_kernel_version > 20) */
/* wrq.u.essid.length--; */
/* ========================================= */
/* That means, if the WIRELESS_EXT less than or equal to 20, the correct ssid len should subtract 1. */
#if WIRELESS_EXT <= 20
len = ((wrqu->essid.length - 1) < IW_ESSID_MAX_SIZE) ? (wrqu->essid.length - 1) : IW_ESSID_MAX_SIZE;
#else
len = (wrqu->essid.length < IW_ESSID_MAX_SIZE) ? wrqu->essid.length : IW_ESSID_MAX_SIZE;
#endif
if (wrqu->essid.length != 33)
RTW_INFO("ssid=%s, len=%d\n", extra, wrqu->essid.length);
_rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID));
ndis_ssid.SsidLength = len;
_rtw_memcpy(ndis_ssid.Ssid, extra, len);
src_ssid = ndis_ssid.Ssid;
_enter_critical_bh(&queue->lock, &irqL);
phead = get_list_head(queue);
pmlmepriv->pscanned = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, pmlmepriv->pscanned) == _TRUE) {
#if 0
if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) {
rtw_set_802_11_ssid(padapter, &ndis_ssid);
goto cancel_ps_deny;
} else {
ret = -EINVAL;
goto cancel_ps_deny;
}
#endif
break;
}
pnetwork = LIST_CONTAINOR(pmlmepriv->pscanned, struct wlan_network, list);
pmlmepriv->pscanned = get_next(pmlmepriv->pscanned);
dst_ssid = pnetwork->network.Ssid.Ssid;
if ((_rtw_memcmp(dst_ssid, src_ssid, ndis_ssid.SsidLength) == _TRUE) &&
(pnetwork->network.Ssid.SsidLength == ndis_ssid.SsidLength)) {
if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) {
if (pnetwork->network.InfrastructureMode != pmlmepriv->cur_network.network.InfrastructureMode)
continue;
}
if (rtw_set_802_11_infrastructure_mode(padapter, pnetwork->network.InfrastructureMode, 0) == _FALSE) {
ret = -1;
_exit_critical_bh(&queue->lock, &irqL);
goto cancel_ps_deny;
}
break;
}
}
_exit_critical_bh(&queue->lock, &irqL);
rtw_set_802_11_authentication_mode(padapter, authmode);
/* set_802_11_encryption_mode(padapter, padapter->securitypriv.ndisencryptstatus); */
if (rtw_set_802_11_ssid(padapter, &ndis_ssid) == _FALSE) {
ret = -1;
goto cancel_ps_deny;
}
}
cancel_ps_deny:
rtw_ps_deny_cancel(padapter, PS_DENY_JOIN);
exit:
RTW_INFO("<=%s, ret %d\n", __FUNCTION__, ret);
#ifdef DBG_IOCTL
RTW_INFO("DBG_IOCTL %s:%d return %d\n", __FUNCTION__, __LINE__, ret);
#endif
return ret;
}
static int rtw_wx_get_essid(struct net_device *dev,
struct iw_request_info *a,
union iwreq_data *wrqu, char *extra)
{
u32 len, ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network;
if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) ||
(check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) {
len = pcur_bss->Ssid.SsidLength;
_rtw_memcpy(extra, pcur_bss->Ssid.Ssid, len);
} else {
len = 0;
*extra = 0;
}
wrqu->essid.length = len;
wrqu->essid.flags = 1;
return ret;
}
static int rtw_wx_set_rate(struct net_device *dev,
struct iw_request_info *a,
union iwreq_data *wrqu, char *extra)
{
int i, ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u8 datarates[NumRates];
u32 target_rate = wrqu->bitrate.value;
u32 fixed = wrqu->bitrate.fixed;
u32 ratevalue = 0;
u8 mpdatarate[NumRates] = {11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 1, 0, 0xff};
if (target_rate == -1) {
ratevalue = 11;
goto set_rate;
}
target_rate = target_rate / 100000;
switch (target_rate) {
case 10:
ratevalue = 0;
break;
case 20:
ratevalue = 1;
break;
case 55:
ratevalue = 2;
break;
case 60:
ratevalue = 3;
break;
case 90:
ratevalue = 4;
break;
case 110:
ratevalue = 5;
break;
case 120:
ratevalue = 6;
break;
case 180:
ratevalue = 7;
break;
case 240:
ratevalue = 8;
break;
case 360:
ratevalue = 9;
break;
case 480:
ratevalue = 10;
break;
case 540:
ratevalue = 11;
break;
default:
ratevalue = 11;
break;
}
set_rate:
for (i = 0; i < NumRates; i++) {
if (ratevalue == mpdatarate[i]) {
datarates[i] = mpdatarate[i];
if (fixed == 0)
break;
} else
datarates[i] = 0xff;
}
if (rtw_setdatarate_cmd(padapter, datarates) != _SUCCESS) {
ret = -1;
}
return ret;
}
static int rtw_wx_get_rate(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
u16 max_rate = 0;
max_rate = rtw_get_cur_max_rate((_adapter *)rtw_netdev_priv(dev));
if (max_rate == 0)
return -EPERM;
wrqu->bitrate.fixed = 0; /* no auto select */
wrqu->bitrate.value = max_rate * 100000;
return 0;
}
static int rtw_wx_set_rts(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
if (wrqu->rts.disabled)
padapter->registrypriv.rts_thresh = 2347;
else {
if (wrqu->rts.value < 0 ||
wrqu->rts.value > 2347)
return -EINVAL;
padapter->registrypriv.rts_thresh = wrqu->rts.value;
}
RTW_INFO("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh);
return 0;
}
static int rtw_wx_get_rts(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
RTW_INFO("%s, rts_thresh=%d\n", __func__, padapter->registrypriv.rts_thresh);
wrqu->rts.value = padapter->registrypriv.rts_thresh;
wrqu->rts.fixed = 0; /* no auto select */
/* wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD); */
return 0;
}
static int rtw_wx_set_frag(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
if (wrqu->frag.disabled)
padapter->xmitpriv.frag_len = MAX_FRAG_THRESHOLD;
else {
if (wrqu->frag.value < MIN_FRAG_THRESHOLD ||
wrqu->frag.value > MAX_FRAG_THRESHOLD)
return -EINVAL;
padapter->xmitpriv.frag_len = wrqu->frag.value & ~0x1;
}
RTW_INFO("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len);
return 0;
}
static int rtw_wx_get_frag(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
RTW_INFO("%s, frag_len=%d\n", __func__, padapter->xmitpriv.frag_len);
wrqu->frag.value = padapter->xmitpriv.frag_len;
wrqu->frag.fixed = 0; /* no auto select */
/* wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FRAG_THRESHOLD); */
return 0;
}
static int rtw_wx_get_retry(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
/* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */
wrqu->retry.value = 7;
wrqu->retry.fixed = 0; /* no auto select */
wrqu->retry.disabled = 1;
return 0;
}
#if 0
#define IW_ENCODE_INDEX 0x00FF /* Token index (if needed) */
#define IW_ENCODE_FLAGS 0xFF00 /* Flags defined below */
#define IW_ENCODE_MODE 0xF000 /* Modes defined below */
#define IW_ENCODE_DISABLED 0x8000 /* Encoding disabled */
#define IW_ENCODE_ENABLED 0x0000 /* Encoding enabled */
#define IW_ENCODE_RESTRICTED 0x4000 /* Refuse non-encoded packets */
#define IW_ENCODE_OPEN 0x2000 /* Accept non-encoded packets */
#define IW_ENCODE_NOKEY 0x0800 /* Key is write only, so not present */
#define IW_ENCODE_TEMP 0x0400 /* Temporary key */
/*
iwconfig wlan0 key on->flags = 0x6001->maybe it means auto
iwconfig wlan0 key off->flags = 0x8800
iwconfig wlan0 key open->flags = 0x2800
iwconfig wlan0 key open 1234567890->flags = 0x2000
iwconfig wlan0 key restricted->flags = 0x4800
iwconfig wlan0 key open [3] 1234567890->flags = 0x2003
iwconfig wlan0 key restricted [2] 1234567890->flags = 0x4002
iwconfig wlan0 key open [3] -> flags = 0x2803
iwconfig wlan0 key restricted [2] -> flags = 0x4802
*/
#endif
static int rtw_wx_set_enc(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *keybuf)
{
u32 key, ret = 0;
u32 keyindex_provided;
NDIS_802_11_WEP wep;
NDIS_802_11_AUTHENTICATION_MODE authmode;
struct iw_point *erq = &(wrqu->encoding);
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
RTW_INFO("+rtw_wx_set_enc, flags=0x%x\n", erq->flags);
_rtw_memset(&wep, 0, sizeof(NDIS_802_11_WEP));
key = erq->flags & IW_ENCODE_INDEX;
if (erq->flags & IW_ENCODE_DISABLED) {
RTW_INFO("EncryptionDisabled\n");
padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled;
padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_;
padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_;
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */
authmode = Ndis802_11AuthModeOpen;
padapter->securitypriv.ndisauthtype = authmode;
goto exit;
}
if (key) {
if (key > WEP_KEYS)
return -EINVAL;
key--;
keyindex_provided = 1;
} else {
keyindex_provided = 0;
key = padapter->securitypriv.dot11PrivacyKeyIndex;
RTW_INFO("rtw_wx_set_enc, key=%d\n", key);
}
/* set authentication mode */
if (erq->flags & IW_ENCODE_OPEN) {
RTW_INFO("rtw_wx_set_enc():IW_ENCODE_OPEN\n");
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;/* Ndis802_11EncryptionDisabled; */
#ifdef CONFIG_PLATFORM_MT53XX
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto;
#else
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open;
#endif
padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_;
padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_;
authmode = Ndis802_11AuthModeOpen;
padapter->securitypriv.ndisauthtype = authmode;
} else if (erq->flags & IW_ENCODE_RESTRICTED) {
RTW_INFO("rtw_wx_set_enc():IW_ENCODE_RESTRICTED\n");
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;
#ifdef CONFIG_PLATFORM_MT53XX
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Auto;
#else
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Shared;
#endif
padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_;
padapter->securitypriv.dot118021XGrpPrivacy = _WEP40_;
authmode = Ndis802_11AuthModeShared;
padapter->securitypriv.ndisauthtype = authmode;
} else {
RTW_INFO("rtw_wx_set_enc():erq->flags=0x%x\n", erq->flags);
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption1Enabled;/* Ndis802_11EncryptionDisabled; */
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */
padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_;
padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_;
authmode = Ndis802_11AuthModeOpen;
padapter->securitypriv.ndisauthtype = authmode;
}
wep.KeyIndex = key;
if (erq->length > 0) {
wep.KeyLength = erq->length <= 5 ? 5 : 13;
wep.Length = wep.KeyLength + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial);
} else {
wep.KeyLength = 0 ;
if (keyindex_provided == 1) { /* set key_id only, no given KeyMaterial(erq->length==0). */
padapter->securitypriv.dot11PrivacyKeyIndex = key;
RTW_INFO("(keyindex_provided == 1), keyid=%d, key_len=%d\n", key, padapter->securitypriv.dot11DefKeylen[key]);
switch (padapter->securitypriv.dot11DefKeylen[key]) {
case 5:
padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_;
break;
case 13:
padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_;
break;
default:
padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_;
break;
}
goto exit;
}
}
wep.KeyIndex |= 0x80000000;
_rtw_memcpy(wep.KeyMaterial, keybuf, wep.KeyLength);
if (rtw_set_802_11_add_wep(padapter, &wep) == _FALSE) {
if (rf_on == pwrpriv->rf_pwrstate)
ret = -EOPNOTSUPP;
goto exit;
}
exit:
return ret;
}
static int rtw_wx_get_enc(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *keybuf)
{
uint key, ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct iw_point *erq = &(wrqu->encoding);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
if (check_fwstate(pmlmepriv, _FW_LINKED) != _TRUE) {
if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != _TRUE) {
erq->length = 0;
erq->flags |= IW_ENCODE_DISABLED;
return 0;
}
}
key = erq->flags & IW_ENCODE_INDEX;
if (key) {
if (key > WEP_KEYS)
return -EINVAL;
key--;
} else
key = padapter->securitypriv.dot11PrivacyKeyIndex;
erq->flags = key + 1;
/* if(padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen) */
/* { */
/* erq->flags |= IW_ENCODE_OPEN; */
/* } */
switch (padapter->securitypriv.ndisencryptstatus) {
case Ndis802_11EncryptionNotSupported:
case Ndis802_11EncryptionDisabled:
erq->length = 0;
erq->flags |= IW_ENCODE_DISABLED;
break;
case Ndis802_11Encryption1Enabled:
erq->length = padapter->securitypriv.dot11DefKeylen[key];
if (erq->length) {
_rtw_memcpy(keybuf, padapter->securitypriv.dot11DefKey[key].skey, padapter->securitypriv.dot11DefKeylen[key]);
erq->flags |= IW_ENCODE_ENABLED;
if (padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeOpen)
erq->flags |= IW_ENCODE_OPEN;
else if (padapter->securitypriv.ndisauthtype == Ndis802_11AuthModeShared)
erq->flags |= IW_ENCODE_RESTRICTED;
} else {
erq->length = 0;
erq->flags |= IW_ENCODE_DISABLED;
}
break;
case Ndis802_11Encryption2Enabled:
case Ndis802_11Encryption3Enabled:
erq->length = 16;
erq->flags |= (IW_ENCODE_ENABLED | IW_ENCODE_OPEN | IW_ENCODE_NOKEY);
break;
default:
erq->length = 0;
erq->flags |= IW_ENCODE_DISABLED;
break;
}
return ret;
}
static int rtw_wx_get_power(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
/* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */
wrqu->power.value = 0;
wrqu->power.fixed = 0; /* no auto select */
wrqu->power.disabled = 1;
return 0;
}
static int rtw_wx_set_gen_ie(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
ret = rtw_set_wpa_ie(padapter, extra, wrqu->data.length);
return ret;
}
static int rtw_wx_set_auth(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct iw_param *param = (struct iw_param *)&(wrqu->param);
#ifdef CONFIG_WAPI_SUPPORT
#ifndef CONFIG_IOCTL_CFG80211
struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
struct security_priv *psecuritypriv = &padapter->securitypriv;
u32 value = param->value;
#endif
#endif
int ret = 0;
switch (param->flags & IW_AUTH_INDEX) {
case IW_AUTH_WPA_VERSION:
#ifdef CONFIG_WAPI_SUPPORT
#ifndef CONFIG_IOCTL_CFG80211
padapter->wapiInfo.bWapiEnable = false;
if (value == IW_AUTH_WAPI_VERSION_1) {
padapter->wapiInfo.bWapiEnable = true;
psecuritypriv->dot11PrivacyAlgrthm = _SMS4_;
psecuritypriv->dot118021XGrpPrivacy = _SMS4_;
psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_WAPI;
pmlmeinfo->auth_algo = psecuritypriv->dot11AuthAlgrthm;
padapter->wapiInfo.extra_prefix_len = WAPI_EXT_LEN;
padapter->wapiInfo.extra_postfix_len = SMS4_MIC_LEN;
}
#endif
#endif
break;
case IW_AUTH_CIPHER_PAIRWISE:
break;
case IW_AUTH_CIPHER_GROUP:
break;
case IW_AUTH_KEY_MGMT:
#ifdef CONFIG_WAPI_SUPPORT
#ifndef CONFIG_IOCTL_CFG80211
RTW_INFO("rtw_wx_set_auth: IW_AUTH_KEY_MGMT case\n");
if (value == IW_AUTH_KEY_MGMT_WAPI_PSK)
padapter->wapiInfo.bWapiPSK = true;
else
padapter->wapiInfo.bWapiPSK = false;
RTW_INFO("rtw_wx_set_auth: IW_AUTH_KEY_MGMT bwapipsk %d\n", padapter->wapiInfo.bWapiPSK);
#endif
#endif
/*
* ??? does not use these parameters
*/
break;
case IW_AUTH_TKIP_COUNTERMEASURES: {
if (param->value) {
/* wpa_supplicant is enabling the tkip countermeasure. */
padapter->securitypriv.btkip_countermeasure = _TRUE;
} else {
/* wpa_supplicant is disabling the tkip countermeasure. */
padapter->securitypriv.btkip_countermeasure = _FALSE;
}
break;
}
case IW_AUTH_DROP_UNENCRYPTED: {
/* HACK:
*
* wpa_supplicant calls set_wpa_enabled when the driver
* is loaded and unloaded, regardless of if WPA is being
* used. No other calls are made which can be used to
* determine if encryption will be used or not prior to
* association being expected. If encryption is not being
* used, drop_unencrypted is set to false, else true -- we
* can use this to determine if the CAP_PRIVACY_ON bit should
* be set.
*/
if (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption1Enabled) {
break;/* it means init value, or using wep, ndisencryptstatus = Ndis802_11Encryption1Enabled, */
/* then it needn't reset it; */
}
if (param->value) {
padapter->securitypriv.ndisencryptstatus = Ndis802_11EncryptionDisabled;
padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_;
padapter->securitypriv.dot118021XGrpPrivacy = _NO_PRIVACY_;
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */
padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen;
}
break;
}
case IW_AUTH_80211_AUTH_ALG:
#if defined(CONFIG_ANDROID) || 1
/*
* It's the starting point of a link layer connection using wpa_supplicant
*/
if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) {
LeaveAllPowerSaveMode(padapter);
rtw_disassoc_cmd(padapter, 500, RTW_CMDF_WAIT_ACK);
RTW_INFO("%s...call rtw_indicate_disconnect\n ", __FUNCTION__);
rtw_indicate_disconnect(padapter, 0, _FALSE);
rtw_free_assoc_resources_cmd(padapter, _TRUE, RTW_CMDF_WAIT_ACK);
}
#endif
ret = wpa_set_auth_algs(dev, (u32)param->value);
break;
case IW_AUTH_WPA_ENABLED:
/* if(param->value) */
/* padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; */ /* 802.1x */
/* else */
/* padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_Open; */ /* open system */
/* _disassociate(priv); */
break;
case IW_AUTH_RX_UNENCRYPTED_EAPOL:
/* ieee->ieee802_1x = param->value; */
break;
case IW_AUTH_PRIVACY_INVOKED:
/* ieee->privacy_invoked = param->value; */
break;
#ifdef CONFIG_WAPI_SUPPORT
#ifndef CONFIG_IOCTL_CFG80211
case IW_AUTH_WAPI_ENABLED:
break;
#endif
#endif
default:
return -EOPNOTSUPP;
}
return ret;
}
static int rtw_wx_set_enc_ext(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
char *alg_name;
u32 param_len;
struct ieee_param *param = NULL;
struct iw_point *pencoding = &wrqu->encoding;
struct iw_encode_ext *pext = (struct iw_encode_ext *)extra;
int ret = 0;
param_len = sizeof(struct ieee_param) + pext->key_len;
param = (struct ieee_param *)rtw_malloc(param_len);
if (param == NULL)
return -1;
_rtw_memset(param, 0, param_len);
param->cmd = IEEE_CMD_SET_ENCRYPTION;
_rtw_memset(param->sta_addr, 0xff, ETH_ALEN);
switch (pext->alg) {
case IW_ENCODE_ALG_NONE:
/* todo: remove key */
/* remove = 1; */
alg_name = "none";
break;
case IW_ENCODE_ALG_WEP:
alg_name = "WEP";
break;
case IW_ENCODE_ALG_TKIP:
alg_name = "TKIP";
break;
case IW_ENCODE_ALG_CCMP:
alg_name = "CCMP";
break;
#ifdef CONFIG_IEEE80211W
case IW_ENCODE_ALG_AES_CMAC:
alg_name = "BIP";
break;
#endif /* CONFIG_IEEE80211W */
#ifdef CONFIG_WAPI_SUPPORT
#ifndef CONFIG_IOCTL_CFG80211
case IW_ENCODE_ALG_SM4:
alg_name = "SMS4";
_rtw_memcpy(param->sta_addr, pext->addr.sa_data, ETH_ALEN);
RTW_INFO("rtw_wx_set_enc_ext: SMS4 case\n");
break;
#endif
#endif
default:
ret = -1;
goto exit;
}
strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN);
if (pext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY)
param->u.crypt.set_tx = 1;
/* cliW: WEP does not have group key
* just not checking GROUP key setting
*/
if ((pext->alg != IW_ENCODE_ALG_WEP) &&
((pext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)
#ifdef CONFIG_IEEE80211W
|| (pext->ext_flags & IW_ENCODE_ALG_AES_CMAC)
#endif /* CONFIG_IEEE80211W */
))
param->u.crypt.set_tx = 0;
param->u.crypt.idx = (pencoding->flags & 0x00FF) - 1 ;
if (pext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) {
#ifdef CONFIG_WAPI_SUPPORT
#ifndef CONFIG_IOCTL_CFG80211
if (pext->alg == IW_ENCODE_ALG_SM4)
_rtw_memcpy(param->u.crypt.seq, pext->rx_seq, 16);
else
#endif /* CONFIG_IOCTL_CFG80211 */
#endif /* CONFIG_WAPI_SUPPORT */
_rtw_memcpy(param->u.crypt.seq, pext->rx_seq, 8);
}
if (pext->key_len) {
param->u.crypt.key_len = pext->key_len;
/* _rtw_memcpy(param + 1, pext + 1, pext->key_len); */
_rtw_memcpy(param->u.crypt.key, pext + 1, pext->key_len);
}
if (pencoding->flags & IW_ENCODE_DISABLED) {
/* todo: remove key */
/* remove = 1; */
}
ret = wpa_set_encryption(dev, param, param_len);
exit:
if (param)
rtw_mfree((u8 *)param, param_len);
return ret;
}
static int rtw_wx_get_nick(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
/* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */
/* struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); */
/* struct security_priv *psecuritypriv = &padapter->securitypriv; */
if (extra) {
wrqu->data.length = 14;
wrqu->data.flags = 1;
_rtw_memcpy(extra, "<WIFI@REALTEK>", 14);
}
/* rtw_signal_process(pid, SIGUSR1); */ /* for test */
/* dump debug info here */
#if 0
u32 dot11AuthAlgrthm; /* 802.11 auth, could be open, shared, and 8021x */
u32 dot11PrivacyAlgrthm; /* This specify the privacy for shared auth. algorithm. */
u32 dot118021XGrpPrivacy; /* This specify the privacy algthm. used for Grp key */
u32 ndisauthtype;
u32 ndisencryptstatus;
#endif
/* RTW_INFO("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n", */
/* psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, */
/* psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); */
/* RTW_INFO("enc_alg=0x%x\n", psecuritypriv->dot11PrivacyAlgrthm); */
/* RTW_INFO("auth_type=0x%x\n", psecuritypriv->ndisauthtype); */
/* RTW_INFO("enc_type=0x%x\n", psecuritypriv->ndisencryptstatus); */
#if 0
RTW_INFO("dbg(0x210)=0x%x\n", rtw_read32(padapter, 0x210));
RTW_INFO("dbg(0x608)=0x%x\n", rtw_read32(padapter, 0x608));
RTW_INFO("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280));
RTW_INFO("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284));
RTW_INFO("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288));
RTW_INFO("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664));
RTW_INFO("\n");
RTW_INFO("dbg(0x430)=0x%x\n", rtw_read32(padapter, 0x430));
RTW_INFO("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438));
RTW_INFO("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440));
RTW_INFO("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458));
RTW_INFO("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484));
RTW_INFO("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488));
RTW_INFO("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444));
RTW_INFO("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448));
RTW_INFO("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c));
RTW_INFO("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450));
#endif
return 0;
}
static int rtw_wx_read32(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
PADAPTER padapter;
struct iw_point *p;
u16 len;
u32 addr;
u32 data32;
u32 bytes;
u8 *ptmp;
int ret;
ret = 0;
padapter = (PADAPTER)rtw_netdev_priv(dev);
p = &wrqu->data;
len = p->length;
if (0 == len)
return -EINVAL;
ptmp = (u8 *)rtw_malloc(len);
if (NULL == ptmp)
return -ENOMEM;
if (copy_from_user(ptmp, p->pointer, len)) {
ret = -EFAULT;
goto exit;
}
bytes = 0;
addr = 0;
sscanf(ptmp, "%d,%x", &bytes, &addr);
switch (bytes) {
case 1:
data32 = rtw_read8(padapter, addr);
sprintf(extra, "0x%02X", data32);
break;
case 2:
data32 = rtw_read16(padapter, addr);
sprintf(extra, "0x%04X", data32);
break;
case 4:
data32 = rtw_read32(padapter, addr);
sprintf(extra, "0x%08X", data32);
break;
#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_SDIO_INDIRECT_ACCESS) && defined(DBG_SDIO_INDIRECT_ACCESS)
case 11:
data32 = rtw_sd_iread8(padapter, addr);
sprintf(extra, "0x%02X", data32);
break;
case 12:
data32 = rtw_sd_iread16(padapter, addr);
sprintf(extra, "0x%04X", data32);
break;
case 14:
data32 = rtw_sd_iread32(padapter, addr);
sprintf(extra, "0x%08X", data32);
break;
#endif
default:
RTW_INFO("%s: usage> read [bytes],[address(hex)]\n", __func__);
ret = -EINVAL;
goto exit;
}
RTW_INFO("%s: addr=0x%08X data=%s\n", __func__, addr, extra);
exit:
rtw_mfree(ptmp, len);
return 0;
}
static int rtw_wx_write32(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev);
u32 addr;
u32 data32;
u32 bytes;
bytes = 0;
addr = 0;
data32 = 0;
sscanf(extra, "%d,%x,%x", &bytes, &addr, &data32);
switch (bytes) {
case 1:
rtw_write8(padapter, addr, (u8)data32);
RTW_INFO("%s: addr=0x%08X data=0x%02X\n", __func__, addr, (u8)data32);
break;
case 2:
rtw_write16(padapter, addr, (u16)data32);
RTW_INFO("%s: addr=0x%08X data=0x%04X\n", __func__, addr, (u16)data32);
break;
case 4:
rtw_write32(padapter, addr, data32);
RTW_INFO("%s: addr=0x%08X data=0x%08X\n", __func__, addr, data32);
break;
default:
RTW_INFO("%s: usage> write [bytes],[address(hex)],[data(hex)]\n", __func__);
return -EINVAL;
}
return 0;
}
static int rtw_wx_read_rf(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u32 path, addr, data32;
path = *(u32 *)extra;
addr = *((u32 *)extra + 1);
data32 = rtw_hal_read_rfreg(padapter, path, addr, 0xFFFFF);
/* RTW_INFO("%s: path=%d addr=0x%02x data=0x%05x\n", __func__, path, addr, data32); */
/*
* IMPORTANT!!
* Only when wireless private ioctl is at odd order,
* "extra" would be copied to user space.
*/
sprintf(extra, "0x%05x", data32);
return 0;
}
static int rtw_wx_write_rf(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u32 path, addr, data32;
path = *(u32 *)extra;
addr = *((u32 *)extra + 1);
data32 = *((u32 *)extra + 2);
/* RTW_INFO("%s: path=%d addr=0x%02x data=0x%05x\n", __func__, path, addr, data32); */
rtw_hal_write_rfreg(padapter, path, addr, 0xFFFFF, data32);
return 0;
}
static int rtw_wx_priv_null(struct net_device *dev, struct iw_request_info *a,
union iwreq_data *wrqu, char *b)
{
return -1;
}
#ifdef CONFIG_RTW_80211K
extern void rm_dbg_cmd(_adapter *padapter, char *s);
static int rtw_wx_priv_rrm(struct net_device *dev, struct iw_request_info *a,
union iwreq_data *wrqu, char *b)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u32 path, addr, data32;
rm_dbg_cmd(padapter, b);
wrqu->data.length = strlen(b);
return 0;
}
#endif
static int dummy(struct net_device *dev, struct iw_request_info *a,
union iwreq_data *wrqu, char *b)
{
/* _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); */
/* struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); */
/* RTW_INFO("cmd_code=%x, fwstate=0x%x\n", a->cmd, get_fwstate(pmlmepriv)); */
return -1;
}
static int rtw_wx_set_channel_plan(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u8 channel_plan_req = (u8)(*((int *)wrqu));
if (_SUCCESS != rtw_set_channel_plan(padapter, channel_plan_req))
return -EPERM;
return 0;
}
static int rtw_wx_set_mtk_wps_probe_ie(struct net_device *dev,
struct iw_request_info *a,
union iwreq_data *wrqu, char *b)
{
#ifdef CONFIG_PLATFORM_MT53XX
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
#endif
return 0;
}
static int rtw_wx_get_sensitivity(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *buf)
{
#ifdef CONFIG_PLATFORM_MT53XX
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
/* Modified by Albert 20110914 */
/* This is in dbm format for MTK platform. */
wrqu->qual.level = padapter->recvpriv.rssi;
RTW_INFO(" level = %u\n", wrqu->qual.level);
#endif
return 0;
}
static int rtw_wx_set_mtk_wps_ie(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
#ifdef CONFIG_PLATFORM_MT53XX
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
return rtw_set_wpa_ie(padapter, wrqu->data.pointer, wrqu->data.length);
#else
return 0;
#endif
}
static void rtw_dbg_mode_hdl(_adapter *padapter, u32 id, u8 *pdata, u32 len)
{
pRW_Reg RegRWStruct;
struct rf_reg_param *prfreg;
u8 path;
u8 offset;
u32 value;
RTW_INFO("%s\n", __FUNCTION__);
switch (id) {
case GEN_MP_IOCTL_SUBCODE(MP_START):
RTW_INFO("871x_driver is only for normal mode, can't enter mp mode\n");
break;
case GEN_MP_IOCTL_SUBCODE(READ_REG):
RegRWStruct = (pRW_Reg)pdata;
switch (RegRWStruct->width) {
case 1:
RegRWStruct->value = rtw_read8(padapter, RegRWStruct->offset);
break;
case 2:
RegRWStruct->value = rtw_read16(padapter, RegRWStruct->offset);
break;
case 4:
RegRWStruct->value = rtw_read32(padapter, RegRWStruct->offset);
break;
default:
break;
}
break;
case GEN_MP_IOCTL_SUBCODE(WRITE_REG):
RegRWStruct = (pRW_Reg)pdata;
switch (RegRWStruct->width) {
case 1:
rtw_write8(padapter, RegRWStruct->offset, (u8)RegRWStruct->value);
break;
case 2:
rtw_write16(padapter, RegRWStruct->offset, (u16)RegRWStruct->value);
break;
case 4:
rtw_write32(padapter, RegRWStruct->offset, (u32)RegRWStruct->value);
break;
default:
break;
}
break;
case GEN_MP_IOCTL_SUBCODE(READ_RF_REG):
prfreg = (struct rf_reg_param *)pdata;
path = (u8)prfreg->path;
offset = (u8)prfreg->offset;
value = rtw_hal_read_rfreg(padapter, path, offset, 0xffffffff);
prfreg->value = value;
break;
case GEN_MP_IOCTL_SUBCODE(WRITE_RF_REG):
prfreg = (struct rf_reg_param *)pdata;
path = (u8)prfreg->path;
offset = (u8)prfreg->offset;
value = prfreg->value;
rtw_hal_write_rfreg(padapter, path, offset, 0xffffffff, value);
break;
case GEN_MP_IOCTL_SUBCODE(TRIGGER_GPIO):
RTW_INFO("==> trigger gpio 0\n");
rtw_hal_set_hwreg(padapter, HW_VAR_TRIGGER_GPIO_0, 0);
break;
#ifdef CONFIG_BT_COEXIST
case GEN_MP_IOCTL_SUBCODE(SET_DM_BT):
RTW_INFO("==> set dm_bt_coexist:%x\n", *(u8 *)pdata);
rtw_hal_set_hwreg(padapter, HW_VAR_BT_SET_COEXIST, pdata);
break;
case GEN_MP_IOCTL_SUBCODE(DEL_BA):
RTW_INFO("==> delete ba:%x\n", *(u8 *)pdata);
rtw_hal_set_hwreg(padapter, HW_VAR_BT_ISSUE_DELBA, pdata);
break;
#endif
#ifdef DBG_CONFIG_ERROR_DETECT
case GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS):
*pdata = rtw_hal_sreset_get_wifi_status(padapter);
break;
#endif
default:
break;
}
}
#ifdef MP_IOCTL_HDL
static int rtw_mp_ioctl_hdl(struct net_device *dev, struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
u32 BytesRead, BytesWritten, BytesNeeded;
struct oid_par_priv oid_par;
struct mp_ioctl_handler *phandler;
struct mp_ioctl_param *poidparam;
uint status = 0;
u16 len;
u8 *pparmbuf = NULL, bset;
PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev);
struct iw_point *p = &wrqu->data;
/* RTW_INFO("+rtw_mp_ioctl_hdl\n"); */
/* mutex_lock(&ioctl_mutex); */
if ((!p->length) || (!p->pointer)) {
ret = -EINVAL;
goto _rtw_mp_ioctl_hdl_exit;
}
pparmbuf = NULL;
bset = (u8)(p->flags & 0xFFFF);
len = p->length;
pparmbuf = (u8 *)rtw_malloc(len);
if (pparmbuf == NULL) {
ret = -ENOMEM;
goto _rtw_mp_ioctl_hdl_exit;
}
if (copy_from_user(pparmbuf, p->pointer, len)) {
ret = -EFAULT;
goto _rtw_mp_ioctl_hdl_exit;
}
poidparam = (struct mp_ioctl_param *)pparmbuf;
if (poidparam->subcode >= MAX_MP_IOCTL_SUBCODE) {
ret = -EINVAL;
goto _rtw_mp_ioctl_hdl_exit;
}
/* RTW_INFO("%s: %d\n", __func__, poidparam->subcode); */
#ifdef CONFIG_MP_INCLUDED
if (padapter->registrypriv.mp_mode == 1) {
phandler = mp_ioctl_hdl + poidparam->subcode;
if ((phandler->paramsize != 0) && (poidparam->len < phandler->paramsize)) {
ret = -EINVAL;
goto _rtw_mp_ioctl_hdl_exit;
}
if (phandler->handler) {
oid_par.adapter_context = padapter;
oid_par.oid = phandler->oid;
oid_par.information_buf = poidparam->data;
oid_par.information_buf_len = poidparam->len;
oid_par.dbg = 0;
BytesWritten = 0;
BytesNeeded = 0;
if (bset) {
oid_par.bytes_rw = &BytesRead;
oid_par.bytes_needed = &BytesNeeded;
oid_par.type_of_oid = SET_OID;
} else {
oid_par.bytes_rw = &BytesWritten;
oid_par.bytes_needed = &BytesNeeded;
oid_par.type_of_oid = QUERY_OID;
}
status = phandler->handler(&oid_par);
/* todo:check status, BytesNeeded, etc. */
} else {
RTW_INFO("rtw_mp_ioctl_hdl(): err!, subcode=%d, oid=%d, handler=%p\n",
poidparam->subcode, phandler->oid, phandler->handler);
ret = -EFAULT;
goto _rtw_mp_ioctl_hdl_exit;
}
} else
#endif
{
rtw_dbg_mode_hdl(padapter, poidparam->subcode, poidparam->data, poidparam->len);
}
if (bset == 0x00) {/* query info */
if (copy_to_user(p->pointer, pparmbuf, len))
ret = -EFAULT;
}
if (status) {
ret = -EFAULT;
goto _rtw_mp_ioctl_hdl_exit;
}
_rtw_mp_ioctl_hdl_exit:
if (pparmbuf)
rtw_mfree(pparmbuf, len);
/* mutex_unlock(&ioctl_mutex); */
return ret;
}
#endif
static int rtw_get_ap_info(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
u32 cnt = 0, wpa_ielen;
_irqL irqL;
_list *plist, *phead;
unsigned char *pbuf;
u8 bssid[ETH_ALEN];
char data[32];
struct wlan_network *pnetwork = NULL;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
_queue *queue = &(pmlmepriv->scanned_queue);
struct iw_point *pdata = &wrqu->data;
RTW_INFO("+rtw_get_aplist_info\n");
if (rtw_is_drv_stopped(padapter) || (pdata == NULL)) {
ret = -EINVAL;
goto exit;
}
while ((check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY | _FW_UNDER_LINKING))) == _TRUE) {
rtw_msleep_os(30);
cnt++;
if (cnt > 100)
break;
}
/* pdata->length = 0; */ /* ? */
pdata->flags = 0;
if (pdata->length >= 32) {
if (copy_from_user(data, pdata->pointer, 32)) {
ret = -EINVAL;
goto exit;
}
} else {
ret = -EINVAL;
goto exit;
}
_enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
phead = get_list_head(queue);
plist = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, plist) == _TRUE)
break;
pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
/* if(hwaddr_aton_i(pdata->pointer, bssid)) */
if (hwaddr_aton_i(data, bssid)) {
RTW_INFO("Invalid BSSID '%s'.\n", (u8 *)data);
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
return -EINVAL;
}
if (_rtw_memcmp(bssid, pnetwork->network.MacAddress, ETH_ALEN) == _TRUE) { /* BSSID match, then check if supporting wpa/wpa2 */
RTW_INFO("BSSID:" MAC_FMT "\n", MAC_ARG(bssid));
pbuf = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength - 12);
if (pbuf && (wpa_ielen > 0)) {
pdata->flags = 1;
break;
}
pbuf = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength - 12);
if (pbuf && (wpa_ielen > 0)) {
pdata->flags = 2;
break;
}
}
plist = get_next(plist);
}
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
if (pdata->length >= 34) {
if (copy_to_user((u8 *)pdata->pointer + 32, (u8 *)&pdata->flags, 1)) {
ret = -EINVAL;
goto exit;
}
}
exit:
return ret;
}
static int rtw_set_pid(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = rtw_netdev_priv(dev);
int *pdata = (int *)wrqu;
int selector;
if (rtw_is_drv_stopped(padapter) || (pdata == NULL)) {
ret = -EINVAL;
goto exit;
}
selector = *pdata;
if (selector < 3 && selector >= 0) {
padapter->pid[selector] = *(pdata + 1);
#ifdef CONFIG_GLOBAL_UI_PID
ui_pid[selector] = *(pdata + 1);
#endif
RTW_INFO("%s set pid[%d]=%d\n", __FUNCTION__, selector , padapter->pid[selector]);
} else
RTW_INFO("%s selector %d error\n", __FUNCTION__, selector);
exit:
return ret;
}
static int rtw_wps_start(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct iw_point *pdata = &wrqu->data;
u32 u32wps_start = 0;
unsigned int uintRet = 0;
if (RTW_CANNOT_RUN(padapter) || (NULL == pdata)) {
ret = -EINVAL;
goto exit;
}
uintRet = copy_from_user((void *) &u32wps_start, pdata->pointer, 4);
if (u32wps_start == 0)
u32wps_start = *extra;
RTW_INFO("[%s] wps_start = %d\n", __FUNCTION__, u32wps_start);
if (u32wps_start == 1) /* WPS Start */
rtw_led_control(padapter, LED_CTL_START_WPS);
else if (u32wps_start == 2) /* WPS Stop because of wps success */
rtw_led_control(padapter, LED_CTL_STOP_WPS);
else if (u32wps_start == 3) /* WPS Stop because of wps fail */
rtw_led_control(padapter, LED_CTL_STOP_WPS_FAIL);
#ifdef CONFIG_INTEL_WIDI
process_intel_widi_wps_status(padapter, u32wps_start);
#endif /* CONFIG_INTEL_WIDI */
exit:
return ret;
}
#ifdef CONFIG_P2P
static int rtw_wext_p2p_enable(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
enum P2P_ROLE init_role = P2P_ROLE_DISABLE;
if (*extra == '0')
init_role = P2P_ROLE_DISABLE;
else if (*extra == '1')
init_role = P2P_ROLE_DEVICE;
else if (*extra == '2')
init_role = P2P_ROLE_CLIENT;
else if (*extra == '3')
init_role = P2P_ROLE_GO;
if (_FAIL == rtw_p2p_enable(padapter, init_role)) {
ret = -EFAULT;
goto exit;
}
/* set channel/bandwidth */
if (init_role != P2P_ROLE_DISABLE) {
u8 channel, ch_offset;
u16 bwmode;
if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN)) {
/* Stay at the listen state and wait for discovery. */
channel = pwdinfo->listen_channel;
pwdinfo->operating_channel = pwdinfo->listen_channel;
ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
bwmode = CHANNEL_WIDTH_20;
}
#ifdef CONFIG_CONCURRENT_MODE
else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) {
_set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_interval);
channel = rtw_mi_get_union_chan(padapter);
ch_offset = rtw_mi_get_union_offset(padapter);
bwmode = rtw_mi_get_union_bw(padapter);
pwdinfo->operating_channel = channel;
}
#endif
else {
pwdinfo->operating_channel = pmlmeext->cur_channel;
channel = pwdinfo->operating_channel;
ch_offset = pmlmeext->cur_ch_offset;
bwmode = pmlmeext->cur_bwmode;
}
set_channel_bwmode(padapter, channel, ch_offset, bwmode);
}
exit:
return ret;
}
static int rtw_p2p_set_go_nego_ssid(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
RTW_INFO("[%s] ssid = %s, len = %zu\n", __FUNCTION__, extra, strlen(extra));
_rtw_memcpy(pwdinfo->nego_ssid, extra, strlen(extra));
pwdinfo->nego_ssidlen = strlen(extra);
return ret;
}
static int rtw_p2p_set_intent(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
u8 intent = pwdinfo->intent;
extra[wrqu->data.length] = 0x00;
intent = rtw_atoi(extra);
if (intent <= 15)
pwdinfo->intent = intent;
else
ret = -1;
RTW_INFO("[%s] intent = %d\n", __FUNCTION__, intent);
return ret;
}
static int rtw_p2p_set_listen_ch(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
u8 listen_ch = pwdinfo->listen_channel; /* Listen channel number */
extra[wrqu->data.length] = 0x00;
listen_ch = rtw_atoi(extra);
if ((listen_ch == 1) || (listen_ch == 6) || (listen_ch == 11)) {
pwdinfo->listen_channel = listen_ch;
set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20);
} else
ret = -1;
RTW_INFO("[%s] listen_ch = %d\n", __FUNCTION__, pwdinfo->listen_channel);
return ret;
}
static int rtw_p2p_set_op_ch(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
/* Commented by Albert 20110524
* This function is used to set the operating channel if the driver will become the group owner */
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
u8 op_ch = pwdinfo->operating_channel; /* Operating channel number */
extra[wrqu->data.length] = 0x00;
op_ch = (u8) rtw_atoi(extra);
if (op_ch > 0)
pwdinfo->operating_channel = op_ch;
else
ret = -1;
RTW_INFO("[%s] op_ch = %d\n", __FUNCTION__, pwdinfo->operating_channel);
return ret;
}
static int rtw_p2p_profilefound(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
/* Comment by Albert 2010/10/13 */
/* Input data format: */
/* Ex: 0 */
/* Ex: 1XX:XX:XX:XX:XX:XXYYSSID */
/* 0 => Reflush the profile record list. */
/* 1 => Add the profile list */
/* XX:XX:XX:XX:XX:XX => peer's MAC Address ( ex: 00:E0:4C:00:00:01 ) */
/* YY => SSID Length */
/* SSID => SSID for persistence group */
RTW_INFO("[%s] In value = %s, len = %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
/* The upper application should pass the SSID to driver by using this rtw_p2p_profilefound function. */
if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) {
if (extra[0] == '0') {
/* Remove all the profile information of wifidirect_info structure. */
_rtw_memset(&pwdinfo->profileinfo[0], 0x00, sizeof(struct profile_info) * P2P_MAX_PERSISTENT_GROUP_NUM);
pwdinfo->profileindex = 0;
} else {
if (pwdinfo->profileindex >= P2P_MAX_PERSISTENT_GROUP_NUM)
ret = -1;
else {
int jj, kk;
/* Add this profile information into pwdinfo->profileinfo */
/* Ex: 1XX:XX:XX:XX:XX:XXYYSSID */
for (jj = 0, kk = 1; jj < ETH_ALEN; jj++, kk += 3)
pwdinfo->profileinfo[pwdinfo->profileindex].peermac[jj] = key_2char2num(extra[kk], extra[kk + 1]);
/* pwdinfo->profileinfo[pwdinfo->profileindex].ssidlen = ( extra[18] - '0' ) * 10 + ( extra[19] - '0' ); */
/* _rtw_memcpy( pwdinfo->profileinfo[pwdinfo->profileindex].ssid, &extra[20], pwdinfo->profileinfo[pwdinfo->profileindex].ssidlen ); */
pwdinfo->profileindex++;
}
}
}
return ret;
}
static int rtw_p2p_setDN(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
_rtw_memset(pwdinfo->device_name, 0x00, WPS_MAX_DEVICE_NAME_LEN);
_rtw_memcpy(pwdinfo->device_name, extra, wrqu->data.length - 1);
pwdinfo->device_name_len = wrqu->data.length - 1;
return ret;
}
static int rtw_p2p_get_status(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
if (padapter->bShowGetP2PState) {
RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo),
pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2],
pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]);
}
/* Commented by Albert 2010/10/12 */
/* Because of the output size limitation, I had removed the "Role" information. */
/* About the "Role" information, we will use the new private IOCTL to get the "Role" information. */
sprintf(extra, "\n\nStatus=%.2d\n", rtw_p2p_state(pwdinfo));
wrqu->data.length = strlen(extra);
return ret;
}
/* Commented by Albert 20110520
* This function will return the config method description
* This config method description will show us which config method the remote P2P device is intented to use
* by sending the provisioning discovery request frame. */
static int rtw_p2p_get_req_cm(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
sprintf(extra, "\n\nCM=%s\n", pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req);
wrqu->data.length = strlen(extra);
return ret;
}
static int rtw_p2p_get_role(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo),
pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2],
pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]);
sprintf(extra, "\n\nRole=%.2d\n", rtw_p2p_role(pwdinfo));
wrqu->data.length = strlen(extra);
return ret;
}
static int rtw_p2p_get_peer_ifaddr(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo),
pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2],
pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]);
sprintf(extra, "\nMAC %.2X:%.2X:%.2X:%.2X:%.2X:%.2X",
pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2],
pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]);
wrqu->data.length = strlen(extra);
return ret;
}
static int rtw_p2p_get_peer_devaddr(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo),
pwdinfo->rx_prov_disc_info.peerDevAddr[0], pwdinfo->rx_prov_disc_info.peerDevAddr[1],
pwdinfo->rx_prov_disc_info.peerDevAddr[2], pwdinfo->rx_prov_disc_info.peerDevAddr[3],
pwdinfo->rx_prov_disc_info.peerDevAddr[4], pwdinfo->rx_prov_disc_info.peerDevAddr[5]);
sprintf(extra, "\n%.2X%.2X%.2X%.2X%.2X%.2X",
pwdinfo->rx_prov_disc_info.peerDevAddr[0], pwdinfo->rx_prov_disc_info.peerDevAddr[1],
pwdinfo->rx_prov_disc_info.peerDevAddr[2], pwdinfo->rx_prov_disc_info.peerDevAddr[3],
pwdinfo->rx_prov_disc_info.peerDevAddr[4], pwdinfo->rx_prov_disc_info.peerDevAddr[5]);
wrqu->data.length = strlen(extra);
return ret;
}
static int rtw_p2p_get_peer_devaddr_by_invitation(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo),
pwdinfo->p2p_peer_device_addr[0], pwdinfo->p2p_peer_device_addr[1],
pwdinfo->p2p_peer_device_addr[2], pwdinfo->p2p_peer_device_addr[3],
pwdinfo->p2p_peer_device_addr[4], pwdinfo->p2p_peer_device_addr[5]);
sprintf(extra, "\nMAC %.2X:%.2X:%.2X:%.2X:%.2X:%.2X",
pwdinfo->p2p_peer_device_addr[0], pwdinfo->p2p_peer_device_addr[1],
pwdinfo->p2p_peer_device_addr[2], pwdinfo->p2p_peer_device_addr[3],
pwdinfo->p2p_peer_device_addr[4], pwdinfo->p2p_peer_device_addr[5]);
wrqu->data.length = strlen(extra);
return ret;
}
static int rtw_p2p_get_groupid(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
sprintf(extra, "\n%.2X:%.2X:%.2X:%.2X:%.2X:%.2X %s",
pwdinfo->groupid_info.go_device_addr[0], pwdinfo->groupid_info.go_device_addr[1],
pwdinfo->groupid_info.go_device_addr[2], pwdinfo->groupid_info.go_device_addr[3],
pwdinfo->groupid_info.go_device_addr[4], pwdinfo->groupid_info.go_device_addr[5],
pwdinfo->groupid_info.ssid);
wrqu->data.length = strlen(extra);
return ret;
}
static int rtw_p2p_get_op_ch(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
RTW_INFO("[%s] Op_ch = %02x\n", __FUNCTION__, pwdinfo->operating_channel);
sprintf(extra, "\n\nOp_ch=%.2d\n", pwdinfo->operating_channel);
wrqu->data.length = strlen(extra);
return ret;
}
static int rtw_p2p_get_wps_configmethod(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra, char *subcmd)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u8 peerMAC[ETH_ALEN] = { 0x00 };
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
_irqL irqL;
_list *plist, *phead;
_queue *queue = &(pmlmepriv->scanned_queue);
struct wlan_network *pnetwork = NULL;
u8 blnMatch = 0;
u16 attr_content = 0;
uint attr_contentlen = 0;
u8 attr_content_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 };
/* Commented by Albert 20110727 */
/* The input data is the MAC address which the application wants to know its WPS config method. */
/* After knowing its WPS config method, the application can decide the config method for provisioning discovery. */
/* Format: iwpriv wlanx p2p_get_wpsCM 00:E0:4C:00:00:05 */
RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd);
macstr2num(peerMAC, subcmd);
_enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
phead = get_list_head(queue);
plist = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, plist) == _TRUE)
break;
pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) {
u8 *wpsie;
uint wpsie_len = 0;
/* The mac address is matched. */
wpsie = rtw_get_wps_ie_from_scan_queue(&pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0]);
if (wpsie) {
rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_CONF_METHOD, (u8 *)&attr_content, &attr_contentlen);
if (attr_contentlen) {
attr_content = be16_to_cpu(attr_content);
sprintf(attr_content_str, "\n\nM=%.4d", attr_content);
blnMatch = 1;
}
}
break;
}
plist = get_next(plist);
}
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
if (!blnMatch)
sprintf(attr_content_str, "\n\nM=0000");
wrqu->data.length = strlen(attr_content_str);
_rtw_memcpy(extra, attr_content_str, wrqu->data.length);
return ret;
}
#ifdef CONFIG_WFD
static int rtw_p2p_get_peer_wfd_port(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
RTW_INFO("[%s] p2p_state = %d\n", __FUNCTION__, rtw_p2p_state(pwdinfo));
sprintf(extra, "\n\nPort=%d\n", pwdinfo->wfd_info->peer_rtsp_ctrlport);
RTW_INFO("[%s] remote port = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_rtsp_ctrlport);
wrqu->data.length = strlen(extra);
return ret;
}
static int rtw_p2p_get_peer_wfd_preferred_connection(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
sprintf(extra, "\n\nwfd_pc=%d\n", pwdinfo->wfd_info->wfd_pc);
RTW_INFO("[%s] wfd_pc = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_pc);
wrqu->data.length = strlen(extra);
pwdinfo->wfd_info->wfd_pc = _FALSE; /* Reset the WFD preferred connection to P2P */
return ret;
}
static int rtw_p2p_get_peer_wfd_session_available(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
sprintf(extra, "\n\nwfd_sa=%d\n", pwdinfo->wfd_info->peer_session_avail);
RTW_INFO("[%s] wfd_sa = %d\n", __FUNCTION__, pwdinfo->wfd_info->peer_session_avail);
wrqu->data.length = strlen(extra);
pwdinfo->wfd_info->peer_session_avail = _TRUE; /* Reset the WFD session available */
return ret;
}
#endif /* CONFIG_WFD */
static int rtw_p2p_get_go_device_address(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra, char *subcmd)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u8 peerMAC[ETH_ALEN] = { 0x00 };
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
_irqL irqL;
_list *plist, *phead;
_queue *queue = &(pmlmepriv->scanned_queue);
struct wlan_network *pnetwork = NULL;
u8 blnMatch = 0;
u8 *p2pie;
uint p2pielen = 0, attr_contentlen = 0;
u8 attr_content[100] = { 0x00 };
u8 go_devadd_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 };
/* Commented by Albert 20121209 */
/* The input data is the GO's interface address which the application wants to know its device address. */
/* Format: iwpriv wlanx p2p_get2 go_devadd=00:E0:4C:00:00:05 */
RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd);
macstr2num(peerMAC, subcmd);
_enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
phead = get_list_head(queue);
plist = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, plist) == _TRUE)
break;
pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) {
/* Commented by Albert 2011/05/18 */
/* Match the device address located in the P2P IE */
/* This is for the case that the P2P device address is not the same as the P2P interface address. */
p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen);
if (p2pie) {
while (p2pie) {
/* The P2P Device ID attribute is included in the Beacon frame. */
/* The P2P Device Info attribute is included in the probe response frame. */
_rtw_memset(attr_content, 0x00, 100);
if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) {
/* Handle the P2P Device ID attribute of Beacon first */
blnMatch = 1;
break;
} else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) {
/* Handle the P2P Device Info attribute of probe response */
blnMatch = 1;
break;
}
/* Get the next P2P IE */
p2pie = rtw_get_p2p_ie(p2pie + p2pielen, BSS_EX_TLV_IES_LEN(&pnetwork->network) - (p2pie + p2pielen - BSS_EX_TLV_IES(&pnetwork->network)), NULL, &p2pielen);
}
}
}
plist = get_next(plist);
}
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
if (!blnMatch)
sprintf(go_devadd_str, "\n\ndev_add=NULL");
else {
sprintf(go_devadd_str, "\n\ndev_add=%.2X:%.2X:%.2X:%.2X:%.2X:%.2X",
attr_content[0], attr_content[1], attr_content[2], attr_content[3], attr_content[4], attr_content[5]);
}
wrqu->data.length = strlen(go_devadd_str);
_rtw_memcpy(extra, go_devadd_str, wrqu->data.length);
return ret;
}
static int rtw_p2p_get_device_type(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra, char *subcmd)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u8 peerMAC[ETH_ALEN] = { 0x00 };
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
_irqL irqL;
_list *plist, *phead;
_queue *queue = &(pmlmepriv->scanned_queue);
struct wlan_network *pnetwork = NULL;
u8 blnMatch = 0;
u8 dev_type[8] = { 0x00 };
uint dev_type_len = 0;
u8 dev_type_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 }; /* +9 is for the str "dev_type=", we have to clear it at wrqu->data.pointer */
/* Commented by Albert 20121209 */
/* The input data is the MAC address which the application wants to know its device type. */
/* Such user interface could know the device type. */
/* Format: iwpriv wlanx p2p_get2 dev_type=00:E0:4C:00:00:05 */
RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd);
macstr2num(peerMAC, subcmd);
_enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
phead = get_list_head(queue);
plist = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, plist) == _TRUE)
break;
pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) {
u8 *wpsie;
uint wpsie_len = 0;
/* The mac address is matched. */
wpsie = rtw_get_wps_ie_from_scan_queue(&pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0]);
if (wpsie) {
rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_PRIMARY_DEV_TYPE, dev_type, &dev_type_len);
if (dev_type_len) {
u16 type = 0;
_rtw_memcpy(&type, dev_type, 2);
type = be16_to_cpu(type);
sprintf(dev_type_str, "\n\nN=%.2d", type);
blnMatch = 1;
}
}
break;
}
plist = get_next(plist);
}
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
if (!blnMatch)
sprintf(dev_type_str, "\n\nN=00");
wrqu->data.length = strlen(dev_type_str);
_rtw_memcpy(extra, dev_type_str, wrqu->data.length);
return ret;
}
static int rtw_p2p_get_device_name(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra, char *subcmd)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u8 peerMAC[ETH_ALEN] = { 0x00 };
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
_irqL irqL;
_list *plist, *phead;
_queue *queue = &(pmlmepriv->scanned_queue);
struct wlan_network *pnetwork = NULL;
u8 blnMatch = 0;
u8 dev_name[WPS_MAX_DEVICE_NAME_LEN] = { 0x00 };
uint dev_len = 0;
u8 dev_name_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 };
/* Commented by Albert 20121225 */
/* The input data is the MAC address which the application wants to know its device name. */
/* Such user interface could show peer device's device name instead of ssid. */
/* Format: iwpriv wlanx p2p_get2 devN=00:E0:4C:00:00:05 */
RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd);
macstr2num(peerMAC, subcmd);
_enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
phead = get_list_head(queue);
plist = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, plist) == _TRUE)
break;
pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) {
u8 *wpsie;
uint wpsie_len = 0;
/* The mac address is matched. */
wpsie = rtw_get_wps_ie_from_scan_queue(&pnetwork->network.IEs[0], pnetwork->network.IELength, NULL, &wpsie_len, pnetwork->network.Reserved[0]);
if (wpsie) {
rtw_get_wps_attr_content(wpsie, wpsie_len, WPS_ATTR_DEVICE_NAME, dev_name, &dev_len);
if (dev_len) {
sprintf(dev_name_str, "\n\nN=%s", dev_name);
blnMatch = 1;
}
}
break;
}
plist = get_next(plist);
}
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
if (!blnMatch)
sprintf(dev_name_str, "\n\nN=0000");
wrqu->data.length = strlen(dev_name_str);
_rtw_memcpy(extra, dev_name_str, wrqu->data.length);
return ret;
}
static int rtw_p2p_get_invitation_procedure(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra, char *subcmd)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u8 peerMAC[ETH_ALEN] = { 0x00 };
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
_irqL irqL;
_list *plist, *phead;
_queue *queue = &(pmlmepriv->scanned_queue);
struct wlan_network *pnetwork = NULL;
u8 blnMatch = 0;
u8 *p2pie;
uint p2pielen = 0, attr_contentlen = 0;
u8 attr_content[2] = { 0x00 };
u8 inv_proc_str[P2P_PRIVATE_IOCTL_SET_LEN] = { 0x00 };
/* Commented by Ouden 20121226 */
/* The application wants to know P2P initation procedure is support or not. */
/* Format: iwpriv wlanx p2p_get2 InvProc=00:E0:4C:00:00:05 */
RTW_INFO("[%s] data = %s\n", __FUNCTION__, subcmd);
macstr2num(peerMAC, subcmd);
_enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
phead = get_list_head(queue);
plist = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, plist) == _TRUE)
break;
pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) {
/* Commented by Albert 20121226 */
/* Match the device address located in the P2P IE */
/* This is for the case that the P2P device address is not the same as the P2P interface address. */
p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen);
if (p2pie) {
while (p2pie) {
/* _rtw_memset( attr_content, 0x00, 2); */
if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_CAPABILITY, attr_content, &attr_contentlen)) {
/* Handle the P2P capability attribute */
blnMatch = 1;
break;
}
/* Get the next P2P IE */
p2pie = rtw_get_p2p_ie(p2pie + p2pielen, BSS_EX_TLV_IES_LEN(&pnetwork->network) - (p2pie + p2pielen - BSS_EX_TLV_IES(&pnetwork->network)), NULL, &p2pielen);
}
}
}
plist = get_next(plist);
}
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
if (!blnMatch)
sprintf(inv_proc_str, "\nIP=-1");
else {
if ((attr_content[0] & 0x20) == 0x20)
sprintf(inv_proc_str, "\nIP=1");
else
sprintf(inv_proc_str, "\nIP=0");
}
wrqu->data.length = strlen(inv_proc_str);
_rtw_memcpy(extra, inv_proc_str, wrqu->data.length);
return ret;
}
static int rtw_p2p_connect(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
u8 peerMAC[ETH_ALEN] = { 0x00 };
int jj, kk;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
_irqL irqL;
_list *plist, *phead;
_queue *queue = &(pmlmepriv->scanned_queue);
struct wlan_network *pnetwork = NULL;
uint uintPeerChannel = 0;
/* Commented by Albert 20110304 */
/* The input data contains two informations. */
/* 1. First information is the MAC address which wants to formate with */
/* 2. Second information is the WPS PINCode or "pbc" string for push button method */
/* Format: 00:E0:4C:00:00:05 */
/* Format: 00:E0:4C:00:00:05 */
RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra);
if (pwdinfo->p2p_state == P2P_STATE_NONE) {
RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__);
return ret;
}
#ifdef CONFIG_INTEL_WIDI
if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) {
RTW_INFO("[%s] WiFi is under survey!\n", __FUNCTION__);
return ret;
}
#endif /* CONFIG_INTEL_WIDI */
if (pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO)
return -1;
for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3)
peerMAC[jj] = key_2char2num(extra[kk], extra[kk + 1]);
_enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
phead = get_list_head(queue);
plist = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, plist) == _TRUE)
break;
pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) {
if (pnetwork->network.Configuration.DSConfig != 0)
uintPeerChannel = pnetwork->network.Configuration.DSConfig;
else if (pwdinfo->nego_req_info.peer_ch != 0)
uintPeerChannel = pnetwork->network.Configuration.DSConfig = pwdinfo->nego_req_info.peer_ch;
else {
/* Unexpected case */
uintPeerChannel = 0;
RTW_INFO("%s uintPeerChannel = 0\n", __func__);
}
break;
}
plist = get_next(plist);
}
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
if (uintPeerChannel) {
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_check_status(padapter, MI_LINKED))
_cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer);
#endif /* CONFIG_CONCURRENT_MODE */
_rtw_memset(&pwdinfo->nego_req_info, 0x00, sizeof(struct tx_nego_req_info));
_rtw_memset(&pwdinfo->groupid_info, 0x00, sizeof(struct group_id_info));
pwdinfo->nego_req_info.peer_channel_num[0] = uintPeerChannel;
_rtw_memcpy(pwdinfo->nego_req_info.peerDevAddr, pnetwork->network.MacAddress, ETH_ALEN);
pwdinfo->nego_req_info.benable = _TRUE;
_cancel_timer_ex(&pwdinfo->restore_p2p_state_timer);
if (rtw_p2p_state(pwdinfo) != P2P_STATE_GONEGO_OK) {
/* Restore to the listen state if the current p2p state is not nego OK */
rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN);
}
rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo));
rtw_p2p_set_state(pwdinfo, P2P_STATE_GONEGO_ING);
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_check_status(padapter, MI_LINKED)) {
u8 union_ch = rtw_mi_get_union_chan(padapter);
u8 union_bw = rtw_mi_get_union_bw(padapter);
u8 union_offset = rtw_mi_get_union_offset(padapter);
set_channel_bwmode(padapter, union_ch, union_offset, union_bw);
rtw_leave_opch(padapter);
}
#endif /* CONFIG_CONCURRENT_MODE */
RTW_INFO("[%s] Start PreTx Procedure!\n", __FUNCTION__);
_set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT);
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_check_status(padapter, MI_LINKED))
_set_timer(&pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_GO_NEGO_TIMEOUT);
else
_set_timer(&pwdinfo->restore_p2p_state_timer, P2P_GO_NEGO_TIMEOUT);
#else
_set_timer(&pwdinfo->restore_p2p_state_timer, P2P_GO_NEGO_TIMEOUT);
#endif /* CONFIG_CONCURRENT_MODE */
} else {
RTW_INFO("[%s] Not Found in Scanning Queue~\n", __FUNCTION__);
#ifdef CONFIG_INTEL_WIDI
_cancel_timer_ex(&pwdinfo->restore_p2p_state_timer);
rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH);
rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE);
rtw_free_network_queue(padapter, _TRUE);
/**
* For WiDi, if we can't find candidate device in scanning queue,
* driver will do scanning itself
*/
_enter_critical_bh(&pmlmepriv->lock, &irqL);
rtw_sitesurvey_cmd(padapter, NULL);
_exit_critical_bh(&pmlmepriv->lock, &irqL);
#endif /* CONFIG_INTEL_WIDI */
ret = -1;
}
exit:
return ret;
}
static int rtw_p2p_invite_req(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
int jj, kk;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
_list *plist, *phead;
_queue *queue = &(pmlmepriv->scanned_queue);
struct wlan_network *pnetwork = NULL;
uint uintPeerChannel = 0;
u8 attr_content[50] = { 0x00 };
u8 *p2pie;
uint p2pielen = 0, attr_contentlen = 0;
_irqL irqL;
struct tx_invite_req_info *pinvite_req_info = &pwdinfo->invitereq_info;
/* Commented by Albert 20120321 */
/* The input data contains two informations. */
/* 1. First information is the P2P device address which you want to send to. */
/* 2. Second information is the group id which combines with GO's mac address, space and GO's ssid. */
/* Command line sample: iwpriv wlan0 p2p_set invite="00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy" */
/* Format: 00:11:22:33:44:55 00:E0:4C:00:00:05 DIRECT-xy */
RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra);
if (wrqu->data.length <= 37) {
RTW_INFO("[%s] Wrong format!\n", __FUNCTION__);
return ret;
}
if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) {
RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__);
return ret;
} else {
/* Reset the content of struct tx_invite_req_info */
pinvite_req_info->benable = _FALSE;
_rtw_memset(pinvite_req_info->go_bssid, 0x00, ETH_ALEN);
_rtw_memset(pinvite_req_info->go_ssid, 0x00, WLAN_SSID_MAXLEN);
pinvite_req_info->ssidlen = 0x00;
pinvite_req_info->operating_ch = pwdinfo->operating_channel;
_rtw_memset(pinvite_req_info->peer_macaddr, 0x00, ETH_ALEN);
pinvite_req_info->token = 3;
}
for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3)
pinvite_req_info->peer_macaddr[jj] = key_2char2num(extra[kk], extra[kk + 1]);
_enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
phead = get_list_head(queue);
plist = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, plist) == _TRUE)
break;
pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
/* Commented by Albert 2011/05/18 */
/* Match the device address located in the P2P IE */
/* This is for the case that the P2P device address is not the same as the P2P interface address. */
p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen);
if (p2pie) {
/* The P2P Device ID attribute is included in the Beacon frame. */
/* The P2P Device Info attribute is included in the probe response frame. */
if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) {
/* Handle the P2P Device ID attribute of Beacon first */
if (_rtw_memcmp(attr_content, pinvite_req_info->peer_macaddr, ETH_ALEN)) {
uintPeerChannel = pnetwork->network.Configuration.DSConfig;
break;
}
} else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) {
/* Handle the P2P Device Info attribute of probe response */
if (_rtw_memcmp(attr_content, pinvite_req_info->peer_macaddr, ETH_ALEN)) {
uintPeerChannel = pnetwork->network.Configuration.DSConfig;
break;
}
}
}
plist = get_next(plist);
}
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
#ifdef CONFIG_WFD
if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST) && uintPeerChannel) {
struct wifi_display_info *pwfd_info = pwdinfo->wfd_info;
u8 *wfd_ie;
uint wfd_ielen = 0;
wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen);
if (wfd_ie) {
u8 *wfd_devinfo;
uint wfd_devlen;
RTW_INFO("[%s] Found WFD IE!\n", __FUNCTION__);
wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen);
if (wfd_devinfo) {
u16 wfd_devinfo_field = 0;
/* Commented by Albert 20120319 */
/* The first two bytes are the WFD device information field of WFD device information subelement. */
/* In big endian format. */
wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo);
if (wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL)
pwfd_info->peer_session_avail = _TRUE;
else
pwfd_info->peer_session_avail = _FALSE;
}
}
if (_FALSE == pwfd_info->peer_session_avail) {
RTW_INFO("[%s] WFD Session not avaiable!\n", __FUNCTION__);
goto exit;
}
}
#endif /* CONFIG_WFD */
if (uintPeerChannel) {
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_check_status(padapter, MI_LINKED))
_cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer);
#endif /* CONFIG_CONCURRENT_MODE */
/* Store the GO's bssid */
for (jj = 0, kk = 18; jj < ETH_ALEN; jj++, kk += 3)
pinvite_req_info->go_bssid[jj] = key_2char2num(extra[kk], extra[kk + 1]);
/* Store the GO's ssid */
pinvite_req_info->ssidlen = wrqu->data.length - 36;
_rtw_memcpy(pinvite_req_info->go_ssid, &extra[36], (u32) pinvite_req_info->ssidlen);
pinvite_req_info->benable = _TRUE;
pinvite_req_info->peer_ch = uintPeerChannel;
rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo));
rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_INVITE_REQ);
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_check_status(padapter, MI_LINKED)) {
u8 union_ch = rtw_mi_get_union_chan(padapter);
u8 union_bw = rtw_mi_get_union_bw(padapter);
u8 union_offset = rtw_mi_get_union_offset(padapter);
set_channel_bwmode(padapter, union_ch, union_offset, union_bw);
rtw_leave_opch(padapter);
} else
set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20);
#else
set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20);
#endif/*CONFIG_CONCURRENT_MODE*/
_set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT);
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_check_status(padapter, MI_LINKED))
_set_timer(&pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_INVITE_TIMEOUT);
else
_set_timer(&pwdinfo->restore_p2p_state_timer, P2P_INVITE_TIMEOUT);
#else
_set_timer(&pwdinfo->restore_p2p_state_timer, P2P_INVITE_TIMEOUT);
#endif /* CONFIG_CONCURRENT_MODE */
} else
RTW_INFO("[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__);
exit:
return ret;
}
static int rtw_p2p_set_persistent(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
/* Commented by Albert 20120328 */
/* The input data is 0 or 1 */
/* 0: disable persistent group functionality */
/* 1: enable persistent group founctionality */
RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra);
if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) {
RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__);
return ret;
} else {
if (extra[0] == '0') /* Disable the persistent group function. */
pwdinfo->persistent_supported = _FALSE;
else if (extra[0] == '1') /* Enable the persistent group function. */
pwdinfo->persistent_supported = _TRUE;
else
pwdinfo->persistent_supported = _FALSE;
}
printk("[%s] persistent_supported = %d\n", __FUNCTION__, pwdinfo->persistent_supported);
exit:
return ret;
}
static int uuid_str2bin(const char *str, u8 *bin)
{
const char *pos;
u8 *opos;
pos = str;
opos = bin;
if (hexstr2bin(pos, opos, 4))
return -1;
pos += 8;
opos += 4;
if (*pos++ != '-' || hexstr2bin(pos, opos, 2))
return -1;
pos += 4;
opos += 2;
if (*pos++ != '-' || hexstr2bin(pos, opos, 2))
return -1;
pos += 4;
opos += 2;
if (*pos++ != '-' || hexstr2bin(pos, opos, 2))
return -1;
pos += 4;
opos += 2;
if (*pos++ != '-' || hexstr2bin(pos, opos, 6))
return -1;
return 0;
}
static int rtw_p2p_set_wps_uuid(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra);
if ((36 == strlen(extra)) && (uuid_str2bin(extra, pwdinfo->uuid) == 0))
pwdinfo->external_uuid = 1;
else {
pwdinfo->external_uuid = 0;
ret = -EINVAL;
}
return ret;
}
#ifdef CONFIG_WFD
static int rtw_p2p_set_pc(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
u8 peerMAC[ETH_ALEN] = { 0x00 };
int jj, kk;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
_list *plist, *phead;
_queue *queue = &(pmlmepriv->scanned_queue);
struct wlan_network *pnetwork = NULL;
u8 attr_content[50] = { 0x00 };
u8 *p2pie;
uint p2pielen = 0, attr_contentlen = 0;
_irqL irqL;
uint uintPeerChannel = 0;
struct wifi_display_info *pwfd_info = pwdinfo->wfd_info;
/* Commented by Albert 20120512 */
/* 1. Input information is the MAC address which wants to know the Preferred Connection bit (PC bit) */
/* Format: 00:E0:4C:00:00:05 */
RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra);
if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) {
RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__);
return ret;
}
for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3)
peerMAC[jj] = key_2char2num(extra[kk], extra[kk + 1]);
_enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
phead = get_list_head(queue);
plist = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, plist) == _TRUE)
break;
pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
/* Commented by Albert 2011/05/18 */
/* Match the device address located in the P2P IE */
/* This is for the case that the P2P device address is not the same as the P2P interface address. */
p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen);
if (p2pie) {
/* The P2P Device ID attribute is included in the Beacon frame. */
/* The P2P Device Info attribute is included in the probe response frame. */
printk("[%s] Got P2P IE\n", __FUNCTION__);
if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) {
/* Handle the P2P Device ID attribute of Beacon first */
printk("[%s] P2P_ATTR_DEVICE_ID\n", __FUNCTION__);
if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) {
uintPeerChannel = pnetwork->network.Configuration.DSConfig;
break;
}
} else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) {
/* Handle the P2P Device Info attribute of probe response */
printk("[%s] P2P_ATTR_DEVICE_INFO\n", __FUNCTION__);
if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) {
uintPeerChannel = pnetwork->network.Configuration.DSConfig;
break;
}
}
}
plist = get_next(plist);
}
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
printk("[%s] channel = %d\n", __FUNCTION__, uintPeerChannel);
if (uintPeerChannel) {
u8 *wfd_ie;
uint wfd_ielen = 0;
wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen);
if (wfd_ie) {
u8 *wfd_devinfo;
uint wfd_devlen;
RTW_INFO("[%s] Found WFD IE!\n", __FUNCTION__);
wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen);
if (wfd_devinfo) {
u16 wfd_devinfo_field = 0;
/* Commented by Albert 20120319 */
/* The first two bytes are the WFD device information field of WFD device information subelement. */
/* In big endian format. */
wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo);
if (wfd_devinfo_field & WFD_DEVINFO_PC_TDLS)
pwfd_info->wfd_pc = _TRUE;
else
pwfd_info->wfd_pc = _FALSE;
}
}
} else
RTW_INFO("[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__);
exit:
return ret;
}
static int rtw_p2p_set_wfd_device_type(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
struct wifi_display_info *pwfd_info = pwdinfo->wfd_info;
/* Commented by Albert 20120328 */
/* The input data is 0 or 1 */
/* 0: specify to Miracast source device */
/* 1 or others: specify to Miracast sink device (display device) */
RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra);
if (extra[0] == '0') /* Set to Miracast source device. */
pwfd_info->wfd_device_type = WFD_DEVINFO_SOURCE;
else /* Set to Miracast sink device. */
pwfd_info->wfd_device_type = WFD_DEVINFO_PSINK;
exit:
return ret;
}
static int rtw_p2p_set_wfd_enable(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
/* Commented by Kurt 20121206
* This function is used to set wfd enabled */
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
if (*extra == '0')
rtw_wfd_enable(padapter, 0);
else if (*extra == '1')
rtw_wfd_enable(padapter, 1);
RTW_INFO("[%s] wfd_enable = %d\n", __FUNCTION__, pwdinfo->wfd_info->wfd_enable);
return ret;
}
static int rtw_p2p_set_driver_iface(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
/* Commented by Kurt 20121206
* This function is used to set driver iface is WEXT or CFG80211 */
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
if (*extra == '1') {
pwdinfo->driver_interface = DRIVER_WEXT;
RTW_INFO("[%s] driver_interface = WEXT\n", __FUNCTION__);
} else if (*extra == '2') {
pwdinfo->driver_interface = DRIVER_CFG80211;
RTW_INFO("[%s] driver_interface = CFG80211\n", __FUNCTION__);
}
return ret;
}
/* To set the WFD session available to enable or disable */
static int rtw_p2p_set_sa(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra);
if (0) {
RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__);
return ret;
} else {
if (extra[0] == '0') /* Disable the session available. */
pwdinfo->session_available = _FALSE;
else if (extra[0] == '1') /* Enable the session available. */
pwdinfo->session_available = _TRUE;
else
pwdinfo->session_available = _FALSE;
}
printk("[%s] session available = %d\n", __FUNCTION__, pwdinfo->session_available);
exit:
return ret;
}
#endif /* CONFIG_WFD */
static int rtw_p2p_prov_disc(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
u8 peerMAC[ETH_ALEN] = { 0x00 };
int jj, kk;
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
_list *plist, *phead;
_queue *queue = &(pmlmepriv->scanned_queue);
struct wlan_network *pnetwork = NULL;
uint uintPeerChannel = 0;
u8 attr_content[100] = { 0x00 };
u8 *p2pie;
uint p2pielen = 0, attr_contentlen = 0;
_irqL irqL;
/* Commented by Albert 20110301 */
/* The input data contains two informations. */
/* 1. First information is the MAC address which wants to issue the provisioning discovery request frame. */
/* 2. Second information is the WPS configuration method which wants to discovery */
/* Format: 00:E0:4C:00:00:05_display */
/* Format: 00:E0:4C:00:00:05_keypad */
/* Format: 00:E0:4C:00:00:05_pbc */
/* Format: 00:E0:4C:00:00:05_label */
RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra);
if (pwdinfo->p2p_state == P2P_STATE_NONE) {
RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__);
return ret;
} else {
#ifdef CONFIG_INTEL_WIDI
if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) {
RTW_INFO("[%s] WiFi is under survey!\n", __FUNCTION__);
return ret;
}
#endif /* CONFIG_INTEL_WIDI */
/* Reset the content of struct tx_provdisc_req_info excluded the wps_config_method_request. */
_rtw_memset(pwdinfo->tx_prov_disc_info.peerDevAddr, 0x00, ETH_ALEN);
_rtw_memset(pwdinfo->tx_prov_disc_info.peerIFAddr, 0x00, ETH_ALEN);
_rtw_memset(&pwdinfo->tx_prov_disc_info.ssid, 0x00, sizeof(NDIS_802_11_SSID));
pwdinfo->tx_prov_disc_info.peer_channel_num[0] = 0;
pwdinfo->tx_prov_disc_info.peer_channel_num[1] = 0;
pwdinfo->tx_prov_disc_info.benable = _FALSE;
}
for (jj = 0, kk = 0; jj < ETH_ALEN; jj++, kk += 3)
peerMAC[jj] = key_2char2num(extra[kk], extra[kk + 1]);
if (_rtw_memcmp(&extra[18], "display", 7))
pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_DISPLYA;
else if (_rtw_memcmp(&extra[18], "keypad", 7))
pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_KEYPAD;
else if (_rtw_memcmp(&extra[18], "pbc", 3))
pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_PUSH_BUTTON;
else if (_rtw_memcmp(&extra[18], "label", 5))
pwdinfo->tx_prov_disc_info.wps_config_method_request = WPS_CM_LABEL;
else {
RTW_INFO("[%s] Unknown WPS config methodn", __FUNCTION__);
return ret ;
}
_enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
phead = get_list_head(queue);
plist = get_next(phead);
while (1) {
if (rtw_end_of_queue_search(phead, plist) == _TRUE)
break;
if (uintPeerChannel != 0)
break;
pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
/* Commented by Albert 2011/05/18 */
/* Match the device address located in the P2P IE */
/* This is for the case that the P2P device address is not the same as the P2P interface address. */
p2pie = rtw_bss_ex_get_p2p_ie(&pnetwork->network, NULL, &p2pielen);
if (p2pie) {
while (p2pie) {
/* The P2P Device ID attribute is included in the Beacon frame. */
/* The P2P Device Info attribute is included in the probe response frame. */
if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_ID, attr_content, &attr_contentlen)) {
/* Handle the P2P Device ID attribute of Beacon first */
if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) {
uintPeerChannel = pnetwork->network.Configuration.DSConfig;
break;
}
} else if (rtw_get_p2p_attr_content(p2pie, p2pielen, P2P_ATTR_DEVICE_INFO, attr_content, &attr_contentlen)) {
/* Handle the P2P Device Info attribute of probe response */
if (_rtw_memcmp(attr_content, peerMAC, ETH_ALEN)) {
uintPeerChannel = pnetwork->network.Configuration.DSConfig;
break;
}
}
/* Get the next P2P IE */
p2pie = rtw_get_p2p_ie(p2pie + p2pielen, BSS_EX_TLV_IES_LEN(&pnetwork->network) - (p2pie + p2pielen - BSS_EX_TLV_IES(&pnetwork->network)), NULL, &p2pielen);
}
}
#ifdef CONFIG_INTEL_WIDI
/* Some Intel WiDi source may not provide P2P IE, */
/* so we could only compare mac addr by 802.11 Source Address */
if (pmlmepriv->widi_state == INTEL_WIDI_STATE_WFD_CONNECTION
&& uintPeerChannel == 0) {
if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) {
uintPeerChannel = pnetwork->network.Configuration.DSConfig;
break;
}
}
#endif /* CONFIG_INTEL_WIDI */
plist = get_next(plist);
}
_exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
if (uintPeerChannel) {
#ifdef CONFIG_WFD
if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) {
struct wifi_display_info *pwfd_info = pwdinfo->wfd_info;
u8 *wfd_ie;
uint wfd_ielen = 0;
wfd_ie = rtw_bss_ex_get_wfd_ie(&pnetwork->network, NULL, &wfd_ielen);
if (wfd_ie) {
u8 *wfd_devinfo;
uint wfd_devlen;
RTW_INFO("[%s] Found WFD IE!\n", __FUNCTION__);
wfd_devinfo = rtw_get_wfd_attr_content(wfd_ie, wfd_ielen, WFD_ATTR_DEVICE_INFO, NULL, &wfd_devlen);
if (wfd_devinfo) {
u16 wfd_devinfo_field = 0;
/* Commented by Albert 20120319 */
/* The first two bytes are the WFD device information field of WFD device information subelement. */
/* In big endian format. */
wfd_devinfo_field = RTW_GET_BE16(wfd_devinfo);
if (wfd_devinfo_field & WFD_DEVINFO_SESSION_AVAIL)
pwfd_info->peer_session_avail = _TRUE;
else
pwfd_info->peer_session_avail = _FALSE;
}
}
if (_FALSE == pwfd_info->peer_session_avail) {
RTW_INFO("[%s] WFD Session not avaiable!\n", __FUNCTION__);
goto exit;
}
}
#endif /* CONFIG_WFD */
RTW_INFO("[%s] peer channel: %d!\n", __FUNCTION__, uintPeerChannel);
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_check_status(padapter, MI_LINKED))
_cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer);
#endif /* CONFIG_CONCURRENT_MODE */
_rtw_memcpy(pwdinfo->tx_prov_disc_info.peerIFAddr, pnetwork->network.MacAddress, ETH_ALEN);
_rtw_memcpy(pwdinfo->tx_prov_disc_info.peerDevAddr, peerMAC, ETH_ALEN);
pwdinfo->tx_prov_disc_info.peer_channel_num[0] = (u16) uintPeerChannel;
pwdinfo->tx_prov_disc_info.benable = _TRUE;
rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo));
rtw_p2p_set_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ);
if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT))
_rtw_memcpy(&pwdinfo->tx_prov_disc_info.ssid, &pnetwork->network.Ssid, sizeof(NDIS_802_11_SSID));
else if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) {
_rtw_memcpy(pwdinfo->tx_prov_disc_info.ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN);
pwdinfo->tx_prov_disc_info.ssid.SsidLength = P2P_WILDCARD_SSID_LEN;
}
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_check_status(padapter, MI_LINKED)) {
u8 union_ch = rtw_mi_get_union_chan(padapter);
u8 union_bw = rtw_mi_get_union_bw(padapter);
u8 union_offset = rtw_mi_get_union_offset(padapter);
set_channel_bwmode(padapter, union_ch, union_offset, union_bw);
rtw_leave_opch(padapter);
} else
set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20);
#else
set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20);
#endif
_set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT);
#ifdef CONFIG_CONCURRENT_MODE
if (rtw_mi_check_status(padapter, MI_LINKED))
_set_timer(&pwdinfo->restore_p2p_state_timer, P2P_CONCURRENT_PROVISION_TIMEOUT);
else
_set_timer(&pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT);
#else
_set_timer(&pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT);
#endif /* CONFIG_CONCURRENT_MODE */
} else {
RTW_INFO("[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__);
#ifdef CONFIG_INTEL_WIDI
_cancel_timer_ex(&pwdinfo->restore_p2p_state_timer);
rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH);
rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE);
rtw_free_network_queue(padapter, _TRUE);
_enter_critical_bh(&pmlmepriv->lock, &irqL);
rtw_sitesurvey_cmd(padapter, NULL);
_exit_critical_bh(&pmlmepriv->lock, &irqL);
#endif /* CONFIG_INTEL_WIDI */
}
exit:
return ret;
}
/* Added by Albert 20110328
* This function is used to inform the driver the user had specified the pin code value or pbc
* to application. */
static int rtw_p2p_got_wpsinfo(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra);
/* Added by Albert 20110328 */
/* if the input data is P2P_NO_WPSINFO -> reset the wpsinfo */
/* if the input data is P2P_GOT_WPSINFO_PEER_DISPLAY_PIN -> the utility just input the PIN code got from the peer P2P device. */
/* if the input data is P2P_GOT_WPSINFO_SELF_DISPLAY_PIN -> the utility just got the PIN code from itself. */
/* if the input data is P2P_GOT_WPSINFO_PBC -> the utility just determine to use the PBC */
if (*extra == '0')
pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO;
else if (*extra == '1')
pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_PEER_DISPLAY_PIN;
else if (*extra == '2')
pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_SELF_DISPLAY_PIN;
else if (*extra == '3')
pwdinfo->ui_got_wps_info = P2P_GOT_WPSINFO_PBC;
else
pwdinfo->ui_got_wps_info = P2P_NO_WPSINFO;
return ret;
}
#endif /* CONFIG_P2P */
static int rtw_p2p_set(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_P2P
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
RTW_INFO("[%s] extra = %s\n", __FUNCTION__, extra);
if (_rtw_memcmp(extra, "enable=", 7))
rtw_wext_p2p_enable(dev, info, wrqu, &extra[7]);
else if (_rtw_memcmp(extra, "setDN=", 6)) {
wrqu->data.length -= 6;
rtw_p2p_setDN(dev, info, wrqu, &extra[6]);
} else if (_rtw_memcmp(extra, "profilefound=", 13)) {
wrqu->data.length -= 13;
rtw_p2p_profilefound(dev, info, wrqu, &extra[13]);
} else if (_rtw_memcmp(extra, "prov_disc=", 10)) {
wrqu->data.length -= 10;
rtw_p2p_prov_disc(dev, info, wrqu, &extra[10]);
} else if (_rtw_memcmp(extra, "nego=", 5)) {
wrqu->data.length -= 5;
rtw_p2p_connect(dev, info, wrqu, &extra[5]);
} else if (_rtw_memcmp(extra, "intent=", 7)) {
/* Commented by Albert 2011/03/23 */
/* The wrqu->data.length will include the null character */
/* So, we will decrease 7 + 1 */
wrqu->data.length -= 8;
rtw_p2p_set_intent(dev, info, wrqu, &extra[7]);
} else if (_rtw_memcmp(extra, "ssid=", 5)) {
wrqu->data.length -= 5;
rtw_p2p_set_go_nego_ssid(dev, info, wrqu, &extra[5]);
} else if (_rtw_memcmp(extra, "got_wpsinfo=", 12)) {
wrqu->data.length -= 12;
rtw_p2p_got_wpsinfo(dev, info, wrqu, &extra[12]);
} else if (_rtw_memcmp(extra, "listen_ch=", 10)) {
/* Commented by Albert 2011/05/24 */
/* The wrqu->data.length will include the null character */
/* So, we will decrease (10 + 1) */
wrqu->data.length -= 11;
rtw_p2p_set_listen_ch(dev, info, wrqu, &extra[10]);
} else if (_rtw_memcmp(extra, "op_ch=", 6)) {
/* Commented by Albert 2011/05/24 */
/* The wrqu->data.length will include the null character */
/* So, we will decrease (6 + 1) */
wrqu->data.length -= 7;
rtw_p2p_set_op_ch(dev, info, wrqu, &extra[6]);
} else if (_rtw_memcmp(extra, "invite=", 7)) {
wrqu->data.length -= 8;
rtw_p2p_invite_req(dev, info, wrqu, &extra[7]);
} else if (_rtw_memcmp(extra, "persistent=", 11)) {
wrqu->data.length -= 11;
rtw_p2p_set_persistent(dev, info, wrqu, &extra[11]);
} else if (_rtw_memcmp(extra, "uuid=", 5)) {
wrqu->data.length -= 5;
ret = rtw_p2p_set_wps_uuid(dev, info, wrqu, &extra[5]);
}
#ifdef CONFIG_WFD
if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) {
if (_rtw_memcmp(extra, "sa=", 3)) {
/* sa: WFD Session Available information */
wrqu->data.length -= 3;
rtw_p2p_set_sa(dev, info, wrqu, &extra[3]);
} else if (_rtw_memcmp(extra, "pc=", 3)) {
/* pc: WFD Preferred Connection */
wrqu->data.length -= 3;
rtw_p2p_set_pc(dev, info, wrqu, &extra[3]);
} else if (_rtw_memcmp(extra, "wfd_type=", 9)) {
wrqu->data.length -= 9;
rtw_p2p_set_wfd_device_type(dev, info, wrqu, &extra[9]);
} else if (_rtw_memcmp(extra, "wfd_enable=", 11)) {
wrqu->data.length -= 11;
rtw_p2p_set_wfd_enable(dev, info, wrqu, &extra[11]);
} else if (_rtw_memcmp(extra, "driver_iface=", 13)) {
wrqu->data.length -= 13;
rtw_p2p_set_driver_iface(dev, info, wrqu, &extra[13]);
}
}
#endif /* CONFIG_WFD */
#endif /* CONFIG_P2P */
return ret;
}
static int rtw_p2p_get(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_P2P
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
if (padapter->bShowGetP2PState)
RTW_INFO("[%s] extra = %s\n", __FUNCTION__, (char *) wrqu->data.pointer);
if (_rtw_memcmp(wrqu->data.pointer, "status", 6))
rtw_p2p_get_status(dev, info, wrqu, extra);
else if (_rtw_memcmp(wrqu->data.pointer, "role", 4))
rtw_p2p_get_role(dev, info, wrqu, extra);
else if (_rtw_memcmp(wrqu->data.pointer, "peer_ifa", 8))
rtw_p2p_get_peer_ifaddr(dev, info, wrqu, extra);
else if (_rtw_memcmp(wrqu->data.pointer, "req_cm", 6))
rtw_p2p_get_req_cm(dev, info, wrqu, extra);
else if (_rtw_memcmp(wrqu->data.pointer, "peer_deva", 9)) {
/* Get the P2P device address when receiving the provision discovery request frame. */
rtw_p2p_get_peer_devaddr(dev, info, wrqu, extra);
} else if (_rtw_memcmp(wrqu->data.pointer, "group_id", 8))
rtw_p2p_get_groupid(dev, info, wrqu, extra);
else if (_rtw_memcmp(wrqu->data.pointer, "inv_peer_deva", 13)) {
/* Get the P2P device address when receiving the P2P Invitation request frame. */
rtw_p2p_get_peer_devaddr_by_invitation(dev, info, wrqu, extra);
} else if (_rtw_memcmp(wrqu->data.pointer, "op_ch", 5))
rtw_p2p_get_op_ch(dev, info, wrqu, extra);
#ifdef CONFIG_WFD
if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) {
if (_rtw_memcmp(wrqu->data.pointer, "peer_port", 9))
rtw_p2p_get_peer_wfd_port(dev, info, wrqu, extra);
else if (_rtw_memcmp(wrqu->data.pointer, "wfd_sa", 6))
rtw_p2p_get_peer_wfd_session_available(dev, info, wrqu, extra);
else if (_rtw_memcmp(wrqu->data.pointer, "wfd_pc", 6))
rtw_p2p_get_peer_wfd_preferred_connection(dev, info, wrqu, extra);
}
#endif /* CONFIG_WFD */
#endif /* CONFIG_P2P */
return ret;
}
static int rtw_p2p_get2(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_P2P
int length = wrqu->data.length;
char *buffer = (u8 *)rtw_malloc(length);
if (buffer == NULL) {
ret = -ENOMEM;
goto bad;
}
if (copy_from_user(buffer, wrqu->data.pointer, wrqu->data.length)) {
ret = -EFAULT;
goto bad;
}
RTW_INFO("[%s] buffer = %s\n", __FUNCTION__, buffer);
if (_rtw_memcmp(buffer, "wpsCM=", 6))
ret = rtw_p2p_get_wps_configmethod(dev, info, wrqu, extra, &buffer[6]);
else if (_rtw_memcmp(buffer, "devN=", 5))
ret = rtw_p2p_get_device_name(dev, info, wrqu, extra, &buffer[5]);
else if (_rtw_memcmp(buffer, "dev_type=", 9))
ret = rtw_p2p_get_device_type(dev, info, wrqu, extra, &buffer[9]);
else if (_rtw_memcmp(buffer, "go_devadd=", 10))
ret = rtw_p2p_get_go_device_address(dev, info, wrqu, extra, &buffer[10]);
else if (_rtw_memcmp(buffer, "InvProc=", 8))
ret = rtw_p2p_get_invitation_procedure(dev, info, wrqu, extra, &buffer[8]);
else {
snprintf(extra, sizeof("Command not found."), "Command not found.");
wrqu->data.length = strlen(extra);
}
bad:
if (buffer)
rtw_mfree(buffer, length);
#endif /* CONFIG_P2P */
return ret;
}
static int rtw_cta_test_start(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter);
RTW_INFO("%s %s\n", __func__, extra);
if (!strcmp(extra, "1"))
hal_data->in_cta_test = 1;
else
hal_data->in_cta_test = 0;
rtw_hal_rcr_set_chk_bssid(padapter, MLME_ACTION_NONE);
return ret;
}
extern int rtw_change_ifname(_adapter *padapter, const char *ifname);
static int rtw_rereg_nd_name(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = rtw_netdev_priv(dev);
struct dvobj_priv *dvobj = adapter_to_dvobj(padapter);
struct rereg_nd_name_data *rereg_priv = &padapter->rereg_nd_name_priv;
char new_ifname[IFNAMSIZ];
if (rereg_priv->old_ifname[0] == 0) {
char *reg_ifname;
#ifdef CONFIG_CONCURRENT_MODE
if (padapter->isprimary)
reg_ifname = padapter->registrypriv.ifname;
else
#endif
reg_ifname = padapter->registrypriv.if2name;
strncpy(rereg_priv->old_ifname, reg_ifname, IFNAMSIZ);
rereg_priv->old_ifname[IFNAMSIZ - 1] = 0;
}
/* RTW_INFO("%s wrqu->data.length:%d\n", __FUNCTION__, wrqu->data.length); */
if (wrqu->data.length > IFNAMSIZ)
return -EFAULT;
if (copy_from_user(new_ifname, wrqu->data.pointer, IFNAMSIZ))
return -EFAULT;
if (0 == strcmp(rereg_priv->old_ifname, new_ifname))
return ret;
RTW_INFO("%s new_ifname:%s\n", __FUNCTION__, new_ifname);
rtw_set_rtnl_lock_holder(dvobj, current);
ret = rtw_change_ifname(padapter, new_ifname);
rtw_set_rtnl_lock_holder(dvobj, NULL);
if (0 != ret)
goto exit;
if (_rtw_memcmp(rereg_priv->old_ifname, "disable%d", 9) == _TRUE) {
/* rtw_ips_mode_req(&padapter->pwrctrlpriv, rereg_priv->old_ips_mode); */
}
strncpy(rereg_priv->old_ifname, new_ifname, IFNAMSIZ);
rereg_priv->old_ifname[IFNAMSIZ - 1] = 0;
if (_rtw_memcmp(new_ifname, "disable%d", 9) == _TRUE) {
RTW_INFO("%s disable\n", __FUNCTION__);
/* free network queue for Android's timming issue */
rtw_free_network_queue(padapter, _TRUE);
/* the interface is being "disabled", we can do deeper IPS */
/* rereg_priv->old_ips_mode = rtw_get_ips_mode_req(&padapter->pwrctrlpriv); */
/* rtw_ips_mode_req(&padapter->pwrctrlpriv, IPS_NORMAL); */
}
exit:
return ret;
}
#ifdef CONFIG_IOL
#include <rtw_iol.h>
#endif
#ifdef CONFIG_BACKGROUND_NOISE_MONITOR
#include "../../hal/hal_dm_acs.h"
#endif
#ifdef DBG_CMD_QUEUE
u8 dump_cmd_id = 0;
#endif
static int rtw_dbg_port(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_irqL irqL;
int ret = 0;
u8 major_cmd, minor_cmd;
u16 arg;
u32 extra_arg, *pdata, val32;
struct sta_info *psta;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
struct security_priv *psecuritypriv = &padapter->securitypriv;
struct wlan_network *cur_network = &(pmlmepriv->cur_network);
struct sta_priv *pstapriv = &padapter->stapriv;
pdata = (u32 *)&wrqu->data;
val32 = *pdata;
arg = (u16)(val32 & 0x0000ffff);
major_cmd = (u8)(val32 >> 24);
minor_cmd = (u8)((val32 >> 16) & 0x00ff);
extra_arg = *(pdata + 1);
switch (major_cmd) {
case 0x70: /* read_reg */
switch (minor_cmd) {
case 1:
RTW_INFO("rtw_read8(0x%x)=0x%02x\n", arg, rtw_read8(padapter, arg));
break;
case 2:
RTW_INFO("rtw_read16(0x%x)=0x%04x\n", arg, rtw_read16(padapter, arg));
break;
case 4:
RTW_INFO("rtw_read32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg));
break;
}
break;
case 0x71: /* write_reg */
switch (minor_cmd) {
case 1:
rtw_write8(padapter, arg, extra_arg);
RTW_INFO("rtw_write8(0x%x)=0x%02x\n", arg, rtw_read8(padapter, arg));
break;
case 2:
rtw_write16(padapter, arg, extra_arg);
RTW_INFO("rtw_write16(0x%x)=0x%04x\n", arg, rtw_read16(padapter, arg));
break;
case 4:
rtw_write32(padapter, arg, extra_arg);
RTW_INFO("rtw_write32(0x%x)=0x%08x\n", arg, rtw_read32(padapter, arg));
break;
}
break;
case 0x72: /* read_bb */
RTW_INFO("read_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff));
break;
case 0x73: /* write_bb */
rtw_hal_write_bbreg(padapter, arg, 0xffffffff, extra_arg);
RTW_INFO("write_bbreg(0x%x)=0x%x\n", arg, rtw_hal_read_bbreg(padapter, arg, 0xffffffff));
break;
case 0x74: /* read_rf */
RTW_INFO("read RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n", minor_cmd, arg, rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff));
break;
case 0x75: /* write_rf */
rtw_hal_write_rfreg(padapter, minor_cmd, arg, 0xffffffff, extra_arg);
RTW_INFO("write RF_reg path(0x%02x),offset(0x%x),value(0x%08x)\n", minor_cmd, arg, rtw_hal_read_rfreg(padapter, minor_cmd, arg, 0xffffffff));
break;
case 0x76:
switch (minor_cmd) {
case 0x00: /* normal mode, */
padapter->recvpriv.is_signal_dbg = 0;
break;
case 0x01: /* dbg mode */
padapter->recvpriv.is_signal_dbg = 1;
extra_arg = extra_arg > 100 ? 100 : extra_arg;
padapter->recvpriv.signal_strength_dbg = extra_arg;
break;
}
break;
case 0x78: /* IOL test */
switch (minor_cmd) {
#ifdef CONFIG_IOL
case 0x04: { /* LLT table initialization test */
u8 page_boundary = 0xf9;
{
struct xmit_frame *xmit_frame;
xmit_frame = rtw_IOL_accquire_xmit_frame(padapter);
if (xmit_frame == NULL) {
ret = -ENOMEM;
break;
}
rtw_IOL_append_LLT_cmd(xmit_frame, page_boundary);
if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 500, 0))
ret = -EPERM;
}
}
break;
case 0x05: { /* blink LED test */
u16 reg = 0x4c;
u32 blink_num = 50;
u32 blink_delay_ms = 200;
int i;
{
struct xmit_frame *xmit_frame;
xmit_frame = rtw_IOL_accquire_xmit_frame(padapter);
if (xmit_frame == NULL) {
ret = -ENOMEM;
break;
}
for (i = 0; i < blink_num; i++) {
#ifdef CONFIG_IOL_NEW_GENERATION
rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x00, 0xff);
rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms);
rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x08, 0xff);
rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms);
#else
rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x00);
rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms);
rtw_IOL_append_WB_cmd(xmit_frame, reg, 0x08);
rtw_IOL_append_DELAY_MS_cmd(xmit_frame, blink_delay_ms);
#endif
}
if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, (blink_delay_ms * blink_num * 2) + 200, 0))
ret = -EPERM;
}
}
break;
case 0x06: { /* continuous wirte byte test */
u16 reg = arg;
u16 start_value = 0;
u32 write_num = extra_arg;
int i;
u8 final;
{
struct xmit_frame *xmit_frame;
xmit_frame = rtw_IOL_accquire_xmit_frame(padapter);
if (xmit_frame == NULL) {
ret = -ENOMEM;
break;
}
for (i = 0; i < write_num; i++) {
#ifdef CONFIG_IOL_NEW_GENERATION
rtw_IOL_append_WB_cmd(xmit_frame, reg, i + start_value, 0xFF);
#else
rtw_IOL_append_WB_cmd(xmit_frame, reg, i + start_value);
#endif
}
if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000, 0))
ret = -EPERM;
}
final = rtw_read8(padapter, reg);
if (start_value + write_num - 1 == final)
RTW_INFO("continuous IOL_CMD_WB_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final);
else
RTW_INFO("continuous IOL_CMD_WB_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final);
}
break;
case 0x07: { /* continuous wirte word test */
u16 reg = arg;
u16 start_value = 200;
u32 write_num = extra_arg;
int i;
u16 final;
{
struct xmit_frame *xmit_frame;
xmit_frame = rtw_IOL_accquire_xmit_frame(padapter);
if (xmit_frame == NULL) {
ret = -ENOMEM;
break;
}
for (i = 0; i < write_num; i++) {
#ifdef CONFIG_IOL_NEW_GENERATION
rtw_IOL_append_WW_cmd(xmit_frame, reg, i + start_value, 0xFFFF);
#else
rtw_IOL_append_WW_cmd(xmit_frame, reg, i + start_value);
#endif
}
if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000, 0))
ret = -EPERM;
}
final = rtw_read16(padapter, reg);
if (start_value + write_num - 1 == final)
RTW_INFO("continuous IOL_CMD_WW_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final);
else
RTW_INFO("continuous IOL_CMD_WW_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final);
}
break;
case 0x08: { /* continuous wirte dword test */
u16 reg = arg;
u32 start_value = 0x110000c7;
u32 write_num = extra_arg;
int i;
u32 final;
{
struct xmit_frame *xmit_frame;
xmit_frame = rtw_IOL_accquire_xmit_frame(padapter);
if (xmit_frame == NULL) {
ret = -ENOMEM;
break;
}
for (i = 0; i < write_num; i++) {
#ifdef CONFIG_IOL_NEW_GENERATION
rtw_IOL_append_WD_cmd(xmit_frame, reg, i + start_value, 0xFFFFFFFF);
#else
rtw_IOL_append_WD_cmd(xmit_frame, reg, i + start_value);
#endif
}
if (_SUCCESS != rtw_IOL_exec_cmds_sync(padapter, xmit_frame, 5000, 0))
ret = -EPERM;
}
final = rtw_read32(padapter, reg);
if (start_value + write_num - 1 == final)
RTW_INFO("continuous IOL_CMD_WD_REG to 0x%x %u times Success, start:%u, final:%u\n", reg, write_num, start_value, final);
else
RTW_INFO("continuous IOL_CMD_WD_REG to 0x%x %u times Fail, start:%u, final:%u\n", reg, write_num, start_value, final);
}
break;
#endif /* CONFIG_IOL */
}
break;
case 0x79: {
/*
* dbg 0x79000000 [value], set RESP_TXAGC to + value, value:0~15
* dbg 0x79010000 [value], set RESP_TXAGC to - value, value:0~15
*/
u8 value = extra_arg & 0x0f;
u8 sign = minor_cmd;
u16 write_value = 0;
RTW_INFO("%s set RESP_TXAGC to %s %u\n", __func__, sign ? "minus" : "plus", value);
if (sign)
value = value | 0x10;
write_value = value | (value << 5);
rtw_write16(padapter, 0x6d9, write_value);
}
break;
case 0x7a:
receive_disconnect(padapter, pmlmeinfo->network.MacAddress
, WLAN_REASON_EXPIRATION_CHK, _FALSE);
break;
case 0x7F:
switch (minor_cmd) {
case 0x0:
RTW_INFO("fwstate=0x%x\n", get_fwstate(pmlmepriv));
break;
case 0x01:
RTW_INFO("auth_alg=0x%x, enc_alg=0x%x, auth_type=0x%x, enc_type=0x%x\n",
psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm,
psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus);
break;
case 0x03:
RTW_INFO("qos_option=%d\n", pmlmepriv->qospriv.qos_option);
#ifdef CONFIG_80211N_HT
RTW_INFO("ht_option=%d\n", pmlmepriv->htpriv.ht_option);
#endif /* CONFIG_80211N_HT */
break;
case 0x04:
RTW_INFO("cur_ch=%d\n", pmlmeext->cur_channel);
RTW_INFO("cur_bw=%d\n", pmlmeext->cur_bwmode);
RTW_INFO("cur_ch_off=%d\n", pmlmeext->cur_ch_offset);
RTW_INFO("oper_ch=%d\n", rtw_get_oper_ch(padapter));
RTW_INFO("oper_bw=%d\n", rtw_get_oper_bw(padapter));
RTW_INFO("oper_ch_offet=%d\n", rtw_get_oper_choffset(padapter));
break;
case 0x05:
psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress);
if (psta) {
RTW_INFO("SSID=%s\n", cur_network->network.Ssid.Ssid);
RTW_INFO("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr));
RTW_INFO("cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset);
RTW_INFO("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self);
RTW_INFO("state=0x%x, aid=%d, macid=%d, raid=%d\n",
psta->state, psta->cmn.aid, psta->cmn.mac_id, psta->cmn.ra_info.rate_id);
#ifdef CONFIG_80211N_HT
RTW_INFO("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate);
RTW_INFO("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n"
, psta->cmn.bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m);
RTW_INFO("ampdu_enable = %d\n", psta->htpriv.ampdu_enable);
RTW_INFO("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap);
#endif /* CONFIG_80211N_HT */
sta_rx_reorder_ctl_dump(RTW_DBGDUMP, psta);
} else
RTW_INFO("can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress));
break;
case 0x06: {
u64 tsf = 0;
tsf = rtw_hal_get_tsftr_by_port(padapter, extra_arg);
RTW_INFO(" PORT-%d TSF :%21lld\n", extra_arg, tsf);
}
break;
case 0x07:
RTW_INFO("bSurpriseRemoved=%s, bDriverStopped=%s\n"
, rtw_is_surprise_removed(padapter) ? "True" : "False"
, rtw_is_drv_stopped(padapter) ? "True" : "False");
break;
case 0x08: {
struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
struct recv_priv *precvpriv = &padapter->recvpriv;
RTW_INFO("free_xmitbuf_cnt=%d, free_xmitframe_cnt=%d"
", free_xmit_extbuf_cnt=%d, free_xframe_ext_cnt=%d"
", free_recvframe_cnt=%d\n",
pxmitpriv->free_xmitbuf_cnt, pxmitpriv->free_xmitframe_cnt,
pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xframe_ext_cnt,
precvpriv->free_recvframe_cnt);
#ifdef CONFIG_USB_HCI
RTW_INFO("rx_urb_pending_cn=%d\n", ATOMIC_READ(&(precvpriv->rx_pending_cnt)));
#endif
}
break;
case 0x09: {
int i;
_list *plist, *phead;
#ifdef CONFIG_AP_MODE
RTW_INFO_DUMP("sta_dz_bitmap:", pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len);
RTW_INFO_DUMP("tim_bitmap:", pstapriv->tim_bitmap, pstapriv->aid_bmp_len);
#endif
_enter_critical_bh(&pstapriv->sta_hash_lock, &irqL);
for (i = 0; i < NUM_STA; i++) {
phead = &(pstapriv->sta_hash[i]);
plist = get_next(phead);
while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) {
psta = LIST_CONTAINOR(plist, struct sta_info, hash_list);
plist = get_next(plist);
if (extra_arg == psta->cmn.aid) {
RTW_INFO("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr));
RTW_INFO("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self);
RTW_INFO("state=0x%x, aid=%d, macid=%d, raid=%d\n",
psta->state, psta->cmn.aid, psta->cmn.mac_id, psta->cmn.ra_info.rate_id);
#ifdef CONFIG_80211N_HT
RTW_INFO("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate);
RTW_INFO("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n",
psta->cmn.bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m,
psta->htpriv.sgi_40m);
RTW_INFO("ampdu_enable = %d\n", psta->htpriv.ampdu_enable);
RTW_INFO("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap);
#endif /* CONFIG_80211N_HT */
#ifdef CONFIG_AP_MODE
RTW_INFO("capability=0x%x\n", psta->capability);
RTW_INFO("flags=0x%x\n", psta->flags);
RTW_INFO("wpa_psk=0x%x\n", psta->wpa_psk);
RTW_INFO("wpa2_group_cipher=0x%x\n", psta->wpa2_group_cipher);
RTW_INFO("wpa2_pairwise_cipher=0x%x\n", psta->wpa2_pairwise_cipher);
RTW_INFO("qos_info=0x%x\n", psta->qos_info);
#endif
RTW_INFO("dot118021XPrivacy=0x%x\n", psta->dot118021XPrivacy);
sta_rx_reorder_ctl_dump(RTW_DBGDUMP, psta);
}
}
}
_exit_critical_bh(&pstapriv->sta_hash_lock, &irqL);
}
break;
case 0x0b: { /* Enable=1, Disable=0 driver control vrtl_carrier_sense. */
/* u8 driver_vcs_en; */ /* Enable=1, Disable=0 driver control vrtl_carrier_sense. */
/* u8 driver_vcs_type; */ /* force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en=1. */
if (arg == 0) {
RTW_INFO("disable driver ctrl vcs\n");
padapter->driver_vcs_en = 0;
} else if (arg == 1) {
RTW_INFO("enable driver ctrl vcs = %d\n", extra_arg);
padapter->driver_vcs_en = 1;
if (extra_arg > 2)
padapter->driver_vcs_type = 1;
else
padapter->driver_vcs_type = extra_arg;
}
}
break;
case 0x0c: { /* dump rx/tx packet */
if (arg == 0) {
RTW_INFO("dump rx packet (%d)\n", extra_arg);
/* pHalData->bDumpRxPkt =extra_arg; */
rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_RXPKT, &(extra_arg));
} else if (arg == 1) {
RTW_INFO("dump tx packet (%d)\n", extra_arg);
rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(extra_arg));
}
}
break;
case 0x0e: {
if (arg == 0) {
RTW_INFO("disable driver ctrl rx_ampdu_factor\n");
padapter->driver_rx_ampdu_factor = 0xFF;
} else if (arg == 1) {
RTW_INFO("enable driver ctrl rx_ampdu_factor = %d\n", extra_arg);
if (extra_arg > 0x03)
padapter->driver_rx_ampdu_factor = 0xFF;
else
padapter->driver_rx_ampdu_factor = extra_arg;
}
}
break;
#ifdef DBG_CONFIG_ERROR_DETECT
case 0x0f: {
if (extra_arg == 0) {
RTW_INFO("###### silent reset test.......#####\n");
rtw_hal_sreset_reset(padapter);
} else {
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
struct sreset_priv *psrtpriv = &pHalData->srestpriv;
psrtpriv->dbg_trigger_point = extra_arg;
}
}
break;
case 0x15: {
struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
RTW_INFO("==>silent resete cnts:%d\n", pwrpriv->ips_enter_cnts);
}
break;
#endif
case 0x10: /* driver version display */
dump_drv_version(RTW_DBGDUMP);
break;
case 0x11: { /* dump linked status */
int pre_mode;
pre_mode = padapter->bLinkInfoDump;
/* linked_info_dump(padapter,extra_arg); */
if (extra_arg == 1 || (extra_arg == 0 && pre_mode == 1)) /* not consider pwr_saving 0: */
padapter->bLinkInfoDump = extra_arg;
else if ((extra_arg == 2) || (extra_arg == 0 && pre_mode == 2)) { /* consider power_saving */
/* RTW_INFO("linked_info_dump =%s\n", (padapter->bLinkInfoDump)?"enable":"disable") */
linked_info_dump(padapter, extra_arg);
}
}
break;
#ifdef CONFIG_80211N_HT
case 0x12: { /* set rx_stbc */
struct registry_priv *pregpriv = &padapter->registrypriv;
/* 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, 0x3: enable both 2.4g and 5g */
/* default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ */
if (pregpriv && (extra_arg == 0 || extra_arg == 1 || extra_arg == 2 || extra_arg == 3)) {
pregpriv->rx_stbc = extra_arg;
RTW_INFO("set rx_stbc=%d\n", pregpriv->rx_stbc);
} else
RTW_INFO("get rx_stbc=%d\n", pregpriv->rx_stbc);
}
break;
case 0x13: { /* set ampdu_enable */
struct registry_priv *pregpriv = &padapter->registrypriv;
/* 0: disable, 0x1:enable */
if (pregpriv && extra_arg < 2) {
pregpriv->ampdu_enable = extra_arg;
RTW_INFO("set ampdu_enable=%d\n", pregpriv->ampdu_enable);
} else
RTW_INFO("get ampdu_enable=%d\n", pregpriv->ampdu_enable);
}
break;
#endif
case 0x14: { /* get wifi_spec */
struct registry_priv *pregpriv = &padapter->registrypriv;
RTW_INFO("get wifi_spec=%d\n", pregpriv->wifi_spec);
}
break;
#ifdef DBG_FIXED_CHAN
case 0x17: {
struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
printk("===> Fixed channel to %d\n", extra_arg);
pmlmeext->fixed_chan = extra_arg;
}
break;
#endif
#ifdef CONFIG_80211N_HT
case 0x19: {
struct registry_priv *pregistrypriv = &padapter->registrypriv;
/* extra_arg : */
/* BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, */
/* BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx */
if (arg == 0) {
RTW_INFO("driver disable LDPC\n");
pregistrypriv->ldpc_cap = 0x00;
} else if (arg == 1) {
RTW_INFO("driver set LDPC cap = 0x%x\n", extra_arg);
pregistrypriv->ldpc_cap = (u8)(extra_arg & 0x33);
}
}
break;
case 0x1a: {
struct registry_priv *pregistrypriv = &padapter->registrypriv;
/* extra_arg : */
/* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, */
/* BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */
if (arg == 0) {
RTW_INFO("driver disable STBC\n");
pregistrypriv->stbc_cap = 0x00;
} else if (arg == 1) {
RTW_INFO("driver set STBC cap = 0x%x\n", extra_arg);
pregistrypriv->stbc_cap = (u8)(extra_arg & 0x33);
}
}
break;
#endif /* CONFIG_80211N_HT */
case 0x1b: {
struct registry_priv *pregistrypriv = &padapter->registrypriv;
if (arg == 0) {
RTW_INFO("disable driver ctrl max_rx_rate, reset to default_rate_set\n");
init_mlme_default_rate_set(padapter);
#ifdef CONFIG_80211N_HT
pregistrypriv->ht_enable = (u8)rtw_ht_enable;
#endif /* CONFIG_80211N_HT */
} else if (arg == 1) {
int i;
u8 max_rx_rate;
RTW_INFO("enable driver ctrl max_rx_rate = 0x%x\n", extra_arg);
max_rx_rate = (u8)extra_arg;
if (max_rx_rate < 0xc) { /* max_rx_rate < MSC0->B or G -> disable HT */
#ifdef CONFIG_80211N_HT
pregistrypriv->ht_enable = 0;
#endif /* CONFIG_80211N_HT */
for (i = 0; i < NumRates; i++) {
if (pmlmeext->datarate[i] > max_rx_rate)
pmlmeext->datarate[i] = 0xff;
}
}
#ifdef CONFIG_80211N_HT
else if (max_rx_rate < 0x1c) { /* mcs0~mcs15 */
u32 mcs_bitmap = 0x0;
for (i = 0; i < ((max_rx_rate + 1) - 0xc); i++)
mcs_bitmap |= BIT(i);
set_mcs_rate_by_mask(pmlmeext->default_supported_mcs_set, mcs_bitmap);
}
#endif /* CONFIG_80211N_HT */
}
}
break;
case 0x1c: { /* enable/disable driver control AMPDU Density for peer sta's rx */
if (arg == 0) {
RTW_INFO("disable driver ctrl ampdu density\n");
padapter->driver_ampdu_spacing = 0xFF;
} else if (arg == 1) {
RTW_INFO("enable driver ctrl ampdu density = %d\n", extra_arg);
if (extra_arg > 0x07)
padapter->driver_ampdu_spacing = 0xFF;
else
padapter->driver_ampdu_spacing = extra_arg;
}
}
break;
#ifdef CONFIG_BACKGROUND_NOISE_MONITOR
case 0x1e: {
RTW_INFO("===========================================\n");
rtw_noise_measure_curchan(padapter);
RTW_INFO("===========================================\n");
}
break;
#endif
#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_SDIO_INDIRECT_ACCESS) && defined(DBG_SDIO_INDIRECT_ACCESS)
case 0x1f:
{
int i, j = 0, test_cnts = 0;
static u8 test_code = 0x5A;
static u32 data_misatch_cnt = 0, d_acc_err_cnt = 0;
u32 d_data, i_data;
u32 imr;
test_cnts = extra_arg;
for (i = 0; i < test_cnts; i++) {
if (RTW_CANNOT_IO(padapter))
break;
rtw_write8(padapter, 0x07, test_code);
d_data = rtw_read32(padapter, 0x04);
imr = rtw_read32(padapter, 0x10250014);
rtw_write32(padapter, 0x10250014, 0);
rtw_msleep_os(50);
i_data = rtw_sd_iread32(padapter, 0x04);
rtw_write32(padapter, 0x10250014, imr);
if (d_data != i_data) {
data_misatch_cnt++;
RTW_ERR("d_data :0x%08x, i_data : 0x%08x\n", d_data, i_data);
}
if (test_code != (i_data >> 24)) {
d_acc_err_cnt++;
rtw_write8(padapter, 0x07, 0xAA);
RTW_ERR("test_code :0x%02x, i_data : 0x%08x\n", test_code, i_data);
}
if ((j++) == 100) {
rtw_msleep_os(2000);
RTW_INFO(" Indirect access testing..........%d/%d\n", i, test_cnts);
j = 0;
}
test_code = ~test_code;
rtw_msleep_os(50);
}
RTW_INFO("========Indirect access test=========\n");
RTW_INFO(" test_cnts = %d\n", test_cnts);
RTW_INFO(" direct & indirect read32 data missatch cnts = %d\n", data_misatch_cnt);
RTW_INFO(" indirect rdata is not equal to wdata cnts = %d\n", d_acc_err_cnt);
RTW_INFO("========Indirect access test=========\n\n");
data_misatch_cnt = d_acc_err_cnt = 0;
}
break;
#endif
case 0x20:
{
if (arg == 0xAA) {
u8 page_offset, page_num;
page_offset = (u8)(extra_arg >> 16);
page_num = (u8)(extra_arg & 0xFF);
rtw_dump_rsvd_page(RTW_DBGDUMP, padapter, page_offset, page_num);
}
#ifdef CONFIG_SUPPORT_FIFO_DUMP
else {
u8 fifo_sel;
u32 addr, size;
fifo_sel = (u8)(arg & 0x0F);
addr = (extra_arg >> 16) & 0xFFFF;
size = extra_arg & 0xFFFF;
rtw_dump_fifo(RTW_DBGDUMP, padapter, fifo_sel, addr, size);
}
#endif
}
break;
case 0x23: {
RTW_INFO("turn %s the bNotifyChannelChange Variable\n", (extra_arg == 1) ? "on" : "off");
padapter->bNotifyChannelChange = extra_arg;
break;
}
case 0x24: {
#ifdef CONFIG_P2P
RTW_INFO("turn %s the bShowGetP2PState Variable\n", (extra_arg == 1) ? "on" : "off");
padapter->bShowGetP2PState = extra_arg;
#endif /* CONFIG_P2P */
break;
}
#ifdef CONFIG_GPIO_API
case 0x25: { /* Get GPIO register */
/*
* dbg 0x7f250000 [gpio_num], Get gpio value, gpio_num:0~7
*/
u8 value;
RTW_INFO("Read GPIO Value extra_arg = %d\n", extra_arg);
value = rtw_hal_get_gpio(padapter, extra_arg);
RTW_INFO("Read GPIO Value = %d\n", value);
break;
}
case 0x26: { /* Set GPIO direction */
/* dbg 0x7f26000x [y], Set gpio direction,
* x: gpio_num,4~7 y: indicate direction, 0~1
*/
int value;
RTW_INFO("Set GPIO Direction! arg = %d ,extra_arg=%d\n", arg , extra_arg);
value = rtw_hal_config_gpio(padapter, arg, extra_arg);
RTW_INFO("Set GPIO Direction %s\n", (value == -1) ? "Fail!!!" : "Success");
break;
}
case 0x27: { /* Set GPIO output direction value */
/*
* dbg 0x7f27000x [y], Set gpio output direction value,
* x: gpio_num,4~7 y: indicate direction, 0~1
*/
int value;
RTW_INFO("Set GPIO Value! arg = %d ,extra_arg=%d\n", arg , extra_arg);
value = rtw_hal_set_gpio_output_value(padapter, arg, extra_arg);
RTW_INFO("Set GPIO Value %s\n", (value == -1) ? "Fail!!!" : "Success");
break;
}
#endif
#ifdef DBG_CMD_QUEUE
case 0x28: {
dump_cmd_id = extra_arg;
RTW_INFO("dump_cmd_id:%d\n", dump_cmd_id);
}
break;
#endif /* DBG_CMD_QUEUE */
case 0xaa: {
if ((extra_arg & 0x7F) > 0x3F)
extra_arg = 0xFF;
RTW_INFO("chang data rate to :0x%02x\n", extra_arg);
padapter->fix_rate = extra_arg;
}
break;
case 0xdd: { /* registers dump , 0 for mac reg,1 for bb reg, 2 for rf reg */
if (extra_arg == 0)
mac_reg_dump(RTW_DBGDUMP, padapter);
else if (extra_arg == 1)
bb_reg_dump(RTW_DBGDUMP, padapter);
else if (extra_arg == 2)
rf_reg_dump(RTW_DBGDUMP, padapter);
else if (extra_arg == 11)
bb_reg_dump_ex(RTW_DBGDUMP, padapter);
}
break;
case 0xee: {
RTW_INFO(" === please control /proc to trun on/off PHYDM func ===\n");
}
break;
case 0xfd:
rtw_write8(padapter, 0xc50, arg);
RTW_INFO("wr(0xc50)=0x%x\n", rtw_read8(padapter, 0xc50));
rtw_write8(padapter, 0xc58, arg);
RTW_INFO("wr(0xc58)=0x%x\n", rtw_read8(padapter, 0xc58));
break;
case 0xfe:
RTW_INFO("rd(0xc50)=0x%x\n", rtw_read8(padapter, 0xc50));
RTW_INFO("rd(0xc58)=0x%x\n", rtw_read8(padapter, 0xc58));
break;
case 0xff: {
RTW_INFO("dbg(0x210)=0x%x\n", rtw_read32(padapter, 0x210));
RTW_INFO("dbg(0x608)=0x%x\n", rtw_read32(padapter, 0x608));
RTW_INFO("dbg(0x280)=0x%x\n", rtw_read32(padapter, 0x280));
RTW_INFO("dbg(0x284)=0x%x\n", rtw_read32(padapter, 0x284));
RTW_INFO("dbg(0x288)=0x%x\n", rtw_read32(padapter, 0x288));
RTW_INFO("dbg(0x664)=0x%x\n", rtw_read32(padapter, 0x664));
RTW_INFO("\n");
RTW_INFO("dbg(0x430)=0x%x\n", rtw_read32(padapter, 0x430));
RTW_INFO("dbg(0x438)=0x%x\n", rtw_read32(padapter, 0x438));
RTW_INFO("dbg(0x440)=0x%x\n", rtw_read32(padapter, 0x440));
RTW_INFO("dbg(0x458)=0x%x\n", rtw_read32(padapter, 0x458));
RTW_INFO("dbg(0x484)=0x%x\n", rtw_read32(padapter, 0x484));
RTW_INFO("dbg(0x488)=0x%x\n", rtw_read32(padapter, 0x488));
RTW_INFO("dbg(0x444)=0x%x\n", rtw_read32(padapter, 0x444));
RTW_INFO("dbg(0x448)=0x%x\n", rtw_read32(padapter, 0x448));
RTW_INFO("dbg(0x44c)=0x%x\n", rtw_read32(padapter, 0x44c));
RTW_INFO("dbg(0x450)=0x%x\n", rtw_read32(padapter, 0x450));
}
break;
}
break;
default:
RTW_INFO("error dbg cmd!\n");
break;
}
return ret;
}
static int wpa_set_param(struct net_device *dev, u8 name, u32 value)
{
uint ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
switch (name) {
case IEEE_PARAM_WPA_ENABLED:
padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; /* 802.1x */
/* ret = ieee80211_wpa_enable(ieee, value); */
switch ((value) & 0xff) {
case 1: /* WPA */
padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK; /* WPA_PSK */
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption2Enabled;
break;
case 2: /* WPA2 */
padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; /* WPA2_PSK */
padapter->securitypriv.ndisencryptstatus = Ndis802_11Encryption3Enabled;
break;
}
break;
case IEEE_PARAM_TKIP_COUNTERMEASURES:
/* ieee->tkip_countermeasures=value; */
break;
case IEEE_PARAM_DROP_UNENCRYPTED: {
/* HACK:
*
* wpa_supplicant calls set_wpa_enabled when the driver
* is loaded and unloaded, regardless of if WPA is being
* used. No other calls are made which can be used to
* determine if encryption will be used or not prior to
* association being expected. If encryption is not being
* used, drop_unencrypted is set to false, else true -- we
* can use this to determine if the CAP_PRIVACY_ON bit should
* be set.
*/
#if 0
struct ieee80211_security sec = {
.flags = SEC_ENABLED,
.enabled = value,
};
ieee->drop_unencrypted = value;
/* We only change SEC_LEVEL for open mode. Others
* are set by ipw_wpa_set_encryption.
*/
if (!value) {
sec.flags |= SEC_LEVEL;
sec.level = SEC_LEVEL_0;
} else {
sec.flags |= SEC_LEVEL;
sec.level = SEC_LEVEL_1;
}
if (ieee->set_security)
ieee->set_security(ieee->dev, &sec);
#endif
break;
}
case IEEE_PARAM_PRIVACY_INVOKED:
/* ieee->privacy_invoked=value; */
break;
case IEEE_PARAM_AUTH_ALGS:
ret = wpa_set_auth_algs(dev, value);
break;
case IEEE_PARAM_IEEE_802_1X:
/* ieee->ieee802_1x=value; */
break;
case IEEE_PARAM_WPAX_SELECT:
/* added for WPA2 mixed mode */
/*RTW_WARN("------------------------>wpax value = %x\n", value);*/
/*
spin_lock_irqsave(&ieee->wpax_suitlist_lock,flags);
ieee->wpax_type_set = 1;
ieee->wpax_type_notify = value;
spin_unlock_irqrestore(&ieee->wpax_suitlist_lock,flags);
*/
break;
default:
ret = -EOPNOTSUPP;
break;
}
return ret;
}
static int wpa_mlme(struct net_device *dev, u32 command, u32 reason)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
switch (command) {
case IEEE_MLME_STA_DEAUTH:
if (!rtw_set_802_11_disassociate(padapter))
ret = -1;
break;
case IEEE_MLME_STA_DISASSOC:
if (!rtw_set_802_11_disassociate(padapter))
ret = -1;
break;
default:
ret = -EOPNOTSUPP;
break;
}
#ifdef CONFIG_RTW_REPEATER_SON
rtw_rson_do_disconnect(padapter);
#endif
return ret;
}
static int wpa_supplicant_ioctl(struct net_device *dev, struct iw_point *p)
{
struct ieee_param *param;
uint ret = 0;
/* down(&ieee->wx_sem); */
if (p->length < sizeof(struct ieee_param) || !p->pointer) {
ret = -EINVAL;
goto out;
}
param = (struct ieee_param *)rtw_malloc(p->length);
if (param == NULL) {
ret = -ENOMEM;
goto out;
}
if (copy_from_user(param, p->pointer, p->length)) {
rtw_mfree((u8 *)param, p->length);
ret = -EFAULT;
goto out;
}
switch (param->cmd) {
case IEEE_CMD_SET_WPA_PARAM:
ret = wpa_set_param(dev, param->u.wpa_param.name, param->u.wpa_param.value);
break;
case IEEE_CMD_SET_WPA_IE:
/* ret = wpa_set_wpa_ie(dev, param, p->length); */
ret = rtw_set_wpa_ie((_adapter *)rtw_netdev_priv(dev), (char *)param->u.wpa_ie.data, (u16)param->u.wpa_ie.len);
break;
case IEEE_CMD_SET_ENCRYPTION:
ret = wpa_set_encryption(dev, param, p->length);
break;
case IEEE_CMD_MLME:
ret = wpa_mlme(dev, param->u.mlme.command, param->u.mlme.reason_code);
break;
default:
RTW_INFO("Unknown WPA supplicant request: %d\n", param->cmd);
ret = -EOPNOTSUPP;
break;
}
if (ret == 0 && copy_to_user(p->pointer, param, p->length))
ret = -EFAULT;
rtw_mfree((u8 *)param, p->length);
out:
/* up(&ieee->wx_sem); */
return ret;
}
#ifdef CONFIG_AP_MODE
static int rtw_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len)
{
int ret = 0;
u32 wep_key_idx, wep_key_len, wep_total_len;
NDIS_802_11_WEP *pwep = NULL;
struct sta_info *psta = NULL, *pbcmc_sta = NULL;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct security_priv *psecuritypriv = &(padapter->securitypriv);
struct sta_priv *pstapriv = &padapter->stapriv;
RTW_INFO("%s\n", __FUNCTION__);
param->u.crypt.err = 0;
param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0';
/* sizeof(struct ieee_param) = 64 bytes; */
/* if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) */
if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) {
ret = -EINVAL;
goto exit;
}
if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) {
if (param->u.crypt.idx >= WEP_KEYS
#ifdef CONFIG_IEEE80211W
&& param->u.crypt.idx > BIP_MAX_KEYID
#endif /* CONFIG_IEEE80211W */
) {
ret = -EINVAL;
goto exit;
}
} else {
psta = rtw_get_stainfo(pstapriv, param->sta_addr);
if (!psta) {
/* ret = -EINVAL; */
RTW_INFO("rtw_set_encryption(), sta has already been removed or never been added\n");
goto exit;
}
}
if (strcmp(param->u.crypt.alg, "none") == 0 && (psta == NULL)) {
/* todo:clear default encryption keys */
psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open;
psecuritypriv->ndisencryptstatus = Ndis802_11EncryptionDisabled;
psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_;
RTW_INFO("clear default encryption keys, keyid=%d\n", param->u.crypt.idx);
goto exit;
}
if (strcmp(param->u.crypt.alg, "WEP") == 0 && (psta == NULL)) {
RTW_INFO("r871x_set_encryption, crypt.alg = WEP\n");
wep_key_idx = param->u.crypt.idx;
wep_key_len = param->u.crypt.key_len;
RTW_INFO("r871x_set_encryption, wep_key_idx=%d, len=%d\n", wep_key_idx, wep_key_len);
if ((wep_key_idx >= WEP_KEYS) || (wep_key_len <= 0)) {
ret = -EINVAL;
goto exit;
}
if (wep_key_len > 0) {
wep_key_len = wep_key_len <= 5 ? 5 : 13;
wep_total_len = wep_key_len + FIELD_OFFSET(NDIS_802_11_WEP, KeyMaterial);
pwep = (NDIS_802_11_WEP *)rtw_malloc(wep_total_len);
if (pwep == NULL) {
RTW_INFO(" r871x_set_encryption: pwep allocate fail !!!\n");
goto exit;
}
_rtw_memset(pwep, 0, wep_total_len);
pwep->KeyLength = wep_key_len;
pwep->Length = wep_total_len;
}
pwep->KeyIndex = wep_key_idx;
_rtw_memcpy(pwep->KeyMaterial, param->u.crypt.key, pwep->KeyLength);
if (param->u.crypt.set_tx) {
RTW_INFO("wep, set_tx=1\n");
psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Auto;
psecuritypriv->ndisencryptstatus = Ndis802_11Encryption1Enabled;
psecuritypriv->dot11PrivacyAlgrthm = _WEP40_;
psecuritypriv->dot118021XGrpPrivacy = _WEP40_;
if (pwep->KeyLength == 13) {
psecuritypriv->dot11PrivacyAlgrthm = _WEP104_;
psecuritypriv->dot118021XGrpPrivacy = _WEP104_;
}
psecuritypriv->dot11PrivacyKeyIndex = wep_key_idx;
_rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength);
psecuritypriv->dot11DefKeylen[wep_key_idx] = pwep->KeyLength;
rtw_ap_set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx, 1);
} else {
RTW_INFO("wep, set_tx=0\n");
/* don't update "psecuritypriv->dot11PrivacyAlgrthm" and */
/* "psecuritypriv->dot11PrivacyKeyIndex=keyid", but can rtw_set_key to cam */
_rtw_memcpy(&(psecuritypriv->dot11DefKey[wep_key_idx].skey[0]), pwep->KeyMaterial, pwep->KeyLength);
psecuritypriv->dot11DefKeylen[wep_key_idx] = pwep->KeyLength;
rtw_ap_set_wep_key(padapter, pwep->KeyMaterial, pwep->KeyLength, wep_key_idx, 0);
}
goto exit;
}
if (!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) /* */ { /* group key */
if (param->u.crypt.set_tx == 1) {
if (strcmp(param->u.crypt.alg, "WEP") == 0) {
RTW_INFO(FUNC_ADPT_FMT" set WEP TX GTK idx:%u, len:%u\n"
, FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len);
_rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len));
psecuritypriv->dot118021XGrpPrivacy = _WEP40_;
if (param->u.crypt.key_len == 13)
psecuritypriv->dot118021XGrpPrivacy = _WEP104_;
} else if (strcmp(param->u.crypt.alg, "TKIP") == 0) {
RTW_INFO(FUNC_ADPT_FMT" set TKIP TX GTK idx:%u, len:%u\n"
, FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len);
psecuritypriv->dot118021XGrpPrivacy = _TKIP_;
_rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len));
/* set mic key */
_rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8);
_rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8);
psecuritypriv->busetkipkey = _TRUE;
} else if (strcmp(param->u.crypt.alg, "CCMP") == 0) {
RTW_INFO(FUNC_ADPT_FMT" set CCMP TX GTK idx:%u, len:%u\n"
, FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len);
psecuritypriv->dot118021XGrpPrivacy = _AES_;
_rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len));
#ifdef CONFIG_IEEE80211W
} else if (strcmp(param->u.crypt.alg, "BIP") == 0) {
RTW_INFO(FUNC_ADPT_FMT" set TX IGTK idx:%u, len:%u\n"
, FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len);
_rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len));
psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx;
psecuritypriv->dot11wBIPtxpn.val = RTW_GET_LE64(param->u.crypt.seq);
psecuritypriv->binstallBIPkey = _TRUE;
goto exit;
#endif /* CONFIG_IEEE80211W */
} else if (strcmp(param->u.crypt.alg, "none") == 0) {
RTW_INFO(FUNC_ADPT_FMT" clear group key, idx:%u\n"
, FUNC_ADPT_ARG(padapter), param->u.crypt.idx);
psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_;
} else {
RTW_WARN(FUNC_ADPT_FMT" set group key, not support\n"
, FUNC_ADPT_ARG(padapter));
goto exit;
}
psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx;
pbcmc_sta = rtw_get_bcmc_stainfo(padapter);
if (pbcmc_sta) {
pbcmc_sta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq);
pbcmc_sta->ieee8021x_blocked = _FALSE;
pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */
}
psecuritypriv->binstallGrpkey = _TRUE;
psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */
rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx);
}
goto exit;
}
if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) { /* psk/802_1x */
if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) {
if (param->u.crypt.set_tx == 1) {
_rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len));
if (strcmp(param->u.crypt.alg, "WEP") == 0) {
RTW_INFO(FUNC_ADPT_FMT" set WEP PTK of "MAC_FMT" idx:%u, len:%u\n"
, FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)
, param->u.crypt.idx, param->u.crypt.key_len);
psta->dot118021XPrivacy = _WEP40_;
if (param->u.crypt.key_len == 13)
psta->dot118021XPrivacy = _WEP104_;
} else if (strcmp(param->u.crypt.alg, "TKIP") == 0) {
RTW_INFO(FUNC_ADPT_FMT" set TKIP PTK of "MAC_FMT" idx:%u, len:%u\n"
, FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)
, param->u.crypt.idx, param->u.crypt.key_len);
psta->dot118021XPrivacy = _TKIP_;
/* set mic key */
_rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8);
_rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8);
psecuritypriv->busetkipkey = _TRUE;
} else if (strcmp(param->u.crypt.alg, "CCMP") == 0) {
RTW_INFO(FUNC_ADPT_FMT" set CCMP PTK of "MAC_FMT" idx:%u, len:%u\n"
, FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)
, param->u.crypt.idx, param->u.crypt.key_len);
psta->dot118021XPrivacy = _AES_;
} else if (strcmp(param->u.crypt.alg, "none") == 0) {
RTW_INFO(FUNC_ADPT_FMT" clear pairwise key of "MAC_FMT" idx:%u\n"
, FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)
, param->u.crypt.idx);
psta->dot118021XPrivacy = _NO_PRIVACY_;
} else {
RTW_WARN(FUNC_ADPT_FMT" set pairwise key of "MAC_FMT", not support\n"
, FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr));
goto exit;
}
psta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq);
psta->dot11rxpn.val = RTW_GET_LE64(param->u.crypt.seq);
psta->ieee8021x_blocked = _FALSE;
if (psta->dot118021XPrivacy != _NO_PRIVACY_) {
psta->bpairwise_key_installed = _TRUE;
/* WPA2 key-handshake has completed */
if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK)
psta->state &= (~WIFI_UNDER_KEY_HANDSHAKE);
}
rtw_ap_set_pairwise_key(padapter, psta);
} else {
RTW_WARN(FUNC_ADPT_FMT" set group key of "MAC_FMT", not support\n"
, FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr));
goto exit;
}
}
}
exit:
if (pwep)
rtw_mfree((u8 *)pwep, wep_total_len);
return ret;
}
static int rtw_set_beacon(struct net_device *dev, struct ieee_param *param, int len)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
struct sta_priv *pstapriv = &padapter->stapriv;
unsigned char *pbuf = param->u.bcn_ie.buf;
RTW_INFO("%s, len=%d\n", __FUNCTION__, len);
if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
return -EINVAL;
_rtw_memcpy(&pstapriv->max_num_sta, param->u.bcn_ie.reserved, 2);
if ((pstapriv->max_num_sta > NUM_STA) || (pstapriv->max_num_sta <= 0))
pstapriv->max_num_sta = NUM_STA;
if (rtw_check_beacon_data(padapter, pbuf, (len - 12 - 2)) == _SUCCESS) /* 12 = param header, 2:no packed */
ret = 0;
else
ret = -EINVAL;
return ret;
}
static int rtw_hostapd_sta_flush(struct net_device *dev)
{
/* _irqL irqL; */
/* _list *phead, *plist; */
int ret = 0;
/* struct sta_info *psta = NULL; */
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
/* struct sta_priv *pstapriv = &padapter->stapriv; */
RTW_INFO("%s\n", __FUNCTION__);
flush_all_cam_entry(padapter); /* clear CAM */
#ifdef CONFIG_AP_MODE
ret = rtw_sta_flush(padapter, _TRUE);
#endif
return ret;
}
static int rtw_add_sta(struct net_device *dev, struct ieee_param *param)
{
int ret = 0;
struct sta_info *psta = NULL;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
struct sta_priv *pstapriv = &padapter->stapriv;
RTW_INFO("rtw_add_sta(aid=%d)=" MAC_FMT "\n", param->u.add_sta.aid, MAC_ARG(param->sta_addr));
if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE)
return -EINVAL;
if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
return -EINVAL;
#if 0
psta = rtw_get_stainfo(pstapriv, param->sta_addr);
if (psta) {
RTW_INFO("rtw_add_sta(), free has been added psta=%p\n", psta);
/* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */
rtw_free_stainfo(padapter, psta);
/* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */
psta = NULL;
}
#endif
/* psta = rtw_alloc_stainfo(pstapriv, param->sta_addr); */
psta = rtw_get_stainfo(pstapriv, param->sta_addr);
if (psta) {
int flags = param->u.add_sta.flags;
/* RTW_INFO("rtw_add_sta(), init sta's variables, psta=%p\n", psta); */
psta->cmn.aid = param->u.add_sta.aid;/* aid=1~2007 */
_rtw_memcpy(psta->bssrateset, param->u.add_sta.tx_supp_rates, 16);
/* check wmm cap. */
if (WLAN_STA_WME & flags)
psta->qos_option = 1;
else
psta->qos_option = 0;
if (pmlmepriv->qospriv.qos_option == 0)
psta->qos_option = 0;
#ifdef CONFIG_80211N_HT
/* chec 802.11n ht cap. */
if (padapter->registrypriv.ht_enable &&
is_supported_ht(padapter->registrypriv.wireless_mode) &&
(WLAN_STA_HT & flags)) {
psta->htpriv.ht_option = _TRUE;
psta->qos_option = 1;
_rtw_memcpy((void *)&psta->htpriv.ht_cap, (void *)&param->u.add_sta.ht_cap, sizeof(struct rtw_ieee80211_ht_cap));
} else
psta->htpriv.ht_option = _FALSE;
if (pmlmepriv->htpriv.ht_option == _FALSE)
psta->htpriv.ht_option = _FALSE;
#endif
update_sta_info_apmode(padapter, psta);
} else
ret = -ENOMEM;
return ret;
}
static int rtw_del_sta(struct net_device *dev, struct ieee_param *param)
{
_irqL irqL;
int ret = 0;
struct sta_info *psta = NULL;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
struct sta_priv *pstapriv = &padapter->stapriv;
RTW_INFO("rtw_del_sta=" MAC_FMT "\n", MAC_ARG(param->sta_addr));
if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE)
return -EINVAL;
if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
return -EINVAL;
psta = rtw_get_stainfo(pstapriv, param->sta_addr);
if (psta) {
u8 updated = _FALSE;
/* RTW_INFO("free psta=%p, aid=%d\n", psta, psta->cmn.aid); */
_enter_critical_bh(&pstapriv->asoc_list_lock, &irqL);
if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) {
rtw_list_delete(&psta->asoc_list);
pstapriv->asoc_list_cnt--;
updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, _TRUE);
}
_exit_critical_bh(&pstapriv->asoc_list_lock, &irqL);
associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL);
psta = NULL;
} else {
RTW_INFO("rtw_del_sta(), sta has already been removed or never been added\n");
/* ret = -1; */
}
return ret;
}
static int rtw_ioctl_get_sta_data(struct net_device *dev, struct ieee_param *param, int len)
{
int ret = 0;
struct sta_info *psta = NULL;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
struct sta_priv *pstapriv = &padapter->stapriv;
struct ieee_param_ex *param_ex = (struct ieee_param_ex *)param;
struct sta_data *psta_data = (struct sta_data *)param_ex->data;
RTW_INFO("rtw_ioctl_get_sta_info, sta_addr: " MAC_FMT "\n", MAC_ARG(param_ex->sta_addr));
if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE)
return -EINVAL;
if (param_ex->sta_addr[0] == 0xff && param_ex->sta_addr[1] == 0xff &&
param_ex->sta_addr[2] == 0xff && param_ex->sta_addr[3] == 0xff &&
param_ex->sta_addr[4] == 0xff && param_ex->sta_addr[5] == 0xff)
return -EINVAL;
psta = rtw_get_stainfo(pstapriv, param_ex->sta_addr);
if (psta) {
#if 0
struct {
u16 aid;
u16 capability;
int flags;
u32 sta_set;
u8 tx_supp_rates[16];
u32 tx_supp_rates_len;
struct rtw_ieee80211_ht_cap ht_cap;
u64 rx_pkts;
u64 rx_bytes;
u64 rx_drops;
u64 tx_pkts;
u64 tx_bytes;
u64 tx_drops;
} get_sta;
#endif
psta_data->aid = (u16)psta->cmn.aid;
psta_data->capability = psta->capability;
psta_data->flags = psta->flags;
/*
nonerp_set : BIT(0)
no_short_slot_time_set : BIT(1)
no_short_preamble_set : BIT(2)
no_ht_gf_set : BIT(3)
no_ht_set : BIT(4)
ht_20mhz_set : BIT(5)
*/
psta_data->sta_set = ((psta->nonerp_set) |
(psta->no_short_slot_time_set << 1) |
(psta->no_short_preamble_set << 2) |
(psta->no_ht_gf_set << 3) |
(psta->no_ht_set << 4) |
(psta->ht_20mhz_set << 5));
psta_data->tx_supp_rates_len = psta->bssratelen;
_rtw_memcpy(psta_data->tx_supp_rates, psta->bssrateset, psta->bssratelen);
#ifdef CONFIG_80211N_HT
if(padapter->registrypriv.ht_enable && is_supported_ht(padapter->registrypriv.wireless_mode))
_rtw_memcpy(&psta_data->ht_cap, &psta->htpriv.ht_cap, sizeof(struct rtw_ieee80211_ht_cap));
#endif /* CONFIG_80211N_HT */
psta_data->rx_pkts = psta->sta_stats.rx_data_pkts;
psta_data->rx_bytes = psta->sta_stats.rx_bytes;
psta_data->rx_drops = psta->sta_stats.rx_drops;
psta_data->tx_pkts = psta->sta_stats.tx_pkts;
psta_data->tx_bytes = psta->sta_stats.tx_bytes;
psta_data->tx_drops = psta->sta_stats.tx_drops;
} else
ret = -1;
return ret;
}
static int rtw_get_sta_wpaie(struct net_device *dev, struct ieee_param *param)
{
int ret = 0;
struct sta_info *psta = NULL;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
struct sta_priv *pstapriv = &padapter->stapriv;
RTW_INFO("rtw_get_sta_wpaie, sta_addr: " MAC_FMT "\n", MAC_ARG(param->sta_addr));
if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE)
return -EINVAL;
if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
return -EINVAL;
psta = rtw_get_stainfo(pstapriv, param->sta_addr);
if (psta) {
if ((psta->wpa_ie[0] == WLAN_EID_RSN) || (psta->wpa_ie[0] == WLAN_EID_GENERIC)) {
int wpa_ie_len;
int copy_len;
wpa_ie_len = psta->wpa_ie[1];
copy_len = ((wpa_ie_len + 2) > sizeof(psta->wpa_ie)) ? (sizeof(psta->wpa_ie)) : (wpa_ie_len + 2);
param->u.wpa_ie.len = copy_len;
_rtw_memcpy(param->u.wpa_ie.reserved, psta->wpa_ie, copy_len);
} else {
/* ret = -1; */
RTW_INFO("sta's wpa_ie is NONE\n");
}
} else
ret = -1;
return ret;
}
static int rtw_set_wps_beacon(struct net_device *dev, struct ieee_param *param, int len)
{
int ret = 0;
unsigned char wps_oui[4] = {0x0, 0x50, 0xf2, 0x04};
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
int ie_len;
RTW_INFO("%s, len=%d\n", __FUNCTION__, len);
if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
return -EINVAL;
ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */
if (pmlmepriv->wps_beacon_ie) {
rtw_mfree(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len);
pmlmepriv->wps_beacon_ie = NULL;
}
if (ie_len > 0) {
pmlmepriv->wps_beacon_ie = rtw_malloc(ie_len);
pmlmepriv->wps_beacon_ie_len = ie_len;
if (pmlmepriv->wps_beacon_ie == NULL) {
RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__);
return -EINVAL;
}
_rtw_memcpy(pmlmepriv->wps_beacon_ie, param->u.bcn_ie.buf, ie_len);
update_beacon(padapter, _VENDOR_SPECIFIC_IE_, wps_oui, _TRUE);
pmlmeext->bstart_bss = _TRUE;
}
return ret;
}
static int rtw_set_wps_probe_resp(struct net_device *dev, struct ieee_param *param, int len)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
int ie_len;
RTW_INFO("%s, len=%d\n", __FUNCTION__, len);
if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
return -EINVAL;
ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */
if (pmlmepriv->wps_probe_resp_ie) {
rtw_mfree(pmlmepriv->wps_probe_resp_ie, pmlmepriv->wps_probe_resp_ie_len);
pmlmepriv->wps_probe_resp_ie = NULL;
}
if (ie_len > 0) {
pmlmepriv->wps_probe_resp_ie = rtw_malloc(ie_len);
pmlmepriv->wps_probe_resp_ie_len = ie_len;
if (pmlmepriv->wps_probe_resp_ie == NULL) {
RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__);
return -EINVAL;
}
_rtw_memcpy(pmlmepriv->wps_probe_resp_ie, param->u.bcn_ie.buf, ie_len);
}
return ret;
}
static int rtw_set_wps_assoc_resp(struct net_device *dev, struct ieee_param *param, int len)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
int ie_len;
RTW_INFO("%s, len=%d\n", __FUNCTION__, len);
if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
return -EINVAL;
ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */
if (pmlmepriv->wps_assoc_resp_ie) {
rtw_mfree(pmlmepriv->wps_assoc_resp_ie, pmlmepriv->wps_assoc_resp_ie_len);
pmlmepriv->wps_assoc_resp_ie = NULL;
}
if (ie_len > 0) {
pmlmepriv->wps_assoc_resp_ie = rtw_malloc(ie_len);
pmlmepriv->wps_assoc_resp_ie_len = ie_len;
if (pmlmepriv->wps_assoc_resp_ie == NULL) {
RTW_INFO("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__);
return -EINVAL;
}
_rtw_memcpy(pmlmepriv->wps_assoc_resp_ie, param->u.bcn_ie.buf, ie_len);
}
return ret;
}
static int rtw_set_hidden_ssid(struct net_device *dev, struct ieee_param *param, int len)
{
int ret = 0;
_adapter *adapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *mlmepriv = &(adapter->mlmepriv);
struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv);
struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info);
int ie_len;
u8 *ssid_ie;
char ssid[NDIS_802_11_LENGTH_SSID + 1];
sint ssid_len = 0;
u8 ignore_broadcast_ssid;
if (check_fwstate(mlmepriv, WIFI_AP_STATE) != _TRUE)
return -EPERM;
if (param->u.bcn_ie.reserved[0] != 0xea)
return -EINVAL;
mlmeinfo->hidden_ssid_mode = ignore_broadcast_ssid = param->u.bcn_ie.reserved[1];
ie_len = len - 12 - 2; /* 12 = param header, 2:no packed */
ssid_ie = rtw_get_ie(param->u.bcn_ie.buf, WLAN_EID_SSID, &ssid_len, ie_len);
if (ssid_ie && ssid_len > 0 && ssid_len <= NDIS_802_11_LENGTH_SSID) {
WLAN_BSSID_EX *pbss_network = &mlmepriv->cur_network.network;
WLAN_BSSID_EX *pbss_network_ext = &mlmeinfo->network;
_rtw_memcpy(ssid, ssid_ie + 2, ssid_len);
ssid[ssid_len] = 0x0;
if (0)
RTW_INFO(FUNC_ADPT_FMT" ssid:(%s,%d), from ie:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter),
ssid, ssid_len,
pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength,
pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength);
_rtw_memcpy(pbss_network->Ssid.Ssid, (void *)ssid, ssid_len);
pbss_network->Ssid.SsidLength = ssid_len;
_rtw_memcpy(pbss_network_ext->Ssid.Ssid, (void *)ssid, ssid_len);
pbss_network_ext->Ssid.SsidLength = ssid_len;
if (0)
RTW_INFO(FUNC_ADPT_FMT" after ssid:(%s,%d), (%s,%d)\n", FUNC_ADPT_ARG(adapter),
pbss_network->Ssid.Ssid, pbss_network->Ssid.SsidLength,
pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength);
}
RTW_INFO(FUNC_ADPT_FMT" ignore_broadcast_ssid:%d, %s,%d\n", FUNC_ADPT_ARG(adapter),
ignore_broadcast_ssid, ssid, ssid_len);
return ret;
}
#if CONFIG_RTW_MACADDR_ACL
static int rtw_ioctl_acl_remove_sta(struct net_device *dev, struct ieee_param *param, int len)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
return -EINVAL;
if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
return -EINVAL;
ret = rtw_acl_remove_sta(padapter, RTW_ACL_PERIOD_BSS, param->sta_addr);
return ret;
}
static int rtw_ioctl_acl_add_sta(struct net_device *dev, struct ieee_param *param, int len)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
return -EINVAL;
if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff &&
param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff &&
param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff)
return -EINVAL;
ret = rtw_acl_add_sta(padapter, RTW_ACL_PERIOD_BSS, param->sta_addr);
return ret;
}
static int rtw_ioctl_set_macaddr_acl(struct net_device *dev, struct ieee_param *param, int len)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE)
return -EINVAL;
rtw_set_macaddr_acl(padapter, RTW_ACL_PERIOD_BSS, param->u.mlme.command);
return ret;
}
#endif /* CONFIG_RTW_MACADDR_ACL */
static int rtw_hostapd_ioctl(struct net_device *dev, struct iw_point *p)
{
struct ieee_param *param;
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
/* RTW_INFO("%s\n", __FUNCTION__); */
/*
* this function is expect to call in master mode, which allows no power saving
* so, we just check hw_init_completed
*/
if (!rtw_is_hw_init_completed(padapter)) {
ret = -EPERM;
goto out;
}
/* if (p->length < sizeof(struct ieee_param) || !p->pointer){ */
if (!p->pointer) {
ret = -EINVAL;
goto out;
}
param = (struct ieee_param *)rtw_malloc(p->length);
if (param == NULL) {
ret = -ENOMEM;
goto out;
}
if (copy_from_user(param, p->pointer, p->length)) {
rtw_mfree((u8 *)param, p->length);
ret = -EFAULT;
goto out;
}
/* RTW_INFO("%s, cmd=%d\n", __FUNCTION__, param->cmd); */
switch (param->cmd) {
case RTL871X_HOSTAPD_FLUSH:
ret = rtw_hostapd_sta_flush(dev);
break;
case RTL871X_HOSTAPD_ADD_STA:
ret = rtw_add_sta(dev, param);
break;
case RTL871X_HOSTAPD_REMOVE_STA:
ret = rtw_del_sta(dev, param);
break;
case RTL871X_HOSTAPD_SET_BEACON:
ret = rtw_set_beacon(dev, param, p->length);
break;
case RTL871X_SET_ENCRYPTION:
ret = rtw_set_encryption(dev, param, p->length);
break;
case RTL871X_HOSTAPD_GET_WPAIE_STA:
ret = rtw_get_sta_wpaie(dev, param);
break;
case RTL871X_HOSTAPD_SET_WPS_BEACON:
ret = rtw_set_wps_beacon(dev, param, p->length);
break;
case RTL871X_HOSTAPD_SET_WPS_PROBE_RESP:
ret = rtw_set_wps_probe_resp(dev, param, p->length);
break;
case RTL871X_HOSTAPD_SET_WPS_ASSOC_RESP:
ret = rtw_set_wps_assoc_resp(dev, param, p->length);
break;
case RTL871X_HOSTAPD_SET_HIDDEN_SSID:
ret = rtw_set_hidden_ssid(dev, param, p->length);
break;
case RTL871X_HOSTAPD_GET_INFO_STA:
ret = rtw_ioctl_get_sta_data(dev, param, p->length);
break;
#if CONFIG_RTW_MACADDR_ACL
case RTL871X_HOSTAPD_SET_MACADDR_ACL:
ret = rtw_ioctl_set_macaddr_acl(dev, param, p->length);
break;
case RTL871X_HOSTAPD_ACL_ADD_STA:
ret = rtw_ioctl_acl_add_sta(dev, param, p->length);
break;
case RTL871X_HOSTAPD_ACL_REMOVE_STA:
ret = rtw_ioctl_acl_remove_sta(dev, param, p->length);
break;
#endif /* CONFIG_RTW_MACADDR_ACL */
default:
RTW_INFO("Unknown hostapd request: %d\n", param->cmd);
ret = -EOPNOTSUPP;
break;
}
if (ret == 0 && copy_to_user(p->pointer, param, p->length))
ret = -EFAULT;
rtw_mfree((u8 *)param, p->length);
out:
return ret;
}
#endif
static int rtw_wx_set_priv(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *awrq,
char *extra)
{
#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV
char *ext_dbg;
#endif
int ret = 0;
int len = 0;
char *ext;
#ifdef CONFIG_ANDROID
int i;
#endif
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct iw_point *dwrq = (struct iw_point *)awrq;
if (dwrq->length == 0)
return -EFAULT;
len = dwrq->length;
ext = rtw_vmalloc(len);
if (!ext)
return -ENOMEM;
if (copy_from_user(ext, dwrq->pointer, len)) {
rtw_vmfree(ext, len);
return -EFAULT;
}
#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV
ext_dbg = rtw_vmalloc(len);
if (!ext_dbg) {
rtw_vmfree(ext, len);
return -ENOMEM;
}
_rtw_memcpy(ext_dbg, ext, len);
#endif
/* added for wps2.0 @20110524 */
if (dwrq->flags == 0x8766 && len > 8) {
u32 cp_sz;
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
u8 *probereq_wpsie = ext;
int probereq_wpsie_len = len;
u8 wps_oui[4] = {0x0, 0x50, 0xf2, 0x04};
if ((_VENDOR_SPECIFIC_IE_ == probereq_wpsie[0]) &&
(_rtw_memcmp(&probereq_wpsie[2], wps_oui, 4) == _TRUE)) {
cp_sz = probereq_wpsie_len > MAX_WPS_IE_LEN ? MAX_WPS_IE_LEN : probereq_wpsie_len;
if (pmlmepriv->wps_probe_req_ie) {
u32 free_len = pmlmepriv->wps_probe_req_ie_len;
pmlmepriv->wps_probe_req_ie_len = 0;
rtw_mfree(pmlmepriv->wps_probe_req_ie, free_len);
pmlmepriv->wps_probe_req_ie = NULL;
}
pmlmepriv->wps_probe_req_ie = rtw_malloc(cp_sz);
if (pmlmepriv->wps_probe_req_ie == NULL) {
printk("%s()-%d: rtw_malloc() ERROR!\n", __FUNCTION__, __LINE__);
ret = -EINVAL;
goto FREE_EXT;
}
_rtw_memcpy(pmlmepriv->wps_probe_req_ie, probereq_wpsie, cp_sz);
pmlmepriv->wps_probe_req_ie_len = cp_sz;
}
goto FREE_EXT;
}
if (len >= WEXT_CSCAN_HEADER_SIZE
&& _rtw_memcmp(ext, WEXT_CSCAN_HEADER, WEXT_CSCAN_HEADER_SIZE) == _TRUE
) {
ret = rtw_wx_set_scan(dev, info, awrq, ext);
goto FREE_EXT;
}
#ifdef CONFIG_ANDROID
/* RTW_INFO("rtw_wx_set_priv: %s req=%s\n", dev->name, ext); */
i = rtw_android_cmdstr_to_num(ext);
switch (i) {
case ANDROID_WIFI_CMD_START:
indicate_wx_custom_event(padapter, "START");
break;
case ANDROID_WIFI_CMD_STOP:
indicate_wx_custom_event(padapter, "STOP");
break;
case ANDROID_WIFI_CMD_RSSI: {
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
struct wlan_network *pcur_network = &pmlmepriv->cur_network;
if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)
sprintf(ext, "%s rssi %d", pcur_network->network.Ssid.Ssid, padapter->recvpriv.rssi);
else
sprintf(ext, "OK");
}
break;
case ANDROID_WIFI_CMD_LINKSPEED: {
u16 mbps = rtw_get_cur_max_rate(padapter) / 10;
sprintf(ext, "LINKSPEED %d", mbps);
}
break;
case ANDROID_WIFI_CMD_MACADDR:
sprintf(ext, "MACADDR = " MAC_FMT, MAC_ARG(dev->dev_addr));
break;
case ANDROID_WIFI_CMD_SCAN_ACTIVE: {
/* rtw_set_scan_mode(padapter, SCAN_ACTIVE); */
sprintf(ext, "OK");
}
break;
case ANDROID_WIFI_CMD_SCAN_PASSIVE: {
/* rtw_set_scan_mode(padapter, SCAN_PASSIVE); */
sprintf(ext, "OK");
}
break;
case ANDROID_WIFI_CMD_COUNTRY: {
char country_code[10];
sscanf(ext, "%*s %s", country_code);
rtw_set_country(padapter, country_code);
sprintf(ext, "OK");
}
break;
default:
#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV
RTW_INFO("%s: %s unknowned req=%s\n", __FUNCTION__,
dev->name, ext_dbg);
#endif
sprintf(ext, "OK");
}
if (copy_to_user(dwrq->pointer, ext, min(dwrq->length, (u16)(strlen(ext) + 1))))
ret = -EFAULT;
#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV
RTW_INFO("%s: %s req=%s rep=%s dwrq->length=%d, strlen(ext)+1=%d\n", __FUNCTION__,
dev->name, ext_dbg , ext, dwrq->length, (u16)(strlen(ext) + 1));
#endif
#endif /* end of CONFIG_ANDROID */
FREE_EXT:
rtw_vmfree(ext, len);
#ifdef CONFIG_DEBUG_RTW_WX_SET_PRIV
rtw_vmfree(ext_dbg, len);
#endif
/* RTW_INFO("rtw_wx_set_priv: (SIOCSIWPRIV) %s ret=%d\n", */
/* dev->name, ret); */
return ret;
}
#ifdef CONFIG_WOWLAN
static int rtw_wowlan_ctrl(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wowlan_ioctl_param poidparam;
struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter);
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct sta_info *psta = NULL;
int ret = 0;
systime start_time = rtw_get_current_time();
poidparam.subcode = 0;
RTW_INFO("+rtw_wowlan_ctrl: %s\n", extra);
if (!check_fwstate(pmlmepriv, _FW_LINKED) &&
check_fwstate(pmlmepriv, WIFI_STATION_STATE) &&
!WOWLAN_IS_STA_MIX_MODE(padapter)) {
#ifdef CONFIG_PNO_SUPPORT
pwrctrlpriv->wowlan_pno_enable = _TRUE;
#else
RTW_INFO("[%s] WARNING: Please Connect With AP First!!\n", __func__);
goto _rtw_wowlan_ctrl_exit_free;
#endif /* CONFIG_PNO_SUPPORT */
}
if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
rtw_scan_abort(padapter);
if (_rtw_memcmp(extra, "enable", 6))
rtw_suspend_common(padapter);
else if (_rtw_memcmp(extra, "disable", 7)) {
#ifdef CONFIG_USB_HCI
RTW_ENABLE_FUNC(padapter, DF_RX_BIT);
RTW_ENABLE_FUNC(padapter, DF_TX_BIT);
#endif
rtw_resume_common(padapter);
#ifdef CONFIG_PNO_SUPPORT
pwrctrlpriv->wowlan_pno_enable = _FALSE;
#endif /* CONFIG_PNO_SUPPORT */
} else {
RTW_INFO("[%s] Invalid Parameter.\n", __func__);
goto _rtw_wowlan_ctrl_exit_free;
}
/* mutex_lock(&ioctl_mutex); */
_rtw_wowlan_ctrl_exit_free:
RTW_INFO("-rtw_wowlan_ctrl( subcode = %d)\n", poidparam.subcode);
RTW_PRINT("%s in %d ms\n", __func__,
rtw_get_passing_time_ms(start_time));
_rtw_wowlan_ctrl_exit:
return ret;
}
/*
* IP filter This pattern if for a frame containing a ip packet:
* AA:AA:AA:AA:AA:AA:BB:BB:BB:BB:BB:BB:CC:CC:DD:-:-:-:-:-:-:-:-:EE:-:-:FF:FF:FF:FF:GG:GG:GG:GG:HH:HH:II:II
*
* A: Ethernet destination address
* B: Ethernet source address
* C: Ethernet protocol type
* D: IP header VER+Hlen, use: 0x45 (4 is for ver 4, 5 is for len 20)
* E: IP protocol
* F: IP source address ( 192.168.0.4: C0:A8:00:2C )
* G: IP destination address ( 192.168.0.4: C0:A8:00:2C )
* H: Source port (1024: 04:00)
* I: Destination port (1024: 04:00)
*/
static int rtw_wowlan_set_pattern(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct wowlan_ioctl_param poidparam;
int ret = 0, len = 0, i = 0;
systime start_time = rtw_get_current_time();
u8 input[wrqu->data.length];
u8 index = 0;
poidparam.subcode = 0;
if (!check_fwstate(pmlmepriv, _FW_LINKED) &&
check_fwstate(pmlmepriv, WIFI_STATION_STATE)) {
ret = -EFAULT;
RTW_INFO("Please Connect With AP First!!\n");
goto _rtw_wowlan_set_pattern_exit;
}
if (wrqu->data.length <= 0) {
ret = -EFAULT;
RTW_INFO("ERROR: parameter length <= 0\n");
goto _rtw_wowlan_set_pattern_exit;
} else {
/* set pattern */
if (copy_from_user(input,
wrqu->data.pointer, wrqu->data.length))
return -EFAULT;
/* leave PS first */
rtw_ps_deny(padapter, PS_DENY_IOCTL);
LeaveAllPowerSaveModeDirect(padapter);
if (strncmp(input, "pattern=", 8) == 0) {
if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_CAM_NUM) {
RTW_INFO("WARNING: priv-pattern is full(idx: %d)\n",
pwrpriv->wowlan_pattern_idx);
RTW_INFO("WARNING: please clean priv-pattern first\n");
ret = -EINVAL;
goto _rtw_wowlan_set_pattern_exit;
} else {
index = pwrpriv->wowlan_pattern_idx;
ret = rtw_wowlan_parser_pattern_cmd(input,
pwrpriv->patterns[index].content,
&pwrpriv->patterns[index].len,
pwrpriv->patterns[index].mask);
if (ret == _TRUE)
pwrpriv->wowlan_pattern_idx++;
}
} else if (strncmp(input, "clean", 5) == 0) {
poidparam.subcode = WOWLAN_PATTERN_CLEAN;
rtw_hal_set_hwreg(padapter,
HW_VAR_WOWLAN, (u8 *)&poidparam);
} else if (strncmp(input, "show", 4) == 0) {
rtw_wow_pattern_cam_dump(padapter);
rtw_wow_pattern_sw_dump(padapter);
} else {
RTW_INFO("ERROR: incorrect parameter!\n");
ret = -EINVAL;
}
rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL);
}
_rtw_wowlan_set_pattern_exit:
return ret;
}
#endif /* CONFIG_WOWLAN */
#ifdef CONFIG_AP_WOWLAN
static int rtw_ap_wowlan_ctrl(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct wowlan_ioctl_param poidparam;
struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter);
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
struct sta_info *psta = NULL;
int ret = 0;
systime start_time = rtw_get_current_time();
poidparam.subcode = 0;
RTW_INFO("+rtw_ap_wowlan_ctrl: %s\n", extra);
if (!check_fwstate(pmlmepriv, WIFI_AP_STATE)) {
RTW_INFO("[%s] It is not AP mode!!\n", __func__);
goto _rtw_ap_wowlan_ctrl_exit_free;
}
if (_rtw_memcmp(extra, "enable", 6)) {
pwrctrlpriv->wowlan_ap_mode = _TRUE;
rtw_suspend_common(padapter);
} else if (_rtw_memcmp(extra, "disable", 7)) {
#ifdef CONFIG_USB_HCI
RTW_ENABLE_FUNC(padapter, DF_RX_BIT);
RTW_ENABLE_FUNC(padapter, DF_TX_BIT);
#endif
rtw_resume_common(padapter);
} else {
RTW_INFO("[%s] Invalid Parameter.\n", __func__);
goto _rtw_ap_wowlan_ctrl_exit_free;
}
/* mutex_lock(&ioctl_mutex); */
_rtw_ap_wowlan_ctrl_exit_free:
RTW_INFO("-rtw_ap_wowlan_ctrl( subcode = %d)\n", poidparam.subcode);
RTW_PRINT("%s in %d ms\n", __func__,
rtw_get_passing_time_ms(start_time));
_rtw_ap_wowlan_ctrl_exit:
return ret;
}
#endif /* CONFIG_AP_WOWLAN */
static int rtw_pm_set(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
unsigned mode = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
RTW_INFO("[%s] extra = %s\n", __FUNCTION__, extra);
if (_rtw_memcmp(extra, "lps=", 4)) {
sscanf(extra + 4, "%u", &mode);
ret = rtw_pm_set_lps(padapter, mode);
} else if (_rtw_memcmp(extra, "ips=", 4)) {
sscanf(extra + 4, "%u", &mode);
ret = rtw_pm_set_ips(padapter, mode);
} else if (_rtw_memcmp(extra, "lps_level=", 10)) {
if (sscanf(extra + 10, "%u", &mode) > 0)
ret = rtw_pm_set_lps_level(padapter, mode);
} else
ret = -EINVAL;
return ret;
}
#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE
int rtw_vendor_ie_get_raw_data(struct net_device *dev, u32 vendor_ie_num,
char *extra, u32 length)
{
int j;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
u32 vendor_ie_mask = 0;
char *pstring;
if (vendor_ie_num >= WLAN_MAX_VENDOR_IE_NUM) {
RTW_INFO("[%s] only support %d vendor ie\n", __func__ ,
WLAN_MAX_VENDOR_IE_NUM);
return -EFAULT;
}
if (pmlmepriv->vendor_ielen[vendor_ie_num] == 0) {
RTW_INFO("[%s] Fail, vendor_ie_num: %d is not set\n", __func__,
vendor_ie_num);
return -EFAULT;
}
if (length < 2 * pmlmepriv->vendor_ielen[vendor_ie_num] + 5) {
RTW_INFO("[%s] Fail, buffer size is too small\n", __func__);
return -EFAULT;
}
vendor_ie_mask = pmlmepriv->vendor_ie_mask[vendor_ie_num];
_rtw_memset(extra, 0, length);
pstring = extra;
pstring += sprintf(pstring, "%d,%x,", vendor_ie_num, vendor_ie_mask);
for (j = 0; j < pmlmepriv->vendor_ielen[vendor_ie_num]; j++)
pstring += sprintf(pstring, "%02x", pmlmepriv->vendor_ie[vendor_ie_num][j]);
length = pstring - extra;
return length;
}
int rtw_vendor_ie_get_data(struct net_device *dev, int vendor_ie_num, char *extra)
{
int j;
char *pstring;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
u32 vendor_ie_mask = 0;
__u16 length = 0;
vendor_ie_mask = pmlmepriv->vendor_ie_mask[vendor_ie_num];
pstring = extra;
pstring += sprintf(pstring , "\nVendor IE num %d , Mask:%x " , vendor_ie_num , vendor_ie_mask);
if (vendor_ie_mask & WIFI_BEACON_VENDOR_IE_BIT)
pstring += sprintf(pstring , "[Beacon]");
if (vendor_ie_mask & WIFI_PROBEREQ_VENDOR_IE_BIT)
pstring += sprintf(pstring , "[Probe Req]");
if (vendor_ie_mask & WIFI_PROBERESP_VENDOR_IE_BIT)
pstring += sprintf(pstring , "[Probe Resp]");
if (vendor_ie_mask & WIFI_ASSOCREQ_VENDOR_IE_BIT)
pstring += sprintf(pstring , "[Assoc Req]");
if (vendor_ie_mask & WIFI_ASSOCRESP_VENDOR_IE_BIT)
pstring += sprintf(pstring , "[Assoc Resp]");
#ifdef CONFIG_P2P
if (vendor_ie_mask & WIFI_P2P_PROBEREQ_VENDOR_IE_BIT)
pstring += sprintf(pstring , "[P2P_Probe Req]");
if (vendor_ie_mask & WIFI_P2P_PROBERESP_VENDOR_IE_BIT)
pstring += sprintf(pstring , "[P2P_Probe Resp]");
#endif
pstring += sprintf(pstring , "\nVendor IE:\n");
for (j = 0 ; j < pmlmepriv->vendor_ielen[vendor_ie_num] ; j++)
pstring += sprintf(pstring , "%02x" , pmlmepriv->vendor_ie[vendor_ie_num][j]);
length = pstring - extra;
return length;
}
int rtw_vendor_ie_get(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra)
{
int ret = 0, vendor_ie_num = 0, cmdlen;
struct iw_point *p;
u8 *ptmp;
p = &wrqu->data;
cmdlen = p->length;
if (0 == cmdlen)
return -EINVAL;
ptmp = (u8 *)rtw_malloc(cmdlen);
if (NULL == ptmp)
return -ENOMEM;
if (copy_from_user(ptmp, p->pointer, cmdlen)) {
ret = -EFAULT;
goto exit;
}
ret = sscanf(ptmp , "%d", &vendor_ie_num);
if (vendor_ie_num > WLAN_MAX_VENDOR_IE_NUM - 1) {
ret = -EFAULT;
goto exit;
}
wrqu->data.length = rtw_vendor_ie_get_data(dev, vendor_ie_num, extra);
exit:
rtw_mfree(ptmp, cmdlen);
return 0;
}
int rtw_vendor_ie_set(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra)
{
int ret = 0, i , len = 0 , totoal_ie_len = 0 , total_ie_len_byte = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
u32 vendor_ie_mask = 0;
u32 vendor_ie_num = 0;
u32 vendor_ie_mask_max = BIT(WLAN_MAX_VENDOR_IE_MASK_MAX) - 1;
u32 id, elen;
ret = sscanf(extra, "%d,%x,%*s", &vendor_ie_num , &vendor_ie_mask);
if (strrchr(extra , ','))
extra = strrchr(extra , ',') + 1;
else
return -EINVAL;
totoal_ie_len = strlen(extra);
RTW_INFO("[%s] vendor_ie_num = %d , vendor_ie_mask = 0x%x , vendor_ie = %s , len = %d\n", __func__ , vendor_ie_num , vendor_ie_mask , extra , totoal_ie_len);
if (vendor_ie_num > WLAN_MAX_VENDOR_IE_NUM - 1) {
RTW_INFO("[%s] Fail, only support %d vendor ie\n", __func__ , WLAN_MAX_VENDOR_IE_NUM);
return -EFAULT;
}
if (totoal_ie_len > WLAN_MAX_VENDOR_IE_LEN) {
RTW_INFO("[%s] Fail , not support ie length extend %d\n", __func__ , WLAN_MAX_VENDOR_IE_LEN);
return -EFAULT;
}
if (vendor_ie_mask > vendor_ie_mask_max) {
RTW_INFO("[%s] Fail, not support vendor_ie_mask more than 0x%x\n", __func__ , vendor_ie_mask_max);
return -EFAULT;
}
if (vendor_ie_mask == 0) {
RTW_INFO("[%s] Clear vendor_ie_num %d group\n", __func__ , vendor_ie_num);
goto _clear_path;
}
if (totoal_ie_len % 2 != 0) {
RTW_INFO("[%s] Fail , IE length = %zu is odd\n" , __func__ , strlen(extra));
return -EFAULT;
}
if (totoal_ie_len > 0) {
for (i = 0 ; i < strlen(extra) ; i += 2) {
pmlmepriv->vendor_ie[vendor_ie_num][len] = key_2char2num(extra[i] , extra[i + 1]);
if (len == 0) {
id = pmlmepriv->vendor_ie[vendor_ie_num][len];
if (id != WLAN_EID_VENDOR_SPECIFIC) {
RTW_INFO("[%s] Fail , VENDOR SPECIFIC IE ID \"%x\" was not correct\n", __func__ , id);
goto _clear_path;
}
} else if (len == 1) {
total_ie_len_byte = (totoal_ie_len / 2) - 2;
elen = pmlmepriv->vendor_ie[vendor_ie_num][len];
if (elen != total_ie_len_byte) {
RTW_INFO("[%s] Fail , Input IE length = \"%d\"(hex:%x) bytes , not match input total IE context length \"%d\" bytes\n", __func__ , elen , elen ,
total_ie_len_byte);
goto _clear_path;
}
}
len++;
}
pmlmepriv->vendor_ielen[vendor_ie_num] = len;
} else
pmlmepriv->vendor_ielen[vendor_ie_num] = 0;
if (vendor_ie_mask & WIFI_BEACON_VENDOR_IE_BIT)
RTW_INFO("[%s] Beacon append vendor ie\n", __func__);
if (vendor_ie_mask & WIFI_PROBEREQ_VENDOR_IE_BIT)
RTW_INFO("[%s] Probe Req append vendor ie\n", __func__);
if (vendor_ie_mask & WIFI_PROBERESP_VENDOR_IE_BIT)
RTW_INFO("[%s] Probe Resp append vendor ie\n", __func__);
if (vendor_ie_mask & WIFI_ASSOCREQ_VENDOR_IE_BIT)
RTW_INFO("[%s] Assoc Req append vendor ie\n", __func__);
if (vendor_ie_mask & WIFI_ASSOCRESP_VENDOR_IE_BIT)
RTW_INFO("[%s] Assoc Resp append vendor ie\n", __func__);
#ifdef CONFIG_P2P
if (vendor_ie_mask & WIFI_P2P_PROBEREQ_VENDOR_IE_BIT)
RTW_INFO("[%s] P2P Probe Req append vendor ie\n", __func__);
if (vendor_ie_mask & WIFI_P2P_PROBERESP_VENDOR_IE_BIT)
RTW_INFO("[%s] P2P Probe Resp append vendor ie\n", __func__);
#endif
pmlmepriv->vendor_ie_mask[vendor_ie_num] = vendor_ie_mask;
return ret;
_clear_path:
_rtw_memset(pmlmepriv->vendor_ie[vendor_ie_num] , 0 , sizeof(u32) * WLAN_MAX_VENDOR_IE_LEN);
pmlmepriv->vendor_ielen[vendor_ie_num] = 0;
pmlmepriv->vendor_ie_mask[vendor_ie_num] = 0;
return -EFAULT;
}
#endif
static int rtw_mp_efuse_get(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wdata, char *extra)
{
PADAPTER padapter = rtw_netdev_priv(dev);
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
PEFUSE_HAL pEfuseHal;
struct iw_point *wrqu;
u8 ips_mode = IPS_NUM; /* init invalid value */
u8 lps_mode = PS_MODE_NUM; /* init invalid value */
struct pwrctrl_priv *pwrctrlpriv ;
u8 *data = NULL;
u8 *rawdata = NULL;
char *pch, *ptmp, *token, *tmp[3] = {0x00, 0x00, 0x00};
u16 i = 0, j = 0, mapLen = 0, addr = 0, cnts = 0;
u16 max_available_len = 0, raw_cursize = 0, raw_maxsize = 0;
u16 mask_len;
u8 mask_buf[64] = "";
int err;
char *pextra = NULL;
#ifdef CONFIG_IOL
u8 org_fw_iol = padapter->registrypriv.fw_iol;/* 0:Disable, 1:enable, 2:by usb speed */
#endif
wrqu = (struct iw_point *)wdata;
pwrctrlpriv = adapter_to_pwrctl(padapter);
pEfuseHal = &pHalData->EfuseHal;
err = 0;
data = rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN);
if (data == NULL) {
err = -ENOMEM;
goto exit;
}
rawdata = rtw_zmalloc(EFUSE_BT_MAX_MAP_LEN);
if (rawdata == NULL) {
err = -ENOMEM;
goto exit;
}
if (copy_from_user(extra, wrqu->pointer, wrqu->length)) {
err = -EFAULT;
goto exit;
}
*(extra + wrqu->length) = '\0';
#ifdef CONFIG_LPS
lps_mode = pwrctrlpriv->power_mgnt;/* keep org value */
rtw_pm_set_lps(padapter, PS_MODE_ACTIVE);
#endif
#ifdef CONFIG_IPS
ips_mode = pwrctrlpriv->ips_mode;/* keep org value */
rtw_pm_set_ips(padapter, IPS_NONE);
#endif
pch = extra;
RTW_INFO("%s: in=%s\n", __FUNCTION__, extra);
i = 0;
/* mac 16 "00e04c871200" rmap,00,2 */
while ((token = strsep(&pch, ",")) != NULL) {
if (i > 2)
break;
tmp[i] = token;
i++;
}
#ifdef CONFIG_IOL
padapter->registrypriv.fw_iol = 0;/* 0:Disable, 1:enable, 2:by usb speed */
#endif
if (strcmp(tmp[0], "status") == 0) {
sprintf(extra, "Load File efuse=%s,Load File MAC=%s"
, pHalData->efuse_file_status == EFUSE_FILE_FAILED ? "FAIL" : "OK"
, pHalData->macaddr_file_status == MACADDR_FILE_FAILED ? "FAIL" : "OK"
);
goto exit;
} else if (strcmp(tmp[0], "drvmap") == 0) {
static u8 drvmaporder = 0;
u8 *efuse;
u32 shift, cnt;
u32 blksz = 0x200; /* The size of one time show, default 512 */
EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, _FALSE);
efuse = pHalData->efuse_eeprom_data;
shift = blksz * drvmaporder;
efuse += shift;
cnt = mapLen - shift;
if (cnt > blksz) {
cnt = blksz;
drvmaporder++;
} else
drvmaporder = 0;
sprintf(extra, "\n");
for (i = 0; i < cnt; i += 16) {
pextra = extra + strlen(extra);
pextra += sprintf(pextra, "0x%02x\t", shift + i);
for (j = 0; j < 8; j++)
pextra += sprintf(pextra, "%02X ", efuse[i + j]);
pextra += sprintf(pextra, "\t");
for (; j < 16; j++)
pextra += sprintf(pextra, "%02X ", efuse[i + j]);
pextra += sprintf(pextra, "\n");
}
if ((shift + cnt) < mapLen)
pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", mapLen-(shift + cnt), mapLen);
} else if (strcmp(tmp[0], "realmap") == 0) {
static u8 order = 0;
u8 *efuse;
u32 shift, cnt;
u32 blksz = 0x200; /* The size of one time show, default 512 */
EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&mapLen, _FALSE);
efuse = pEfuseHal->fakeEfuseInitMap;
if (rtw_efuse_mask_map_read(padapter, 0, mapLen, efuse) == _FAIL) {
RTW_INFO("%s: read realmap Fail!!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
#if 0
RTW_INFO("OFFSET\tVALUE(hex)\n");
for (i = 0; i < mapLen; i += 16) {
RTW_INFO("0x%02x\t", i);
for (j = 0; j < 8; j++)
RTW_INFO("%02X ", efuse[i + j]);
RTW_INFO("\t");
for (; j < 16; j++)
RTW_INFO("%02X ", efuse[i + j]);
RTW_INFO("\n");
}
RTW_INFO("\n");
#endif
shift = blksz * order;
efuse += shift;
cnt = mapLen - shift;
if (cnt > blksz) {
cnt = blksz;
order++;
} else
order = 0;
sprintf(extra, "\n");
for (i = 0; i < cnt; i += 16) {
pextra = extra + strlen(extra);
pextra += sprintf(pextra, "0x%02x\t", shift + i);
for (j = 0; j < 8; j++)
pextra += sprintf(pextra, "%02X ", efuse[i + j]);
pextra += sprintf(pextra, "\t");
for (; j < 16; j++)
pextra += sprintf(pextra, "%02X ", efuse[i + j]);
pextra += sprintf(pextra, "\n");
}
if ((shift + cnt) < mapLen)
pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", mapLen-(shift + cnt), mapLen);
} else if (strcmp(tmp[0], "rmap") == 0) {
if ((tmp[1] == NULL) || (tmp[2] == NULL)) {
RTW_INFO("%s: rmap Fail!! Parameters error!\n", __FUNCTION__);
err = -EINVAL;
goto exit;
}
/* rmap addr cnts */
addr = simple_strtoul(tmp[1], &ptmp, 16);
RTW_INFO("%s: addr=%x\n", __FUNCTION__, addr);
cnts = simple_strtoul(tmp[2], &ptmp, 10);
if (cnts == 0) {
RTW_INFO("%s: rmap Fail!! cnts error!\n", __FUNCTION__);
err = -EINVAL;
goto exit;
}
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (PVOID)&max_available_len, _FALSE);
if ((addr + cnts) > max_available_len) {
RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts);
err = -EINVAL;
goto exit;
}
if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) {
RTW_INFO("%s: rtw_efuse_mask_map_read error!\n", __func__);
err = -EFAULT;
goto exit;
}
/* RTW_INFO("%s: data={", __FUNCTION__); */
*extra = 0;
pextra = extra;
for (i = 0; i < cnts; i++) {
/* RTW_INFO("0x%02x ", data[i]); */
pextra += sprintf(pextra, "0x%02X ", data[i]);
}
/* RTW_INFO("}\n"); */
} else if (strcmp(tmp[0], "realraw") == 0) {
static u8 raw_order = 0;
u32 shift, cnt;
u32 blksz = 0x200; /* The size of one time show, default 512 */
addr = 0;
EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN , (PVOID)&mapLen, _FALSE);
RTW_INFO("Real content len = %d\n",mapLen );
if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) {
RTW_INFO("%s: rtw_efuse_access Fail!!\n", __func__);
err = -EFAULT;
goto exit;
}
_rtw_memset(extra, '\0', strlen(extra));
shift = blksz * raw_order;
rawdata += shift;
cnt = mapLen - shift;
if (cnt > blksz) {
cnt = blksz;
raw_order++;
} else
raw_order = 0;
sprintf(extra, "\n");
for (i = 0; i < cnt; i += 16) {
pextra = extra + strlen(extra);
pextra += sprintf(pextra, "0x%02x\t", shift + i);
for (j = 0; j < 8; j++)
pextra += sprintf(pextra, "%02X ", rawdata[i + j]);
pextra += sprintf(pextra, "\t");
for (; j < 16; j++)
pextra += sprintf(pextra, "%02X ", rawdata[i + j]);
pextra += sprintf(pextra, "\n");
}
if ((shift + cnt) < mapLen)
pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", mapLen-(shift + cnt), mapLen);
} else if (strcmp(tmp[0], "btrealraw") == 0) {
static u8 bt_raw_order = 0;
u32 shift, cnt;
u32 blksz = 0x200; /* The size of one time show, default 512 */
addr = 0;
EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_REAL_CONTENT_LEN, (PVOID)&mapLen, _FALSE);
RTW_INFO("Real content len = %d\n", mapLen);
#ifdef RTW_HALMAC
if (rtw_efuse_bt_access(padapter, _FALSE, 0, mapLen, rawdata) == _FAIL) {
RTW_INFO("%s: rtw_efuse_access Fail!!\n", __func__);
err = -EFAULT;
goto exit;
}
#else
rtw_write8(padapter, 0x35, 0x1);
if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) {
RTW_INFO("%s: rtw_efuse_access Fail!!\n", __func__);
err = -EFAULT;
goto exit;
}
#endif
_rtw_memset(extra, '\0', strlen(extra));
shift = blksz * bt_raw_order;
rawdata += shift;
cnt = mapLen - shift;
if (cnt > blksz) {
cnt = blksz;
bt_raw_order++;
} else
bt_raw_order = 0;
sprintf(extra, "\n");
for (i = 0; i < cnt; i += 16) {
pextra = extra + strlen(extra);
pextra += sprintf(pextra, "0x%02x\t", shift + i);
for (j = 0; j < 8; j++)
pextra += sprintf(pextra, "%02X ", rawdata[i + j]);
pextra += sprintf(pextra, "\t");
for (; j < 16; j++)
pextra += sprintf(pextra, "%02X ", rawdata[i + j]);
pextra += sprintf(pextra, "\n");
}
if ((shift + cnt) < mapLen)
pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", mapLen-(shift + cnt), mapLen);
} else if (strcmp(tmp[0], "mac") == 0) {
if (hal_efuse_macaddr_offset(padapter) == -1) {
err = -EFAULT;
goto exit;
}
addr = hal_efuse_macaddr_offset(padapter);
cnts = 6;
EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE);
if ((addr + cnts) > max_available_len) {
RTW_INFO("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts);
err = -EFAULT;
goto exit;
}
if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) {
RTW_INFO("%s: rtw_efuse_mask_map_read error!\n", __func__);
err = -EFAULT;
goto exit;
}
/* RTW_INFO("%s: MAC address={", __FUNCTION__); */
*extra = 0;
pextra = extra;
for (i = 0; i < cnts; i++) {
/* RTW_INFO("%02X", data[i]); */
pextra += sprintf(pextra, "%02X", data[i]);
if (i != (cnts - 1)) {
/* RTW_INFO(":"); */
pextra += sprintf(pextra, ":");
}
}
/* RTW_INFO("}\n"); */
} else if (strcmp(tmp[0], "vidpid") == 0) {
#ifdef CONFIG_RTL8188E
#ifdef CONFIG_USB_HCI
addr = EEPROM_VID_88EU;
#endif
#ifdef CONFIG_PCI_HCI
addr = EEPROM_VID_88EE;
#endif
#endif /* CONFIG_RTL8188E */
#ifdef CONFIG_RTL8192E
#ifdef CONFIG_USB_HCI
addr = EEPROM_VID_8192EU;
#endif
#ifdef CONFIG_PCI_HCI
addr = EEPROM_VID_8192EE;
#endif
#endif /* CONFIG_RTL8192E */
#ifdef CONFIG_RTL8723B
addr = EEPROM_VID_8723BU;
#endif /* CONFIG_RTL8192E */
#ifdef CONFIG_RTL8188F
addr = EEPROM_VID_8188FU;
#endif /* CONFIG_RTL8188F */
#ifdef CONFIG_RTL8188GTV
addr = EEPROM_VID_8188GTVU;
#endif
#ifdef CONFIG_RTL8703B
#ifdef CONFIG_USB_HCI
addr = EEPROM_VID_8703BU;
#endif
#endif /* CONFIG_RTL8703B */
#ifdef CONFIG_RTL8723D
#ifdef CONFIG_USB_HCI
addr = EEPROM_VID_8723DU;
#endif /* CONFIG_USB_HCI */
#endif /* CONFIG_RTL8723D */
cnts = 4;
EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE);
if ((addr + cnts) > max_available_len) {
RTW_INFO("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts);
err = -EFAULT;
goto exit;
}
if (rtw_efuse_mask_map_read(padapter, addr, cnts, data) == _FAIL) {
RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
/* RTW_INFO("%s: {VID,PID}={", __FUNCTION__); */
*extra = 0;
pextra = extra;
for (i = 0; i < cnts; i++) {
/* RTW_INFO("0x%02x", data[i]); */
pextra += sprintf(pextra, "0x%02X", data[i]);
if (i != (cnts - 1)) {
/* RTW_INFO(","); */
pextra += sprintf(pextra, ",");
}
}
/* RTW_INFO("}\n"); */
} else if (strcmp(tmp[0], "ableraw") == 0) {
#ifdef RTW_HALMAC
raw_maxsize = efuse_GetavailableSize(padapter);
#else
efuse_GetCurrentSize(padapter, &raw_cursize);
raw_maxsize = efuse_GetMaxSize(padapter);
#endif
sprintf(extra, "[available raw size]= %d bytes\n", raw_maxsize - raw_cursize);
} else if (strcmp(tmp[0], "btableraw") == 0) {
efuse_bt_GetCurrentSize(padapter, &raw_cursize);
raw_maxsize = efuse_bt_GetMaxSize(padapter);
sprintf(extra, "[available raw size]= %d bytes\n", raw_maxsize - raw_cursize);
} else if (strcmp(tmp[0], "btfmap") == 0) {
BTEfuse_PowerSwitch(padapter, 1, _TRUE);
mapLen = EFUSE_BT_MAX_MAP_LEN;
if (rtw_BT_efuse_map_read(padapter, 0, mapLen, pEfuseHal->BTEfuseInitMap) == _FAIL) {
RTW_INFO("%s: rtw_BT_efuse_map_read Fail!!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
/* RTW_INFO("OFFSET\tVALUE(hex)\n"); */
sprintf(extra, "\n");
for (i = 0; i < 512; i += 16) { /* set 512 because the iwpriv's extra size have limit 0x7FF */
/* RTW_INFO("0x%03x\t", i); */
pextra = extra + strlen(extra);
pextra += sprintf(pextra, "0x%03x\t", i);
for (j = 0; j < 8; j++) {
/* RTW_INFO("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); */
pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]);
}
/* RTW_INFO("\t"); */
pextra += sprintf(pextra, "\t");
for (; j < 16; j++) {
/* RTW_INFO("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); */
pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]);
}
/* RTW_INFO("\n"); */
pextra += sprintf(pextra, "\n");
}
/* RTW_INFO("\n"); */
} else if (strcmp(tmp[0], "btbmap") == 0) {
BTEfuse_PowerSwitch(padapter, 1, _TRUE);
mapLen = EFUSE_BT_MAX_MAP_LEN;
if (rtw_BT_efuse_map_read(padapter, 0, mapLen, pEfuseHal->BTEfuseInitMap) == _FAIL) {
RTW_INFO("%s: rtw_BT_efuse_map_read Fail!!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
/* RTW_INFO("OFFSET\tVALUE(hex)\n"); */
sprintf(extra, "\n");
for (i = 512; i < 1024 ; i += 16) {
/* RTW_INFO("0x%03x\t", i); */
pextra = extra + strlen(extra);
pextra += sprintf(pextra, "0x%03x\t", i);
for (j = 0; j < 8; j++) {
/* RTW_INFO("%02X ", data[i+j]); */
pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]);
}
/* RTW_INFO("\t"); */
pextra += sprintf(pextra, "\t");
for (; j < 16; j++) {
/* RTW_INFO("%02X ", data[i+j]); */
pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]);
}
/* RTW_INFO("\n"); */
pextra += sprintf(pextra, "\n");
}
/* RTW_INFO("\n"); */
} else if (strcmp(tmp[0], "btrmap") == 0) {
u8 BTStatus;
rtw_write8(padapter, 0xa3, 0x05); /* For 8723AB ,8821S ? */
BTStatus = rtw_read8(padapter, 0xa0);
RTW_INFO("%s: Check 0xa0 BT Status =0x%x\n", __FUNCTION__, BTStatus);
if (BTStatus != 0x04) {
sprintf(extra, "BT Status not Active ,can't to read BT eFuse\n");
goto exit;
}
if ((tmp[1] == NULL) || (tmp[2] == NULL)) {
err = -EINVAL;
goto exit;
}
BTEfuse_PowerSwitch(padapter, 1, _TRUE);
/* rmap addr cnts */
addr = simple_strtoul(tmp[1], &ptmp, 16);
RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr);
cnts = simple_strtoul(tmp[2], &ptmp, 10);
if (cnts == 0) {
RTW_INFO("%s: btrmap Fail!! cnts error!\n", __FUNCTION__);
err = -EINVAL;
goto exit;
}
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
#ifndef RTW_HALMAC
EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE);
if ((addr + cnts) > max_available_len) {
RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts);
err = -EFAULT;
goto exit;
}
#endif
if (rtw_BT_efuse_map_read(padapter, addr, cnts, data) == _FAIL) {
RTW_INFO("%s: rtw_BT_efuse_map_read error!!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
*extra = 0;
pextra = extra;
/* RTW_INFO("%s: bt efuse data={", __FUNCTION__); */
for (i = 0; i < cnts; i++) {
/* RTW_INFO("0x%02x ", data[i]); */
pextra += sprintf(pextra, " 0x%02X ", data[i]);
}
/* RTW_INFO("}\n"); */
RTW_INFO(FUNC_ADPT_FMT ": BT MAC=[%s]\n", FUNC_ADPT_ARG(padapter), extra);
} else if (strcmp(tmp[0], "btffake") == 0) {
/* RTW_INFO("OFFSET\tVALUE(hex)\n"); */
sprintf(extra, "\n");
for (i = 0; i < 512; i += 16) {
/* RTW_INFO("0x%03x\t", i); */
pextra = extra + strlen(extra);
pextra += sprintf(pextra, "0x%03x\t", i);
for (j = 0; j < 8; j++) {
/* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */
pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]);
}
/* RTW_INFO("\t"); */
pextra += sprintf(pextra, "\t");
for (; j < 16; j++) {
/* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */
pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]);
}
/* RTW_INFO("\n"); */
pextra += sprintf(pextra, "\n");
}
/* RTW_INFO("\n"); */
} else if (strcmp(tmp[0], "btbfake") == 0) {
/* RTW_INFO("OFFSET\tVALUE(hex)\n"); */
sprintf(extra, "\n");
for (i = 512; i < 1024; i += 16) {
/* RTW_INFO("0x%03x\t", i); */
pextra = extra + strlen(extra);
pextra += sprintf(pextra, "0x%03x\t", i);
for (j = 0; j < 8; j++) {
/* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */
pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]);
}
/* RTW_INFO("\t"); */
pextra += sprintf(pextra, "\t");
for (; j < 16; j++) {
/* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */
pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]);
}
/* RTW_INFO("\n"); */
pextra += sprintf(pextra, "\n");
}
/* RTW_INFO("\n"); */
} else if (strcmp(tmp[0], "wlrfkmap") == 0) {
static u8 fk_order = 0;
u8 *efuse;
u32 shift, cnt;
u32 blksz = 0x200; /* The size of one time show, default 512 */
EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&mapLen, _FALSE);
efuse = pEfuseHal->fakeEfuseModifiedMap;
shift = blksz * fk_order;
efuse += shift;
cnt = mapLen - shift;
if (cnt > blksz) {
cnt = blksz;
fk_order++;
} else
fk_order = 0;
sprintf(extra, "\n");
for (i = 0; i < cnt; i += 16) {
pextra = extra + strlen(extra);
pextra += sprintf(pextra, "0x%02x\t", shift + i);
for (j = 0; j < 8; j++)
pextra += sprintf(pextra, "%02X ", efuse[i + j]);
pextra += sprintf(pextra, "\t");
for (; j < 16; j++)
pextra += sprintf(pextra, "%02X ", efuse[i + j]);
pextra += sprintf(pextra, "\n");
}
if ((shift + cnt) < mapLen)
pextra += sprintf(pextra, "\t...more\n");
} else if (strcmp(tmp[0], "wlrfkrmap") == 0) {
if ((tmp[1] == NULL) || (tmp[2] == NULL)) {
RTW_INFO("%s: rmap Fail!! Parameters error!\n", __FUNCTION__);
err = -EINVAL;
goto exit;
}
/* rmap addr cnts */
addr = simple_strtoul(tmp[1], &ptmp, 16);
RTW_INFO("%s: addr=%x\n", __FUNCTION__, addr);
cnts = simple_strtoul(tmp[2], &ptmp, 10);
if (cnts == 0) {
RTW_INFO("%s: rmap Fail!! cnts error!\n", __FUNCTION__);
err = -EINVAL;
goto exit;
}
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
/* RTW_INFO("%s: data={", __FUNCTION__); */
*extra = 0;
pextra = extra;
for (i = 0; i < cnts; i++) {
RTW_INFO("wlrfkrmap = 0x%02x\n", pEfuseHal->fakeEfuseModifiedMap[addr + i]);
pextra += sprintf(pextra, "0x%02X ", pEfuseHal->fakeEfuseModifiedMap[addr+i]);
}
} else if (strcmp(tmp[0], "btrfkrmap") == 0) {
if ((tmp[1] == NULL) || (tmp[2] == NULL)) {
RTW_INFO("%s: rmap Fail!! Parameters error!\n", __FUNCTION__);
err = -EINVAL;
goto exit;
}
/* rmap addr cnts */
addr = simple_strtoul(tmp[1], &ptmp, 16);
RTW_INFO("%s: addr=%x\n", __FUNCTION__, addr);
cnts = simple_strtoul(tmp[2], &ptmp, 10);
if (cnts == 0) {
RTW_INFO("%s: rmap Fail!! cnts error!\n", __FUNCTION__);
err = -EINVAL;
goto exit;
}
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
/* RTW_INFO("%s: data={", __FUNCTION__); */
*extra = 0;
pextra = extra;
for (i = 0; i < cnts; i++) {
RTW_INFO("wlrfkrmap = 0x%02x\n", pEfuseHal->fakeBTEfuseModifiedMap[addr + i]);
pextra += sprintf(pextra, "0x%02X ", pEfuseHal->fakeBTEfuseModifiedMap[addr+i]);
}
} else if (strcmp(tmp[0], "mask") == 0) {
*extra = 0;
mask_len = sizeof(u8) * rtw_get_efuse_mask_arraylen(padapter);
rtw_efuse_mask_array(padapter, mask_buf);
if (padapter->registrypriv.bFileMaskEfuse == _TRUE)
_rtw_memcpy(mask_buf, maskfileBuffer, mask_len);
sprintf(extra, "\n");
pextra = extra + strlen(extra);
for (i = 0; i < mask_len; i++)
pextra += sprintf(pextra, "0x%02X\n", mask_buf[i]);
} else
sprintf(extra, "Command not found!");
exit:
if (data)
rtw_mfree(data, EFUSE_BT_MAX_MAP_LEN);
if (rawdata)
rtw_mfree(rawdata, EFUSE_BT_MAX_MAP_LEN);
if (!err)
wrqu->length = strlen(extra);
if (padapter->registrypriv.mp_mode == 0) {
#ifdef CONFIG_IPS
rtw_pm_set_ips(padapter, ips_mode);
#endif /* CONFIG_IPS */
#ifdef CONFIG_LPS
rtw_pm_set_lps(padapter, lps_mode);
#endif /* CONFIG_LPS */
}
#ifdef CONFIG_IOL
padapter->registrypriv.fw_iol = org_fw_iol;/* 0:Disable, 1:enable, 2:by usb speed */
#endif
return err;
}
static int rtw_mp_efuse_set(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wdata, char *extra)
{
struct iw_point *wrqu;
PADAPTER padapter;
struct pwrctrl_priv *pwrctrlpriv ;
PHAL_DATA_TYPE pHalData;
PEFUSE_HAL pEfuseHal;
struct hal_ops *pHalFunc;
struct mp_priv *pmp_priv;
u8 ips_mode = IPS_NUM; /* init invalid value */
u8 lps_mode = PS_MODE_NUM; /* init invalid value */
u32 i = 0, j = 0, jj, kk;
u8 *setdata = NULL;
u8 *ShadowMapBT = NULL;
u8 *ShadowMapWiFi = NULL;
u8 *setrawdata = NULL;
char *pch, *ptmp, *token, *tmp[3] = {0x00, 0x00, 0x00};
u16 addr = 0xFF, cnts = 0, BTStatus = 0 , max_available_len = 0;
u16 wifimaplen;
int err;
boolean bcmpchk = _TRUE;
wrqu = (struct iw_point *)wdata;
padapter = rtw_netdev_priv(dev);
pwrctrlpriv = adapter_to_pwrctl(padapter);
pHalData = GET_HAL_DATA(padapter);
pEfuseHal = &pHalData->EfuseHal;
pHalFunc = &padapter->hal_func;
pmp_priv = &padapter->mppriv;
err = 0;
if (copy_from_user(extra, wrqu->pointer, wrqu->length))
return -EFAULT;
*(extra + wrqu->length) = '\0';
EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&wifimaplen, _FALSE);
setdata = rtw_zmalloc(1024);
if (setdata == NULL) {
err = -ENOMEM;
goto exit;
}
ShadowMapBT = rtw_malloc(EFUSE_BT_MAX_MAP_LEN);
if (ShadowMapBT == NULL) {
err = -ENOMEM;
goto exit;
}
ShadowMapWiFi = rtw_malloc(wifimaplen);
if (ShadowMapWiFi == NULL) {
err = -ENOMEM;
goto exit;
}
setrawdata = rtw_malloc(EFUSE_MAX_SIZE);
if (setrawdata == NULL) {
err = -ENOMEM;
goto exit;
}
#ifdef CONFIG_LPS
lps_mode = pwrctrlpriv->power_mgnt;/* keep org value */
rtw_pm_set_lps(padapter, PS_MODE_ACTIVE);
#endif
#ifdef CONFIG_IPS
ips_mode = pwrctrlpriv->ips_mode;/* keep org value */
rtw_pm_set_ips(padapter, IPS_NONE);
#endif
pch = extra;
RTW_INFO("%s: in=%s\n", __FUNCTION__, extra);
i = 0;
while ((token = strsep(&pch, ",")) != NULL) {
if (i > 2)
break;
tmp[i] = token;
i++;
}
/* tmp[0],[1],[2] */
/* wmap,addr,00e04c871200 */
if (strcmp(tmp[0], "wmap") == 0) {
if ((tmp[1] == NULL) || (tmp[2] == NULL)) {
err = -EINVAL;
goto exit;
}
#ifndef RTW_HALMAC
/* unknown bug workaround, need to fix later */
addr = 0x1ff;
rtw_write8(padapter, EFUSE_CTRL + 1, (addr & 0xff));
rtw_msleep_os(10);
rtw_write8(padapter, EFUSE_CTRL + 2, ((addr >> 8) & 0x03));
rtw_msleep_os(10);
rtw_write8(padapter, EFUSE_CTRL + 3, 0x72);
rtw_msleep_os(10);
rtw_read8(padapter, EFUSE_CTRL);
#endif /* RTW_HALMAC */
addr = simple_strtoul(tmp[1], &ptmp, 16);
addr &= 0xFFF;
cnts = strlen(tmp[2]);
if (cnts % 2) {
err = -EINVAL;
goto exit;
}
cnts /= 2;
if (cnts == 0) {
err = -EINVAL;
goto exit;
}
RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr);
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
RTW_INFO("%s: map data=%s\n", __FUNCTION__, tmp[2]);
for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2)
setdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]);
EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE);
if ((addr + cnts) > max_available_len) {
RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts);
err = -EFAULT;
goto exit;
}
if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) {
RTW_INFO("%s: rtw_efuse_map_write error!!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
*extra = 0;
RTW_INFO("%s: after rtw_efuse_map_write to _rtw_memcmp\n", __func__);
if (rtw_efuse_mask_map_read(padapter, addr, cnts, ShadowMapWiFi) == _SUCCESS) {
if (_rtw_memcmp((void *)ShadowMapWiFi , (void *)setdata, cnts)) {
RTW_INFO("%s: WiFi write map afterf compare success\n", __FUNCTION__);
sprintf(extra, "WiFi write map compare OK\n");
err = 0;
goto exit;
} else {
sprintf(extra, "WiFi write map compare FAIL\n");
RTW_INFO("%s: WiFi write map compare Fail\n", __FUNCTION__);
err = 0;
goto exit;
}
}
} else if (strcmp(tmp[0], "wraw") == 0) {
if ((tmp[1] == NULL) || (tmp[2] == NULL)) {
err = -EINVAL;
goto exit;
}
addr = simple_strtoul(tmp[1], &ptmp, 16);
addr &= 0xFFF;
cnts = strlen(tmp[2]);
if (cnts % 2) {
err = -EINVAL;
goto exit;
}
cnts /= 2;
if (cnts == 0) {
err = -EINVAL;
goto exit;
}
RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr);
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
RTW_INFO("%s: raw data=%s\n", __FUNCTION__, tmp[2]);
for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2)
setrawdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]);
if (rtw_efuse_access(padapter, _TRUE, addr, cnts, setrawdata) == _FAIL) {
RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
} else if (strcmp(tmp[0], "btwraw") == 0) {
if ((tmp[1] == NULL) || (tmp[2] == NULL)) {
err = -EINVAL;
goto exit;
}
addr = simple_strtoul(tmp[1], &ptmp, 16);
addr &= 0xFFF;
cnts = strlen(tmp[2]);
if (cnts % 2) {
err = -EINVAL;
goto exit;
}
cnts /= 2;
if (cnts == 0) {
err = -EINVAL;
goto exit;
}
RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr);
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
RTW_INFO("%s: raw data=%s\n", __FUNCTION__, tmp[2]);
for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2)
setrawdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]);
#ifdef RTW_HALMAC
if (rtw_efuse_bt_access(padapter, _TRUE, addr, cnts, setrawdata) == _FAIL) {
RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
#else
rtw_write8(padapter, 0x35, 1); /* switch bank 1 (BT)*/
if (rtw_efuse_access(padapter, _TRUE, addr, cnts, setrawdata) == _FAIL) {
RTW_INFO("%s: rtw_efuse_access error!!\n", __FUNCTION__);
rtw_write8(padapter, 0x35, 0); /* switch bank 0 (WiFi)*/
err = -EFAULT;
goto exit;
}
rtw_write8(padapter, 0x35, 0); /* switch bank 0 (WiFi)*/
#endif
} else if (strcmp(tmp[0], "mac") == 0) {
if (tmp[1] == NULL) {
err = -EINVAL;
goto exit;
}
/* mac,00e04c871200 */
if (hal_efuse_macaddr_offset(padapter) == -1) {
err = -EFAULT;
goto exit;
}
addr = hal_efuse_macaddr_offset(padapter);
cnts = strlen(tmp[1]);
if (cnts % 2) {
err = -EINVAL;
goto exit;
}
cnts /= 2;
if (cnts == 0) {
err = -EINVAL;
goto exit;
}
if (cnts > 6) {
RTW_INFO("%s: error data for mac addr=\"%s\"\n", __FUNCTION__, tmp[1]);
err = -EFAULT;
goto exit;
}
RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr);
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
RTW_INFO("%s: MAC address=%s\n", __FUNCTION__, tmp[1]);
for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2)
setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]);
EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE);
if ((addr + cnts) > max_available_len) {
RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts);
err = -EFAULT;
goto exit;
}
if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) {
RTW_INFO("%s: rtw_efuse_map_write error!!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
} else if (strcmp(tmp[0], "vidpid") == 0) {
if (tmp[1] == NULL) {
err = -EINVAL;
goto exit;
}
/* pidvid,da0b7881 */
#ifdef CONFIG_RTL8188E
#ifdef CONFIG_USB_HCI
addr = EEPROM_VID_88EU;
#endif
#ifdef CONFIG_PCI_HCI
addr = EEPROM_VID_88EE;
#endif
#endif /* CONFIG_RTL8188E */
#ifdef CONFIG_RTL8192E
#ifdef CONFIG_USB_HCI
addr = EEPROM_VID_8192EU;
#endif
#ifdef CONFIG_PCI_HCI
addr = EEPROM_VID_8192EE;
#endif
#endif /* CONFIG_RTL8188E */
#ifdef CONFIG_RTL8723B
addr = EEPROM_VID_8723BU;
#endif
#ifdef CONFIG_RTL8188F
addr = EEPROM_VID_8188FU;
#endif
#ifdef CONFIG_RTL8188GTV
addr = EEPROM_VID_8188GTVU;
#endif
#ifdef CONFIG_RTL8703B
#ifdef CONFIG_USB_HCI
addr = EEPROM_VID_8703BU;
#endif /* CONFIG_USB_HCI */
#endif /* CONFIG_RTL8703B */
#ifdef CONFIG_RTL8723D
#ifdef CONFIG_USB_HCI
addr = EEPROM_VID_8723DU;
#endif /* CONFIG_USB_HCI */
#endif /* CONFIG_RTL8723D */
cnts = strlen(tmp[1]);
if (cnts % 2) {
err = -EINVAL;
goto exit;
}
cnts /= 2;
if (cnts == 0) {
err = -EINVAL;
goto exit;
}
RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr);
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
RTW_INFO("%s: VID/PID=%s\n", __FUNCTION__, tmp[1]);
for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2)
setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]);
EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE);
if ((addr + cnts) > max_available_len) {
RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts);
err = -EFAULT;
goto exit;
}
if (rtw_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) {
RTW_INFO("%s: rtw_efuse_map_write error!!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
} else if (strcmp(tmp[0], "wldumpfake") == 0) {
if (wifimaplen > EFUSE_MAX_MAP_LEN)
cnts = EFUSE_MAX_MAP_LEN;
else
cnts = wifimaplen;
if (rtw_efuse_mask_map_read(padapter, 0, cnts, pEfuseHal->fakeEfuseModifiedMap) == _SUCCESS)
RTW_INFO("%s: WiFi hw efuse dump to Fake map success\n", __func__);
else {
RTW_INFO("%s: WiFi hw efuse dump to Fake map Fail\n", __func__);
err = -EFAULT;
}
} else if (strcmp(tmp[0], "btwmap") == 0) {
rtw_write8(padapter, 0xa3, 0x05); /* For 8723AB ,8821S ? */
BTStatus = rtw_read8(padapter, 0xa0);
RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __FUNCTION__, BTStatus);
if (BTStatus != 0x04) {
sprintf(extra, "BT Status not Active ,can't do Write\n");
goto exit;
}
if ((tmp[1] == NULL) || (tmp[2] == NULL)) {
err = -EINVAL;
goto exit;
}
#ifndef RTW_HALMAC
BTEfuse_PowerSwitch(padapter, 1, _TRUE);
addr = 0x1ff;
rtw_write8(padapter, EFUSE_CTRL + 1, (addr & 0xff));
rtw_msleep_os(10);
rtw_write8(padapter, EFUSE_CTRL + 2, ((addr >> 8) & 0x03));
rtw_msleep_os(10);
rtw_write8(padapter, EFUSE_CTRL + 3, 0x72);
rtw_msleep_os(10);
rtw_read8(padapter, EFUSE_CTRL);
BTEfuse_PowerSwitch(padapter, 1, _FALSE);
#endif /* RTW_HALMAC */
addr = simple_strtoul(tmp[1], &ptmp, 16);
addr &= 0xFFF;
cnts = strlen(tmp[2]);
if (cnts % 2) {
err = -EINVAL;
goto exit;
}
cnts /= 2;
if (cnts == 0) {
err = -EINVAL;
goto exit;
}
RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr);
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
RTW_INFO("%s: BT data=%s\n", __FUNCTION__, tmp[2]);
for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2)
setdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]);
#ifndef RTW_HALMAC
EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE);
if ((addr + cnts) > max_available_len) {
RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts);
err = -EFAULT;
goto exit;
}
#endif
if (rtw_BT_efuse_map_write(padapter, addr, cnts, setdata) == _FAIL) {
RTW_INFO("%s: rtw_BT_efuse_map_write error!!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
*extra = 0;
RTW_INFO("%s: after rtw_BT_efuse_map_write to _rtw_memcmp\n", __FUNCTION__);
if ((rtw_BT_efuse_map_read(padapter, addr, cnts, ShadowMapBT) == _SUCCESS)) {
if (_rtw_memcmp((void *)ShadowMapBT , (void *)setdata, cnts)) {
RTW_INFO("%s: BT write map compare OK BTStatus=0x%x\n", __FUNCTION__, BTStatus);
sprintf(extra, "BT write map compare OK");
err = 0;
goto exit;
} else {
sprintf(extra, "BT write map compare FAIL");
RTW_INFO("%s: BT write map compare FAIL BTStatus=0x%x\n", __FUNCTION__, BTStatus);
err = 0;
goto exit;
}
}
} else if (strcmp(tmp[0], "btwfake") == 0) {
if ((tmp[1] == NULL) || (tmp[2] == NULL)) {
err = -EINVAL;
goto exit;
}
addr = simple_strtoul(tmp[1], &ptmp, 16);
addr &= 0xFFF;
cnts = strlen(tmp[2]);
if (cnts % 2) {
err = -EINVAL;
goto exit;
}
cnts /= 2;
if (cnts == 0) {
err = -EINVAL;
goto exit;
}
RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr);
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
RTW_INFO("%s: BT tmp data=%s\n", __FUNCTION__, tmp[2]);
for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2)
pEfuseHal->fakeBTEfuseModifiedMap[addr + jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]);
} else if (strcmp(tmp[0], "btdumpfake") == 0) {
if (rtw_BT_efuse_map_read(padapter, 0, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _SUCCESS)
RTW_INFO("%s: BT read all map success\n", __FUNCTION__);
else {
RTW_INFO("%s: BT read all map Fail!\n", __FUNCTION__);
err = -EFAULT;
}
} else if (strcmp(tmp[0], "btfk2map") == 0) {
rtw_write8(padapter, 0xa3, 0x05);
BTStatus = rtw_read8(padapter, 0xa0);
RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __FUNCTION__, BTStatus);
if (BTStatus != 0x04) {
sprintf(extra, "BT Status not Active Write FAIL\n");
goto exit;
}
#ifndef RTW_HALMAC
BTEfuse_PowerSwitch(padapter, 1, _TRUE);
addr = 0x1ff;
rtw_write8(padapter, EFUSE_CTRL + 1, (addr & 0xff));
rtw_msleep_os(10);
rtw_write8(padapter, EFUSE_CTRL + 2, ((addr >> 8) & 0x03));
rtw_msleep_os(10);
rtw_write8(padapter, EFUSE_CTRL + 3, 0x72);
rtw_msleep_os(10);
rtw_read8(padapter, EFUSE_CTRL);
BTEfuse_PowerSwitch(padapter, 1, _FALSE);
#endif /* RTW_HALMAC */
_rtw_memcpy(pEfuseHal->BTEfuseModifiedMap, pEfuseHal->fakeBTEfuseModifiedMap, EFUSE_BT_MAX_MAP_LEN);
if (rtw_BT_efuse_map_write(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _FAIL) {
RTW_INFO("%s: rtw_BT_efuse_map_write error!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
RTW_INFO("pEfuseHal->fakeBTEfuseModifiedMap OFFSET\tVALUE(hex)\n");
for (i = 0; i < EFUSE_BT_MAX_MAP_LEN; i += 16) {
printk("0x%02x\t", i);
for (j = 0; j < 8; j++)
printk("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i + j]);
printk("\t");
for (; j < 16; j++)
printk("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i + j]);
printk("\n");
}
printk("\n");
#if 1
err = -EFAULT;
RTW_INFO("%s: rtw_BT_efuse_map_read _rtw_memcmp\n", __FUNCTION__);
if ((rtw_BT_efuse_map_read(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseInitMap) == _SUCCESS)) {
if (_rtw_memcmp((void *)pEfuseHal->fakeBTEfuseModifiedMap, (void *)pEfuseHal->fakeBTEfuseInitMap, EFUSE_BT_MAX_MAP_LEN)) {
sprintf(extra, "BT write map compare OK");
RTW_INFO("%s: BT write map afterf compare success BTStatus=0x%x\n", __FUNCTION__, BTStatus);
err = 0;
goto exit;
} else {
sprintf(extra, "BT write map compare FAIL");
if (rtw_BT_efuse_map_write(padapter, 0x00, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseModifiedMap) == _FAIL)
RTW_INFO("%s: rtw_BT_efuse_map_write compare error,retry = %d!\n", __FUNCTION__, i);
if (rtw_BT_efuse_map_read(padapter, EFUSE_BT, EFUSE_BT_MAX_MAP_LEN, pEfuseHal->fakeBTEfuseInitMap) == _SUCCESS) {
RTW_INFO("pEfuseHal->fakeBTEfuseInitMap OFFSET\tVALUE(hex)\n");
for (i = 0; i < EFUSE_BT_MAX_MAP_LEN; i += 16) {
printk("0x%02x\t", i);
for (j = 0; j < 8; j++)
printk("%02X ", pEfuseHal->fakeBTEfuseInitMap[i + j]);
printk("\t");
for (; j < 16; j++)
printk("%02X ", pEfuseHal->fakeBTEfuseInitMap[i + j]);
printk("\n");
}
printk("\n");
}
RTW_INFO("%s: BT write map afterf compare not match to write efuse try write Map again , BTStatus=0x%x\n", __FUNCTION__, BTStatus);
goto exit;
}
}
#endif
} else if (strcmp(tmp[0], "wlfk2map") == 0) {
*extra = 0;
if (padapter->registrypriv.bFileMaskEfuse != _TRUE && pmp_priv->bloadefusemap == _TRUE) {
RTW_INFO("%s: File eFuse mask file not to be loaded\n", __FUNCTION__);
sprintf(extra, "Not load eFuse mask file yet, Please use the efuse_mask CMD, now remove the interface !!!!\n");
rtw_set_surprise_removed(padapter);
err = 0;
goto exit;
}
if (wifimaplen > EFUSE_MAX_MAP_LEN)
cnts = EFUSE_MAX_MAP_LEN;
else
cnts = wifimaplen;
if (rtw_efuse_map_write(padapter, 0x00, cnts, pEfuseHal->fakeEfuseModifiedMap) == _FAIL) {
RTW_INFO("%s: rtw_efuse_map_write fakeEfuseModifiedMap error!\n", __FUNCTION__);
err = -EFAULT;
goto exit;
}
if (rtw_efuse_mask_map_read(padapter, 0x00, wifimaplen, ShadowMapWiFi) == _SUCCESS) {
addr = 0x00;
err = _TRUE;
for (i = 0; i < cnts; i++) {
if (padapter->registrypriv.boffefusemask == 0) {
if (padapter->registrypriv.bFileMaskEfuse == _TRUE) {
if (rtw_file_efuse_IsMasked(padapter, addr + i) == _TRUE) /*use file efuse mask. */
bcmpchk = _FALSE;
} else {
if (efuse_IsMasked(padapter, addr + i) == _TRUE)
bcmpchk = _FALSE;
}
}
if (bcmpchk == _TRUE) {
RTW_INFO("compare readMapWiFi[0x%02x] = %x, ModifiedMap = %x\n", addr + i, ShadowMapWiFi[ addr + i], pEfuseHal->fakeEfuseModifiedMap[addr + i]);
if (_rtw_memcmp((void *) &ShadowMapWiFi[addr + i], (void *)&pEfuseHal->fakeEfuseModifiedMap[addr + i], 1) == _FALSE){
err = _FALSE;
break;
}
}
bcmpchk = _TRUE;
}
}
if (err) {
RTW_INFO("%s: WiFi write map afterf compare OK\n", __FUNCTION__);
sprintf(extra, "WiFi write map compare OK\n");
err = 0;
goto exit;
} else {
sprintf(extra, "WiFi write map compare FAIL\n");
RTW_INFO("%s: WiFi write map compare Fail\n", __FUNCTION__);
err = 0;
goto exit;
}
} else if (strcmp(tmp[0], "wlwfake") == 0) {
if ((tmp[1] == NULL) || (tmp[2] == NULL)) {
err = -EINVAL;
goto exit;
}
addr = simple_strtoul(tmp[1], &ptmp, 16);
addr &= 0xFFF;
cnts = strlen(tmp[2]);
if (cnts % 2) {
err = -EINVAL;
goto exit;
}
cnts /= 2;
if (cnts == 0) {
err = -EINVAL;
goto exit;
}
RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr);
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
RTW_INFO("%s: map tmp data=%s\n", __FUNCTION__, tmp[2]);
for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2)
pEfuseHal->fakeEfuseModifiedMap[addr + jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]);
_rtw_memset(extra, '\0', strlen(extra));
sprintf(extra, "wlwfake OK\n");
}
else if (strcmp(tmp[0], "wfakemac") == 0) {
if (tmp[1] == NULL) {
err = -EINVAL;
goto exit;
}
/* wfakemac,00e04c871200 */
if (hal_efuse_macaddr_offset(padapter) == -1) {
err = -EFAULT;
goto exit;
}
addr = hal_efuse_macaddr_offset(padapter);
cnts = strlen(tmp[1]);
if (cnts % 2) {
err = -EINVAL;
goto exit;
}
cnts /= 2;
if (cnts == 0) {
err = -EINVAL;
goto exit;
}
if (cnts > 6) {
RTW_INFO("%s: error data for mac addr=\"%s\"\n", __FUNCTION__, tmp[1]);
err = -EFAULT;
goto exit;
}
RTW_INFO("%s: addr=0x%X\n", __FUNCTION__, addr);
RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts);
RTW_INFO("%s: MAC address=%s\n", __FUNCTION__, tmp[1]);
for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2)
pEfuseHal->fakeEfuseModifiedMap[addr + jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]);
_rtw_memset(extra, '\0', strlen(extra));
sprintf(extra, "write mac addr to fake map OK\n");
} else if(strcmp(tmp[0], "update") == 0) {
RTW_INFO("To Use new eFuse map\n");
/*step read efuse/eeprom data and get mac_addr*/
rtw_hal_read_chip_info(padapter);
/* set mac addr*/
rtw_macaddr_cfg(adapter_mac_addr(padapter), get_hal_mac_addr(padapter));
_rtw_memcpy(padapter->pnetdev->dev_addr, get_hal_mac_addr(padapter), ETH_ALEN); /* set mac addr to net_device */
#ifdef CONFIG_P2P
rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter));
#endif
#ifdef CONFIG_MI_WITH_MBSSID_CAM
rtw_hal_change_macaddr_mbid(padapter, adapter_mac_addr(padapter));
#else
rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, adapter_mac_addr(padapter)); /* set mac addr to mac register */
#endif
/*pHalFunc->hal_deinit(padapter);*/
if (pHalFunc->hal_init(padapter) == _FAIL) {
err = -EINVAL;
goto exit;
}
_rtw_memset(extra, '\0', strlen(extra));
sprintf(extra, "eFuse Update OK\n");
} else if (strcmp(tmp[0], "analyze") == 0) {
rtw_efuse_analyze(padapter, EFUSE_WIFI, 0);
_rtw_memset(extra, '\0', strlen(extra));
sprintf(extra, "eFuse Analyze OK,please to check kernel log\n");
}
exit:
if (setdata)
rtw_mfree(setdata, 1024);
if (ShadowMapBT)
rtw_mfree(ShadowMapBT, EFUSE_BT_MAX_MAP_LEN);
if (ShadowMapWiFi)
rtw_mfree(ShadowMapWiFi, wifimaplen);
if (setrawdata)
rtw_mfree(setrawdata, EFUSE_MAX_SIZE);
wrqu->length = strlen(extra);
if (padapter->registrypriv.mp_mode == 0) {
#ifdef CONFIG_IPS
rtw_pm_set_ips(padapter, ips_mode);
#endif /* CONFIG_IPS */
#ifdef CONFIG_LPS
rtw_pm_set_lps(padapter, lps_mode);
#endif /* CONFIG_LPS */
}
return err;
}
static int rtw_wx_tdls_wfd_enable(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
#ifdef CONFIG_WFD
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
if (extra[0] == '0')
rtw_tdls_wfd_enable(padapter, 0);
else
rtw_tdls_wfd_enable(padapter, 1);
#endif /* CONFIG_WFD */
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_weaksec(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
u8 i, j;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
if (extra[0] == '0')
padapter->wdinfo.wfd_tdls_weaksec = 0;
else
padapter->wdinfo.wfd_tdls_weaksec = 1;
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_enable(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
if (extra[0] == '0')
rtw_disable_tdls_func(padapter, _TRUE);
else if (extra[0] == '1')
rtw_enable_tdls_func(padapter);
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_setup(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
u8 i, j;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_txmgmt txmgmt;
#ifdef CONFIG_WFD
struct wifidirect_info *pwdinfo = &(padapter->wdinfo);
#endif /* CONFIG_WFD */
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
if (wrqu->data.length - 1 != 17) {
RTW_INFO("[%s] length:%d != 17\n", __FUNCTION__, (wrqu->data.length - 1));
return ret;
}
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3)
txmgmt.peer[i] = key_2char2num(*(extra + j), *(extra + j + 1));
#ifdef CONFIG_WFD
if (_AES_ != padapter->securitypriv.dot11PrivacyAlgrthm) {
/* Weak Security situation with AP. */
if (0 == pwdinfo->wfd_tdls_weaksec) {
/* Can't send the tdls setup request out!! */
RTW_INFO("[%s] Current link is not AES, "
"SKIP sending the tdls setup request!!\n", __FUNCTION__);
} else
issue_tdls_setup_req(padapter, &txmgmt, _TRUE);
} else
#endif /* CONFIG_WFD */
{
issue_tdls_setup_req(padapter, &txmgmt, _TRUE);
}
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_teardown(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
u8 i, j;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct sta_info *ptdls_sta = NULL;
struct tdls_txmgmt txmgmt;
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
if (wrqu->data.length - 1 != 17 && wrqu->data.length - 1 != 19) {
RTW_INFO("[%s] length:%d != 17 or 19\n",
__FUNCTION__, (wrqu->data.length - 1));
return ret;
}
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
for (i = 0, j = 0; i < ETH_ALEN; i++, j += 3)
txmgmt.peer[i] = key_2char2num(*(extra + j), *(extra + j + 1));
ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), txmgmt.peer);
if (ptdls_sta != NULL) {
txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_;
if (wrqu->data.length - 1 == 19)
issue_tdls_teardown(padapter, &txmgmt, _FALSE);
else
issue_tdls_teardown(padapter, &txmgmt, _TRUE);
} else
RTW_INFO("TDLS peer not found\n");
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_discovery(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_txmgmt txmgmt;
int i = 0, j = 0;
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3)
txmgmt.peer[i] = key_2char2num(*(extra + j), *(extra + j + 1));
issue_tdls_dis_req(padapter, &txmgmt);
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_ch_switch(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
#ifdef CONFIG_TDLS_CH_SW
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info;
u8 i, j;
struct sta_info *ptdls_sta = NULL;
u8 take_care_iqk;
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) {
RTW_INFO("TDLS channel switch is not allowed\n");
return ret;
}
for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3)
pchsw_info->addr[i] = key_2char2num(*(extra + j), *(extra + j + 1));
ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pchsw_info->addr);
if (ptdls_sta == NULL)
return ret;
pchsw_info->ch_sw_state |= TDLS_CH_SW_INITIATOR_STATE;
if (ptdls_sta != NULL) {
if (pchsw_info->off_ch_num == 0)
pchsw_info->off_ch_num = 11;
} else
RTW_INFO("TDLS peer not found\n");
rtw_pm_set_lps(padapter, PS_MODE_ACTIVE);
rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk);
if (take_care_iqk == _TRUE) {
u8 central_chnl;
u8 bw_mode;
bw_mode = (pchsw_info->ch_offset) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20;
central_chnl = rtw_get_center_ch(pchsw_info->off_ch_num, bw_mode, pchsw_info->ch_offset);
if (rtw_hal_ch_sw_iqk_info_search(padapter, central_chnl, bw_mode) >= 0)
rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_START);
else
rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_PREPARE);
} else
rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_START);
/* issue_tdls_ch_switch_req(padapter, ptdls_sta); */
/* RTW_INFO("issue tdls ch switch req\n"); */
#endif /* CONFIG_TDLS_CH_SW */
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_ch_switch_off(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
#ifdef CONFIG_TDLS_CH_SW
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info;
u8 i, j, mac_addr[ETH_ALEN];
struct sta_info *ptdls_sta = NULL;
struct tdls_txmgmt txmgmt;
_rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt));
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
if (rtw_tdls_is_chsw_allowed(padapter) == _FALSE) {
RTW_INFO("TDLS channel switch is not allowed\n");
return ret;
}
if (wrqu->data.length >= 17) {
for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3)
mac_addr[i] = key_2char2num(*(extra + j), *(extra + j + 1));
ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr);
}
if (ptdls_sta == NULL)
return ret;
rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_END_TO_BASE_CHNL);
pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE |
TDLS_CH_SWITCH_ON_STATE |
TDLS_PEER_AT_OFF_STATE);
_rtw_memset(pchsw_info->addr, 0x00, ETH_ALEN);
ptdls_sta->ch_switch_time = 0;
ptdls_sta->ch_switch_timeout = 0;
_cancel_timer_ex(&ptdls_sta->ch_sw_timer);
_cancel_timer_ex(&ptdls_sta->delay_timer);
_cancel_timer_ex(&ptdls_sta->stay_on_base_chnl_timer);
_cancel_timer_ex(&ptdls_sta->ch_sw_monitor_timer);
rtw_pm_set_lps(padapter, PS_MODE_MAX);
#endif /* CONFIG_TDLS_CH_SW */
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_dump_ch(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
#ifdef CONFIG_TDLS_CH_SW
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
RTW_INFO("[%s] dump_stack:%s\n", __FUNCTION__, extra);
extra[wrqu->data.length] = 0x00;
ptdlsinfo->chsw_info.dump_stack = rtw_atoi(extra);
return ret;
#endif
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_off_ch_num(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
#ifdef CONFIG_TDLS_CH_SW
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
RTW_INFO("[%s] off_ch_num:%s\n", __FUNCTION__, extra);
extra[wrqu->data.length] = 0x00;
ptdlsinfo->chsw_info.off_ch_num = rtw_atoi(extra);
return ret;
#endif
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_ch_offset(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
#ifdef CONFIG_TDLS_CH_SW
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
RTW_INFO("[%s] ch_offset:%s\n", __FUNCTION__, extra);
extra[wrqu->data.length] = 0x00;
switch (rtw_atoi(extra)) {
case SCA:
ptdlsinfo->chsw_info.ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER;
break;
case SCB:
ptdlsinfo->chsw_info.ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER;
break;
default:
ptdlsinfo->chsw_info.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
break;
}
return ret;
#endif
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_pson(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u8 i, j, mac_addr[ETH_ALEN];
struct sta_info *ptdls_sta = NULL;
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
for (i = 0, j = 0; i < ETH_ALEN; i++, j += 3)
mac_addr[i] = key_2char2num(*(extra + j), *(extra + j + 1));
ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr);
issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->cmn.mac_addr, 1, 3, 500);
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_psoff(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u8 i, j, mac_addr[ETH_ALEN];
struct sta_info *ptdls_sta = NULL;
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
for (i = 0, j = 0; i < ETH_ALEN; i++, j += 3)
mac_addr[i] = key_2char2num(*(extra + j), *(extra + j + 1));
ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr);
if (ptdls_sta)
issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->cmn.mac_addr, 0, 3, 500);
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_setip(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
#ifdef CONFIG_WFD
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info;
u8 i = 0, j = 0, k = 0, tag = 0;
RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1);
while (i < 4) {
for (j = 0; j < 4; j++) {
if (*(extra + j + tag) == '.' || *(extra + j + tag) == '\0') {
if (j == 1)
pwfd_info->ip_address[i] = convert_ip_addr('0', '0', *(extra + (j - 1) + tag));
if (j == 2)
pwfd_info->ip_address[i] = convert_ip_addr('0', *(extra + (j - 2) + tag), *(extra + (j - 1) + tag));
if (j == 3)
pwfd_info->ip_address[i] = convert_ip_addr(*(extra + (j - 3) + tag), *(extra + (j - 2) + tag), *(extra + (j - 1) + tag));
tag += j + 1;
break;
}
}
i++;
}
RTW_INFO("[%s] Set IP = %u.%u.%u.%u\n", __FUNCTION__,
ptdlsinfo->wfd_info->ip_address[0],
ptdlsinfo->wfd_info->ip_address[1],
ptdlsinfo->wfd_info->ip_address[2],
ptdlsinfo->wfd_info->ip_address[3]);
#endif /* CONFIG_WFD */
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_getip(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
#ifdef CONFIG_WFD
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info;
RTW_INFO("[%s]\n", __FUNCTION__);
sprintf(extra, "\n\n%u.%u.%u.%u\n",
pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1],
pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3]);
RTW_INFO("[%s] IP=%u.%u.%u.%u\n", __FUNCTION__,
pwfd_info->peer_ip_address[0], pwfd_info->peer_ip_address[1],
pwfd_info->peer_ip_address[2], pwfd_info->peer_ip_address[3]);
wrqu->data.length = strlen(extra);
#endif /* CONFIG_WFD */
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_getport(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
#ifdef CONFIG_WFD
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
struct wifi_display_info *pwfd_info = ptdlsinfo->wfd_info;
RTW_INFO("[%s]\n", __FUNCTION__);
sprintf(extra, "\n\n%d\n", pwfd_info->peer_rtsp_ctrlport);
RTW_INFO("[%s] remote port = %d\n",
__FUNCTION__, pwfd_info->peer_rtsp_ctrlport);
wrqu->data.length = strlen(extra);
#endif /* CONFIG_WFD */
#endif /* CONFIG_TDLS */
return ret;
}
/* WFDTDLS, for sigma test */
static int rtw_tdls_dis_result(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
#ifdef CONFIG_WFD
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
RTW_INFO("[%s]\n", __FUNCTION__);
if (ptdlsinfo->dev_discovered == _TRUE) {
sprintf(extra, "\n\nDis=1\n");
ptdlsinfo->dev_discovered = _FALSE;
}
wrqu->data.length = strlen(extra);
#endif /* CONFIG_WFD */
#endif /* CONFIG_TDLS */
return ret;
}
/* WFDTDLS, for sigma test */
static int rtw_wfd_tdls_status(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct tdls_info *ptdlsinfo = &padapter->tdlsinfo;
RTW_INFO("[%s]\n", __FUNCTION__);
sprintf(extra, "\nlink_established:%d\n"
"sta_cnt:%d\n"
"sta_maximum:%d\n"
"cur_channel:%d\n"
"tdls_enable:%d"
#ifdef CONFIG_TDLS_CH_SW
"ch_sw_state:%08x\n"
"chsw_on:%d\n"
"off_ch_num:%d\n"
"cur_time:%d\n"
"ch_offset:%d\n"
"delay_swtich_back:%d"
#endif
,
ptdlsinfo->link_established, ptdlsinfo->sta_cnt,
ptdlsinfo->sta_maximum, ptdlsinfo->cur_channel,
rtw_is_tdls_enabled(padapter)
#ifdef CONFIG_TDLS_CH_SW
,
ptdlsinfo->chsw_info.ch_sw_state,
ATOMIC_READ(&padapter->tdlsinfo.chsw_info.chsw_on),
ptdlsinfo->chsw_info.off_ch_num,
ptdlsinfo->chsw_info.cur_time,
ptdlsinfo->chsw_info.ch_offset,
ptdlsinfo->chsw_info.delay_switch_back
#endif
);
wrqu->data.length = strlen(extra);
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_getsta(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
u8 i, j;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
u8 addr[ETH_ALEN] = {0};
char charmac[17];
struct sta_info *ptdls_sta = NULL;
RTW_INFO("[%s] %s %d\n", __FUNCTION__,
(char *)wrqu->data.pointer, wrqu->data.length - 1);
if (copy_from_user(charmac, wrqu->data.pointer + 9, 17)) {
ret = -EFAULT;
goto exit;
}
RTW_INFO("[%s] %d, charmac:%s\n", __FUNCTION__, __LINE__, charmac);
for (i = 0, j = 0 ; i < ETH_ALEN; i++, j += 3)
addr[i] = key_2char2num(*(charmac + j), *(charmac + j + 1));
RTW_INFO("[%s] %d, charmac:%s, addr:"MAC_FMT"\n",
__FUNCTION__, __LINE__, charmac, MAC_ARG(addr));
ptdls_sta = rtw_get_stainfo(&padapter->stapriv, addr);
if (ptdls_sta) {
sprintf(extra, "\n\ntdls_sta_state=0x%08x\n", ptdls_sta->tdls_sta_state);
RTW_INFO("\n\ntdls_sta_state=%d\n", ptdls_sta->tdls_sta_state);
} else {
sprintf(extra, "\n\nNot found this sta\n");
RTW_INFO("\n\nNot found this sta\n");
}
wrqu->data.length = strlen(extra);
#endif /* CONFIG_TDLS */
exit:
return ret;
}
static int rtw_tdls_get_best_ch(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
#ifdef CONFIG_FIND_BEST_CHANNEL
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter);
u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0;
for (i = 0; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) {
if (rfctl->channel_set[i].ChannelNum == 1)
index_24G = i;
if (rfctl->channel_set[i].ChannelNum == 36)
index_5G = i;
}
for (i = 0; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) {
/* 2.4G */
if (rfctl->channel_set[i].ChannelNum == 6 || rfctl->channel_set[i].ChannelNum == 11) {
if (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_24G].rx_count) {
index_24G = i;
best_channel_24G = rfctl->channel_set[i].ChannelNum;
}
}
/* 5G */
if (rfctl->channel_set[i].ChannelNum >= 36
&& rfctl->channel_set[i].ChannelNum < 140) {
/* Find primary channel */
if (((rfctl->channel_set[i].ChannelNum - 36) % 8 == 0)
&& (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_5G].rx_count)) {
index_5G = i;
best_channel_5G = rfctl->channel_set[i].ChannelNum;
}
}
if (rfctl->channel_set[i].ChannelNum >= 149
&& rfctl->channel_set[i].ChannelNum < 165) {
/* Find primary channel */
if (((rfctl->channel_set[i].ChannelNum - 149) % 8 == 0)
&& (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_5G].rx_count)) {
index_5G = i;
best_channel_5G = rfctl->channel_set[i].ChannelNum;
}
}
#if 1 /* debug */
RTW_INFO("The rx cnt of channel %3d = %d\n",
rfctl->channel_set[i].ChannelNum,
rfctl->channel_set[i].rx_count);
#endif
}
sprintf(extra, "\nbest_channel_24G = %d\n", best_channel_24G);
RTW_INFO("best_channel_24G = %d\n", best_channel_24G);
if (index_5G != 0) {
sprintf(extra, "best_channel_5G = %d\n", best_channel_5G);
RTW_INFO("best_channel_5G = %d\n", best_channel_5G);
}
wrqu->data.length = strlen(extra);
#endif
return 0;
}
static int rtw_tdls(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
RTW_INFO("[%s] extra = %s\n", __FUNCTION__, extra);
if (hal_chk_wl_func(padapter, WL_FUNC_TDLS) == _FALSE) {
RTW_INFO("Discard tdls oper since hal doesn't support tdls\n");
return 0;
}
if (rtw_is_tdls_enabled(padapter) == _FALSE) {
RTW_INFO("TDLS is not enabled\n");
return 0;
}
/* WFD Sigma will use the tdls enable command to let the driver know we want to test the tdls now! */
if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) {
if (_rtw_memcmp(extra, "wfdenable=", 10)) {
wrqu->data.length -= 10;
rtw_wx_tdls_wfd_enable(dev, info, wrqu, &extra[10]);
return ret;
}
}
if (_rtw_memcmp(extra, "weaksec=", 8)) {
wrqu->data.length -= 8;
rtw_tdls_weaksec(dev, info, wrqu, &extra[8]);
return ret;
} else if (_rtw_memcmp(extra, "tdlsenable=", 11)) {
wrqu->data.length -= 11;
rtw_tdls_enable(dev, info, wrqu, &extra[11]);
return ret;
}
if (_rtw_memcmp(extra, "setup=", 6)) {
wrqu->data.length -= 6;
rtw_tdls_setup(dev, info, wrqu, &extra[6]);
} else if (_rtw_memcmp(extra, "tear=", 5)) {
wrqu->data.length -= 5;
rtw_tdls_teardown(dev, info, wrqu, &extra[5]);
} else if (_rtw_memcmp(extra, "dis=", 4)) {
wrqu->data.length -= 4;
rtw_tdls_discovery(dev, info, wrqu, &extra[4]);
} else if (_rtw_memcmp(extra, "swoff=", 6)) {
wrqu->data.length -= 6;
rtw_tdls_ch_switch_off(dev, info, wrqu, &extra[6]);
} else if (_rtw_memcmp(extra, "sw=", 3)) {
wrqu->data.length -= 3;
rtw_tdls_ch_switch(dev, info, wrqu, &extra[3]);
} else if (_rtw_memcmp(extra, "dumpstack=", 10)) {
wrqu->data.length -= 10;
rtw_tdls_dump_ch(dev, info, wrqu, &extra[10]);
} else if (_rtw_memcmp(extra, "offchnum=", 9)) {
wrqu->data.length -= 9;
rtw_tdls_off_ch_num(dev, info, wrqu, &extra[9]);
} else if (_rtw_memcmp(extra, "choffset=", 9)) {
wrqu->data.length -= 9;
rtw_tdls_ch_offset(dev, info, wrqu, &extra[9]);
} else if (_rtw_memcmp(extra, "pson=", 5)) {
wrqu->data.length -= 5;
rtw_tdls_pson(dev, info, wrqu, &extra[5]);
} else if (_rtw_memcmp(extra, "psoff=", 6)) {
wrqu->data.length -= 6;
rtw_tdls_psoff(dev, info, wrqu, &extra[6]);
}
#ifdef CONFIG_WFD
if (hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) {
if (_rtw_memcmp(extra, "setip=", 6)) {
wrqu->data.length -= 6;
rtw_tdls_setip(dev, info, wrqu, &extra[6]);
} else if (_rtw_memcmp(extra, "tprobe=", 6))
issue_tunneled_probe_req((_adapter *)rtw_netdev_priv(dev));
}
#endif /* CONFIG_WFD */
#endif /* CONFIG_TDLS */
return ret;
}
static int rtw_tdls_get(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
#ifdef CONFIG_TDLS
RTW_INFO("[%s] extra = %s\n", __FUNCTION__, (char *) wrqu->data.pointer);
if (_rtw_memcmp(wrqu->data.pointer, "ip", 2))
rtw_tdls_getip(dev, info, wrqu, extra);
else if (_rtw_memcmp(wrqu->data.pointer, "port", 4))
rtw_tdls_getport(dev, info, wrqu, extra);
/* WFDTDLS, for sigma test */
else if (_rtw_memcmp(wrqu->data.pointer, "dis", 3))
rtw_tdls_dis_result(dev, info, wrqu, extra);
else if (_rtw_memcmp(wrqu->data.pointer, "status", 6))
rtw_wfd_tdls_status(dev, info, wrqu, extra);
else if (_rtw_memcmp(wrqu->data.pointer, "tdls_sta=", 9))
rtw_tdls_getsta(dev, info, wrqu, extra);
else if (_rtw_memcmp(wrqu->data.pointer, "best_ch", 7))
rtw_tdls_get_best_ch(dev, info, wrqu, extra);
#endif /* CONFIG_TDLS */
return ret;
}
#ifdef CONFIG_INTEL_WIDI
static int rtw_widi_set(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
process_intel_widi_cmd(padapter, extra);
return ret;
}
static int rtw_widi_set_probe_request(struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
int ret = 0;
u8 *pbuf = NULL;
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
pbuf = rtw_malloc(sizeof(l2_msg_t));
if (pbuf) {
if (copy_from_user(pbuf, wrqu->data.pointer, wrqu->data.length))
ret = -EFAULT;
/* _rtw_memcpy(pbuf, wrqu->data.pointer, wrqu->data.length); */
if (wrqu->data.flags == 0)
intel_widi_wk_cmd(padapter, INTEL_WIDI_ISSUE_PROB_WK, pbuf, sizeof(l2_msg_t));
else if (wrqu->data.flags == 1)
rtw_set_wfd_rds_sink_info(padapter, (l2_msg_t *)pbuf);
}
return ret;
}
#endif /* CONFIG_INTEL_WIDI */
#ifdef CONFIG_MAC_LOOPBACK_DRIVER
#if defined(CONFIG_RTL8188E)
#include <rtl8188e_hal.h>
extern void rtl8188e_cal_txdesc_chksum(struct tx_desc *ptxdesc);
#define cal_txdesc_chksum rtl8188e_cal_txdesc_chksum
#ifdef CONFIG_SDIO_HCI || defined(CONFIG_GSPI_HCI)
extern void rtl8188es_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf);
#define fill_default_txdesc rtl8188es_fill_default_txdesc
#endif /* CONFIG_SDIO_HCI */
#endif /* CONFIG_RTL8188E */
#if defined(CONFIG_RTL8723B)
extern void rtl8723b_cal_txdesc_chksum(struct tx_desc *ptxdesc);
#define cal_txdesc_chksum rtl8723b_cal_txdesc_chksum
extern void rtl8723b_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf);
#define fill_default_txdesc rtl8723b_fill_default_txdesc
#endif /* CONFIG_RTL8723B */
#if defined(CONFIG_RTL8703B)
/* extern void rtl8703b_cal_txdesc_chksum(struct tx_desc *ptxdesc); */
#define cal_txdesc_chksum rtl8703b_cal_txdesc_chksum
/* extern void rtl8703b_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); */
#define fill_default_txdesc rtl8703b_fill_default_txdesc
#endif /* CONFIG_RTL8703B */
#if defined(CONFIG_RTL8723D)
/* extern void rtl8723d_cal_txdesc_chksum(struct tx_desc *ptxdesc); */
#define cal_txdesc_chksum rtl8723d_cal_txdesc_chksum
/* extern void rtl8723d_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); */
#define fill_default_txdesc rtl8723d_fill_default_txdesc
#endif /* CONFIG_RTL8723D */
#if defined(CONFIG_RTL8710B)
#define cal_txdesc_chksum rtl8710b_cal_txdesc_chksum
#define fill_default_txdesc rtl8710b_fill_default_txdesc
#endif /* CONFIG_RTL8710B */
#if defined(CONFIG_RTL8192E)
extern void rtl8192e_cal_txdesc_chksum(struct tx_desc *ptxdesc);
#define cal_txdesc_chksum rtl8192e_cal_txdesc_chksum
#ifdef CONFIG_SDIO_HCI || defined(CONFIG_GSPI_HCI)
extern void rtl8192es_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf);
#define fill_default_txdesc rtl8192es_fill_default_txdesc
#endif /* CONFIG_SDIO_HCI */
#endif /* CONFIG_RTL8192E */
#if defined(CONFIG_RTL8192F)
/* extern void rtl8192f_cal_txdesc_chksum(struct tx_desc *ptxdesc); */
#define cal_txdesc_chksum rtl8192f_cal_txdesc_chksum
/* extern void rtl8192f_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); */
#define fill_default_txdesc rtl8192f_fill_default_txdesc
#endif /* CONFIG_RTL8192F */
static s32 initLoopback(PADAPTER padapter)
{
PLOOPBACKDATA ploopback;
if (padapter->ploopback == NULL) {
ploopback = (PLOOPBACKDATA)rtw_zmalloc(sizeof(LOOPBACKDATA));
if (ploopback == NULL)
return -ENOMEM;
_rtw_init_sema(&ploopback->sema, 0);
ploopback->bstop = _TRUE;
ploopback->cnt = 0;
ploopback->size = 300;
_rtw_memset(ploopback->msg, 0, sizeof(ploopback->msg));
padapter->ploopback = ploopback;
}
return 0;
}
static void freeLoopback(PADAPTER padapter)
{
PLOOPBACKDATA ploopback;
ploopback = padapter->ploopback;
if (ploopback) {
rtw_mfree((u8 *)ploopback, sizeof(LOOPBACKDATA));
padapter->ploopback = NULL;
}
}
static s32 initpseudoadhoc(PADAPTER padapter)
{
NDIS_802_11_NETWORK_INFRASTRUCTURE networkType;
s32 err;
networkType = Ndis802_11IBSS;
err = rtw_set_802_11_infrastructure_mode(padapter, networkType, 0);
if (err == _FALSE)
return _FAIL;
err = rtw_setopmode_cmd(padapter, networkType, RTW_CMDF_WAIT_ACK);
if (err == _FAIL)
return _FAIL;
return _SUCCESS;
}
static s32 createpseudoadhoc(PADAPTER padapter)
{
NDIS_802_11_AUTHENTICATION_MODE authmode;
struct mlme_priv *pmlmepriv;
NDIS_802_11_SSID *passoc_ssid;
WLAN_BSSID_EX *pdev_network;
u8 *pibss;
u8 ssid[] = "pseduo_ad-hoc";
s32 err;
_irqL irqL;
pmlmepriv = &padapter->mlmepriv;
authmode = Ndis802_11AuthModeOpen;
err = rtw_set_802_11_authentication_mode(padapter, authmode);
if (err == _FALSE)
return _FAIL;
passoc_ssid = &pmlmepriv->assoc_ssid;
_rtw_memset(passoc_ssid, 0, sizeof(NDIS_802_11_SSID));
passoc_ssid->SsidLength = sizeof(ssid) - 1;
_rtw_memcpy(passoc_ssid->Ssid, ssid, passoc_ssid->SsidLength);
pdev_network = &padapter->registrypriv.dev_network;
pibss = padapter->registrypriv.dev_network.MacAddress;
_rtw_memcpy(&pdev_network->Ssid, passoc_ssid, sizeof(NDIS_802_11_SSID));
rtw_update_registrypriv_dev_network(padapter);
rtw_generate_random_ibss(pibss);
_enter_critical_bh(&pmlmepriv->lock, &irqL);
/*pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;*/
init_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
_exit_critical_bh(&pmlmepriv->lock, &irqL);
#if 0
err = rtw_create_ibss_cmd(padapter, 0);
if (err == _FAIL)
return _FAIL;
#else
{
struct wlan_network *pcur_network;
struct sta_info *psta;
/* 3 create a new psta */
pcur_network = &pmlmepriv->cur_network;
/* clear psta in the cur_network, if any */
psta = rtw_get_stainfo(&padapter->stapriv, pcur_network->network.MacAddress);
if (psta)
rtw_free_stainfo(padapter, psta);
psta = rtw_alloc_stainfo(&padapter->stapriv, pibss);
if (psta == NULL)
return _FAIL;
/* 3 join psudo AdHoc */
pcur_network->join_res = 1;
pcur_network->aid = psta->cmn.aid = 1;
_rtw_memcpy(&pcur_network->network, pdev_network, get_WLAN_BSSID_EX_sz(pdev_network));
/* set msr to WIFI_FW_ADHOC_STATE */
padapter->hw_port = HW_PORT0;
Set_MSR(padapter, WIFI_FW_ADHOC_STATE);
}
#endif
return _SUCCESS;
}
static struct xmit_frame *createloopbackpkt(PADAPTER padapter, u32 size)
{
struct xmit_priv *pxmitpriv;
struct xmit_frame *pframe;
struct xmit_buf *pxmitbuf;
struct pkt_attrib *pattrib;
struct tx_desc *desc;
u8 *pkt_start, *pkt_end, *ptr;
struct rtw_ieee80211_hdr *hdr;
s32 bmcast;
_irqL irqL;
if ((TXDESC_SIZE + WLANHDR_OFFSET + size) > MAX_XMITBUF_SZ)
return NULL;
pxmitpriv = &padapter->xmitpriv;
pframe = NULL;
/* 2 1. allocate xmit frame */
pframe = rtw_alloc_xmitframe(pxmitpriv);
if (pframe == NULL)
return NULL;
pframe->padapter = padapter;
/* 2 2. allocate xmit buffer */
_enter_critical_bh(&pxmitpriv->lock, &irqL);
pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv);
_exit_critical_bh(&pxmitpriv->lock, &irqL);
if (pxmitbuf == NULL) {
rtw_free_xmitframe(pxmitpriv, pframe);
return NULL;
}
pframe->pxmitbuf = pxmitbuf;
pframe->buf_addr = pxmitbuf->pbuf;
pxmitbuf->priv_data = pframe;
/* 2 3. update_attrib() */
pattrib = &pframe->attrib;
/* init xmitframe attribute */
_rtw_memset(pattrib, 0, sizeof(struct pkt_attrib));
pattrib->ether_type = 0x8723;
_rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN);
_rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
_rtw_memset(pattrib->dst, 0xFF, ETH_ALEN);
_rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN);
/* pattrib->dhcp_pkt = 0;
* pattrib->pktlen = 0; */
pattrib->ack_policy = 0;
/* pattrib->pkt_hdrlen = ETH_HLEN; */
pattrib->hdrlen = WLAN_HDR_A3_LEN;
pattrib->subtype = WIFI_DATA;
pattrib->priority = 0;
pattrib->qsel = pattrib->priority;
/* do_queue_select(padapter, pattrib); */
pattrib->nr_frags = 1;
pattrib->encrypt = 0;
pattrib->bswenc = _FALSE;
pattrib->qos_en = _FALSE;
bmcast = IS_MCAST(pattrib->ra);
if (bmcast)
pattrib->psta = rtw_get_bcmc_stainfo(padapter);
else
pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv));
pattrib->mac_id = pattrib->psta->cmn.mac_id;
pattrib->pktlen = size;
pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->pktlen;
/* 2 4. fill TX descriptor */
desc = (struct tx_desc *)pframe->buf_addr;
_rtw_memset(desc, 0, TXDESC_SIZE);
fill_default_txdesc(pframe, (u8 *)desc);
/* Hw set sequence number */
((PTXDESC)desc)->hwseq_en = 0; /* HWSEQ_EN, 0:disable, 1:enable
* ((PTXDESC)desc)->hwseq_sel = 0; */ /* HWSEQ_SEL */
((PTXDESC)desc)->disdatafb = 1;
/* convert to little endian */
desc->txdw0 = cpu_to_le32(desc->txdw0);
desc->txdw1 = cpu_to_le32(desc->txdw1);
desc->txdw2 = cpu_to_le32(desc->txdw2);
desc->txdw3 = cpu_to_le32(desc->txdw3);
desc->txdw4 = cpu_to_le32(desc->txdw4);
desc->txdw5 = cpu_to_le32(desc->txdw5);
desc->txdw6 = cpu_to_le32(desc->txdw6);
desc->txdw7 = cpu_to_le32(desc->txdw7);
#ifdef CONFIG_PCI_HCI
desc->txdw8 = cpu_to_le32(desc->txdw8);
desc->txdw9 = cpu_to_le32(desc->txdw9);
desc->txdw10 = cpu_to_le32(desc->txdw10);
desc->txdw11 = cpu_to_le32(desc->txdw11);
desc->txdw12 = cpu_to_le32(desc->txdw12);
desc->txdw13 = cpu_to_le32(desc->txdw13);
desc->txdw14 = cpu_to_le32(desc->txdw14);
desc->txdw15 = cpu_to_le32(desc->txdw15);
#endif
cal_txdesc_chksum(desc);
/* 2 5. coalesce */
pkt_start = pframe->buf_addr + TXDESC_SIZE;
pkt_end = pkt_start + pattrib->last_txcmdsz;
/* 3 5.1. make wlan header, make_wlanhdr() */
hdr = (struct rtw_ieee80211_hdr *)pkt_start;
set_frame_sub_type(&hdr->frame_ctl, pattrib->subtype);
_rtw_memcpy(hdr->addr1, pattrib->dst, ETH_ALEN); /* DA */
_rtw_memcpy(hdr->addr2, pattrib->src, ETH_ALEN); /* SA */
_rtw_memcpy(hdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); /* RA, BSSID */
/* 3 5.2. make payload */
ptr = pkt_start + pattrib->hdrlen;
get_random_bytes(ptr, pkt_end - ptr);
pxmitbuf->len = TXDESC_SIZE + pattrib->last_txcmdsz;
pxmitbuf->ptail += pxmitbuf->len;
return pframe;
}
static void freeloopbackpkt(PADAPTER padapter, struct xmit_frame *pframe)
{
struct xmit_priv *pxmitpriv;
struct xmit_buf *pxmitbuf;
pxmitpriv = &padapter->xmitpriv;
pxmitbuf = pframe->pxmitbuf;
rtw_free_xmitframe(pxmitpriv, pframe);
rtw_free_xmitbuf(pxmitpriv, pxmitbuf);
}
static void printdata(u8 *pbuf, u32 len)
{
u32 i, val;
for (i = 0; (i + 4) <= len; i += 4) {
printk("%08X", *(u32 *)(pbuf + i));
if ((i + 4) & 0x1F)
printk(" ");
else
printk("\n");
}
if (i < len) {
#ifdef __BIG_ENDIAN
for (; i < len, i++)
printk("%02X", pbuf + i);
#else /* __LITTLE_ENDIAN */
#if 0
val = 0;
_rtw_memcpy(&val, pbuf + i, len - i);
printk("%8X", val);
#else
u8 str[9];
u8 n;
val = 0;
n = len - i;
_rtw_memcpy(&val, pbuf + i, n);
sprintf(str, "%08X", val);
n = (4 - n) * 2;
printk("%8s", str + n);
#endif
#endif /* __LITTLE_ENDIAN */
}
printk("\n");
}
static u8 pktcmp(PADAPTER padapter, u8 *txbuf, u32 txsz, u8 *rxbuf, u32 rxsz)
{
PHAL_DATA_TYPE phal;
struct recv_stat *prxstat;
struct recv_stat report;
PRXREPORT prxreport;
u32 drvinfosize;
u32 rxpktsize;
u8 fcssize;
u8 ret = _FALSE;
prxstat = (struct recv_stat *)rxbuf;
report.rxdw0 = le32_to_cpu(prxstat->rxdw0);
report.rxdw1 = le32_to_cpu(prxstat->rxdw1);
report.rxdw2 = le32_to_cpu(prxstat->rxdw2);
report.rxdw3 = le32_to_cpu(prxstat->rxdw3);
report.rxdw4 = le32_to_cpu(prxstat->rxdw4);
report.rxdw5 = le32_to_cpu(prxstat->rxdw5);
prxreport = (PRXREPORT)&report;
drvinfosize = prxreport->drvinfosize << 3;
rxpktsize = prxreport->pktlen;
phal = GET_HAL_DATA(padapter);
if (rtw_hal_rcr_check(padapter, RCR_APPFCS))
fcssize = IEEE80211_FCS_LEN;
else
fcssize = 0;
if ((txsz - TXDESC_SIZE) != (rxpktsize - fcssize)) {
RTW_INFO("%s: ERROR! size not match tx/rx=%d/%d !\n",
__func__, txsz - TXDESC_SIZE, rxpktsize - fcssize);
ret = _FALSE;
} else {
ret = _rtw_memcmp(txbuf + TXDESC_SIZE, \
rxbuf + RXDESC_SIZE + drvinfosize, \
txsz - TXDESC_SIZE);
if (ret == _FALSE)
RTW_INFO("%s: ERROR! pkt content mismatch!\n", __func__);
}
if (ret == _FALSE) {
RTW_INFO("\n%s: TX PKT total=%d, desc=%d, content=%d\n",
__func__, txsz, TXDESC_SIZE, txsz - TXDESC_SIZE);
RTW_INFO("%s: TX DESC size=%d\n", __func__, TXDESC_SIZE);
printdata(txbuf, TXDESC_SIZE);
RTW_INFO("%s: TX content size=%d\n", __func__, txsz - TXDESC_SIZE);
printdata(txbuf + TXDESC_SIZE, txsz - TXDESC_SIZE);
RTW_INFO("\n%s: RX PKT read=%d offset=%d(%d,%d) content=%d\n",
__func__, rxsz, RXDESC_SIZE + drvinfosize, RXDESC_SIZE, drvinfosize, rxpktsize);
if (rxpktsize != 0) {
RTW_INFO("%s: RX DESC size=%d\n", __func__, RXDESC_SIZE);
printdata(rxbuf, RXDESC_SIZE);
RTW_INFO("%s: RX drvinfo size=%d\n", __func__, drvinfosize);
printdata(rxbuf + RXDESC_SIZE, drvinfosize);
RTW_INFO("%s: RX content size=%d\n", __func__, rxpktsize);
printdata(rxbuf + RXDESC_SIZE + drvinfosize, rxpktsize);
} else {
RTW_INFO("%s: RX data size=%d\n", __func__, rxsz);
printdata(rxbuf, rxsz);
}
}
return ret;
}
thread_return lbk_thread(thread_context context)
{
s32 err;
PADAPTER padapter;
PLOOPBACKDATA ploopback;
struct xmit_frame *pxmitframe;
u32 cnt, ok, fail, headerlen;
u32 pktsize;
u32 ff_hwaddr;
padapter = (PADAPTER)context;
ploopback = padapter->ploopback;
if (ploopback == NULL)
return -1;
cnt = 0;
ok = 0;
fail = 0;
daemonize("%s", "RTW_LBK_THREAD");
allow_signal(SIGTERM);
do {
if (ploopback->size == 0) {
get_random_bytes(&pktsize, 4);
pktsize = (pktsize % 1535) + 1; /* 1~1535 */
} else
pktsize = ploopback->size;
pxmitframe = createloopbackpkt(padapter, pktsize);
if (pxmitframe == NULL) {
sprintf(ploopback->msg, "loopback FAIL! 3. create Packet FAIL!");
break;
}
ploopback->txsize = TXDESC_SIZE + pxmitframe->attrib.last_txcmdsz;
_rtw_memcpy(ploopback->txbuf, pxmitframe->buf_addr, ploopback->txsize);
ff_hwaddr = rtw_get_ff_hwaddr(pxmitframe);
cnt++;
RTW_INFO("%s: wirte port cnt=%d size=%d\n", __func__, cnt, ploopback->txsize);
pxmitframe->pxmitbuf->pdata = ploopback->txbuf;
rtw_write_port(padapter, ff_hwaddr, ploopback->txsize, (u8 *)pxmitframe->pxmitbuf);
/* wait for rx pkt */
_rtw_down_sema(&ploopback->sema);
err = pktcmp(padapter, ploopback->txbuf, ploopback->txsize, ploopback->rxbuf, ploopback->rxsize);
if (err == _TRUE)
ok++;
else
fail++;
ploopback->txsize = 0;
_rtw_memset(ploopback->txbuf, 0, 0x8000);
ploopback->rxsize = 0;
_rtw_memset(ploopback->rxbuf, 0, 0x8000);
freeloopbackpkt(padapter, pxmitframe);
pxmitframe = NULL;
flush_signals_thread();
if ((ploopback->bstop == _TRUE) ||
((ploopback->cnt != 0) && (ploopback->cnt == cnt))) {
u32 ok_rate, fail_rate, all;
all = cnt;
ok_rate = (ok * 100) / all;
fail_rate = (fail * 100) / all;
sprintf(ploopback->msg, \
"loopback result: ok=%d%%(%d/%d),error=%d%%(%d/%d)", \
ok_rate, ok, all, fail_rate, fail, all);
break;
}
} while (1);
ploopback->bstop = _TRUE;
thread_exit(NULL);
return 0;
}
static void loopbackTest(PADAPTER padapter, u32 cnt, u32 size, u8 *pmsg)
{
PLOOPBACKDATA ploopback;
u32 len;
s32 err;
ploopback = padapter->ploopback;
if (ploopback) {
if (ploopback->bstop == _FALSE) {
ploopback->bstop = _TRUE;
_rtw_up_sema(&ploopback->sema);
}
len = 0;
do {
len = strlen(ploopback->msg);
if (len)
break;
rtw_msleep_os(1);
} while (1);
_rtw_memcpy(pmsg, ploopback->msg, len + 1);
freeLoopback(padapter);
return;
}
/* disable dynamic algorithm */
rtw_phydm_ability_backup(padapter);
rtw_phydm_func_disable_all(padapter);
/* create pseudo ad-hoc connection */
err = initpseudoadhoc(padapter);
if (err == _FAIL) {
sprintf(pmsg, "loopback FAIL! 1.1 init ad-hoc FAIL!");
return;
}
err = createpseudoadhoc(padapter);
if (err == _FAIL) {
sprintf(pmsg, "loopback FAIL! 1.2 create ad-hoc master FAIL!");
return;
}
err = initLoopback(padapter);
if (err) {
sprintf(pmsg, "loopback FAIL! 2. init FAIL! error code=%d", err);
return;
}
ploopback = padapter->ploopback;
ploopback->bstop = _FALSE;
ploopback->cnt = cnt;
ploopback->size = size;
ploopback->lbkthread = kthread_run(lbk_thread, padapter, "RTW_LBK_THREAD");
if (IS_ERR(padapter->lbkthread)) {
freeLoopback(padapter);
ploopback->lbkthread = NULL;
sprintf(pmsg, "loopback start FAIL! cnt=%d", cnt);
return;
}
sprintf(pmsg, "loopback start! cnt=%d", cnt);
}
#endif /* CONFIG_MAC_LOOPBACK_DRIVER */
static int rtw_test(
struct net_device *dev,
struct iw_request_info *info,
union iwreq_data *wrqu, char *extra)
{
u32 len;
u8 *pbuf, *pch;
char *ptmp;
u8 *delim = ",";
PADAPTER padapter = rtw_netdev_priv(dev);
RTW_INFO("+%s\n", __func__);
len = wrqu->data.length;
pbuf = (u8 *)rtw_zmalloc(len + 1);
if (pbuf == NULL) {
RTW_INFO("%s: no memory!\n", __func__);
return -ENOMEM;
}
if (copy_from_user(pbuf, wrqu->data.pointer, len)) {
rtw_mfree(pbuf, len + 1);
RTW_INFO("%s: copy from user fail!\n", __func__);
return -EFAULT;
}
pbuf[len] = '\0';
RTW_INFO("%s: string=\"%s\"\n", __func__, pbuf);
ptmp = (char *)pbuf;
pch = strsep(&ptmp, delim);
if ((pch == NULL) || (strlen(pch) == 0)) {
rtw_mfree(pbuf, len);
RTW_INFO("%s: parameter error(level 1)!\n", __func__);
return -EFAULT;
}
#ifdef CONFIG_MAC_LOOPBACK_DRIVER
if (strcmp(pch, "loopback") == 0) {
s32 cnt = 0;
u32 size = 64;
pch = strsep(&ptmp, delim);
if ((pch == NULL) || (strlen(pch) == 0)) {
rtw_mfree(pbuf, len);
RTW_INFO("%s: parameter error(level 2)!\n", __func__);
return -EFAULT;
}
sscanf(pch, "%d", &cnt);
RTW_INFO("%s: loopback cnt=%d\n", __func__, cnt);
pch = strsep(&ptmp, delim);
if ((pch == NULL) || (strlen(pch) == 0)) {
rtw_mfree(pbuf, len);
RTW_INFO("%s: parameter error(level 2)!\n", __func__);
return -EFAULT;
}
sscanf(pch, "%d", &size);
RTW_INFO("%s: loopback size=%d\n", __func__, size);
loopbackTest(padapter, cnt, size, extra);
wrqu->data.length = strlen(extra) + 1;
goto free_buf;
}
#endif
#ifdef CONFIG_BT_COEXIST
if (strcmp(pch, "bton") == 0) {
rtw_btcoex_SetManualControl(padapter, _FALSE);
goto free_buf;
} else if (strcmp(pch, "btoff") == 0) {
rtw_btcoex_SetManualControl(padapter, _TRUE);
goto free_buf;
}
#endif
if (strcmp(pch, "h2c") == 0) {
u8 param[8];
u8 count = 0;
u32 tmp;
u8 i;
u32 pos;
u8 ret;
do {
pch = strsep(&ptmp, delim);
if ((pch == NULL) || (strlen(pch) == 0))
break;
sscanf(pch, "%x", &tmp);
param[count++] = (u8)tmp;
} while (count < 8);
if (count == 0) {
rtw_mfree(pbuf, len);
RTW_INFO("%s: parameter error(level 2)!\n", __func__);
return -EFAULT;
}
ret = rtw_test_h2c_cmd(padapter, param, count);
pos = sprintf(extra, "H2C ID=0x%02x content=", param[0]);
for (i = 1; i < count; i++)
pos += sprintf(extra + pos, "%02x,", param[i]);
extra[pos] = 0;
pos--;
pos += sprintf(extra + pos, " %s", ret == _FAIL ? "FAIL" : "OK");
wrqu->data.length = strlen(extra) + 1;
goto free_buf;
}
free_buf:
rtw_mfree(pbuf, len);
return 0;
}
static iw_handler rtw_handlers[] = {
NULL, /* SIOCSIWCOMMIT */
rtw_wx_get_name, /* SIOCGIWNAME */
dummy, /* SIOCSIWNWID */
dummy, /* SIOCGIWNWID */
rtw_wx_set_freq, /* SIOCSIWFREQ */
rtw_wx_get_freq, /* SIOCGIWFREQ */
rtw_wx_set_mode, /* SIOCSIWMODE */
rtw_wx_get_mode, /* SIOCGIWMODE */
dummy, /* SIOCSIWSENS */
rtw_wx_get_sens, /* SIOCGIWSENS */
NULL, /* SIOCSIWRANGE */
rtw_wx_get_range, /* SIOCGIWRANGE */
rtw_wx_set_priv, /* SIOCSIWPRIV */
NULL, /* SIOCGIWPRIV */
NULL, /* SIOCSIWSTATS */
NULL, /* SIOCGIWSTATS */
dummy, /* SIOCSIWSPY */
dummy, /* SIOCGIWSPY */
NULL, /* SIOCGIWTHRSPY */
NULL, /* SIOCWIWTHRSPY */
rtw_wx_set_wap, /* SIOCSIWAP */
rtw_wx_get_wap, /* SIOCGIWAP */
rtw_wx_set_mlme, /* request MLME operation; uses struct iw_mlme */
dummy, /* SIOCGIWAPLIST -- depricated */
rtw_wx_set_scan, /* SIOCSIWSCAN */
rtw_wx_get_scan, /* SIOCGIWSCAN */
rtw_wx_set_essid, /* SIOCSIWESSID */
rtw_wx_get_essid, /* SIOCGIWESSID */
dummy, /* SIOCSIWNICKN */
rtw_wx_get_nick, /* SIOCGIWNICKN */
NULL, /* -- hole -- */
NULL, /* -- hole -- */
rtw_wx_set_rate, /* SIOCSIWRATE */
rtw_wx_get_rate, /* SIOCGIWRATE */
rtw_wx_set_rts, /* SIOCSIWRTS */
rtw_wx_get_rts, /* SIOCGIWRTS */
rtw_wx_set_frag, /* SIOCSIWFRAG */
rtw_wx_get_frag, /* SIOCGIWFRAG */
dummy, /* SIOCSIWTXPOW */
dummy, /* SIOCGIWTXPOW */
dummy, /* SIOCSIWRETRY */
rtw_wx_get_retry, /* SIOCGIWRETRY */
rtw_wx_set_enc, /* SIOCSIWENCODE */
rtw_wx_get_enc, /* SIOCGIWENCODE */
dummy, /* SIOCSIWPOWER */
rtw_wx_get_power, /* SIOCGIWPOWER */
NULL, /*---hole---*/
NULL, /*---hole---*/
rtw_wx_set_gen_ie, /* SIOCSIWGENIE */
NULL, /* SIOCGWGENIE */
rtw_wx_set_auth, /* SIOCSIWAUTH */
NULL, /* SIOCGIWAUTH */
rtw_wx_set_enc_ext, /* SIOCSIWENCODEEXT */
NULL, /* SIOCGIWENCODEEXT */
rtw_wx_set_pmkid, /* SIOCSIWPMKSA */
NULL, /*---hole---*/
};
#if WIRELESS_EXT >= 17
static struct iw_statistics *rtw_get_wireless_stats(struct net_device *dev)
{
_adapter *padapter = (_adapter *)rtw_netdev_priv(dev);
struct iw_statistics *piwstats = &padapter->iwstats;
int tmp_level = 0;
int tmp_qual = 0;
int tmp_noise = 0;
if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) != _TRUE) {
piwstats->qual.qual = 0;
piwstats->qual.level = 0;
piwstats->qual.noise = 0;
/* RTW_INFO("No link level:%d, qual:%d, noise:%d\n", tmp_level, tmp_qual, tmp_noise); */
} else {
#ifdef CONFIG_SIGNAL_DISPLAY_DBM
tmp_level = translate_percentage_to_dbm(padapter->recvpriv.signal_strength);
#else
tmp_level = padapter->recvpriv.signal_strength;
#endif
tmp_qual = padapter->recvpriv.signal_qual;
#ifdef CONFIG_BACKGROUND_NOISE_MONITOR
if (IS_NM_ENABLE(padapter)) {
tmp_noise = rtw_noise_measure_curchan(padapter);
#ifndef CONFIG_SIGNAL_DISPLAY_DBM
tmp_noise = translate_dbm_to_percentage(tmp_noise);/*percentage*/
#endif
}
#endif
/* RTW_INFO("level:%d, qual:%d, noise:%d, rssi (%d)\n", tmp_level, tmp_qual, tmp_noise,padapter->recvpriv.rssi); */
piwstats->qual.level = tmp_level;
piwstats->qual.qual = tmp_qual;
piwstats->qual.noise = tmp_noise;
}
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 14))
piwstats->qual.updated = IW_QUAL_ALL_UPDATED ;/* |IW_QUAL_DBM; */
#else
#ifdef RTK_DMP_PLATFORM
/* IW_QUAL_DBM= 0x8, if driver use this flag, wireless extension will show value of dbm. */
/* remove this flag for show percentage 0~100 */
piwstats->qual.updated = 0x07;
#else
piwstats->qual.updated = 0x0f;
#endif
#endif
#ifdef CONFIG_SIGNAL_DISPLAY_DBM
piwstats->qual.updated = piwstats->qual.updated | IW_QUAL_DBM;
#endif
return &padapter->iwstats;
}
#endif
#ifdef CONFIG_WIRELESS_EXT
struct iw_handler_def rtw_handlers_def = {
.standard = rtw_handlers,
.num_standard = sizeof(rtw_handlers) / sizeof(iw_handler),
#if WIRELESS_EXT >= 17
.get_wireless_stats = rtw_get_wireless_stats,
#endif
};
#endif
int rtw_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
{
struct iwreq *wrq = (struct iwreq *)rq;
int ret = 0;
switch (cmd) {
case RTL_IOCTL_WPA_SUPPLICANT:
ret = wpa_supplicant_ioctl(dev, &wrq->u.data);
break;
#ifdef CONFIG_AP_MODE
case RTL_IOCTL_HOSTAPD:
ret = rtw_hostapd_ioctl(dev, &wrq->u.data);
break;
#ifdef CONFIG_WIRELESS_EXT
case SIOCSIWMODE:
ret = rtw_wx_set_mode(dev, NULL, &wrq->u, NULL);
break;
#endif
#endif /* CONFIG_AP_MODE */
default:
ret = -EOPNOTSUPP;
break;
}
return ret;
}
View Git Blame Copy Permalink