add rk3288 pinctrl dts code
[firefly-linux-kernel-4.4.55.git] / drivers / net / wireless / rtl8188eu / os_dep / linux / mlme_linux.c
1 /******************************************************************************
2  *
3  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
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  * 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
17  *
18  *
19  ******************************************************************************/
20
21
22 #define _MLME_OSDEP_C_
23
24 #include <drv_types.h>
25
26
27 #ifdef RTK_DMP_PLATFORM
28 void Linkup_workitem_callback(struct work_struct *work)
29 {
30         struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkup_workitem);
31         _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv);
32
33 _func_enter_;
34
35         RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("+ Linkup_workitem_callback\n"));
36
37 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,12))
38         kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKUP);
39 #else
40         kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKUP);
41 #endif
42
43 _func_exit_;
44 }
45
46 void Linkdown_workitem_callback(struct work_struct *work)
47 {
48         struct mlme_priv *pmlmepriv = container_of(work, struct mlme_priv, Linkdown_workitem);
49         _adapter *padapter = container_of(pmlmepriv, _adapter, mlmepriv);
50
51 _func_enter_;
52
53         RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("+ Linkdown_workitem_callback\n"));
54
55 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,12))
56         kobject_uevent(&padapter->pnetdev->dev.kobj, KOBJ_LINKDOWN);
57 #else
58         kobject_hotplug(&padapter->pnetdev->class_dev.kobj, KOBJ_LINKDOWN);
59 #endif
60
61 _func_exit_;
62 }
63 #endif
64
65
66 /*
67 void sitesurvey_ctrl_handler(void *FunctionContext)
68 {
69         _adapter *adapter = (_adapter *)FunctionContext;
70
71         _sitesurvey_ctrl_handler(adapter);
72
73         _set_timer(&adapter->mlmepriv.sitesurveyctrl.sitesurvey_ctrl_timer, 3000);
74 }
75 */
76
77 void rtw_join_timeout_handler (void *FunctionContext)
78 {
79         _adapter *adapter = (_adapter *)FunctionContext;
80         _rtw_join_timeout_handler(adapter);
81 }
82
83
84 void _rtw_scan_timeout_handler (void *FunctionContext)
85 {
86         _adapter *adapter = (_adapter *)FunctionContext;
87         rtw_scan_timeout_handler(adapter);
88 }
89
90
91 void _dynamic_check_timer_handlder (void *FunctionContext)
92 {
93         _adapter *adapter = (_adapter *)FunctionContext;
94
95 #if (MP_DRIVER == 1)
96         if (adapter->registrypriv.mp_mode == 1 && adapter->mppriv.mp_dm ==0) //for MP ODM dynamic Tx power tracking
97         {
98                 //DBG_871X("_dynamic_check_timer_handlder mp_dm =0 return \n");
99                 _set_timer(&adapter->mlmepriv.dynamic_chk_timer, 2000);
100                 return;
101         }
102 #endif
103
104 #ifdef CONFIG_CONCURRENT_MODE
105         if(adapter->pbuddy_adapter)
106                 rtw_dynamic_check_timer_handlder(adapter->pbuddy_adapter);
107 #endif //CONFIG_CONCURRENT_MODE
108
109         rtw_dynamic_check_timer_handlder(adapter);
110         
111         _set_timer(&adapter->mlmepriv.dynamic_chk_timer, 2000);
112 }
113
114 #ifdef CONFIG_SET_SCAN_DENY_TIMER
115 void _rtw_set_scan_deny_timer_hdl(void *FunctionContext)
116 {
117         _adapter *adapter = (_adapter *)FunctionContext;         
118         rtw_set_scan_deny_timer_hdl(adapter);
119 }
120 #endif
121
122
123 void rtw_init_mlme_timer(_adapter *padapter)
124 {
125         struct  mlme_priv *pmlmepriv = &padapter->mlmepriv;
126
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);
130
131         _init_timer(&(pmlmepriv->dynamic_chk_timer), padapter->pnetdev, _dynamic_check_timer_handlder, padapter);
132
133         #ifdef CONFIG_SET_SCAN_DENY_TIMER
134         _init_timer(&(pmlmepriv->set_scan_deny_timer), padapter->pnetdev, _rtw_set_scan_deny_timer_hdl, padapter);
135         #endif
136
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);
140 #endif
141
142 }
143
144 extern void rtw_indicate_wx_assoc_event(_adapter *padapter);
145 extern void rtw_indicate_wx_disassoc_event(_adapter *padapter);
146
147 void rtw_os_indicate_connect(_adapter *adapter)
148 {
149         struct mlme_priv *pmlmepriv = &(adapter->mlmepriv);
150 _func_enter_;   
151
152 #ifdef CONFIG_IOCTL_CFG80211
153         if ( (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)==_TRUE ) || 
154                 (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)==_TRUE ) )
155         {
156                 rtw_cfg80211_ibss_indicate_connect(adapter);
157         }
158         else
159                 rtw_cfg80211_indicate_connect(adapter);
160 #endif //CONFIG_IOCTL_CFG80211
161
162         rtw_indicate_wx_assoc_event(adapter);
163         netif_carrier_on(adapter->pnetdev);
164
165         if(adapter->pid[2] !=0)
166                 rtw_signal_process(adapter->pid[2], SIGALRM);
167
168 #ifdef RTK_DMP_PLATFORM
169         _set_workitem(&adapter->mlmepriv.Linkup_workitem);
170 #endif
171
172 _func_exit_;    
173
174 }
175
176 extern void indicate_wx_scan_complete_event(_adapter *padapter);
177 void rtw_os_indicate_scan_done( _adapter *padapter, bool aborted)
178 {
179 #ifdef CONFIG_IOCTL_CFG80211
180         rtw_cfg80211_indicate_scan_done(padapter, aborted);
181 #endif
182         indicate_wx_scan_complete_event(padapter);
183 }
184
185 static RT_PMKID_LIST   backupPMKIDList[ NUM_PMKID_CACHE ];
186 void rtw_reset_securitypriv( _adapter *adapter )
187 {
188         u8      backupPMKIDIndex = 0;
189         u8      backupTKIPCountermeasure = 0x00;
190         u32     backupTKIPcountermeasure_time = 0;
191         // add for CONFIG_IEEE80211W, none 11w also can use
192         _irqL irqL;
193         struct mlme_ext_priv    *pmlmeext = &adapter->mlmeextpriv;
194         
195         _enter_critical_bh(&adapter->security_key_mutex, &irqL);
196         
197         if(adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)//802.1x
198         {                
199                 // Added by Albert 2009/02/18
200                 // We have to backup the PMK information for WiFi PMK Caching test item.
201                 //
202                 // Backup the btkip_countermeasure information.
203                 // When the countermeasure is trigger, the driver have to disconnect with AP for 60 seconds.
204
205                 _rtw_memset( &backupPMKIDList[ 0 ], 0x00, sizeof( RT_PMKID_LIST ) * NUM_PMKID_CACHE );
206
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);
217
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;                
224
225                 adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen;
226                 adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled;
227
228         }
229         else //reset values in securitypriv 
230         {
231                 //if(adapter->mlmepriv.fw_state & WIFI_STATION_STATE)
232                 //{
233                 struct security_priv *psec_priv=&adapter->securitypriv;
234
235                 psec_priv->dot11AuthAlgrthm =dot11AuthAlgrthm_Open;  //open system
236                 psec_priv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
237                 psec_priv->dot11PrivacyKeyIndex = 0;
238
239                 psec_priv->dot118021XGrpPrivacy = _NO_PRIVACY_;
240                 psec_priv->dot118021XGrpKeyid = 1;
241
242                 psec_priv->ndisauthtype = Ndis802_11AuthModeOpen;
243                 psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled;
244                 //}
245         }
246         // add for CONFIG_IEEE80211W, none 11w also can use
247         _exit_critical_bh(&adapter->security_key_mutex, &irqL);
248 }
249
250 void rtw_os_indicate_disconnect( _adapter *adapter )
251 {
252         //RT_PMKID_LIST   backupPMKIDList[ NUM_PMKID_CACHE ];
253
254 _func_enter_;
255
256         netif_carrier_off(adapter->pnetdev); // Do it first for tx broadcast pkt after disconnection issue!
257
258 #ifdef CONFIG_IOCTL_CFG80211
259         rtw_cfg80211_indicate_disconnect(adapter);
260 #endif //CONFIG_IOCTL_CFG80211
261
262         rtw_indicate_wx_disassoc_event(adapter);
263
264 #ifdef RTK_DMP_PLATFORM
265         _set_workitem(&adapter->mlmepriv.Linkdown_workitem);
266 #endif
267          //modify for CONFIG_IEEE80211W, none 11w also can use the same command
268          rtw_reset_securitypriv_cmd(adapter);
269
270 _func_exit_;
271
272 }
273
274 void rtw_report_sec_ie(_adapter *adapter,u8 authmode,u8 *sec_ie)
275 {
276         uint    len;
277         u8      *buff,*p,i;
278         union iwreq_data wrqu;
279
280 _func_enter_;
281
282         RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("+rtw_report_sec_ie, authmode=%d\n", authmode));
283
284         buff = NULL;
285         if(authmode==_WPA_IE_ID_)
286         {
287                 RT_TRACE(_module_mlme_osdep_c_,_drv_info_,("rtw_report_sec_ie, authmode=%d\n", authmode));
288                 
289                 buff = rtw_malloc(IW_CUSTOM_MAX);
290                 
291                 _rtw_memset(buff,0,IW_CUSTOM_MAX);
292                 
293                 p=buff;
294                 
295                 p+=sprintf(p,"ASSOCINFO(ReqIEs=");
296
297                 len = sec_ie[1]+2;
298                 len =  (len < IW_CUSTOM_MAX) ? len:IW_CUSTOM_MAX;
299                         
300                 for(i=0;i<len;i++){
301                         p+=sprintf(p,"%02x",sec_ie[i]);
302                 }
303
304                 p+=sprintf(p,")");
305                 
306                 _rtw_memset(&wrqu,0,sizeof(wrqu));
307                 
308                 wrqu.data.length=p-buff;
309                 
310                 wrqu.data.length = (wrqu.data.length<IW_CUSTOM_MAX) ? wrqu.data.length:IW_CUSTOM_MAX;
311                 
312 #ifndef CONFIG_IOCTL_CFG80211
313                 wireless_send_event(adapter->pnetdev,IWEVCUSTOM,&wrqu,buff);
314 #endif
315
316                 if(buff)
317                     rtw_mfree(buff, IW_CUSTOM_MAX);
318                 
319         }
320
321 _func_exit_;
322
323 }
324
325 void _survey_timer_hdl (void *FunctionContext)
326 {
327         _adapter *padapter = (_adapter *)FunctionContext;
328         
329         survey_timer_hdl(padapter);
330 }
331
332 void _link_timer_hdl (void *FunctionContext)
333 {
334         _adapter *padapter = (_adapter *)FunctionContext;
335         link_timer_hdl(padapter);
336 }
337
338 void _addba_timer_hdl(void *FunctionContext)
339 {
340         struct sta_info *psta = (struct sta_info *)FunctionContext;
341         addba_timer_hdl(psta);
342 }
343
344 #ifdef CONFIG_IEEE80211W
345 void _sa_query_timer_hdl (void *FunctionContext)
346 {
347         _adapter *padapter = (_adapter *)FunctionContext;
348         sa_query_timer_hdl(padapter);
349 }
350 #endif //CONFIG_IEEE80211W
351
352 void init_addba_retry_timer(_adapter *padapter, struct sta_info *psta)
353 {
354
355         _init_timer(&psta->addba_retry_timer, padapter->pnetdev, _addba_timer_hdl, psta);
356 }
357
358 /*
359 void _reauth_timer_hdl(void *FunctionContext)
360 {
361         _adapter *padapter = (_adapter *)FunctionContext;
362         reauth_timer_hdl(padapter);
363 }
364
365 void _reassoc_timer_hdl(void *FunctionContext)
366 {
367         _adapter *padapter = (_adapter *)FunctionContext;
368         reassoc_timer_hdl(padapter);
369 }
370 */
371
372 void init_mlme_ext_timer(_adapter *padapter)
373 {       
374         struct  mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
375
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);
382
383         //_init_timer(&pmlmeext->reauth_timer, padapter->pnetdev, _reauth_timer_hdl, padapter);
384         //_init_timer(&pmlmeext->reassoc_timer, padapter->pnetdev, _reassoc_timer_hdl, padapter);
385 }
386
387 #ifdef CONFIG_AP_MODE
388
389 void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta)
390 {
391         union iwreq_data wrqu;
392         struct sta_priv *pstapriv = &padapter->stapriv;
393
394         if(psta==NULL)
395                 return;
396
397         if(psta->aid > NUM_STA)
398                 return;
399
400         if(pstapriv->sta_aid[psta->aid - 1] != psta)
401                 return;
402         
403         
404         wrqu.addr.sa_family = ARPHRD_ETHER;     
405         
406         _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN);
407
408         DBG_871X("+rtw_indicate_sta_assoc_event\n");
409         
410 #ifndef CONFIG_IOCTL_CFG80211
411         wireless_send_event(padapter->pnetdev, IWEVREGISTERED, &wrqu, NULL);
412 #endif
413
414 }
415
416 void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta)
417 {
418         union iwreq_data wrqu;
419         struct sta_priv *pstapriv = &padapter->stapriv;
420
421         if(psta==NULL)
422                 return;
423
424         if(psta->aid > NUM_STA)
425                 return;
426
427         if(pstapriv->sta_aid[psta->aid - 1] != psta)
428                 return;
429         
430         
431         wrqu.addr.sa_family = ARPHRD_ETHER;     
432         
433         _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN);
434
435         DBG_871X("+rtw_indicate_sta_disassoc_event\n");
436         
437 #ifndef CONFIG_IOCTL_CFG80211
438         wireless_send_event(padapter->pnetdev, IWEVEXPIRED, &wrqu, NULL);
439 #endif
440         
441 }
442
443
444 #ifdef CONFIG_HOSTAPD_MLME
445
446 static int mgnt_xmit_entry(struct sk_buff *skb, struct net_device *pnetdev)
447 {
448         struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
449         _adapter *padapter = (_adapter *)phostapdpriv->padapter;
450
451         //DBG_871X("%s\n", __FUNCTION__);
452
453         return rtw_hal_hostap_mgnt_xmit_entry(padapter, skb);
454 }
455
456 static int mgnt_netdev_open(struct net_device *pnetdev)
457 {
458         struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
459
460         DBG_871X("mgnt_netdev_open: MAC Address:" MAC_FMT "\n", MAC_ARG(pnetdev->dev_addr));
461
462
463         init_usb_anchor(&phostapdpriv->anchored);
464         
465         if(!rtw_netif_queue_stopped(pnetdev))
466                 rtw_netif_start_queue(pnetdev);
467         else
468                 rtw_netif_wake_queue(pnetdev);
469
470
471         netif_carrier_on(pnetdev);
472                 
473         //rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100);//only excluding beacon 
474                 
475         return 0;       
476 }
477 static int mgnt_netdev_close(struct net_device *pnetdev)
478 {
479         struct hostapd_priv *phostapdpriv = rtw_netdev_priv(pnetdev);
480
481         DBG_871X("%s\n", __FUNCTION__);
482
483         usb_kill_anchored_urbs(&phostapdpriv->anchored);
484
485         netif_carrier_off(pnetdev);
486
487         if (!rtw_netif_queue_stopped(pnetdev))
488                 rtw_netif_stop_queue(pnetdev);
489         
490         //rtw_write16(phostapdpriv->padapter, 0x0116, 0x3f3f);
491         
492         return 0;       
493 }
494
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,
503 };
504 #endif
505
506 int hostapd_mode_init(_adapter *padapter)
507 {
508         unsigned char mac[ETH_ALEN];
509         struct hostapd_priv *phostapdpriv;
510         struct net_device *pnetdev;
511         
512         pnetdev = rtw_alloc_etherdev(sizeof(struct hostapd_priv));      
513         if (!pnetdev)
514            return -ENOMEM;
515
516         //SET_MODULE_OWNER(pnetdev);
517        ether_setup(pnetdev);
518
519         //pnetdev->type = ARPHRD_IEEE80211;
520         
521         phostapdpriv = rtw_netdev_priv(pnetdev);
522         phostapdpriv->pmgnt_netdev = pnetdev;
523         phostapdpriv->padapter= padapter;
524         padapter->phostapdpriv = phostapdpriv;
525         
526         //pnetdev->init = NULL;
527         
528 #if (LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,29))
529
530         DBG_871X("register rtl871x_mgnt_netdev_ops to netdev_ops\n");
531
532         pnetdev->netdev_ops = &rtl871x_mgnt_netdev_ops;
533         
534 #else
535
536         pnetdev->open = mgnt_netdev_open;
537
538         pnetdev->stop = mgnt_netdev_close;      
539         
540         pnetdev->hard_start_xmit = mgnt_xmit_entry;
541         
542         //pnetdev->set_mac_address = r871x_net_set_mac_address;
543         
544         //pnetdev->get_stats = r871x_net_get_stats;
545
546         //pnetdev->do_ioctl = r871x_mp_ioctl;
547         
548 #endif
549
550         pnetdev->watchdog_timeo = HZ; /* 1 second timeout */    
551
552         //pnetdev->wireless_handlers = NULL;
553
554 #ifdef CONFIG_TCP_CSUM_OFFLOAD_TX
555         pnetdev->features |= NETIF_F_IP_CSUM;
556 #endif  
557
558         
559         
560         if(dev_alloc_name(pnetdev,"mgnt.wlan%d") < 0)
561         {
562                 DBG_871X("hostapd_mode_init(): dev_alloc_name, fail! \n");              
563         }
564
565
566         //SET_NETDEV_DEV(pnetdev, pintfpriv->udev);
567
568
569         mac[0]=0x00;
570         mac[1]=0xe0;
571         mac[2]=0x4c;
572         mac[3]=0x87;
573         mac[4]=0x11;
574         mac[5]=0x12;
575                                 
576         _rtw_memcpy(pnetdev->dev_addr, mac, ETH_ALEN);
577         
578
579         netif_carrier_off(pnetdev);
580
581
582         /* Tell the network stack we exist */
583         if (register_netdev(pnetdev) != 0)
584         {
585                 DBG_871X("hostapd_mode_init(): register_netdev fail!\n");
586                 
587                 if(pnetdev)
588                 {        
589                         rtw_free_netdev(pnetdev);
590                 }
591         }
592         
593         return 0;
594         
595 }
596
597 void hostapd_mode_unload(_adapter *padapter)
598 {
599         struct hostapd_priv *phostapdpriv = padapter->phostapdpriv;
600         struct net_device *pnetdev = phostapdpriv->pmgnt_netdev;
601
602         unregister_netdev(pnetdev);
603         rtw_free_netdev(pnetdev);
604         
605 }
606
607 #endif
608 #endif
609