1 /******************************************************************************
3 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
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.
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
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
19 ******************************************************************************/
22 #define _MLME_OSDEP_C_
24 #include <drv_types.h>
27 #ifdef RTK_DMP_PLATFORM
28 void Linkup_workitem_callback(struct work_struct *work)
30 struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkup_workitem);
31 _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv);
35 RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("+ Linkup_workitem_callback\n"));
37 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,12))
38 kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKUP);
40 kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKUP);
46 void Linkdown_workitem_callback(struct work_struct *work)
48 struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkdown_workitem);
49 _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv);
53 RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("+ Linkdown_workitem_callback\n"));
55 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,12))
56 kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKDOWN);
58 kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKDOWN);
67 void sitesurvey_ctrl_handler(void *FunctionContext)
69 _adapter *adapter = (_adapter *)FunctionContext;
71 _sitesurvey_ctrl_handler(adapter);
73 _set_timer(&adapter->mlmepriv.sitesurveyctrl.sitesurvey_ctrl_timer, 3000);
77 void rtw_join_timeout_handler (void *FunctionContext)
79 _adapter *adapter = (_adapter *)FunctionContext;
80 _rtw_join_timeout_handler(adapter);
84 void _rtw_scan_timeout_handler (void *FunctionContext)
86 _adapter *adapter = (_adapter *)FunctionContext;
87 rtw_scan_timeout_handler(adapter);
91 void _dynamic_check_timer_handlder (void *FunctionContext)
93 _adapter *adapter = (_adapter *)FunctionContext;
96 if (adapter->registrypriv.mp_mode == 1 && adapter->mppriv.mp_dm ==0) //for MP ODM dynamic Tx power tracking
98 //DBG_871X("_dynamic_check_timer_handlder mp_dm =0 return \n");
99 _set_timer(&adapter->mlmepriv.dynamic_chk_timer, 2000);
104 #ifdef CONFIG_CONCURRENT_MODE
105 if(adapter->pbuddy_adapter)
106 rtw_dynamic_check_timer_handlder(adapter->pbuddy_adapter);
107 #endif //CONFIG_CONCURRENT_MODE
109 rtw_dynamic_check_timer_handlder(adapter);
111 _set_timer(&adapter->mlmepriv.dynamic_chk_timer, 2000);
114 #ifdef CONFIG_SET_SCAN_DENY_TIMER
115 void _rtw_set_scan_deny_timer_hdl(void *FunctionContext)
117 _adapter *adapter = (_adapter *)FunctionContext;
118 rtw_set_scan_deny_timer_hdl(adapter);
123 void rtw_init_mlme_timer(_adapter *padapter)
125 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
127 _init_timer(&(pmlmepriv->assoc_timer), padapter->pnetdev, rtw_join_timeout_handler, padapter);
128 //_init_timer(&(pmlmepriv->sitesurveyctrl.sitesurvey_ctrl_timer), padapter->pnetdev, sitesurvey_ctrl_handler, padapter);
129 _init_timer(&(pmlmepriv->scan_to_timer), padapter->pnetdev, _rtw_scan_timeout_handler, padapter);
131 _init_timer(&(pmlmepriv->dynamic_chk_timer), padapter->pnetdev, _dynamic_check_timer_handlder, padapter);
133 #ifdef CONFIG_SET_SCAN_DENY_TIMER
134 _init_timer(&(pmlmepriv->set_scan_deny_timer), padapter->pnetdev, _rtw_set_scan_deny_timer_hdl, padapter);
137 #ifdef RTK_DMP_PLATFORM
138 _init_workitem(&(pmlmepriv->Linkup_workitem), Linkup_workitem_callback, padapter);
139 _init_workitem(&(pmlmepriv->Linkdown_workitem), Linkdown_workitem_callback, padapter);
144 extern void rtw_indicate_wx_assoc_event(_adapter *padapter);
145 extern void rtw_indicate_wx_disassoc_event(_adapter *padapter);
147 void rtw_os_indicate_connect(_adapter *adapter)
149 struct mlme_priv *pmlmepriv = &(adapter->mlmepriv);
152 #ifdef CONFIG_IOCTL_CFG80211
153 if ( (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)==_TRUE ) ||
154 (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==_TRUE ) )
156 rtw_cfg80211_ibss_indicate_connect(adapter);
159 rtw_cfg80211_indicate_connect(adapter);
160 #endif //CONFIG_IOCTL_CFG80211
162 rtw_indicate_wx_assoc_event(adapter);
163 netif_carrier_on(adapter->pnetdev);
165 if(adapter->pid[2] !=0)
166 rtw_signal_process(adapter->pid[2], SIGALRM);
168 #ifdef RTK_DMP_PLATFORM
169 _set_workitem(&adapter->mlmepriv.Linkup_workitem);
176 extern void indicate_wx_scan_complete_event(_adapter *padapter);
177 void rtw_os_indicate_scan_done( _adapter *padapter, bool aborted)
179 #ifdef CONFIG_IOCTL_CFG80211
180 rtw_cfg80211_indicate_scan_done(padapter, aborted);
182 indicate_wx_scan_complete_event(padapter);
185 static RT_PMKID_LIST backupPMKIDList[ NUM_PMKID_CACHE ];
186 void rtw_reset_securitypriv( _adapter *adapter )
188 u8 backupPMKIDIndex = 0;
189 u8 backupTKIPCountermeasure = 0x00;
190 u32 backupTKIPcountermeasure_time = 0;
191 // add for CONFIG_IEEE80211W, none 11w also can use
193 struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
195 _enter_critical_bh(&adapter->security_key_mutex, &irqL);
197 if(adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)//802.1x
199 // Added by Albert 2009/02/18
200 // We have to backup the PMK information for WiFi PMK Caching test item.
202 // Backup the btkip_countermeasure information.
203 // When the countermeasure is trigger, the driver have to disconnect with AP for 60 seconds.
205 _rtw_memset( &backupPMKIDList[ 0 ], 0x00, sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE );
207 _rtw_memcpy( &backupPMKIDList[ 0 ], &adapter->securitypriv.PMKIDList[ 0 ], sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE );
208 backupPMKIDIndex = adapter->securitypriv.PMKIDIndex;
209 backupTKIPCountermeasure = adapter->securitypriv.btkip_countermeasure;
210 backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time;
211 #ifdef CONFIG_IEEE80211W
212 //reset RX BIP packet number
213 pmlmeext->mgnt_80211w_IPN_rx = 0;
214 #endif //CONFIG_IEEE80211W
215 _rtw_memset((unsigned char *)&adapter->securitypriv, 0, sizeof (struct security_priv));
216 //_init_timer(&(adapter->securitypriv.tkip_timer),adapter->pnetdev, rtw_use_tkipkey_handler, adapter);
218 // Added by Albert 2009/02/18
219 // Restore the PMK information to securitypriv structure for the following connection.
220 _rtw_memcpy( &adapter->securitypriv.PMKIDList[ 0 ], &backupPMKIDList[ 0 ], sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE );
221 adapter->securitypriv.PMKIDIndex = backupPMKIDIndex;
222 adapter->securitypriv.btkip_countermeasure = backupTKIPCountermeasure;
223 adapter->securitypriv.btkip_countermeasure_time = backupTKIPcountermeasure_time;
225 adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen;
226 adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled;
229 else //reset values in securitypriv
231 //if(adapter->mlmepriv.fw_state & WIFI_STATION_STATE)
233 struct security_priv *psec_priv=&adapter->securitypriv;
235 psec_priv->dot11AuthAlgrthm =dot11AuthAlgrthm_Open; //open system
236 psec_priv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
237 psec_priv->dot11PrivacyKeyIndex = 0;
239 psec_priv->dot118021XGrpPrivacy = _NO_PRIVACY_;
240 psec_priv->dot118021XGrpKeyid = 1;
242 psec_priv->ndisauthtype = Ndis802_11AuthModeOpen;
243 psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled;
246 // add for CONFIG_IEEE80211W, none 11w also can use
247 _exit_critical_bh(&adapter->security_key_mutex, &irqL);
250 void rtw_os_indicate_disconnect( _adapter *adapter )
252 //RT_PMKID_LIST backupPMKIDList[ NUM_PMKID_CACHE ];
256 netif_carrier_off(adapter->pnetdev); // Do it first for tx broadcast pkt after disconnection issue!
258 #ifdef CONFIG_IOCTL_CFG80211
259 rtw_cfg80211_indicate_disconnect(adapter);
260 #endif //CONFIG_IOCTL_CFG80211
262 rtw_indicate_wx_disassoc_event(adapter);
264 #ifdef RTK_DMP_PLATFORM
265 _set_workitem(&adapter->mlmepriv.Linkdown_workitem);
267 //modify for CONFIG_IEEE80211W, none 11w also can use the same command
268 rtw_reset_securitypriv_cmd(adapter);
274 void rtw_report_sec_ie(_adapter *adapter,u8 authmode,u8 *sec_ie)
278 union iwreq_data wrqu;
282 RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("+rtw_report_sec_ie, authmode=%d\n", authmode));
285 if(authmode==_WPA_IE_ID_)
287 RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("rtw_report_sec_ie, authmode=%d\n", authmode));
289 buff = rtw_malloc(IW_CUSTOM_MAX);
291 _rtw_memset(buff,0,IW_CUSTOM_MAX);
295 p+=sprintf(p,"ASSOCINFO(ReqIEs=");
298 len = (len < IW_CUSTOM_MAX) ? len:IW_CUSTOM_MAX;
301 p+=sprintf(p,"%02x",sec_ie[i]);
306 _rtw_memset(&wrqu,0,sizeof(wrqu));
308 wrqu.data.length=p-buff;
310 wrqu.data.length = (wrqu.data.length<IW_CUSTOM_MAX) ? wrqu.data.length:IW_CUSTOM_MAX;
312 #ifndef CONFIG_IOCTL_CFG80211
313 wireless_send_event(adapter->pnetdev,IWEVCUSTOM,&wrqu,buff);
317 rtw_mfree(buff, IW_CUSTOM_MAX);
325 void _survey_timer_hdl (void *FunctionContext)
327 _adapter *padapter = (_adapter *)FunctionContext;
329 survey_timer_hdl(padapter);
332 void _link_timer_hdl (void *FunctionContext)
334 _adapter *padapter = (_adapter *)FunctionContext;
335 link_timer_hdl(padapter);
338 void _addba_timer_hdl(void *FunctionContext)
340 struct sta_info *psta = (struct sta_info *)FunctionContext;
341 addba_timer_hdl(psta);
344 #ifdef CONFIG_IEEE80211W
345 void _sa_query_timer_hdl (void *FunctionContext)
347 _adapter *padapter = (_adapter *)FunctionContext;
348 sa_query_timer_hdl(padapter);
350 #endif //CONFIG_IEEE80211W
352 void init_addba_retry_timer(_adapter *padapter, struct sta_info *psta)
355 _init_timer(&psta->addba_retry_timer, padapter->pnetdev, _addba_timer_hdl, psta);
359 void _reauth_timer_hdl(void *FunctionContext)
361 _adapter *padapter = (_adapter *)FunctionContext;
362 reauth_timer_hdl(padapter);
365 void _reassoc_timer_hdl(void *FunctionContext)
367 _adapter *padapter = (_adapter *)FunctionContext;
368 reassoc_timer_hdl(padapter);
372 void init_mlme_ext_timer(_adapter *padapter)
374 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
376 _init_timer(&pmlmeext->survey_timer, padapter->pnetdev, _survey_timer_hdl, padapter);
377 _init_timer(&pmlmeext->link_timer, padapter->pnetdev, _link_timer_hdl, padapter);
378 #ifdef CONFIG_IEEE80211W
379 _init_timer(&pmlmeext->sa_query_timer, padapter->pnetdev, _sa_query_timer_hdl, padapter);
380 #endif //CONFIG_IEEE80211W
381 //_init_timer(&pmlmeext->ADDBA_timer, padapter->pnetdev, _addba_timer_hdl, padapter);
383 //_init_timer(&pmlmeext->reauth_timer, padapter->pnetdev, _reauth_timer_hdl, padapter);
384 //_init_timer(&pmlmeext->reassoc_timer, padapter->pnetdev, _reassoc_timer_hdl, padapter);
387 #ifdef CONFIG_AP_MODE
389 void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta)
391 union iwreq_data wrqu;
392 struct sta_priv *pstapriv = &padapter->stapriv;
397 if(psta->aid > NUM_STA)
400 if(pstapriv->sta_aid[psta->aid - 1] != psta)
404 wrqu.addr.sa_family = ARPHRD_ETHER;
406 _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN);
408 DBG_871X("+rtw_indicate_sta_assoc_event\n");
410 #ifndef CONFIG_IOCTL_CFG80211
411 wireless_send_event(padapter->pnetdev, IWEVREGISTERED, &wrqu, NULL);
416 void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta)
418 union iwreq_data wrqu;
419 struct sta_priv *pstapriv = &padapter->stapriv;
424 if(psta->aid > NUM_STA)
427 if(pstapriv->sta_aid[psta->aid - 1] != psta)
431 wrqu.addr.sa_family = ARPHRD_ETHER;
433 _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN);
435 DBG_871X("+rtw_indicate_sta_disassoc_event\n");
437 #ifndef CONFIG_IOCTL_CFG80211
438 wireless_send_event(padapter->pnetdev, IWEVEXPIRED, &wrqu, NULL);
444 #ifdef CONFIG_HOSTAPD_MLME
446 static int mgnt_xmit_entry(struct sk_buff *skb, struct net_device *pnetdev)
448 struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
449 _adapter *padapter = (_adapter *)phostapdpriv->padapter;
451 //DBG_871X("%s\n", __FUNCTION__);
453 return rtw_hal_hostap_mgnt_xmit_entry(padapter, skb);
456 static int mgnt_netdev_open(struct net_device *pnetdev)
458 struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
460 DBG_871X("mgnt_netdev_open: MAC Address:" MAC_FMT "\n", MAC_ARG(pnetdev->dev_addr));
463 init_usb_anchor(&phostapdpriv->anchored);
465 if(!rtw_netif_queue_stopped(pnetdev))
466 rtw_netif_start_queue(pnetdev);
468 rtw_netif_wake_queue(pnetdev);
471 netif_carrier_on(pnetdev);
473 //rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100);//only excluding beacon
477 static int mgnt_netdev_close(struct net_device *pnetdev)
479 struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
481 DBG_871X("%s\n", __FUNCTION__);
483 usb_kill_anchored_urbs(&phostapdpriv->anchored);
485 netif_carrier_off(pnetdev);
487 if (!rtw_netif_queue_stopped(pnetdev))
488 rtw_netif_stop_queue(pnetdev);
490 //rtw_write16(phostapdpriv->padapter, 0x0116, 0x3f3f);
495 #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29))
496 static const struct net_device_ops rtl871x_mgnt_netdev_ops = {
497 .ndo_open = mgnt_netdev_open,
498 .ndo_stop = mgnt_netdev_close,
499 .ndo_start_xmit = mgnt_xmit_entry,
500 //.ndo_set_mac_address = r871x_net_set_mac_address,
501 //.ndo_get_stats = r871x_net_get_stats,
502 //.ndo_do_ioctl = r871x_mp_ioctl,
506 int hostapd_mode_init(_adapter *padapter)
508 unsigned char mac[ETH_ALEN];
509 struct hostapd_priv *phostapdpriv;
510 struct net_device *pnetdev;
512 pnetdev = rtw_alloc_etherdev(sizeof(struct hostapd_priv));
516 //SET_MODULE_OWNER(pnetdev);
517 ether_setup(pnetdev);
519 //pnetdev->type = ARPHRD_IEEE80211;
521 phostapdpriv = rtw_netdev_priv(pnetdev);
522 phostapdpriv->pmgnt_netdev = pnetdev;
523 phostapdpriv->padapter= padapter;
524 padapter->phostapdpriv = phostapdpriv;
526 //pnetdev->init = NULL;
528 #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29))
530 DBG_871X("register rtl871x_mgnt_netdev_ops to netdev_ops\n");
532 pnetdev->netdev_ops = &rtl871x_mgnt_netdev_ops;
536 pnetdev->open = mgnt_netdev_open;
538 pnetdev->stop = mgnt_netdev_close;
540 pnetdev->hard_start_xmit = mgnt_xmit_entry;
542 //pnetdev->set_mac_address = r871x_net_set_mac_address;
544 //pnetdev->get_stats = r871x_net_get_stats;
546 //pnetdev->do_ioctl = r871x_mp_ioctl;
550 pnetdev->watchdog_timeo = HZ; /* 1 second timeout */
552 //pnetdev->wireless_handlers = NULL;
554 #ifdef CONFIG_TCP_CSUM_OFFLOAD_TX
555 pnetdev->features |= NETIF_F_IP_CSUM;
560 if(dev_alloc_name(pnetdev,"mgnt.wlan%d") < 0)
562 DBG_871X("hostapd_mode_init(): dev_alloc_name, fail! \n");
566 //SET_NETDEV_DEV(pnetdev, pintfpriv->udev);
576 _rtw_memcpy(pnetdev->dev_addr, mac, ETH_ALEN);
579 netif_carrier_off(pnetdev);
582 /* Tell the network stack we exist */
583 if (register_netdev(pnetdev) != 0)
585 DBG_871X("hostapd_mode_init(): register_netdev fail!\n");
589 rtw_free_netdev(pnetdev);
597 void hostapd_mode_unload(_adapter *padapter)
599 struct hostapd_priv *phostapdpriv = padapter->phostapdpriv;
600 struct net_device *pnetdev = phostapdpriv->pmgnt_netdev;
602 unregister_netdev(pnetdev);
603 rtw_free_netdev(pnetdev);