rtl8821ce/os_dep/linux/mlme_linux.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2007 - 2017 Realtek Corporation.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of version 2 of the GNU General Public License as
   7  * published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12  * more details.
  13  *
  14  *****************************************************************************/
  15
  16
  17 #define _MLME_OSDEP_C_
  18
  19 #include <drv_types.h>
  20
  21
  22 #ifdef RTK_DMP_PLATFORM
  23 void Linkup_workitem_callback(struct work_struct *work)
  24 {
  25         struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkup_workitem);
  26         _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv);
  27
  28
  29
  30 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12))
  31         kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKUP);
  32 #else
  33         kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKUP);
  34 #endif
  35
  36 }
  37
  38 void Linkdown_workitem_callback(struct work_struct *work)
  39 {
  40         struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkdown_workitem);
  41         _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv);
  42
  43
  44
  45 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 12))
  46         kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKDOWN);
  47 #else
  48         kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKDOWN);
  49 #endif
  50
  51 }
  52 #endif
  53
  54 extern void rtw_indicate_wx_assoc_event(_adapter *padapter);
  55 extern void rtw_indicate_wx_disassoc_event(_adapter *padapter);
  56
  57 void rtw_os_indicate_connect(_adapter *adapter)
  58 {
  59         struct mlme_priv *pmlmepriv = &(adapter->mlmepriv);
  60
  61 #ifdef CONFIG_IOCTL_CFG80211
  62         if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) ||
  63             (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE))
  64                 rtw_cfg80211_ibss_indicate_connect(adapter);
  65         else
  66                 rtw_cfg80211_indicate_connect(adapter);
  67 #endif /* CONFIG_IOCTL_CFG80211 */
  68
  69         rtw_indicate_wx_assoc_event(adapter);
  70
  71 #ifdef CONFIG_RTW_MESH
  72 #if CONFIG_RTW_MESH_CTO_MGATE_CARRIER
  73         if (!rtw_mesh_cto_mgate_required(adapter))
  74 #endif
  75 #endif
  76                 rtw_netif_carrier_on(adapter->pnetdev);
  77
  78         if (adapter->pid[2] != 0)
  79                 rtw_signal_process(adapter->pid[2], SIGALRM);
  80
  81 #ifdef RTK_DMP_PLATFORM
  82         _set_workitem(&adapter->mlmepriv.Linkup_workitem);
  83 #endif
  84
  85
  86 }
  87
  88 extern void indicate_wx_scan_complete_event(_adapter *padapter);
  89 void rtw_os_indicate_scan_done(_adapter *padapter, bool aborted)
  90 {
  91 #ifdef CONFIG_IOCTL_CFG80211
  92         rtw_cfg80211_indicate_scan_done(padapter, aborted);
  93 #endif
  94         indicate_wx_scan_complete_event(padapter);
  95 }
  96
  97 static RT_PMKID_LIST   backupPMKIDList[NUM_PMKID_CACHE];
  98 void rtw_reset_securitypriv(_adapter *adapter)
  99 {
 100         u8      backupPMKIDIndex = 0;
 101         u8      backupTKIPCountermeasure = 0x00;
 102         u32     backupTKIPcountermeasure_time = 0;
 103         /* add for CONFIG_IEEE80211W, none 11w also can use */
 104         _irqL irqL;
 105
 106         _enter_critical_bh(&adapter->security_key_mutex, &irqL);
 107
 108         if (adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { /* 802.1x */
 109                 /* Added by Albert 2009/02/18 */
 110                 /* We have to backup the PMK information for WiFi PMK Caching test item. */
 111                 /*  */
 112                 /* Backup the btkip_countermeasure information. */
 113                 /* When the countermeasure is trigger, the driver have to disconnect with AP for 60 seconds. */
 114
 115                 _rtw_memset(&backupPMKIDList[0], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
 116
 117                 _rtw_memcpy(&backupPMKIDList[0], &adapter->securitypriv.PMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
 118                 backupPMKIDIndex = adapter->securitypriv.PMKIDIndex;
 119                 backupTKIPCountermeasure = adapter->securitypriv.btkip_countermeasure;
 120                 backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time;
 121                 _rtw_memset((unsigned char *)&adapter->securitypriv, 0, sizeof(struct security_priv));
 122
 123                 /* Added by Albert 2009/02/18 */
 124                 /* Restore the PMK information to securitypriv structure for the following connection. */
 125                 _rtw_memcpy(&adapter->securitypriv.PMKIDList[0], &backupPMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
 126                 adapter->securitypriv.PMKIDIndex = backupPMKIDIndex;
 127                 adapter->securitypriv.btkip_countermeasure = backupTKIPCountermeasure;
 128                 adapter->securitypriv.btkip_countermeasure_time = backupTKIPcountermeasure_time;
 129
 130                 adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen;
 131                 adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled;
 132
 133         } else { /* reset values in securitypriv */
 134                 /* if(adapter->mlmepriv.fw_state & WIFI_STATION_STATE) */
 135                 /* { */
 136                 struct security_priv *psec_priv = &adapter->securitypriv;
 137
 138                 psec_priv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */
 139                 psec_priv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
 140                 psec_priv->dot11PrivacyKeyIndex = 0;
 141
 142                 psec_priv->dot118021XGrpPrivacy = _NO_PRIVACY_;
 143                 psec_priv->dot118021XGrpKeyid = 1;
 144
 145                 psec_priv->ndisauthtype = Ndis802_11AuthModeOpen;
 146                 psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled;
 147                 /* } */
 148         }
 149         /* add for CONFIG_IEEE80211W, none 11w also can use */
 150         _exit_critical_bh(&adapter->security_key_mutex, &irqL);
 151
 152         RTW_INFO(FUNC_ADPT_FMT" - End to Disconnect\n", FUNC_ADPT_ARG(adapter));
 153 }
 154
 155 void rtw_os_indicate_disconnect(_adapter *adapter,  u16 reason, u8 locally_generated)
 156 {
 157         /* RT_PMKID_LIST   backupPMKIDList[NUM_PMKID_CACHE]; */
 158
 159
 160         rtw_netif_carrier_off(adapter->pnetdev); /* Do it first for tx broadcast pkt after disconnection issue! */
 161
 162 #ifdef CONFIG_IOCTL_CFG80211
 163         rtw_cfg80211_indicate_disconnect(adapter,  reason, locally_generated);
 164 #endif /* CONFIG_IOCTL_CFG80211 */
 165
 166         rtw_indicate_wx_disassoc_event(adapter);
 167
 168 #ifdef RTK_DMP_PLATFORM
 169         _set_workitem(&adapter->mlmepriv.Linkdown_workitem);
 170 #endif
 171         /* modify for CONFIG_IEEE80211W, none 11w also can use the same command */
 172         rtw_reset_securitypriv_cmd(adapter);
 173
 174
 175 }
 176
 177 void rtw_report_sec_ie(_adapter *adapter, u8 authmode, u8 *sec_ie)
 178 {
 179         uint    len;
 180         u8      *buff, *p, i;
 181         union iwreq_data wrqu;
 182
 183
 184
 185         buff = NULL;
 186         if (authmode == _WPA_IE_ID_) {
 187
 188                 buff = rtw_zmalloc(IW_CUSTOM_MAX);
 189                 if (NULL == buff) {
 190                         RTW_INFO(FUNC_ADPT_FMT ": alloc memory FAIL!!\n",
 191                                  FUNC_ADPT_ARG(adapter));
 192                         return;
 193                 }
 194                 p = buff;
 195
 196                 p += sprintf(p, "ASSOCINFO(ReqIEs=");
 197
 198                 len = sec_ie[1] + 2;
 199                 len = (len < IW_CUSTOM_MAX) ? len : IW_CUSTOM_MAX;
 200
 201                 for (i = 0; i < len; i++)
 202                         p += sprintf(p, "%02x", sec_ie[i]);
 203
 204                 p += sprintf(p, ")");
 205
 206                 _rtw_memset(&wrqu, 0, sizeof(wrqu));
 207
 208                 wrqu.data.length = p - buff;
 209
 210                 wrqu.data.length = (wrqu.data.length < IW_CUSTOM_MAX) ? wrqu.data.length : IW_CUSTOM_MAX;
 211
 212 #ifndef CONFIG_IOCTL_CFG80211
 213                 wireless_send_event(adapter->pnetdev, IWEVCUSTOM, &wrqu, buff);
 214 #endif
 215
 216                 rtw_mfree(buff, IW_CUSTOM_MAX);
 217         }
 218
 219
 220 }
 221
 222 #ifdef CONFIG_AP_MODE
 223
 224 void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta)
 225 {
 226         union iwreq_data wrqu;
 227         struct sta_priv *pstapriv = &padapter->stapriv;
 228
 229         if (psta == NULL)
 230                 return;
 231
 232         if (psta->cmn.aid > pstapriv->max_aid)
 233                 return;
 234
 235         if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta)
 236                 return;
 237
 238
 239         wrqu.addr.sa_family = ARPHRD_ETHER;
 240
 241         _rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, ETH_ALEN);
 242
 243         RTW_INFO("+rtw_indicate_sta_assoc_event\n");
 244
 245 #ifndef CONFIG_IOCTL_CFG80211
 246         wireless_send_event(padapter->pnetdev, IWEVREGISTERED, &wrqu, NULL);
 247 #endif
 248
 249 }
 250
 251 void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta)
 252 {
 253         union iwreq_data wrqu;
 254         struct sta_priv *pstapriv = &padapter->stapriv;
 255
 256         if (psta == NULL)
 257                 return;
 258
 259         if (psta->cmn.aid > pstapriv->max_aid)
 260                 return;
 261
 262         if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta)
 263                 return;
 264
 265
 266         wrqu.addr.sa_family = ARPHRD_ETHER;
 267
 268         _rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, ETH_ALEN);
 269
 270         RTW_INFO("+rtw_indicate_sta_disassoc_event\n");
 271
 272 #ifndef CONFIG_IOCTL_CFG80211
 273         wireless_send_event(padapter->pnetdev, IWEVEXPIRED, &wrqu, NULL);
 274 #endif
 275
 276 }
 277
 278
 279 #ifdef CONFIG_HOSTAPD_MLME
 280
 281 static int mgnt_xmit_entry(struct sk_buff *skb, struct net_device *pnetdev)
 282 {
 283         struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
 284         _adapter *padapter = (_adapter *)phostapdpriv->padapter;
 285
 286         /* RTW_INFO("%s\n", __FUNCTION__); */
 287
 288         return rtw_hal_hostap_mgnt_xmit_entry(padapter, skb);
 289 }
 290
 291 static int mgnt_netdev_open(struct net_device *pnetdev)
 292 {
 293         struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
 294
 295         RTW_INFO("mgnt_netdev_open: MAC Address:" MAC_FMT "\n", MAC_ARG(pnetdev->dev_addr));
 296
 297
 298         init_usb_anchor(&phostapdpriv->anchored);
 299
 300         rtw_netif_wake_queue(pnetdev);
 301
 302         rtw_netif_carrier_on(pnetdev);
 303
 304         /* rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100); */ /* only excluding beacon */
 305
 306         return 0;
 307 }
 308 static int mgnt_netdev_close(struct net_device *pnetdev)
 309 {
 310         struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
 311
 312         RTW_INFO("%s\n", __FUNCTION__);
 313
 314         usb_kill_anchored_urbs(&phostapdpriv->anchored);
 315
 316         rtw_netif_carrier_off(pnetdev);
 317
 318         rtw_netif_stop_queue(pnetdev);
 319
 320         /* rtw_write16(phostapdpriv->padapter, 0x0116, 0x3f3f); */
 321
 322         return 0;
 323 }
 324
 325 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29))
 326 static const struct net_device_ops rtl871x_mgnt_netdev_ops = {
 327         .ndo_open = mgnt_netdev_open,
 328         .ndo_stop = mgnt_netdev_close,
 329         .ndo_start_xmit = mgnt_xmit_entry,
 330         #if 0
 331         .ndo_set_mac_address = r871x_net_set_mac_address,
 332         .ndo_get_stats = r871x_net_get_stats,
 333         .ndo_do_ioctl = r871x_mp_ioctl,
 334         #endif
 335 };
 336 #endif
 337
 338 int hostapd_mode_init(_adapter *padapter)
 339 {
 340         unsigned char mac[ETH_ALEN];
 341         struct hostapd_priv *phostapdpriv;
 342         struct net_device *pnetdev;
 343
 344         pnetdev = rtw_alloc_etherdev(sizeof(struct hostapd_priv));
 345         if (!pnetdev)
 346                 return -ENOMEM;
 347
 348         /* SET_MODULE_OWNER(pnetdev); */
 349         ether_setup(pnetdev);
 350
 351         /* pnetdev->type = ARPHRD_IEEE80211; */
 352
 353         phostapdpriv = rtw_netdev_priv(pnetdev);
 354         phostapdpriv->pmgnt_netdev = pnetdev;
 355         phostapdpriv->padapter = padapter;
 356         padapter->phostapdpriv = phostapdpriv;
 357
 358         /* pnetdev->init = NULL; */
 359
 360 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29))
 361
 362         RTW_INFO("register rtl871x_mgnt_netdev_ops to netdev_ops\n");
 363
 364         pnetdev->netdev_ops = &rtl871x_mgnt_netdev_ops;
 365
 366 #else
 367
 368         pnetdev->open = mgnt_netdev_open;
 369
 370         pnetdev->stop = mgnt_netdev_close;
 371
 372         pnetdev->hard_start_xmit = mgnt_xmit_entry;
 373
 374         /* pnetdev->set_mac_address = r871x_net_set_mac_address; */
 375
 376         /* pnetdev->get_stats = r871x_net_get_stats; */
 377
 378         /* pnetdev->do_ioctl = r871x_mp_ioctl; */
 379
 380 #endif
 381
 382         pnetdev->watchdog_timeo = HZ; /* 1 second timeout */
 383
 384         /* pnetdev->wireless_handlers = NULL; */
 385
 386
 387
 388
 389         if (dev_alloc_name(pnetdev, "mgnt.wlan%d") < 0)
 390                 RTW_INFO("hostapd_mode_init(): dev_alloc_name, fail!\n");
 391
 392
 393         /* SET_NETDEV_DEV(pnetdev, pintfpriv->udev); */
 394
 395
 396         mac[0] = 0x00;
 397         mac[1] = 0xe0;
 398         mac[2] = 0x4c;
 399         mac[3] = 0x87;
 400         mac[4] = 0x11;
 401         mac[5] = 0x12;
 402
 403         _rtw_memcpy(pnetdev->dev_addr, mac, ETH_ALEN);
 404
 405
 406         rtw_netif_carrier_off(pnetdev);
 407
 408
 409         /* Tell the network stack we exist */
 410         if (register_netdev(pnetdev) != 0) {
 411                 RTW_INFO("hostapd_mode_init(): register_netdev fail!\n");
 412
 413                 if (pnetdev)
 414                         rtw_free_netdev(pnetdev);
 415         }
 416
 417         return 0;
 418
 419 }
 420
 421 void hostapd_mode_unload(_adapter *padapter)
 422 {
 423         struct hostapd_priv *phostapdpriv = padapter->phostapdpriv;
 424         struct net_device *pnetdev = phostapdpriv->pmgnt_netdev;
 425
 426         unregister_netdev(pnetdev);
 427         rtw_free_netdev(pnetdev);
 428
 429 }
 430
 431 #endif
 432 #endif