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 extern void indicate_wx_scan_complete_event(_adapter *padapter);
rtw_os_indicate_scan_done(_adapter * padapter,bool aborted)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];
rtw_reset_securitypriv(_adapter * adapter)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 u8 backup_sw_encrypt, backup_sw_decrypt;
110
111 backup_sw_encrypt = adapter->securitypriv.sw_encrypt;
112 backup_sw_decrypt = adapter->securitypriv.sw_decrypt;
113
114 /* Added by Albert 2009/02/18 */
115 /* We have to backup the PMK information for WiFi PMK Caching test item. */
116 /* */
117 /* Backup the btkip_countermeasure information. */
118 /* When the countermeasure is trigger, the driver have to disconnect with AP for 60 seconds. */
119
120 _rtw_memset(&backupPMKIDList[0], 0x00, sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
121
122 _rtw_memcpy(&backupPMKIDList[0], &adapter->securitypriv.PMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
123 backupPMKIDIndex = adapter->securitypriv.PMKIDIndex;
124 backupTKIPCountermeasure = adapter->securitypriv.btkip_countermeasure;
125 backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time;
126 _rtw_memset((unsigned char *)&adapter->securitypriv, 0, sizeof(struct security_priv));
127
128 /* Added by Albert 2009/02/18 */
129 /* Restore the PMK information to securitypriv structure for the following connection. */
130 _rtw_memcpy(&adapter->securitypriv.PMKIDList[0], &backupPMKIDList[0], sizeof(RT_PMKID_LIST) * NUM_PMKID_CACHE);
131 adapter->securitypriv.PMKIDIndex = backupPMKIDIndex;
132 adapter->securitypriv.btkip_countermeasure = backupTKIPCountermeasure;
133 adapter->securitypriv.btkip_countermeasure_time = backupTKIPcountermeasure_time;
134
135 adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen;
136 adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled;
137
138 adapter->securitypriv.extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE;
139
140 adapter->securitypriv.sw_encrypt = backup_sw_encrypt;
141 adapter->securitypriv.sw_decrypt = backup_sw_decrypt;
142
143 } else { /* reset values in securitypriv */
144 /* if(adapter->mlmepriv.fw_state & WIFI_STATION_STATE) */
145 /* { */
146 struct security_priv *psec_priv = &adapter->securitypriv;
147
148 psec_priv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */
149 psec_priv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
150 psec_priv->dot11PrivacyKeyIndex = 0;
151
152 psec_priv->dot118021XGrpPrivacy = _NO_PRIVACY_;
153 psec_priv->dot118021XGrpKeyid = 1;
154
155 psec_priv->ndisauthtype = Ndis802_11AuthModeOpen;
156 psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled;
157 /* } */
158
159 psec_priv->extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE;
160 }
161 /* add for CONFIG_IEEE80211W, none 11w also can use */
162 _exit_critical_bh(&adapter->security_key_mutex, &irqL);
163
164 RTW_INFO(FUNC_ADPT_FMT" - End to Disconnect\n", FUNC_ADPT_ARG(adapter));
165 }
166
rtw_os_indicate_disconnect(_adapter * adapter,u16 reason,u8 locally_generated)167 void rtw_os_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_generated)
168 {
169 /* RT_PMKID_LIST backupPMKIDList[NUM_PMKID_CACHE]; */
170
171
172 rtw_netif_carrier_off(adapter->pnetdev); /* Do it first for tx broadcast pkt after disconnection issue! */
173
174 #ifdef CONFIG_IOCTL_CFG80211
175 rtw_cfg80211_indicate_disconnect(adapter, reason, locally_generated);
176 #endif /* CONFIG_IOCTL_CFG80211 */
177
178 rtw_indicate_wx_disassoc_event(adapter);
179
180 #ifdef RTK_DMP_PLATFORM
181 _set_workitem(&adapter->mlmepriv.Linkdown_workitem);
182 #endif
183 /* modify for CONFIG_IEEE80211W, none 11w also can use the same command */
184 rtw_reset_securitypriv_cmd(adapter);
185
186
187 }
188
rtw_report_sec_ie(_adapter * adapter,u8 authmode,u8 * sec_ie)189 void rtw_report_sec_ie(_adapter *adapter, u8 authmode, u8 *sec_ie)
190 {
191 uint len;
192 u8 *buff, *p, i;
193 union iwreq_data wrqu;
194
195
196
197 buff = NULL;
198 if (authmode == _WPA_IE_ID_) {
199
200 buff = rtw_zmalloc(IW_CUSTOM_MAX);
201 if (NULL == buff) {
202 RTW_INFO(FUNC_ADPT_FMT ": alloc memory FAIL!!\n",
203 FUNC_ADPT_ARG(adapter));
204 return;
205 }
206 p = buff;
207
208 p += sprintf(p, "ASSOCINFO(ReqIEs=");
209
210 len = sec_ie[1] + 2;
211 len = (len < IW_CUSTOM_MAX) ? len : IW_CUSTOM_MAX;
212
213 for (i = 0; i < len; i++)
214 p += sprintf(p, "%02x", sec_ie[i]);
215
216 p += sprintf(p, ")");
217
218 _rtw_memset(&wrqu, 0, sizeof(wrqu));
219
220 wrqu.data.length = p - buff;
221
222 wrqu.data.length = (wrqu.data.length < IW_CUSTOM_MAX) ? wrqu.data.length : IW_CUSTOM_MAX;
223
224 #ifndef CONFIG_IOCTL_CFG80211
225 wireless_send_event(adapter->pnetdev, IWEVCUSTOM, &wrqu, buff);
226 #endif
227
228 rtw_mfree(buff, IW_CUSTOM_MAX);
229 }
230
231
232 }
233
234 #ifdef CONFIG_AP_MODE
235
rtw_indicate_sta_assoc_event(_adapter * padapter,struct sta_info * psta)236 void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta)
237 {
238 union iwreq_data wrqu;
239 struct sta_priv *pstapriv = &padapter->stapriv;
240
241 if (psta == NULL)
242 return;
243
244 if (psta->cmn.aid > pstapriv->max_aid)
245 return;
246
247 if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta)
248 return;
249
250
251 wrqu.addr.sa_family = ARPHRD_ETHER;
252
253 _rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, ETH_ALEN);
254
255 RTW_INFO("+rtw_indicate_sta_assoc_event\n");
256
257 #ifndef CONFIG_IOCTL_CFG80211
258 wireless_send_event(padapter->pnetdev, IWEVREGISTERED, &wrqu, NULL);
259 #endif
260
261 }
262
rtw_indicate_sta_disassoc_event(_adapter * padapter,struct sta_info * psta)263 void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta)
264 {
265 union iwreq_data wrqu;
266 struct sta_priv *pstapriv = &padapter->stapriv;
267
268 if (psta == NULL)
269 return;
270
271 if (psta->cmn.aid > pstapriv->max_aid)
272 return;
273
274 if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta)
275 return;
276
277
278 wrqu.addr.sa_family = ARPHRD_ETHER;
279
280 _rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, ETH_ALEN);
281
282 RTW_INFO("+rtw_indicate_sta_disassoc_event\n");
283
284 #ifndef CONFIG_IOCTL_CFG80211
285 wireless_send_event(padapter->pnetdev, IWEVEXPIRED, &wrqu, NULL);
286 #endif
287
288 }
289
290
291 #ifdef CONFIG_HOSTAPD_MLME
292
mgnt_xmit_entry(struct sk_buff * skb,struct net_device * pnetdev)293 static int mgnt_xmit_entry(struct sk_buff *skb, struct net_device *pnetdev)
294 {
295 struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
296 _adapter *padapter = (_adapter *)phostapdpriv->padapter;
297
298 /* RTW_INFO("%s\n", __FUNCTION__); */
299
300 return rtw_hal_hostap_mgnt_xmit_entry(padapter, skb);
301 }
302
mgnt_netdev_open(struct net_device * pnetdev)303 static int mgnt_netdev_open(struct net_device *pnetdev)
304 {
305 struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
306
307 RTW_INFO("mgnt_netdev_open: MAC Address:" MAC_FMT "\n", MAC_ARG(pnetdev->dev_addr));
308
309
310 init_usb_anchor(&phostapdpriv->anchored);
311
312 rtw_netif_wake_queue(pnetdev);
313
314 rtw_netif_carrier_on(pnetdev);
315
316 /* rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100); */ /* only excluding beacon */
317
318 return 0;
319 }
mgnt_netdev_close(struct net_device * pnetdev)320 static int mgnt_netdev_close(struct net_device *pnetdev)
321 {
322 struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
323
324 RTW_INFO("%s\n", __FUNCTION__);
325
326 usb_kill_anchored_urbs(&phostapdpriv->anchored);
327
328 rtw_netif_carrier_off(pnetdev);
329
330 rtw_netif_stop_queue(pnetdev);
331
332 /* rtw_write16(phostapdpriv->padapter, 0x0116, 0x3f3f); */
333
334 return 0;
335 }
336
337 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29))
338 static const struct net_device_ops rtl871x_mgnt_netdev_ops = {
339 .ndo_open = mgnt_netdev_open,
340 .ndo_stop = mgnt_netdev_close,
341 .ndo_start_xmit = mgnt_xmit_entry,
342 #if 0
343 .ndo_set_mac_address = r871x_net_set_mac_address,
344 .ndo_get_stats = r871x_net_get_stats,
345 .ndo_do_ioctl = r871x_mp_ioctl,
346 #endif
347 };
348 #endif
349
hostapd_mode_init(_adapter * padapter)350 int hostapd_mode_init(_adapter *padapter)
351 {
352 unsigned char mac[ETH_ALEN];
353 struct hostapd_priv *phostapdpriv;
354 struct net_device *pnetdev;
355
356 pnetdev = rtw_alloc_etherdev(sizeof(struct hostapd_priv));
357 if (!pnetdev)
358 return -ENOMEM;
359
360 /* SET_MODULE_OWNER(pnetdev); */
361 ether_setup(pnetdev);
362
363 /* pnetdev->type = ARPHRD_IEEE80211; */
364
365 phostapdpriv = rtw_netdev_priv(pnetdev);
366 phostapdpriv->pmgnt_netdev = pnetdev;
367 phostapdpriv->padapter = padapter;
368 padapter->phostapdpriv = phostapdpriv;
369
370 /* pnetdev->init = NULL; */
371
372 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29))
373
374 RTW_INFO("register rtl871x_mgnt_netdev_ops to netdev_ops\n");
375
376 pnetdev->netdev_ops = &rtl871x_mgnt_netdev_ops;
377
378 #else
379
380 pnetdev->open = mgnt_netdev_open;
381
382 pnetdev->stop = mgnt_netdev_close;
383
384 pnetdev->hard_start_xmit = mgnt_xmit_entry;
385
386 /* pnetdev->set_mac_address = r871x_net_set_mac_address; */
387
388 /* pnetdev->get_stats = r871x_net_get_stats; */
389
390 /* pnetdev->do_ioctl = r871x_mp_ioctl; */
391
392 #endif
393
394 pnetdev->watchdog_timeo = HZ; /* 1 second timeout */
395
396 /* pnetdev->wireless_handlers = NULL; */
397
398
399
400
401 if (dev_alloc_name(pnetdev, "mgnt.wlan%d") < 0)
402 RTW_INFO("hostapd_mode_init(): dev_alloc_name, fail!\n");
403
404
405 /* SET_NETDEV_DEV(pnetdev, pintfpriv->udev); */
406
407
408 mac[0] = 0x00;
409 mac[1] = 0xe0;
410 mac[2] = 0x4c;
411 mac[3] = 0x87;
412 mac[4] = 0x11;
413 mac[5] = 0x12;
414
415 _rtw_memcpy(pnetdev->dev_addr, mac, ETH_ALEN);
416
417
418 rtw_netif_carrier_off(pnetdev);
419
420
421 /* Tell the network stack we exist */
422 if (register_netdev(pnetdev) != 0) {
423 RTW_INFO("hostapd_mode_init(): register_netdev fail!\n");
424
425 if (pnetdev)
426 rtw_free_netdev(pnetdev);
427 }
428
429 return 0;
430
431 }
432
hostapd_mode_unload(_adapter * padapter)433 void hostapd_mode_unload(_adapter *padapter)
434 {
435 struct hostapd_priv *phostapdpriv = padapter->phostapdpriv;
436 struct net_device *pnetdev = phostapdpriv->pmgnt_netdev;
437
438 unregister_netdev(pnetdev);
439 rtw_free_netdev(pnetdev);
440
441 }
442
443 #endif
444 #endif
445