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
Linkup_workitem_callback(struct work_struct * work)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
Linkdown_workitem_callback(struct work_struct * work)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
rtw_os_indicate_connect(_adapter * adapter)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 #ifdef CONFIG_RTL8822CS_WIFI_HDF
89 struct rtk_ScannedBssInfo
90 {
91 int signal; /**< Signal strength */
92 signed char freq; /**< Center frequency of the channel where the BSS is located */
93 unsigned char arry[2]; /**< Reserved */
94 unsigned int mgmtLen; /**< Management frame length */
95 struct ieee80211_mgmt *mgmt; /**< Start address of the management frame */
96 };
97
indicate_wx_scan_get_result_event(_adapter * padapter)98 void indicate_wx_scan_get_result_event(_adapter *padapter)
99 {
100 struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter);
101 RT_CHANNEL_INFO *chset = rfctl->channel_set;
102 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
103 _irqL irqL;
104 _list *plist, *phead;
105 _queue *queue = &(pmlmepriv->scanned_queue);
106 struct wlan_network *pnetwork = NULL;
107 u8 ch;
108 u32 cnt=0;
109 int ret = 0;
110 u8 ie_offset;
111 u16 cap;
112 struct rtk_ScannedBssInfo bssInfo;
113 struct WlanChannel channel;
114
115 if (adapter_to_pwrctl(padapter)->brfoffbyhw && rtw_is_drv_stopped(padapter)) {
116 return;
117 }
118 _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
119
120 phead = get_list_head(queue);
121 plist = get_next(phead);
122
123 cnt = 0;
124 while (1)
125 {
126 if (rtw_end_of_queue_search(phead,plist) == _TRUE) {
127 break;
128 }
129
130 pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list);
131 ch = pnetwork->network.Configuration.DSConfig;
132
133 //report network only if the current channel set contains the channel to which this network belongs
134 if(rtw_chset_search_ch(chset, ch) >= 0
135 && rtw_mlme_band_check(padapter, ch) == _TRUE
136 #ifdef CONFIG_VALIDATE_SSID
137 && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid))
138 #endif
139 && (!IS_DFS_SLAVE_WITH_RD(rfctl)
140 || rtw_rfctl_dfs_domain_unknown(rfctl)
141 || !rtw_chset_is_ch_non_ocp(chset, ch))
142 )
143 {
144 if (cnt >= SCAN_AP_LIMIT) {
145 break;
146 }
147
148 channel.channelId = chset[rtw_chset_search_ch(chset, ch)].ChannelNum;
149 channel.flags = ((chset[rtw_chset_search_ch(chset, ch)].flags & RTW_CHF_NO_IR) ? SCAN_PASSIVE : SCAN_ACTIVE);
150 channel.centerFreq = rtw_ch2freq(chset[rtw_chset_search_ch(chset, ch)].ChannelNum);
151
152 bssInfo.signal = pnetwork->network.Rssi;
153 bssInfo.freq = channel.centerFreq;
154
155 bssInfo.arry[0] = pnetwork->network.Reserved[0];
156 if (pnetwork->network.Reserved[0] == BSS_TYPE_BCN) {
157 ie_offset = _BEACON_IE_OFFSET_;
158 } else {
159 if (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_RSP) {
160 ie_offset = _PROBERSP_IE_OFFSET_;
161 } else if (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ) {
162 ie_offset = _PROBEREQ_IE_OFFSET_;
163 } else {
164 ie_offset = _FIXED_IE_LENGTH_;
165 }
166 }
167
168 bssInfo.mgmtLen = sizeof(struct ieee80211_mgmt) + pnetwork->network.IELength - ie_offset;
169
170 bssInfo.mgmt = (struct ieee80211_mgmt*)_rtw_malloc(bssInfo.mgmtLen);
171 _rtw_memset(bssInfo.mgmt, 0, bssInfo.mgmtLen);
172
173 _rtw_memcpy(bssInfo.mgmt->bssid, pnetwork->network.MacAddress, ETH_ALEN);
174
175 bssInfo.mgmt->u.probe_resp.beacon_int = pnetwork->network.Configuration.BeaconPeriod;
176
177 _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2);
178
179 bssInfo.mgmt->u.probe_resp.capab_info = le16_to_cpu(cap);
180
181 _rtw_memcpy(bssInfo.mgmt->u.probe_resp.variable, pnetwork->network.IEs+ie_offset, pnetwork->network.IELength-ie_offset);
182
183 ret = HdfWifiEventInformBssFrame(get_rtl_netdev(), &channel, (struct ScannedBssInfo *)&bssInfo);
184 if (ret != 0) {
185 RTW_ERR("%s, Hdf Wifi Inform Bss Frame fail ret=%d\n",__func__,ret);
186 }
187
188 rtw_mfree(bssInfo.mgmt, bssInfo.mgmtLen);
189 rtw_mdelay_os(1);
190 cnt++;
191
192 }
193
194 plist = get_next(plist);
195 }
196
197 _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL);
198 }
199 #endif
200
201 extern void indicate_wx_scan_complete_event(_adapter *padapter);
rtw_os_indicate_scan_done(_adapter * padapter,bool aborted)202 void rtw_os_indicate_scan_done(_adapter *padapter, bool aborted)
203 {
204 #ifdef CONFIG_RTL8822CS_WIFI_HDF
205 indicate_wx_scan_get_result_event(padapter);
206 #else
207 #ifdef CONFIG_IOCTL_CFG80211
208 rtw_cfg80211_indicate_scan_done(padapter, aborted);
209 #endif
210 #endif
211 indicate_wx_scan_complete_event(padapter);
212 }
213
214 static RT_PMKID_LIST backupPMKIDList[NUM_PMKID_CACHE];
rtw_reset_securitypriv(_adapter * adapter)215 void rtw_reset_securitypriv(_adapter *adapter)
216 {
217 u8 backupPMKIDIndex = 0;
218 u8 backupTKIPCountermeasure = 0x00;
219 u32 backupTKIPcountermeasure_time = 0;
220 /* add for CONFIG_IEEE80211W, none 11w also can use */
221 _irqL irqL;
222
223 _enter_critical_bh(&adapter->security_key_mutex, &irqL);
224
225 if (adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { /* 802.1x */
226 u8 backup_sw_encrypt, backup_sw_decrypt;
227
228 backup_sw_encrypt = adapter->securitypriv.sw_encrypt;
229 backup_sw_decrypt = adapter->securitypriv.sw_decrypt;
230
231 /* Added by Albert 2009/02/18 */
232 /* We have to backup the PMK information for WiFi PMK Caching test item. */
233 /* */
234 /* Backup the btkip_countermeasure information. */
235 /* When the countermeasure is trigger, the driver have to disconnect with AP for 60 seconds. */
236
237 _rtw_memset(&backupPMKIDList[0], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
238
239 _rtw_memcpy(&backupPMKIDList[0], &adapter->securitypriv.PMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
240 backupPMKIDIndex = adapter->securitypriv.PMKIDIndex;
241 backupTKIPCountermeasure = adapter->securitypriv.btkip_countermeasure;
242 backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time;
243 _rtw_memset((unsigned char *)&adapter->securitypriv, 0, sizeof(struct security_priv));
244
245 /* Added by Albert 2009/02/18 */
246 /* Restore the PMK information to securitypriv structure for the following connection. */
247 _rtw_memcpy(&adapter->securitypriv.PMKIDList[0], &backupPMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
248 adapter->securitypriv.PMKIDIndex = backupPMKIDIndex;
249 adapter->securitypriv.btkip_countermeasure = backupTKIPCountermeasure;
250 adapter->securitypriv.btkip_countermeasure_time = backupTKIPcountermeasure_time;
251
252 adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen;
253 adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled;
254
255 adapter->securitypriv.extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE;
256
257 adapter->securitypriv.sw_encrypt = backup_sw_encrypt;
258 adapter->securitypriv.sw_decrypt = backup_sw_decrypt;
259
260 } else { /* reset values in securitypriv */
261 /* if(adapter->mlmepriv.fw_state & WIFI_STATION_STATE) */
262 /* { */
263 struct security_priv *psec_priv = &adapter->securitypriv;
264
265 psec_priv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */
266 psec_priv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
267 psec_priv->dot11PrivacyKeyIndex = 0;
268
269 psec_priv->dot118021XGrpPrivacy = _NO_PRIVACY_;
270 psec_priv->dot118021XGrpKeyid = 1;
271
272 psec_priv->ndisauthtype = Ndis802_11AuthModeOpen;
273 psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled;
274 /* } */
275
276 psec_priv->extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE;
277 }
278 /* add for CONFIG_IEEE80211W, none 11w also can use */
279 _exit_critical_bh(&adapter->security_key_mutex, &irqL);
280
281 RTW_INFO(FUNC_ADPT_FMT" - End to Disconnect\n", FUNC_ADPT_ARG(adapter));
282 }
283
rtw_os_indicate_disconnect(_adapter * adapter,u16 reason,u8 locally_generated)284 void rtw_os_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_generated)
285 {
286 /* RT_PMKID_LIST backupPMKIDList[NUM_PMKID_CACHE]; */
287
288 rtw_netif_carrier_off(adapter->pnetdev); /* Do it first for tx broadcast pkt after disconnection issue! */
289 #ifdef CONFIG_RTL8822CS_WIFI_HDF
290 RTW_INFO("indicate disassoc\n");
291
292 HdfWifiEventDisconnected(get_rtl_netdev(), reason,
293 adapter->mlmepriv.cur_network.network.IEs,adapter->mlmepriv.cur_network.network.IELength);
294 #else
295 #ifdef CONFIG_IOCTL_CFG80211
296 rtw_cfg80211_indicate_disconnect(adapter, reason, locally_generated);
297 #endif /* CONFIG_IOCTL_CFG80211 */
298
299 rtw_indicate_wx_disassoc_event(adapter);
300 #endif
301
302 #ifdef RTK_DMP_PLATFORM
303 _set_workitem(&adapter->mlmepriv.Linkdown_workitem);
304 #endif
305 /* modify for CONFIG_IEEE80211W, none 11w also can use the same command */
306 rtw_reset_securitypriv_cmd(adapter);
307 }
308
rtw_report_sec_ie(_adapter * adapter,u8 authmode,u8 * sec_ie)309 void rtw_report_sec_ie(_adapter *adapter, u8 authmode, u8 *sec_ie)
310 {
311 uint len;
312 u8 *buff, *p, i;
313 union iwreq_data wrqu;
314
315
316
317 buff = NULL;
318 if (authmode == _WPA_IE_ID_) {
319
320 buff = rtw_zmalloc(IW_CUSTOM_MAX);
321 if (NULL == buff) {
322 RTW_INFO(FUNC_ADPT_FMT ": alloc memory FAIL!!\n",
323 FUNC_ADPT_ARG(adapter));
324 return;
325 }
326 p = buff;
327
328 p += sprintf(p, "ASSOCINFO(ReqIEs=");
329
330 len = sec_ie[1] + 2;
331 len = (len < IW_CUSTOM_MAX) ? len : IW_CUSTOM_MAX;
332
333 for (i = 0; i < len; i++)
334 p += sprintf(p, "%02x", sec_ie[i]);
335
336 p += sprintf(p, ")");
337
338 _rtw_memset(&wrqu, 0, sizeof(wrqu));
339
340 wrqu.data.length = p - buff;
341
342 wrqu.data.length = (wrqu.data.length < IW_CUSTOM_MAX) ? wrqu.data.length : IW_CUSTOM_MAX;
343
344 #ifndef CONFIG_IOCTL_CFG80211
345 wireless_send_event(adapter->pnetdev, IWEVCUSTOM, &wrqu, buff);
346 #endif
347
348 rtw_mfree(buff, IW_CUSTOM_MAX);
349 }
350
351
352 }
353
354 #ifdef CONFIG_AP_MODE
355
rtw_indicate_sta_assoc_event(_adapter * padapter,struct sta_info * psta)356 void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta)
357 {
358 union iwreq_data wrqu;
359 struct sta_priv *pstapriv = &padapter->stapriv;
360
361 if (psta == NULL)
362 return;
363
364 if (psta->cmn.aid > pstapriv->max_aid)
365 return;
366
367 if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta)
368 return;
369
370
371 wrqu.addr.sa_family = ARPHRD_ETHER;
372
373 _rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, ETH_ALEN);
374
375 RTW_INFO("+rtw_indicate_sta_assoc_event\n");
376
377 #ifndef CONFIG_IOCTL_CFG80211
378 wireless_send_event(padapter->pnetdev, IWEVREGISTERED, &wrqu, NULL);
379 #endif
380
381 }
382
rtw_indicate_sta_disassoc_event(_adapter * padapter,struct sta_info * psta)383 void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta)
384 {
385 union iwreq_data wrqu;
386 struct sta_priv *pstapriv = &padapter->stapriv;
387
388 if (psta == NULL)
389 return;
390
391 if (psta->cmn.aid > pstapriv->max_aid)
392 return;
393
394 if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta)
395 return;
396
397
398 wrqu.addr.sa_family = ARPHRD_ETHER;
399
400 _rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, ETH_ALEN);
401
402 RTW_INFO("+rtw_indicate_sta_disassoc_event\n");
403
404 #ifndef CONFIG_IOCTL_CFG80211
405 wireless_send_event(padapter->pnetdev, IWEVEXPIRED, &wrqu, NULL);
406 #endif
407
408 }
409
410
411 #ifdef CONFIG_HOSTAPD_MLME
412
mgnt_xmit_entry(struct sk_buff * skb,struct net_device * pnetdev)413 static int mgnt_xmit_entry(struct sk_buff *skb, struct net_device *pnetdev)
414 {
415 struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
416 _adapter *padapter = (_adapter *)phostapdpriv->padapter;
417
418 /* RTW_INFO("%s\n", __FUNCTION__); */
419
420 return rtw_hal_hostap_mgnt_xmit_entry(padapter, skb);
421 }
422
mgnt_netdev_open(struct net_device * pnetdev)423 static int mgnt_netdev_open(struct net_device *pnetdev)
424 {
425 struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
426
427 RTW_INFO("mgnt_netdev_open: MAC Address:" MAC_FMT "\n", MAC_ARG(pnetdev->dev_addr));
428
429
430 init_usb_anchor(&phostapdpriv->anchored);
431
432 rtw_netif_wake_queue(pnetdev);
433
434 rtw_netif_carrier_on(pnetdev);
435
436 /* rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100); */ /* only excluding beacon */
437
438 return 0;
439 }
mgnt_netdev_close(struct net_device * pnetdev)440 static int mgnt_netdev_close(struct net_device *pnetdev)
441 {
442 struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
443
444 RTW_INFO("%s\n", __FUNCTION__);
445
446 usb_kill_anchored_urbs(&phostapdpriv->anchored);
447
448 rtw_netif_carrier_off(pnetdev);
449
450 rtw_netif_stop_queue(pnetdev);
451
452 /* rtw_write16(phostapdpriv->padapter, 0x0116, 0x3f3f); */
453
454 return 0;
455 }
456
457 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29))
458 static const struct net_device_ops rtl871x_mgnt_netdev_ops = {
459 .ndo_open = mgnt_netdev_open,
460 .ndo_stop = mgnt_netdev_close,
461 .ndo_start_xmit = mgnt_xmit_entry,
462 #if 0
463 .ndo_set_mac_address = r871x_net_set_mac_address,
464 .ndo_get_stats = r871x_net_get_stats,
465 .ndo_do_ioctl = r871x_mp_ioctl,
466 #endif
467 };
468 #endif
469
hostapd_mode_init(_adapter * padapter)470 int hostapd_mode_init(_adapter *padapter)
471 {
472 unsigned char mac[ETH_ALEN];
473 struct hostapd_priv *phostapdpriv;
474 struct net_device *pnetdev;
475
476 pnetdev = rtw_alloc_etherdev(sizeof(struct hostapd_priv));
477 if (!pnetdev)
478 return -ENOMEM;
479
480 /* SET_MODULE_OWNER(pnetdev); */
481 ether_setup(pnetdev);
482
483 /* pnetdev->type = ARPHRD_IEEE80211; */
484
485 phostapdpriv = rtw_netdev_priv(pnetdev);
486 phostapdpriv->pmgnt_netdev = pnetdev;
487 phostapdpriv->padapter = padapter;
488 padapter->phostapdpriv = phostapdpriv;
489
490 /* pnetdev->init = NULL; */
491
492 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29))
493
494 RTW_INFO("register rtl871x_mgnt_netdev_ops to netdev_ops\n");
495
496 pnetdev->netdev_ops = &rtl871x_mgnt_netdev_ops;
497
498 #else
499
500 pnetdev->open = mgnt_netdev_open;
501
502 pnetdev->stop = mgnt_netdev_close;
503
504 pnetdev->hard_start_xmit = mgnt_xmit_entry;
505
506 /* pnetdev->set_mac_address = r871x_net_set_mac_address; */
507
508 /* pnetdev->get_stats = r871x_net_get_stats; */
509
510 /* pnetdev->do_ioctl = r871x_mp_ioctl; */
511
512 #endif
513
514 pnetdev->watchdog_timeo = HZ; /* 1 second timeout */
515
516 /* pnetdev->wireless_handlers = NULL; */
517
518
519
520
521 if (dev_alloc_name(pnetdev, "mgnt.wlan%d") < 0)
522 RTW_INFO("hostapd_mode_init(): dev_alloc_name, fail!\n");
523
524
525 /* SET_NETDEV_DEV(pnetdev, pintfpriv->udev); */
526
527
528 mac[0] = 0x00;
529 mac[1] = 0xe0;
530 mac[2] = 0x4c;
531 mac[3] = 0x87;
532 mac[4] = 0x11;
533 mac[5] = 0x12;
534
535 _rtw_memcpy(pnetdev->dev_addr, mac, ETH_ALEN);
536
537
538 rtw_netif_carrier_off(pnetdev);
539
540
541 /* Tell the network stack we exist */
542 if (register_netdev(pnetdev) != 0) {
543 RTW_INFO("hostapd_mode_init(): register_netdev fail!\n");
544
545 if (pnetdev)
546 rtw_free_netdev(pnetdev);
547 }
548
549 return 0;
550
551 }
552
hostapd_mode_unload(_adapter * padapter)553 void hostapd_mode_unload(_adapter *padapter)
554 {
555 struct hostapd_priv *phostapdpriv = padapter->phostapdpriv;
556 struct net_device *pnetdev = phostapdpriv->pmgnt_netdev;
557
558 unregister_netdev(pnetdev);
559 rtw_free_netdev(pnetdev);
560
561 }
562
563 #endif
564 #endif
565