1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2007 - 2011 Realtek Corporation. */
3 
4 #define _OS_INTFS_C_
5 
6 #include "../include/osdep_service.h"
7 #include "../include/drv_types.h"
8 #include "../include/hal_intf.h"
9 #include "../include/rtw_ioctl.h"
10 #include "../include/usb_osintf.h"
11 #include "../include/rtw_br_ext.h"
12 #include "../include/rtw_led.h"
13 #include "../include/rtl8188e_dm.h"
14 
15 MODULE_LICENSE("GPL");
16 MODULE_DESCRIPTION("Realtek Wireless Lan Driver");
17 MODULE_AUTHOR("Realtek Semiconductor Corp.");
18 MODULE_FIRMWARE(FW_RTL8188EU);
19 
20 #define CONFIG_BR_EXT_BRNAME "br0"
21 #define RTW_NOTCH_FILTER 0 /* 0:Disable, 1:Enable, */
22 
23 /* module param defaults */
24 static int rtw_rfintfs = HWPI;
25 static int rtw_lbkmode;/* RTL8712_AIR_TRX; */
26 static int rtw_network_mode = Ndis802_11IBSS;/* Ndis802_11Infrastructure; infra, ad-hoc, auto */
27 static int rtw_channel = 1;/* ad-hoc support requirement */
28 static int rtw_wireless_mode = WIRELESS_11BG_24N;
29 static int rtw_vrtl_carrier_sense = AUTO_VCS;
30 static int rtw_vcs_type = RTS_CTS;/*  */
31 static int rtw_rts_thresh = 2347;/*  */
32 static int rtw_frag_thresh = 2346;/*  */
33 static int rtw_preamble = PREAMBLE_LONG;/* long, short, auto */
34 static int rtw_scan_mode = 1;/* active, passive */
35 static int rtw_adhoc_tx_pwr = 1;
36 static int rtw_soft_ap;
37 static int rtw_power_mgnt = 1;
38 static int rtw_ips_mode = IPS_NORMAL;
39 
40 static int rtw_smart_ps = 2;
41 
42 module_param(rtw_ips_mode, int, 0644);
43 MODULE_PARM_DESC(rtw_ips_mode, "The default IPS mode");
44 
45 static int rtw_radio_enable = 1;
46 static int rtw_long_retry_lmt = 7;
47 static int rtw_short_retry_lmt = 7;
48 static int rtw_busy_thresh = 40;
49 static int rtw_ack_policy = NORMAL_ACK;
50 
51 static int rtw_software_encrypt;
52 static int rtw_software_decrypt;
53 
54 static int rtw_acm_method;/*  0:By SW 1:By HW. */
55 
56 static int rtw_wmm_enable = 1;/*  default is set to enable the wmm. */
57 static int rtw_uapsd_enable;
58 static int rtw_uapsd_max_sp = NO_LIMIT;
59 static int rtw_uapsd_acbk_en;
60 static int rtw_uapsd_acbe_en;
61 static int rtw_uapsd_acvi_en;
62 static int rtw_uapsd_acvo_en;
63 
64 static int rtw_led_enable = 1;
65 
66 static int rtw_ht_enable = 1;
67 static int rtw_cbw40_enable = 3; /*  0 :disable, bit(0): enable 2.4g, bit(1): enable 5g */
68 static int rtw_ampdu_enable = 1;/* for enable tx_ampdu */
69 static int rtw_rx_stbc = 1;/*  0: disable, bit(0):enable 2.4g, bit(1):enable 5g, default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ */
70 static int rtw_ampdu_amsdu;/*  0: disabled, 1:enabled, 2:auto */
71 
72 static int rtw_lowrate_two_xmit = 1;/* Use 2 path Tx to transmit MCS0~7 and legacy mode */
73 
74 static int rtw_low_power;
75 static int rtw_wifi_spec;
76 static int rtw_channel_plan = RT_CHANNEL_DOMAIN_MAX;
77 static int rtw_AcceptAddbaReq = true;/*  0:Reject AP's Add BA req, 1:Accept AP's Add BA req. */
78 
79 static int rtw_antdiv_cfg = 2; /*  0:OFF , 1:ON, 2:decide by Efuse config */
80 static int rtw_antdiv_type; /* 0:decide by efuse  1: for 88EE, 1Tx and 1RxCG are diversity.(2 Ant with SPDT), 2:  for 88EE, 1Tx and 2Rx are diversity.(2 Ant, Tx and RxCG are both on aux port, RxCS is on main port), 3: for 88EE, 1Tx and 1RxCG are fixed.(1Ant, Tx and RxCG are both on aux port) */
81 
82 
83 static int rtw_hwpdn_mode = 2;/* 0:disable, 1:enable, 2: by EFUSE config */
84 
85 static int rtw_hwpwrp_detect; /* HW power  ping detect 0:disable , 1:enable */
86 
87 static int rtw_hw_wps_pbc = 1;
88 
89 int rtw_mc2u_disable;
90 
91 static int rtw_80211d;
92 
93 static char *ifname = "wlan%d";
94 module_param(ifname, charp, 0644);
95 MODULE_PARM_DESC(ifname, "The default name to allocate for first interface");
96 
97 static char *if2name = "wlan%d";
98 module_param(if2name, charp, 0644);
99 MODULE_PARM_DESC(if2name, "The default name to allocate for second interface");
100 
101 char *rtw_initmac;  /*  temp mac address if users want to use instead of the mac address in Efuse */
102 
103 module_param(rtw_initmac, charp, 0644);
104 module_param(rtw_channel_plan, int, 0644);
105 module_param(rtw_rfintfs, int, 0644);
106 module_param(rtw_lbkmode, int, 0644);
107 module_param(rtw_network_mode, int, 0644);
108 module_param(rtw_channel, int, 0644);
109 module_param(rtw_wmm_enable, int, 0644);
110 module_param(rtw_vrtl_carrier_sense, int, 0644);
111 module_param(rtw_vcs_type, int, 0644);
112 module_param(rtw_busy_thresh, int, 0644);
113 module_param(rtw_led_enable, int, 0644);
114 module_param(rtw_ht_enable, int, 0644);
115 module_param(rtw_cbw40_enable, int, 0644);
116 module_param(rtw_ampdu_enable, int, 0644);
117 module_param(rtw_rx_stbc, int, 0644);
118 module_param(rtw_ampdu_amsdu, int, 0644);
119 module_param(rtw_lowrate_two_xmit, int, 0644);
120 module_param(rtw_power_mgnt, int, 0644);
121 module_param(rtw_smart_ps, int, 0644);
122 module_param(rtw_low_power, int, 0644);
123 module_param(rtw_wifi_spec, int, 0644);
124 module_param(rtw_antdiv_cfg, int, 0644);
125 module_param(rtw_antdiv_type, int, 0644);
126 module_param(rtw_hwpdn_mode, int, 0644);
127 module_param(rtw_hwpwrp_detect, int, 0644);
128 module_param(rtw_hw_wps_pbc, int, 0644);
129 
130 static uint rtw_max_roaming_times = 2;
131 module_param(rtw_max_roaming_times, uint, 0644);
132 MODULE_PARM_DESC(rtw_max_roaming_times, "The max roaming times to try");
133 
134 static int rtw_fw_iol = 1;/*  0:Disable, 1:enable, 2:by usb speed */
135 module_param(rtw_fw_iol, int, 0644);
136 MODULE_PARM_DESC(rtw_fw_iol, "FW IOL");
137 
138 module_param(rtw_mc2u_disable, int, 0644);
139 
140 module_param(rtw_80211d, int, 0644);
141 MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism");
142 
143 static uint rtw_notch_filter = RTW_NOTCH_FILTER;
144 module_param(rtw_notch_filter, uint, 0644);
145 MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P");
146 
loadparam(struct adapter * padapter)147 static uint loadparam(struct adapter *padapter)
148 {
149 	struct registry_priv  *registry_par = &padapter->registrypriv;
150 
151 	registry_par->rfintfs = (u8)rtw_rfintfs;
152 	registry_par->lbkmode = (u8)rtw_lbkmode;
153 	registry_par->network_mode  = (u8)rtw_network_mode;
154 
155 	memcpy(registry_par->ssid.Ssid, "ANY", 3);
156 	registry_par->ssid.SsidLength = 3;
157 
158 	registry_par->channel = (u8)rtw_channel;
159 	registry_par->wireless_mode = (u8)rtw_wireless_mode;
160 	registry_par->vrtl_carrier_sense = (u8)rtw_vrtl_carrier_sense;
161 	registry_par->vcs_type = (u8)rtw_vcs_type;
162 	registry_par->rts_thresh = (u16)rtw_rts_thresh;
163 	registry_par->frag_thresh = (u16)rtw_frag_thresh;
164 	registry_par->preamble = (u8)rtw_preamble;
165 	registry_par->scan_mode = (u8)rtw_scan_mode;
166 	registry_par->adhoc_tx_pwr = (u8)rtw_adhoc_tx_pwr;
167 	registry_par->soft_ap =  (u8)rtw_soft_ap;
168 	registry_par->smart_ps =  (u8)rtw_smart_ps;
169 	registry_par->power_mgnt = (u8)rtw_power_mgnt;
170 	registry_par->ips_mode = (u8)rtw_ips_mode;
171 	registry_par->radio_enable = (u8)rtw_radio_enable;
172 	registry_par->long_retry_lmt = (u8)rtw_long_retry_lmt;
173 	registry_par->short_retry_lmt = (u8)rtw_short_retry_lmt;
174 	registry_par->busy_thresh = (u16)rtw_busy_thresh;
175 	registry_par->ack_policy = (u8)rtw_ack_policy;
176 	registry_par->software_encrypt = (u8)rtw_software_encrypt;
177 	registry_par->software_decrypt = (u8)rtw_software_decrypt;
178 	registry_par->acm_method = (u8)rtw_acm_method;
179 
180 	 /* UAPSD */
181 	registry_par->wmm_enable = (u8)rtw_wmm_enable;
182 	registry_par->uapsd_enable = (u8)rtw_uapsd_enable;
183 	registry_par->uapsd_max_sp = (u8)rtw_uapsd_max_sp;
184 	registry_par->uapsd_acbk_en = (u8)rtw_uapsd_acbk_en;
185 	registry_par->uapsd_acbe_en = (u8)rtw_uapsd_acbe_en;
186 	registry_par->uapsd_acvi_en = (u8)rtw_uapsd_acvi_en;
187 	registry_par->uapsd_acvo_en = (u8)rtw_uapsd_acvo_en;
188 
189 	registry_par->led_enable = (u8)rtw_led_enable;
190 
191 	registry_par->ht_enable = (u8)rtw_ht_enable;
192 	registry_par->cbw40_enable = (u8)rtw_cbw40_enable;
193 	registry_par->ampdu_enable = (u8)rtw_ampdu_enable;
194 	registry_par->rx_stbc = (u8)rtw_rx_stbc;
195 	registry_par->ampdu_amsdu = (u8)rtw_ampdu_amsdu;
196 	registry_par->lowrate_two_xmit = (u8)rtw_lowrate_two_xmit;
197 	registry_par->low_power = (u8)rtw_low_power;
198 	registry_par->wifi_spec = (u8)rtw_wifi_spec;
199 	registry_par->channel_plan = (u8)rtw_channel_plan;
200 	registry_par->bAcceptAddbaReq = (u8)rtw_AcceptAddbaReq;
201 	registry_par->antdiv_cfg = (u8)rtw_antdiv_cfg;
202 	registry_par->antdiv_type = (u8)rtw_antdiv_type;
203 	registry_par->hwpdn_mode = (u8)rtw_hwpdn_mode;/* 0:disable, 1:enable, 2:by EFUSE config */
204 	registry_par->hwpwrp_detect = (u8)rtw_hwpwrp_detect;/* 0:disable, 1:enable */
205 	registry_par->hw_wps_pbc = (u8)rtw_hw_wps_pbc;
206 
207 	registry_par->max_roaming_times = (u8)rtw_max_roaming_times;
208 
209 	registry_par->fw_iol = rtw_fw_iol;
210 
211 	registry_par->enable80211d = (u8)rtw_80211d;
212 	snprintf(registry_par->ifname, 16, "%s", ifname);
213 	snprintf(registry_par->if2name, 16, "%s", if2name);
214 	registry_par->notch_filter = (u8)rtw_notch_filter;
215 
216 	return _SUCCESS;
217 }
218 
rtw_net_set_mac_address(struct net_device * pnetdev,void * p)219 static int rtw_net_set_mac_address(struct net_device *pnetdev, void *p)
220 {
221 	struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
222 	struct sockaddr *addr = p;
223 
224 	if (!padapter->bup)
225 		memcpy(padapter->eeprompriv.mac_addr, addr->sa_data, ETH_ALEN);
226 
227 	return 0;
228 }
229 
rtw_net_get_stats(struct net_device * pnetdev)230 static struct net_device_stats *rtw_net_get_stats(struct net_device *pnetdev)
231 {
232 	struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
233 	struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
234 	struct recv_priv *precvpriv = &padapter->recvpriv;
235 
236 	padapter->stats.tx_packets = pxmitpriv->tx_pkts;/* pxmitpriv->tx_pkts++; */
237 	padapter->stats.rx_packets = precvpriv->rx_pkts;/* precvpriv->rx_pkts++; */
238 	padapter->stats.tx_dropped = pxmitpriv->tx_drop;
239 	padapter->stats.rx_dropped = precvpriv->rx_drop;
240 	padapter->stats.tx_bytes = pxmitpriv->tx_bytes;
241 	padapter->stats.rx_bytes = precvpriv->rx_bytes;
242 	return &padapter->stats;
243 }
244 
245 /*
246  * AC to queue mapping
247  *
248  * AC_VO -> queue 0
249  * AC_VI -> queue 1
250  * AC_BE -> queue 2
251  * AC_BK -> queue 3
252  */
253 static const u16 rtw_1d_to_queue[8] = { 2, 3, 3, 2, 1, 1, 0, 0 };
254 
255 /* Given a data frame determine the 802.1p/1d tag to use. */
rtw_classify8021d(struct sk_buff * skb)256 static unsigned int rtw_classify8021d(struct sk_buff *skb)
257 {
258 	unsigned int dscp;
259 
260 	/* skb->priority values from 256->263 are magic values to
261 	 * directly indicate a specific 802.1d priority.  This is used
262 	 * to allow 802.1d priority to be passed directly in from VLAN
263 	 * tags, etc.
264 	 */
265 	if (skb->priority >= 256 && skb->priority <= 263)
266 		return skb->priority - 256;
267 
268 	switch (skb->protocol) {
269 	case htons(ETH_P_IP):
270 		dscp = ip_hdr(skb)->tos & 0xfc;
271 		break;
272 	default:
273 		return 0;
274 	}
275 
276 	return dscp >> 5;
277 }
278 
rtw_select_queue(struct net_device * dev,struct sk_buff * skb,struct net_device * sb_dev)279 static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb, struct net_device *sb_dev)
280 {
281 	struct adapter	*padapter = rtw_netdev_priv(dev);
282 	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
283 
284 	skb->priority = rtw_classify8021d(skb);
285 
286 	if (pmlmepriv->acm_mask != 0)
287 		skb->priority = qos_acm(pmlmepriv->acm_mask, skb->priority);
288 
289 	return rtw_1d_to_queue[skb->priority];
290 }
291 
rtw_recv_select_queue(struct sk_buff * skb)292 u16 rtw_recv_select_queue(struct sk_buff *skb)
293 {
294 	struct iphdr *piphdr;
295 	unsigned int dscp;
296 	__be16	eth_type;
297 	u32 priority;
298 	u8 *pdata = skb->data;
299 
300 	memcpy(&eth_type, pdata + (ETH_ALEN << 1), 2);
301 
302 	switch (eth_type) {
303 	case htons(ETH_P_IP):
304 		piphdr = (struct iphdr *)(pdata + ETH_HLEN);
305 		dscp = piphdr->tos & 0xfc;
306 		priority = dscp >> 5;
307 		break;
308 	default:
309 		priority = 0;
310 	}
311 
312 	return rtw_1d_to_queue[priority];
313 }
314 
315 static const struct net_device_ops rtw_netdev_ops = {
316 	.ndo_open = netdev_open,
317 	.ndo_stop = netdev_close,
318 	.ndo_start_xmit = rtw_xmit_entry,
319 	.ndo_select_queue	= rtw_select_queue,
320 	.ndo_set_mac_address = rtw_net_set_mac_address,
321 	.ndo_get_stats = rtw_net_get_stats,
322 };
323 
rtw_init_netdev_name(struct net_device * pnetdev,const char * ifname)324 int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname)
325 {
326 	int err;
327 
328 	err = dev_alloc_name(pnetdev, ifname);
329 	if (err < 0)
330 		return err;
331 
332 	netif_carrier_off(pnetdev);
333 	return 0;
334 }
335 
336 static const struct device_type wlan_type = {
337 	.name = "wlan",
338 };
339 
rtw_init_netdev(struct adapter * old_padapter)340 struct net_device *rtw_init_netdev(struct adapter *old_padapter)
341 {
342 	struct adapter *padapter;
343 	struct net_device *pnetdev;
344 
345 	if (old_padapter)
346 		pnetdev = rtw_alloc_etherdev_with_old_priv(sizeof(struct adapter), (void *)old_padapter);
347 	else
348 		pnetdev = rtw_alloc_etherdev(sizeof(struct adapter));
349 
350 	if (!pnetdev)
351 		return NULL;
352 
353 	pnetdev->dev.type = &wlan_type;
354 	padapter = rtw_netdev_priv(pnetdev);
355 	padapter->pnetdev = pnetdev;
356 	pnetdev->netdev_ops = &rtw_netdev_ops;
357 	pnetdev->watchdog_timeo = HZ * 3; /* 3 second timeout */
358 	pnetdev->wireless_handlers = (struct iw_handler_def *)&rtw_handlers_def;
359 
360 	/* step 2. */
361 	loadparam(padapter);
362 
363 	return pnetdev;
364 }
365 
rtw_start_drv_threads(struct adapter * padapter)366 u32 rtw_start_drv_threads(struct adapter *padapter)
367 {
368 	u32 _status = _SUCCESS;
369 
370 	padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD");
371 	if (IS_ERR(padapter->cmdThread))
372 		_status = _FAIL;
373 	else
374 		/* wait for rtw_cmd_thread() to start running */
375 		wait_for_completion(&padapter->cmdpriv.start_cmd_thread);
376 
377 	return _status;
378 }
379 
rtw_stop_drv_threads(struct adapter * padapter)380 void rtw_stop_drv_threads(struct adapter *padapter)
381 {
382 	/* Below is to termindate rtw_cmd_thread & event_thread... */
383 	complete(&padapter->cmdpriv.enqueue_cmd);
384 	if (padapter->cmdThread)
385 		/* wait for rtw_cmd_thread() to stop running */
386 		wait_for_completion(&padapter->cmdpriv.stop_cmd_thread);
387 }
388 
rtw_init_default_value(struct adapter * padapter)389 static void rtw_init_default_value(struct adapter *padapter)
390 {
391 	struct registry_priv *pregistrypriv = &padapter->registrypriv;
392 	struct xmit_priv	*pxmitpriv = &padapter->xmitpriv;
393 	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
394 	struct security_priv *psecuritypriv = &padapter->securitypriv;
395 
396 	/* xmit_priv */
397 	pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense;
398 	pxmitpriv->vcs = pregistrypriv->vcs_type;
399 	pxmitpriv->vcs_type = pregistrypriv->vcs_type;
400 	pxmitpriv->frag_len = pregistrypriv->frag_thresh;
401 
402 	/* mlme_priv */
403 	pmlmepriv->scan_interval = SCAN_INTERVAL;/*  30*2 sec = 60sec */
404 	pmlmepriv->scan_mode = SCAN_ACTIVE;
405 
406 	/* ht_priv */
407 	pmlmepriv->htpriv.ampdu_enable = false;/* set to disabled */
408 
409 	/* security_priv */
410 	psecuritypriv->binstallGrpkey = _FAIL;
411 	psecuritypriv->sw_encrypt = pregistrypriv->software_encrypt;
412 	psecuritypriv->sw_decrypt = pregistrypriv->software_decrypt;
413 	psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */
414 	psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
415 	psecuritypriv->dot11PrivacyKeyIndex = 0;
416 	psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_;
417 	psecuritypriv->dot118021XGrpKeyid = 1;
418 	psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen;
419 	psecuritypriv->ndisencryptstatus = Ndis802_11WEPDisabled;
420 
421 	/* registry_priv */
422 	rtw_init_registrypriv_dev_network(padapter);
423 	rtw_update_registrypriv_dev_network(padapter);
424 
425 	/* hal_priv */
426 	rtl8188eu_init_default_value(padapter);
427 
428 	/* misc. */
429 	padapter->bReadPortCancel = false;
430 	padapter->bWritePortCancel = false;
431 	padapter->bRxRSSIDisplay = 0;
432 	padapter->bNotifyChannelChange = 0;
433 	padapter->bShowGetP2PState = 1;
434 }
435 
rtw_reset_drv_sw(struct adapter * padapter)436 u8 rtw_reset_drv_sw(struct adapter *padapter)
437 {
438 	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
439 
440 	/* hal_priv */
441 	rtl8188eu_init_default_value(padapter);
442 	padapter->bReadPortCancel = false;
443 	padapter->bWritePortCancel = false;
444 	padapter->bRxRSSIDisplay = 0;
445 	pmlmepriv->scan_interval = SCAN_INTERVAL;/*  30*2 sec = 60sec */
446 
447 	padapter->xmitpriv.tx_pkts = 0;
448 	padapter->recvpriv.rx_pkts = 0;
449 
450 	pmlmepriv->LinkDetectInfo.bBusyTraffic = false;
451 
452 	_clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING);
453 
454 	/* mlmeextpriv */
455 	padapter->mlmeextpriv.sitesurvey_res.state = SCAN_DISABLE;
456 
457 	rtw_set_signal_stat_timer(&padapter->recvpriv);
458 
459 	return _SUCCESS;
460 }
461 
rtw_init_drv_sw(struct adapter * padapter)462 u8 rtw_init_drv_sw(struct adapter *padapter)
463 {
464 	if ((rtw_init_cmd_priv(&padapter->cmdpriv)) == _FAIL) {
465 		dev_err(dvobj_to_dev(padapter->dvobj), "rtw_init_cmd_priv failed\n");
466 		return _FAIL;
467 	}
468 
469 	padapter->cmdpriv.padapter = padapter;
470 
471 	if ((rtw_init_evt_priv(&padapter->evtpriv)) == _FAIL) {
472 		dev_err(dvobj_to_dev(padapter->dvobj), "rtw_init_evt_priv failed\n");
473 		goto free_cmd_priv;
474 	}
475 
476 	if (rtw_init_mlme_priv(padapter) == _FAIL) {
477 		dev_err(dvobj_to_dev(padapter->dvobj), "rtw_init_mlme_priv failed\n");
478 		goto free_evt_priv;
479 	}
480 
481 	rtw_init_wifidirect_timers(padapter);
482 	init_wifidirect_info(padapter, P2P_ROLE_DISABLE);
483 	reset_global_wifidirect_info(padapter);
484 
485 	init_mlme_ext_priv(padapter);
486 
487 	if (_rtw_init_xmit_priv(&padapter->xmitpriv, padapter) == _FAIL) {
488 		dev_err(dvobj_to_dev(padapter->dvobj), "_rtw_init_xmit_priv failed\n");
489 		goto free_mlme_ext;
490 	}
491 
492 	if (_rtw_init_recv_priv(&padapter->recvpriv, padapter) == _FAIL) {
493 		dev_err(dvobj_to_dev(padapter->dvobj), "_rtw_init_recv_priv failed\n");
494 		goto free_xmit_priv;
495 	}
496 
497 	if (_rtw_init_sta_priv(&padapter->stapriv) == _FAIL) {
498 		dev_err(dvobj_to_dev(padapter->dvobj), "_rtw_init_sta_priv failed\n");
499 		goto free_recv_priv;
500 	}
501 
502 	padapter->stapriv.padapter = padapter;
503 
504 	rtw_init_bcmc_stainfo(padapter);
505 
506 	rtw_init_pwrctrl_priv(padapter);
507 
508 	rtw_init_default_value(padapter);
509 
510 	rtl8188e_init_dm_priv(padapter);
511 	rtl8188eu_InitSwLeds(padapter);
512 
513 	spin_lock_init(&padapter->br_ext_lock);
514 
515 	return _SUCCESS;
516 
517 free_recv_priv:
518 	_rtw_free_recv_priv(&padapter->recvpriv);
519 
520 free_xmit_priv:
521 	_rtw_free_xmit_priv(&padapter->xmitpriv);
522 
523 free_mlme_ext:
524 	free_mlme_ext_priv(&padapter->mlmeextpriv);
525 
526 	rtw_free_mlme_priv(&padapter->mlmepriv);
527 
528 free_evt_priv:
529 	rtw_free_evt_priv(&padapter->evtpriv);
530 
531 free_cmd_priv:
532 	rtw_free_cmd_priv(&padapter->cmdpriv);
533 
534 	return _FAIL;
535 }
536 
rtw_cancel_all_timer(struct adapter * padapter)537 void rtw_cancel_all_timer(struct adapter *padapter)
538 {
539 	_cancel_timer_ex(&padapter->mlmepriv.assoc_timer);
540 
541 	_cancel_timer_ex(&padapter->mlmepriv.scan_to_timer);
542 
543 	_cancel_timer_ex(&padapter->mlmepriv.dynamic_chk_timer);
544 
545 	/*  cancel sw led timer */
546 	rtl8188eu_DeInitSwLeds(padapter);
547 
548 	_cancel_timer_ex(&padapter->pwrctrlpriv.pwr_state_check_timer);
549 
550 	_cancel_timer_ex(&padapter->recvpriv.signal_stat_timer);
551 }
552 
rtw_free_drv_sw(struct adapter * padapter)553 u8 rtw_free_drv_sw(struct adapter *padapter)
554 {
555 	/* we can call rtw_p2p_enable here, but: */
556 	/*  1. rtw_p2p_enable may have IO operation */
557 	/*  2. rtw_p2p_enable is bundled with wext interface */
558 	{
559 		struct wifidirect_info *pwdinfo = &padapter->wdinfo;
560 		if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) {
561 			_cancel_timer_ex(&pwdinfo->find_phase_timer);
562 			_cancel_timer_ex(&pwdinfo->restore_p2p_state_timer);
563 			_cancel_timer_ex(&pwdinfo->pre_tx_scan_timer);
564 			rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE);
565 		}
566 	}
567 
568 	free_mlme_ext_priv(&padapter->mlmeextpriv);
569 
570 	rtw_free_cmd_priv(&padapter->cmdpriv);
571 
572 	rtw_free_evt_priv(&padapter->evtpriv);
573 
574 	rtw_free_mlme_priv(&padapter->mlmepriv);
575 	_rtw_free_xmit_priv(&padapter->xmitpriv);
576 
577 	_rtw_free_sta_priv(&padapter->stapriv); /* will free bcmc_stainfo here */
578 
579 	_rtw_free_recv_priv(&padapter->recvpriv);
580 
581 	/* free the old_pnetdev */
582 	if (padapter->rereg_nd_name_priv.old_pnetdev) {
583 		free_netdev(padapter->rereg_nd_name_priv.old_pnetdev);
584 		padapter->rereg_nd_name_priv.old_pnetdev = NULL;
585 	}
586 
587 	/*  clear pbuddystruct adapter to avoid access wrong pointer. */
588 	if (padapter->pbuddy_adapter)
589 		padapter->pbuddy_adapter->pbuddy_adapter = NULL;
590 
591 	return _SUCCESS;
592 }
593 
netdev_br_init(struct net_device * netdev)594 void netdev_br_init(struct net_device *netdev)
595 {
596 	struct adapter *adapter = (struct adapter *)rtw_netdev_priv(netdev);
597 
598 	rcu_read_lock();
599 
600 	if (rcu_dereference(adapter->pnetdev->rx_handler_data)) {
601 		struct net_device *br_netdev;
602 		struct net *devnet = NULL;
603 
604 		devnet = dev_net(netdev);
605 		br_netdev = dev_get_by_name(devnet, CONFIG_BR_EXT_BRNAME);
606 		if (br_netdev) {
607 			memcpy(adapter->br_mac, br_netdev->dev_addr, ETH_ALEN);
608 			dev_put(br_netdev);
609 		} else {
610 			pr_info("%s()-%d: dev_get_by_name(%s) failed!",
611 				__func__, __LINE__, CONFIG_BR_EXT_BRNAME);
612 		}
613 	}
614 	adapter->ethBrExtInfo.addPPPoETag = 1;
615 
616 	rcu_read_unlock();
617 }
618 
_netdev_open(struct net_device * pnetdev)619 static int _netdev_open(struct net_device *pnetdev)
620 {
621 	uint status;
622 	struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
623 
624 	if (!padapter->bup) {
625 		padapter->bDriverStopped = false;
626 		padapter->bSurpriseRemoved = false;
627 		padapter->bCardDisableWOHSM = false;
628 
629 		status = rtw_hal_init(padapter);
630 		if (status == _FAIL)
631 			goto netdev_open_error;
632 
633 		netdev_dbg(pnetdev, "MAC Address = %pM\n", pnetdev->dev_addr);
634 
635 		status = rtw_start_drv_threads(padapter);
636 		if (status == _FAIL) {
637 			pr_info("Initialize driver software resource Failed!\n");
638 			goto netdev_open_error;
639 		}
640 
641 		if (init_hw_mlme_ext(padapter) == _FAIL) {
642 			pr_info("can't init mlme_ext_priv\n");
643 			goto netdev_open_error;
644 		}
645 		if (padapter->intf_start)
646 			padapter->intf_start(padapter);
647 
648 		rtw_led_control(padapter, LED_CTL_NO_LINK);
649 
650 		padapter->bup = true;
651 	}
652 	padapter->net_closed = false;
653 
654 	_set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);
655 
656 	padapter->pwrctrlpriv.bips_processing = false;
657 	rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv);
658 
659 	if (!rtw_netif_queue_stopped(pnetdev))
660 		netif_tx_start_all_queues(pnetdev);
661 	else
662 		netif_tx_wake_all_queues(pnetdev);
663 
664 	netdev_br_init(pnetdev);
665 
666 	return 0;
667 
668 netdev_open_error:
669 	padapter->bup = false;
670 	netif_carrier_off(pnetdev);
671 	netif_tx_stop_all_queues(pnetdev);
672 	return -1;
673 }
674 
netdev_open(struct net_device * pnetdev)675 int netdev_open(struct net_device *pnetdev)
676 {
677 	int ret;
678 	struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
679 
680 	mutex_lock(padapter->hw_init_mutex);
681 	ret = _netdev_open(pnetdev);
682 	mutex_unlock(padapter->hw_init_mutex);
683 	return ret;
684 }
685 
ips_netdrv_open(struct adapter * padapter)686 static int  ips_netdrv_open(struct adapter *padapter)
687 {
688 	int status = _SUCCESS;
689 	padapter->net_closed = false;
690 
691 	padapter->bDriverStopped = false;
692 	padapter->bSurpriseRemoved = false;
693 	padapter->bCardDisableWOHSM = false;
694 
695 	status = rtw_hal_init(padapter);
696 	if (status == _FAIL)
697 		goto netdev_open_error;
698 
699 	if (padapter->intf_start)
700 		padapter->intf_start(padapter);
701 
702 	rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv);
703 	_set_timer(&padapter->mlmepriv.dynamic_chk_timer, 5000);
704 
705 	return _SUCCESS;
706 
707 netdev_open_error:
708 	return _FAIL;
709 }
710 
rtw_ips_pwr_up(struct adapter * padapter)711 int rtw_ips_pwr_up(struct adapter *padapter)
712 {
713 	int result;
714 	rtw_reset_drv_sw(padapter);
715 
716 	result = ips_netdrv_open(padapter);
717 
718 	rtw_led_control(padapter, LED_CTL_NO_LINK);
719 
720 	return result;
721 }
722 
rtw_ips_pwr_down(struct adapter * padapter)723 void rtw_ips_pwr_down(struct adapter *padapter)
724 {
725 	padapter->bCardDisableWOHSM = true;
726 	padapter->net_closed = true;
727 
728 	rtw_led_control(padapter, LED_CTL_POWER_OFF);
729 
730 	rtw_ips_dev_unload(padapter);
731 	padapter->bCardDisableWOHSM = false;
732 }
733 
rtw_fifo_cleanup(struct adapter * adapter)734 static void rtw_fifo_cleanup(struct adapter *adapter)
735 {
736 	struct pwrctrl_priv *pwrpriv = &adapter->pwrctrlpriv;
737 	u8 trycnt = 100;
738 	int res;
739 	u32 reg;
740 
741 	/* pause tx */
742 	rtw_write8(adapter, REG_TXPAUSE, 0xff);
743 
744 	/* keep sn */
745 	/* FIXME: return an error to caller */
746 	res = rtw_read16(adapter, REG_NQOS_SEQ, &adapter->xmitpriv.nqos_ssn);
747 	if (res)
748 		return;
749 
750 	if (!pwrpriv->bkeepfwalive) {
751 		/* RX DMA stop */
752 		res = rtw_read32(adapter, REG_RXPKT_NUM, &reg);
753 		if (res)
754 			return;
755 
756 		rtw_write32(adapter, REG_RXPKT_NUM,
757 			    (reg | RW_RELEASE_EN));
758 		do {
759 			res = rtw_read32(adapter, REG_RXPKT_NUM, &reg);
760 			if (res)
761 				continue;
762 
763 			if (!(reg & RXDMA_IDLE))
764 				break;
765 		} while (trycnt--);
766 
767 		/* RQPN Load 0 */
768 		rtw_write16(adapter, REG_RQPN_NPQ, 0x0);
769 		rtw_write32(adapter, REG_RQPN, 0x80000000);
770 		mdelay(10);
771 	}
772 }
773 
rtw_ips_dev_unload(struct adapter * padapter)774 void rtw_ips_dev_unload(struct adapter *padapter)
775 {
776 	rtw_fifo_cleanup(padapter);
777 
778 	if (padapter->intf_stop)
779 		padapter->intf_stop(padapter);
780 
781 	/* s5. */
782 	if (!padapter->bSurpriseRemoved)
783 		rtw_hal_deinit(padapter);
784 }
785 
netdev_close(struct net_device * pnetdev)786 int netdev_close(struct net_device *pnetdev)
787 {
788 	struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
789 	struct dvobj_priv *dvobj = adapter_to_dvobj(padapter);
790 
791 	padapter->net_closed = true;
792 
793 	if (padapter->pwrctrlpriv.rf_pwrstate == rf_on) {
794 		/* s1. */
795 		if (pnetdev) {
796 			if (!rtw_netif_queue_stopped(pnetdev))
797 				netif_tx_stop_all_queues(pnetdev);
798 		}
799 
800 		/* s2. */
801 		LeaveAllPowerSaveMode(padapter);
802 		rtw_disassoc_cmd(padapter, 500, false);
803 		/* s2-2.  indicate disconnect to os */
804 		rtw_indicate_disconnect(padapter);
805 		/* s2-3. */
806 		rtw_free_assoc_resources(padapter, 1);
807 		/* s2-4. */
808 		rtw_free_network_queue(padapter, true);
809 		/*  Close LED */
810 		rtw_led_control(padapter, LED_CTL_POWER_OFF);
811 	}
812 
813 	nat25_db_cleanup(padapter);
814 
815 	rtw_p2p_enable(padapter, P2P_ROLE_DISABLE);
816 
817 	kfree(dvobj->firmware.data);
818 	dvobj->firmware.data = NULL;
819 
820 	return 0;
821 }
822