mirror of
https://github.com/morrownr/8821cu-20210916.git
synced 2024-12-23 06:42:50 +00:00
445 lines
11 KiB
C
445 lines
11 KiB
C
|
/******************************************************************************
|
||
|
*
|
||
|
* 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 _MLME_OSDEP_C_
|
||
|
|
||
|
#include <drv_types.h>
|
||
|
|
||
|
|
||
|
#ifdef RTK_DMP_PLATFORM
|
||
|
void Linkup_workitem_callback(struct work_struct *work)
|
||
|
{
|
||
|
struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkup_workitem);
|
||
|
_adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv);
|
||
|
|
||
|
|
||
|
|
||
|
#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12))
|
||
|
kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKUP);
|
||
|
#else
|
||
|
kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKUP);
|
||
|
#endif
|
||
|
|
||
|
}
|
||
|
|
||
|
void Linkdown_workitem_callback(struct work_struct *work)
|
||
|
{
|
||
|
struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkdown_workitem);
|
||
|
_adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv);
|
||
|
|
||
|
|
||
|
|
||
|
#if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12))
|
||
|
kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKDOWN);
|
||
|
#else
|
||
|
kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKDOWN);
|
||
|
#endif
|
||
|
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
extern void rtw_indicate_wx_assoc_event(_adapter *padapter);
|
||
|
extern void rtw_indicate_wx_disassoc_event(_adapter *padapter);
|
||
|
|
||
|
void rtw_os_indicate_connect(_adapter *adapter)
|
||
|
{
|
||
|
struct mlme_priv *pmlmepriv = &(adapter->mlmepriv);
|
||
|
|
||
|
#ifdef CONFIG_IOCTL_CFG80211
|
||
|
if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) ||
|
||
|
(check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE))
|
||
|
rtw_cfg80211_ibss_indicate_connect(adapter);
|
||
|
else
|
||
|
rtw_cfg80211_indicate_connect(adapter);
|
||
|
#endif /* CONFIG_IOCTL_CFG80211 */
|
||
|
|
||
|
rtw_indicate_wx_assoc_event(adapter);
|
||
|
|
||
|
#ifdef CONFIG_RTW_MESH
|
||
|
#if CONFIG_RTW_MESH_CTO_MGATE_CARRIER
|
||
|
if (!rtw_mesh_cto_mgate_required(adapter))
|
||
|
#endif
|
||
|
#endif
|
||
|
rtw_netif_carrier_on(adapter->pnetdev);
|
||
|
|
||
|
if (adapter->pid[2] != 0)
|
||
|
rtw_signal_process(adapter->pid[2], SIGALRM);
|
||
|
|
||
|
#ifdef RTK_DMP_PLATFORM
|
||
|
_set_workitem(&adapter->mlmepriv.Linkup_workitem);
|
||
|
#endif
|
||
|
|
||
|
|
||
|
}
|
||
|
|
||
|
extern void indicate_wx_scan_complete_event(_adapter *padapter);
|
||
|
void rtw_os_indicate_scan_done(_adapter *padapter, bool aborted)
|
||
|
{
|
||
|
#ifdef CONFIG_IOCTL_CFG80211
|
||
|
rtw_cfg80211_indicate_scan_done(padapter, aborted);
|
||
|
#endif
|
||
|
indicate_wx_scan_complete_event(padapter);
|
||
|
}
|
||
|
|
||
|
static RT_PMKID_LIST backupPMKIDList[NUM_PMKID_CACHE];
|
||
|
void rtw_reset_securitypriv(_adapter *adapter)
|
||
|
{
|
||
|
u8 backupPMKIDIndex = 0;
|
||
|
u8 backupTKIPCountermeasure = 0x00;
|
||
|
u32 backupTKIPcountermeasure_time = 0;
|
||
|
/* add for CONFIG_IEEE80211W, none 11w also can use */
|
||
|
_irqL irqL;
|
||
|
|
||
|
_enter_critical_bh(&adapter->security_key_mutex, &irqL);
|
||
|
|
||
|
if (adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { /* 802.1x */
|
||
|
u8 backup_sw_encrypt, backup_sw_decrypt;
|
||
|
|
||
|
backup_sw_encrypt = adapter->securitypriv.sw_encrypt;
|
||
|
backup_sw_decrypt = adapter->securitypriv.sw_decrypt;
|
||
|
|
||
|
/* Added by Albert 2009/02/18 */
|
||
|
/* We have to backup the PMK information for WiFi PMK Caching test item. */
|
||
|
/* */
|
||
|
/* Backup the btkip_countermeasure information. */
|
||
|
/* When the countermeasure is trigger, the driver have to disconnect with AP for 60 seconds. */
|
||
|
|
||
|
_rtw_memset(&backupPMKIDList[0], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
|
||
|
|
||
|
_rtw_memcpy(&backupPMKIDList[0], &adapter->securitypriv.PMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
|
||
|
backupPMKIDIndex = adapter->securitypriv.PMKIDIndex;
|
||
|
backupTKIPCountermeasure = adapter->securitypriv.btkip_countermeasure;
|
||
|
backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time;
|
||
|
_rtw_memset((unsigned char *)&adapter->securitypriv, 0, sizeof(struct security_priv));
|
||
|
|
||
|
/* Added by Albert 2009/02/18 */
|
||
|
/* Restore the PMK information to securitypriv structure for the following connection. */
|
||
|
_rtw_memcpy(&adapter->securitypriv.PMKIDList[0], &backupPMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
|
||
|
adapter->securitypriv.PMKIDIndex = backupPMKIDIndex;
|
||
|
adapter->securitypriv.btkip_countermeasure = backupTKIPCountermeasure;
|
||
|
adapter->securitypriv.btkip_countermeasure_time = backupTKIPcountermeasure_time;
|
||
|
|
||
|
adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen;
|
||
|
adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled;
|
||
|
|
||
|
adapter->securitypriv.extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE;
|
||
|
|
||
|
adapter->securitypriv.sw_encrypt = backup_sw_encrypt;
|
||
|
adapter->securitypriv.sw_decrypt = backup_sw_decrypt;
|
||
|
|
||
|
} else { /* reset values in securitypriv */
|
||
|
/* if(adapter->mlmepriv.fw_state & WIFI_STATION_STATE) */
|
||
|
/* { */
|
||
|
struct security_priv *psec_priv = &adapter->securitypriv;
|
||
|
|
||
|
psec_priv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */
|
||
|
psec_priv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
|
||
|
psec_priv->dot11PrivacyKeyIndex = 0;
|
||
|
|
||
|
psec_priv->dot118021XGrpPrivacy = _NO_PRIVACY_;
|
||
|
psec_priv->dot118021XGrpKeyid = 1;
|
||
|
|
||
|
psec_priv->ndisauthtype = Ndis802_11AuthModeOpen;
|
||
|
psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled;
|
||
|
/* } */
|
||
|
|
||
|
psec_priv->extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE;
|
||
|
}
|
||
|
/* add for CONFIG_IEEE80211W, none 11w also can use */
|
||
|
_exit_critical_bh(&adapter->security_key_mutex, &irqL);
|
||
|
|
||
|
RTW_INFO(FUNC_ADPT_FMT" - End to Disconnect\n", FUNC_ADPT_ARG(adapter));
|
||
|
}
|
||
|
|
||
|
void rtw_os_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_generated)
|
||
|
{
|
||
|
/* RT_PMKID_LIST backupPMKIDList[NUM_PMKID_CACHE]; */
|
||
|
|
||
|
|
||
|
rtw_netif_carrier_off(adapter->pnetdev); /* Do it first for tx broadcast pkt after disconnection issue! */
|
||
|
|
||
|
#ifdef CONFIG_IOCTL_CFG80211
|
||
|
rtw_cfg80211_indicate_disconnect(adapter, reason, locally_generated);
|
||
|
#endif /* CONFIG_IOCTL_CFG80211 */
|
||
|
|
||
|
rtw_indicate_wx_disassoc_event(adapter);
|
||
|
|
||
|
#ifdef RTK_DMP_PLATFORM
|
||
|
_set_workitem(&adapter->mlmepriv.Linkdown_workitem);
|
||
|
#endif
|
||
|
/* modify for CONFIG_IEEE80211W, none 11w also can use the same command */
|
||
|
rtw_reset_securitypriv_cmd(adapter);
|
||
|
|
||
|
|
||
|
}
|
||
|
|
||
|
void rtw_report_sec_ie(_adapter *adapter, u8 authmode, u8 *sec_ie)
|
||
|
{
|
||
|
uint len;
|
||
|
u8 *buff, *p, i;
|
||
|
union iwreq_data wrqu;
|
||
|
|
||
|
|
||
|
|
||
|
buff = NULL;
|
||
|
if (authmode == _WPA_IE_ID_) {
|
||
|
|
||
|
buff = rtw_zmalloc(IW_CUSTOM_MAX);
|
||
|
if (NULL == buff) {
|
||
|
RTW_INFO(FUNC_ADPT_FMT ": alloc memory FAIL!!\n",
|
||
|
FUNC_ADPT_ARG(adapter));
|
||
|
return;
|
||
|
}
|
||
|
p = buff;
|
||
|
|
||
|
p += sprintf(p, "ASSOCINFO(ReqIEs=");
|
||
|
|
||
|
len = sec_ie[1] + 2;
|
||
|
len = (len < IW_CUSTOM_MAX) ? len : IW_CUSTOM_MAX;
|
||
|
|
||
|
for (i = 0; i < len; i++)
|
||
|
p += sprintf(p, "%02x", sec_ie[i]);
|
||
|
|
||
|
p += sprintf(p, ")");
|
||
|
|
||
|
_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;
|
||
|
|
||
|
#ifndef CONFIG_IOCTL_CFG80211
|
||
|
wireless_send_event(adapter->pnetdev, IWEVCUSTOM, &wrqu, buff);
|
||
|
#endif
|
||
|
|
||
|
rtw_mfree(buff, IW_CUSTOM_MAX);
|
||
|
}
|
||
|
|
||
|
|
||
|
}
|
||
|
|
||
|
#ifdef CONFIG_AP_MODE
|
||
|
|
||
|
void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta)
|
||
|
{
|
||
|
union iwreq_data wrqu;
|
||
|
struct sta_priv *pstapriv = &padapter->stapriv;
|
||
|
|
||
|
if (psta == NULL)
|
||
|
return;
|
||
|
|
||
|
if (psta->cmn.aid > pstapriv->max_aid)
|
||
|
return;
|
||
|
|
||
|
if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta)
|
||
|
return;
|
||
|
|
||
|
|
||
|
wrqu.addr.sa_family = ARPHRD_ETHER;
|
||
|
|
||
|
_rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, ETH_ALEN);
|
||
|
|
||
|
RTW_INFO("+rtw_indicate_sta_assoc_event\n");
|
||
|
|
||
|
#ifndef CONFIG_IOCTL_CFG80211
|
||
|
wireless_send_event(padapter->pnetdev, IWEVREGISTERED, &wrqu, NULL);
|
||
|
#endif
|
||
|
|
||
|
}
|
||
|
|
||
|
void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta)
|
||
|
{
|
||
|
union iwreq_data wrqu;
|
||
|
struct sta_priv *pstapriv = &padapter->stapriv;
|
||
|
|
||
|
if (psta == NULL)
|
||
|
return;
|
||
|
|
||
|
if (psta->cmn.aid > pstapriv->max_aid)
|
||
|
return;
|
||
|
|
||
|
if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta)
|
||
|
return;
|
||
|
|
||
|
|
||
|
wrqu.addr.sa_family = ARPHRD_ETHER;
|
||
|
|
||
|
_rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, ETH_ALEN);
|
||
|
|
||
|
RTW_INFO("+rtw_indicate_sta_disassoc_event\n");
|
||
|
|
||
|
#ifndef CONFIG_IOCTL_CFG80211
|
||
|
wireless_send_event(padapter->pnetdev, IWEVEXPIRED, &wrqu, NULL);
|
||
|
#endif
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
#ifdef CONFIG_HOSTAPD_MLME
|
||
|
|
||
|
static int mgnt_xmit_entry(struct sk_buff *skb, struct net_device *pnetdev)
|
||
|
{
|
||
|
struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
|
||
|
_adapter *padapter = (_adapter *)phostapdpriv->padapter;
|
||
|
|
||
|
/* RTW_INFO("%s\n", __FUNCTION__); */
|
||
|
|
||
|
return rtw_hal_hostap_mgnt_xmit_entry(padapter, skb);
|
||
|
}
|
||
|
|
||
|
static int mgnt_netdev_open(struct net_device *pnetdev)
|
||
|
{
|
||
|
struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
|
||
|
|
||
|
RTW_INFO("mgnt_netdev_open: MAC Address:" MAC_FMT "\n", MAC_ARG(pnetdev->dev_addr));
|
||
|
|
||
|
|
||
|
init_usb_anchor(&phostapdpriv->anchored);
|
||
|
|
||
|
rtw_netif_wake_queue(pnetdev);
|
||
|
|
||
|
rtw_netif_carrier_on(pnetdev);
|
||
|
|
||
|
/* rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100); */ /* only excluding beacon */
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
static int mgnt_netdev_close(struct net_device *pnetdev)
|
||
|
{
|
||
|
struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
|
||
|
|
||
|
RTW_INFO("%s\n", __FUNCTION__);
|
||
|
|
||
|
usb_kill_anchored_urbs(&phostapdpriv->anchored);
|
||
|
|
||
|
rtw_netif_carrier_off(pnetdev);
|
||
|
|
||
|
rtw_netif_stop_queue(pnetdev);
|
||
|
|
||
|
/* rtw_write16(phostapdpriv->padapter, 0x0116, 0x3f3f); */
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29))
|
||
|
static const struct net_device_ops rtl871x_mgnt_netdev_ops = {
|
||
|
.ndo_open = mgnt_netdev_open,
|
||
|
.ndo_stop = mgnt_netdev_close,
|
||
|
.ndo_start_xmit = mgnt_xmit_entry,
|
||
|
#if 0
|
||
|
.ndo_set_mac_address = r871x_net_set_mac_address,
|
||
|
.ndo_get_stats = r871x_net_get_stats,
|
||
|
.ndo_do_ioctl = r871x_mp_ioctl,
|
||
|
#endif
|
||
|
};
|
||
|
#endif
|
||
|
|
||
|
int hostapd_mode_init(_adapter *padapter)
|
||
|
{
|
||
|
unsigned char mac[ETH_ALEN];
|
||
|
struct hostapd_priv *phostapdpriv;
|
||
|
struct net_device *pnetdev;
|
||
|
|
||
|
pnetdev = rtw_alloc_etherdev(sizeof(struct hostapd_priv));
|
||
|
if (!pnetdev)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
/* SET_MODULE_OWNER(pnetdev); */
|
||
|
ether_setup(pnetdev);
|
||
|
|
||
|
/* pnetdev->type = ARPHRD_IEEE80211; */
|
||
|
|
||
|
phostapdpriv = rtw_netdev_priv(pnetdev);
|
||
|
phostapdpriv->pmgnt_netdev = pnetdev;
|
||
|
phostapdpriv->padapter = padapter;
|
||
|
padapter->phostapdpriv = phostapdpriv;
|
||
|
|
||
|
/* pnetdev->init = NULL; */
|
||
|
|
||
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29))
|
||
|
|
||
|
RTW_INFO("register rtl871x_mgnt_netdev_ops to netdev_ops\n");
|
||
|
|
||
|
pnetdev->netdev_ops = &rtl871x_mgnt_netdev_ops;
|
||
|
|
||
|
#else
|
||
|
|
||
|
pnetdev->open = mgnt_netdev_open;
|
||
|
|
||
|
pnetdev->stop = mgnt_netdev_close;
|
||
|
|
||
|
pnetdev->hard_start_xmit = mgnt_xmit_entry;
|
||
|
|
||
|
/* pnetdev->set_mac_address = r871x_net_set_mac_address; */
|
||
|
|
||
|
/* pnetdev->get_stats = r871x_net_get_stats; */
|
||
|
|
||
|
/* pnetdev->do_ioctl = r871x_mp_ioctl; */
|
||
|
|
||
|
#endif
|
||
|
|
||
|
pnetdev->watchdog_timeo = HZ; /* 1 second timeout */
|
||
|
|
||
|
/* pnetdev->wireless_handlers = NULL; */
|
||
|
|
||
|
|
||
|
|
||
|
|
||
|
if (dev_alloc_name(pnetdev, "mgnt.wlan%d") < 0)
|
||
|
RTW_INFO("hostapd_mode_init(): dev_alloc_name, fail!\n");
|
||
|
|
||
|
|
||
|
/* SET_NETDEV_DEV(pnetdev, pintfpriv->udev); */
|
||
|
|
||
|
|
||
|
mac[0] = 0x00;
|
||
|
mac[1] = 0xe0;
|
||
|
mac[2] = 0x4c;
|
||
|
mac[3] = 0x87;
|
||
|
mac[4] = 0x11;
|
||
|
mac[5] = 0x12;
|
||
|
|
||
|
_rtw_memcpy(pnetdev->dev_addr, mac, ETH_ALEN);
|
||
|
|
||
|
|
||
|
rtw_netif_carrier_off(pnetdev);
|
||
|
|
||
|
|
||
|
/* Tell the network stack we exist */
|
||
|
if (register_netdev(pnetdev) != 0) {
|
||
|
RTW_INFO("hostapd_mode_init(): register_netdev fail!\n");
|
||
|
|
||
|
if (pnetdev)
|
||
|
rtw_free_netdev(pnetdev);
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
}
|
||
|
|
||
|
void hostapd_mode_unload(_adapter *padapter)
|
||
|
{
|
||
|
struct hostapd_priv *phostapdpriv = padapter->phostapdpriv;
|
||
|
struct net_device *pnetdev = phostapdpriv->pmgnt_netdev;
|
||
|
|
||
|
unregister_netdev(pnetdev);
|
||
|
rtw_free_netdev(pnetdev);
|
||
|
|
||
|
}
|
||
|
|
||
|
#endif
|
||
|
#endif
|