staging: rtl8723au: Do not reset wdev->iftype in netdev_close()
[deliverable/linux.git] / drivers / staging / rtl8723au / os_dep / os_intfs.c
CommitLineData
b1925ad8
LF
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 ******************************************************************************/
15#define _OS_INTFS_C_
16
17#include <osdep_service.h>
18#include <drv_types.h>
19#include <xmit_osdep.h>
20#include <recv_osdep.h>
21#include <hal_intf.h>
22#include <rtw_version.h>
23#include <ethernet.h>
24
25#include <usb_osintf.h>
26#include <linux/version.h>
27
28MODULE_LICENSE("GPL");
29MODULE_DESCRIPTION("Realtek Wireless Lan Driver");
30MODULE_AUTHOR("Realtek Semiconductor Corp.");
31MODULE_AUTHOR("Larry Finger <Larry.Finger@lwfinger.net>");
32MODULE_AUTHOR("Jes Sorensen <Jes.Sorensen@redhat.com>");
33MODULE_VERSION(DRIVERVERSION);
34MODULE_FIRMWARE("rtlwifi/rtl8821aefw.bin");
35
36/* module param defaults */
37static int rtw_chip_version = 0x00;
38static int rtw_rfintfs = HWPI;
39static int rtw_debug = 1;
40
41static int rtw_channel = 1;/* ad-hoc support requirement */
42static int rtw_wireless_mode = WIRELESS_11BG_24N;
43static int rtw_vrtl_carrier_sense = AUTO_VCS;
44static int rtw_vcs_type = RTS_CTS;/* */
45static int rtw_rts_thresh = 2347;/* */
46static int rtw_frag_thresh = 2346;/* */
47static int rtw_preamble = PREAMBLE_LONG;/* long, short, auto */
48static int rtw_scan_mode = 1;/* active, passive */
49static int rtw_adhoc_tx_pwr = 1;
50static int rtw_soft_ap;
51static int rtw_power_mgnt = 1;
52static int rtw_ips_mode = IPS_NORMAL;
53
54static int rtw_smart_ps = 2;
55
56module_param(rtw_ips_mode, int, 0644);
57MODULE_PARM_DESC(rtw_ips_mode, "The default IPS mode");
58
59static int rtw_long_retry_lmt = 7;
60static int rtw_short_retry_lmt = 7;
61static int rtw_busy_thresh = 40;
62static int rtw_ack_policy = NORMAL_ACK;
63
64static int rtw_acm_method;/* 0:By SW 1:By HW. */
65
66static int rtw_wmm_enable = 1;/* default is set to enable the wmm. */
67static int rtw_uapsd_enable;
68
69int rtw_ht_enable23A = 1;
70/* 0 :diable, bit(0): enable 2.4g, bit(1): enable 5g */
71int rtw_cbw40_enable23A = 3;
72int rtw_ampdu_enable23A = 1;/* for enable tx_ampdu */
73/* 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, default is set to enable
74 * 2.4GHZ for IOT issue with bufflao's AP at 5GHZ
75 */
76static int rtw_rx_stbc = 1;
77static int rtw_ampdu_amsdu;/* 0: disabled, 1:enabled, 2:auto */
78
79/* Use 2 path Tx to transmit MCS0~7 and legacy mode */
80static int rtw_lowrate_two_xmit = 1;
81
82/* int rf_config = RF_1T2R; 1T2R */
83static int rtw_rf_config = RF_819X_MAX_TYPE; /* auto */
84static int rtw_low_power;
85static int rtw_wifi_spec;
86static int rtw_channel_plan = RT_CHANNEL_DOMAIN_MAX;
87
88#ifdef CONFIG_8723AU_BT_COEXIST
89static int rtw_btcoex_enable = 1;
90static int rtw_bt_iso = 2;/* 0:Low, 1:High, 2:From Efuse */
91/* 0:Idle, 1:None-SCO, 2:SCO, 3:From Counter, 4.Busy, 5.OtherBusy */
92static int rtw_bt_sco = 3;
93/* 0:Disable BT control A-MPDU, 1:Enable BT control A-MPDU. */
94static int rtw_bt_ampdu = 1 ;
95#endif
96
97/* 0:Reject AP's Add BA req, 1:Accept AP's Add BA req. */
98static int rtw_AcceptAddbaReq = true;
99
100static int rtw_antdiv_cfg = 2; /* 0:OFF , 1:ON, 2:decide by Efuse config */
101static int rtw_antdiv_type; /* 0:decide by efuse */
102
103static int rtw_enusbss;/* 0:disable, 1:enable */
104
105static int rtw_hwpdn_mode = 2;/* 0:disable, 1:enable, 2: by EFUSE config */
106
107static int rtw_hwpwrp_detect; /* HW power ping detect 0:disable , 1:enable */
108
109static int rtw_hw_wps_pbc = 1;
110
111static int rtw_80211d;
112
113static int rtw_regulatory_id = 0xff;/* Regulatory tab id, 0xff = follow efuse's setting */
114
115module_param(rtw_regulatory_id, int, 0644);
116
117static char *ifname = "wlan%d";
118module_param(ifname, charp, 0644);
119MODULE_PARM_DESC(ifname, "The default name to allocate for first interface");
120
121static char *if2name = "wlan%d";
122module_param(if2name, charp, 0644);
123MODULE_PARM_DESC(if2name, "The default name to allocate for second interface");
124
125module_param(rtw_channel_plan, int, 0644);
126module_param(rtw_chip_version, int, 0644);
127module_param(rtw_rfintfs, int, 0644);
128module_param(rtw_channel, int, 0644);
129module_param(rtw_wmm_enable, int, 0644);
130module_param(rtw_vrtl_carrier_sense, int, 0644);
131module_param(rtw_vcs_type, int, 0644);
132module_param(rtw_busy_thresh, int, 0644);
133module_param(rtw_ht_enable23A, int, 0644);
134module_param(rtw_cbw40_enable23A, int, 0644);
135module_param(rtw_ampdu_enable23A, int, 0644);
136module_param(rtw_rx_stbc, int, 0644);
137module_param(rtw_ampdu_amsdu, int, 0644);
138
139module_param(rtw_lowrate_two_xmit, int, 0644);
140
141module_param(rtw_rf_config, int, 0644);
142module_param(rtw_power_mgnt, int, 0644);
143module_param(rtw_smart_ps, int, 0644);
144module_param(rtw_low_power, int, 0644);
145module_param(rtw_wifi_spec, int, 0644);
146
147module_param(rtw_antdiv_cfg, int, 0644);
148
149module_param(rtw_enusbss, int, 0644);
150module_param(rtw_hwpdn_mode, int, 0644);
151module_param(rtw_hwpwrp_detect, int, 0644);
152
153module_param(rtw_hw_wps_pbc, int, 0644);
154
155static uint rtw_max_roaming_times = 2;
156module_param(rtw_max_roaming_times, uint, 0644);
157MODULE_PARM_DESC(rtw_max_roaming_times, "The max roaming times to try");
158
159module_param(rtw_80211d, int, 0644);
160MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism");
161
162#ifdef CONFIG_8723AU_BT_COEXIST
163module_param(rtw_btcoex_enable, int, 0644);
164MODULE_PARM_DESC(rtw_btcoex_enable, "Enable BT co-existence mechanism");
165#endif
166
167static uint rtw_notch_filter;
168module_param(rtw_notch_filter, uint, 0644);
169MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P");
170module_param_named(debug, rtw_debug, int, 0444);
171MODULE_PARM_DESC(debug, "Set debug level (1-9) (default 1)");
172
173static int netdev_close(struct net_device *pnetdev);
174
175static uint loadparam(struct rtw_adapter *padapter, struct net_device *pnetdev)
176{
177 struct registry_priv *registry_par = &padapter->registrypriv;
178 uint status = _SUCCESS;
179
180 GlobalDebugLevel23A = rtw_debug;
181 registry_par->chip_version = (u8)rtw_chip_version;
182 registry_par->rfintfs = (u8)rtw_rfintfs;
183 memcpy(registry_par->ssid.ssid, "ANY", 3);
184 registry_par->ssid.ssid_len = 3;
185 registry_par->channel = (u8)rtw_channel;
186 registry_par->wireless_mode = (u8)rtw_wireless_mode;
187 registry_par->vrtl_carrier_sense = (u8)rtw_vrtl_carrier_sense;
188 registry_par->vcs_type = (u8)rtw_vcs_type;
189 registry_par->rts_thresh = (u16)rtw_rts_thresh;
190 registry_par->frag_thresh = (u16)rtw_frag_thresh;
191 registry_par->preamble = (u8)rtw_preamble;
192 registry_par->scan_mode = (u8)rtw_scan_mode;
193 registry_par->adhoc_tx_pwr = (u8)rtw_adhoc_tx_pwr;
194 registry_par->soft_ap = (u8)rtw_soft_ap;
195 registry_par->smart_ps = (u8)rtw_smart_ps;
196 registry_par->power_mgnt = (u8)rtw_power_mgnt;
197 registry_par->ips_mode = (u8)rtw_ips_mode;
198 registry_par->long_retry_lmt = (u8)rtw_long_retry_lmt;
199 registry_par->short_retry_lmt = (u8)rtw_short_retry_lmt;
200 registry_par->busy_thresh = (u16)rtw_busy_thresh;
201 registry_par->ack_policy = (u8)rtw_ack_policy;
202 registry_par->acm_method = (u8)rtw_acm_method;
203 /* UAPSD */
204 registry_par->wmm_enable = (u8)rtw_wmm_enable;
205 registry_par->uapsd_enable = (u8)rtw_uapsd_enable;
206 registry_par->ht_enable = (u8)rtw_ht_enable23A;
207 registry_par->cbw40_enable = (u8)rtw_cbw40_enable23A;
208 registry_par->ampdu_enable = (u8)rtw_ampdu_enable23A;
209 registry_par->rx_stbc = (u8)rtw_rx_stbc;
210 registry_par->ampdu_amsdu = (u8)rtw_ampdu_amsdu;
211 registry_par->lowrate_two_xmit = (u8)rtw_lowrate_two_xmit;
212 registry_par->rf_config = (u8)rtw_rf_config;
213 registry_par->low_power = (u8)rtw_low_power;
214 registry_par->wifi_spec = (u8)rtw_wifi_spec;
215 registry_par->channel_plan = (u8)rtw_channel_plan;
216#ifdef CONFIG_8723AU_BT_COEXIST
217 registry_par->btcoex = (u8)rtw_btcoex_enable;
218 registry_par->bt_iso = (u8)rtw_bt_iso;
219 registry_par->bt_sco = (u8)rtw_bt_sco;
220 registry_par->bt_ampdu = (u8)rtw_bt_ampdu;
221#endif
222 registry_par->bAcceptAddbaReq = (u8)rtw_AcceptAddbaReq;
223 registry_par->antdiv_cfg = (u8)rtw_antdiv_cfg;
224 registry_par->antdiv_type = (u8)rtw_antdiv_type;
225
226 /* 0:disable, 1:enable, 2:by EFUSE config */
227 registry_par->hwpdn_mode = (u8)rtw_hwpdn_mode;
228 /* 0:disable, 1:enable */
229 registry_par->hwpwrp_detect = (u8)rtw_hwpwrp_detect;
230 registry_par->hw_wps_pbc = (u8)rtw_hw_wps_pbc;
231 registry_par->max_roaming_times = (u8)rtw_max_roaming_times;
232 registry_par->enable80211d = (u8)rtw_80211d;
233 snprintf(registry_par->ifname, 16, "%s", ifname);
234 snprintf(registry_par->if2name, 16, "%s", if2name);
235 registry_par->notch_filter = (u8)rtw_notch_filter;
236 registry_par->regulatory_tid = (u8)rtw_regulatory_id;
237 return status;
238}
239
240static int rtw_net_set_mac_address(struct net_device *pnetdev, void *p)
241{
242 struct rtw_adapter *padapter = netdev_priv(pnetdev);
243 struct sockaddr *addr = p;
244
245 if (!padapter->bup)
246 ether_addr_copy(padapter->eeprompriv.mac_addr, addr->sa_data);
247 return 0;
248}
249
250static struct net_device_stats *rtw_net_get_stats(struct net_device *pnetdev)
251{
252 struct rtw_adapter *padapter = netdev_priv(pnetdev);
253 struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
254 struct recv_priv *precvpriv = &padapter->recvpriv;
255
256 padapter->stats.tx_packets = pxmitpriv->tx_pkts;
257 padapter->stats.rx_packets = precvpriv->rx_pkts;
258 padapter->stats.tx_dropped = pxmitpriv->tx_drop;
259 padapter->stats.rx_dropped = precvpriv->rx_drop;
260 padapter->stats.tx_bytes = pxmitpriv->tx_bytes;
261 padapter->stats.rx_bytes = precvpriv->rx_bytes;
262
263 return &padapter->stats;
264}
265
266/*
267 * AC to queue mapping
268 *
269 * AC_VO -> queue 0
270 * AC_VI -> queue 1
271 * AC_BE -> queue 2
272 * AC_BK -> queue 3
273 */
274static const u16 rtw_1d_to_queue[8] = { 2, 3, 3, 2, 1, 1, 0, 0 };
275
276/* Given a data frame determine the 802.1p/1d tag to use. */
277static unsigned int rtw_classify8021d(struct sk_buff *skb)
278{
279 unsigned int dscp;
280
281 /* skb->priority values from 256->263 are magic values to
282 * directly indicate a specific 802.1d priority. This is used
283 * to allow 802.1d priority to be passed directly in from VLAN
284 * tags, etc.
285 */
286 if (skb->priority >= 256 && skb->priority <= 263)
287 return skb->priority - 256;
288 switch (skb->protocol) {
289 case htons(ETH_P_IP):
290 dscp = ip_hdr(skb)->tos & 0xfc;
291 break;
292 default:
293 return 0;
294 }
295 return dscp >> 5;
296}
297
298static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb,
299 void *accel_priv,
300 select_queue_fallback_t fallback)
301{
302 struct rtw_adapter *padapter = netdev_priv(dev);
303 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
304
305 skb->priority = rtw_classify8021d(skb);
306
307 if (pmlmepriv->acm_mask != 0)
308 skb->priority = qos_acm23a(pmlmepriv->acm_mask, skb->priority);
309 return rtw_1d_to_queue[skb->priority];
310}
311
312u16 rtw_recv_select_queue23a(struct sk_buff *skb)
313{
314 struct iphdr *piphdr;
315 unsigned int dscp;
316 u16 eth_type;
317 u32 priority;
318 u8 *pdata = skb->data;
319
320 memcpy(&eth_type, pdata + (ETH_ALEN << 1), 2);
321 switch (eth_type) {
322 case htons(ETH_P_IP):
323 piphdr = (struct iphdr *)(pdata + ETH_HLEN);
324 dscp = piphdr->tos & 0xfc;
325 priority = dscp >> 5;
326 break;
327 default:
328 priority = 0;
329 }
330 return rtw_1d_to_queue[priority];
331}
332
333static const struct net_device_ops rtw_netdev_ops = {
334 .ndo_open = netdev_open23a,
335 .ndo_stop = netdev_close,
336 .ndo_start_xmit = rtw_xmit23a_entry23a,
337 .ndo_select_queue = rtw_select_queue,
338 .ndo_set_mac_address = rtw_net_set_mac_address,
339 .ndo_get_stats = rtw_net_get_stats,
340};
341
342int rtw_init_netdev23a_name23a(struct net_device *pnetdev, const char *ifname)
343{
344 if (dev_alloc_name(pnetdev, ifname) < 0) {
345 RT_TRACE(_module_os_intfs_c_, _drv_err_,
346 ("dev_alloc_name, fail!\n"));
347 }
348 netif_carrier_off(pnetdev);
349 return 0;
350}
351
352static const struct device_type wlan_type = {
353 .name = "wlan",
354};
355
356struct net_device *rtw_init_netdev23a(struct rtw_adapter *old_padapter)
357{
358 struct rtw_adapter *padapter;
359 struct net_device *pnetdev;
360
361 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+init_net_dev\n"));
362
363 pnetdev = alloc_etherdev_mq(sizeof(struct rtw_adapter), 4);
364 if (!pnetdev)
365 return NULL;
366
367 pnetdev->dev.type = &wlan_type;
368 padapter = netdev_priv(pnetdev);
369 padapter->pnetdev = pnetdev;
370
371 DBG_8723A("register rtw_netdev_ops to netdev_ops\n");
372 pnetdev->netdev_ops = &rtw_netdev_ops;
373
374 pnetdev->watchdog_timeo = HZ*3; /* 3 second timeout */
375
376 /* step 2. */
377 loadparam(padapter, pnetdev);
378 return pnetdev;
379}
380
381u32 rtw_start_drv_threads23a(struct rtw_adapter *padapter)
382{
383 u32 _status = _SUCCESS;
384
385 RT_TRACE(_module_os_intfs_c_, _drv_info_,
386 ("+rtw_start_drv_threads23a\n"));
387 padapter->cmdThread = kthread_run(rtw_cmd_thread23a, padapter,
388 "RTW_CMD_THREAD");
389 if (IS_ERR(padapter->cmdThread)) {
390 _status = _FAIL;
391 } else {
392 /* wait for cmd_thread to run */
393 down(&padapter->cmdpriv.terminate_cmdthread_sema);
394 }
395 rtw_hal_start_thread23a(padapter);
396 return _status;
397}
398
399void rtw_stop_drv_threads23a(struct rtw_adapter *padapter)
400{
401 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_stop_drv_threads23a\n"));
402
403 /* Below is to termindate rtw_cmd_thread23a & event_thread... */
404 up(&padapter->cmdpriv.cmd_queue_sema);
405 if (padapter->cmdThread)
406 down(&padapter->cmdpriv.terminate_cmdthread_sema);
407 rtw_hal_stop_thread23a(padapter);
408}
409
410static u8 rtw_init_default_value(struct rtw_adapter *padapter)
411{
412 struct registry_priv *pregistrypriv = &padapter->registrypriv;
413 struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
414 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
415 struct security_priv *psecuritypriv = &padapter->securitypriv;
416 u8 ret = _SUCCESS;
417
418 /* xmit_priv */
419 pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense;
420 pxmitpriv->vcs = pregistrypriv->vcs_type;
421 pxmitpriv->vcs_type = pregistrypriv->vcs_type;
422 /* pxmitpriv->rts_thresh = pregistrypriv->rts_thresh; */
423 pxmitpriv->frag_len = pregistrypriv->frag_thresh;
424
425 /* mlme_priv */
426 pmlmepriv->scan_interval = SCAN_INTERVAL;/* 30*2 sec = 60sec */
427 pmlmepriv->scan_mode = SCAN_ACTIVE;
428
429 /* ht_priv */
430 pmlmepriv->htpriv.ampdu_enable = false;/* set to disabled */
431
432 /* security_priv */
433 psecuritypriv->binstallGrpkey = _FAIL;
434
435 /* open system */
436 psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open;
437 psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
438
439 psecuritypriv->dot11PrivacyKeyIndex = 0;
440
441 psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_;
442 psecuritypriv->dot118021XGrpKeyid = 1;
443
444 psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen;
445 psecuritypriv->ndisencryptstatus = Ndis802_11WEPDisabled;
446
447 /* registry_priv */
448 rtw_init_registrypriv_dev_network23a(padapter);
449 rtw_update_registrypriv_dev_network23a(padapter);
450
451 /* hal_priv */
452 rtw_hal_def_value_init23a(padapter);
453
454 /* misc. */
455 padapter->bReadPortCancel = false;
456 padapter->bWritePortCancel = false;
457 padapter->bRxRSSIDisplay = 0;
458 padapter->bNotifyChannelChange = 0;
459#ifdef CONFIG_8723AU_P2P
460 padapter->bShowGetP2PState = 1;
461#endif
462 return ret;
463}
464
465u8 rtw_reset_drv_sw23a(struct rtw_adapter *padapter)
466{
467 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
468 struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv;
469 u8 ret8 = _SUCCESS;
470
471 /* hal_priv */
472 rtw_hal_def_value_init23a(padapter);
473 padapter->bReadPortCancel = false;
474 padapter->bWritePortCancel = false;
475 padapter->bRxRSSIDisplay = 0;
476 pmlmepriv->scan_interval = SCAN_INTERVAL;/* 30*2 sec = 60sec */
477
478 padapter->xmitpriv.tx_pkts = 0;
479 padapter->recvpriv.rx_pkts = 0;
480
481 pmlmepriv->LinkDetectInfo.bBusyTraffic = false;
482
483 _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING);
484
485 rtw_hal_sreset_reset23a_value23a(padapter);
486 pwrctrlpriv->pwr_state_check_cnts = 0;
487
488 /* mlmeextpriv */
489 padapter->mlmeextpriv.sitesurvey_res.state = SCAN_DISABLE;
490
491 rtw_set_signal_stat_timer(&padapter->recvpriv);
492 return ret8;
493}
494
495u8 rtw_init_drv_sw23a(struct rtw_adapter *padapter)
496{
497 u8 ret8 = _SUCCESS;
498
499 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_init_drv_sw23a\n"));
500
501 if ((rtw_init_cmd_priv23a(&padapter->cmdpriv)) == _FAIL) {
502 RT_TRACE(_module_os_intfs_c_, _drv_err_,
503 ("\n Can't init cmd_priv\n"));
504 ret8 = _FAIL;
505 goto exit;
506 }
507
508 padapter->cmdpriv.padapter = padapter;
509
510 if (rtw_init_evt_priv23a(&padapter->evtpriv) == _FAIL) {
511 RT_TRACE(_module_os_intfs_c_, _drv_err_,
512 ("\n Can't init evt_priv\n"));
513 ret8 = _FAIL;
514 goto exit;
515 }
516
517 if (rtw_init_mlme_priv23a(padapter) == _FAIL) {
518 RT_TRACE(_module_os_intfs_c_, _drv_err_,
519 ("\n Can't init mlme_priv\n"));
520 ret8 = _FAIL;
521 goto exit;
522 }
523
524#ifdef CONFIG_8723AU_P2P
525 rtw_init_wifidirect_timers23a(padapter);
526 init_wifidirect_info23a(padapter, P2P_ROLE_DISABLE);
527 reset_global_wifidirect_info23a(padapter);
528 rtw_init_cfg80211_wifidirect_info(padapter);
529#ifdef CONFIG_8723AU_P2P
530 if (rtw_init_wifi_display_info(padapter) == _FAIL)
531 RT_TRACE(_module_os_intfs_c_, _drv_err_,
532 ("\n Can't init init_wifi_display_info\n"));
533#endif
534#endif /* CONFIG_8723AU_P2P */
535
536 if (init_mlme_ext_priv23a(padapter) == _FAIL) {
537 RT_TRACE(_module_os_intfs_c_, _drv_err_,
538 ("\n Can't init mlme_ext_priv\n"));
539 ret8 = _FAIL;
540 goto exit;
541 }
542
543 if (_rtw_init_xmit_priv23a(&padapter->xmitpriv, padapter) == _FAIL) {
544 DBG_8723A("Can't _rtw_init_xmit_priv23a\n");
545 ret8 = _FAIL;
546 goto exit;
547 }
548
549 if (_rtw_init_recv_priv23a(&padapter->recvpriv, padapter) == _FAIL) {
550 DBG_8723A("Can't _rtw_init_recv_priv23a\n");
551 ret8 = _FAIL;
552 goto exit;
553 }
554
555 if (_rtw_init_sta_priv23a(&padapter->stapriv) == _FAIL) {
556 DBG_8723A("Can't _rtw_init_sta_priv23a\n");
557 ret8 = _FAIL;
558 goto exit;
559 }
560
561 padapter->stapriv.padapter = padapter;
562 padapter->setband = GHZ24_50;
563 rtw_init_bcmc_stainfo23a(padapter);
564
565 rtw_init_pwrctrl_priv23a(padapter);
566
567 ret8 = rtw_init_default_value(padapter);
568
569 rtw_hal_dm_init23a(padapter);
570 rtw_hal_sw_led_init23a(padapter);
571
572 rtw_hal_sreset_init23a(padapter);
573
574exit:
575
576 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-rtw_init_drv_sw23a\n"));
577 return ret8;
578}
579
580void rtw_cancel_all_timer23a(struct rtw_adapter *padapter)
581{
582 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_cancel_all_timer23a\n"));
583
584 del_timer_sync(&padapter->mlmepriv.assoc_timer);
585 RT_TRACE(_module_os_intfs_c_, _drv_info_,
586 ("rtw_cancel_all_timer23a:cancel association timer complete!\n"));
587
588 del_timer_sync(&padapter->mlmepriv.scan_to_timer);
589 RT_TRACE(_module_os_intfs_c_, _drv_info_,
590 ("rtw_cancel_all_timer23a:cancel scan_to_timer!\n"));
591
592 del_timer_sync(&padapter->mlmepriv.dynamic_chk_timer);
593 RT_TRACE(_module_os_intfs_c_, _drv_info_,
594 ("rtw_cancel_all_timer23a:cancel dynamic_chk_timer!\n"));
595
596 /* cancel sw led timer */
597 rtw_hal_sw_led_deinit23a(padapter);
598 RT_TRACE(_module_os_intfs_c_, _drv_info_,
599 ("rtw_cancel_all_timer23a:cancel DeInitSwLeds!\n"));
600
601 del_timer_sync(&padapter->pwrctrlpriv.pwr_state_check_timer);
602
603#ifdef CONFIG_8723AU_P2P
604 del_timer_sync(&padapter->cfg80211_wdinfo.remain_on_ch_timer);
605#endif /* CONFIG_8723AU_P2P */
606
607 del_timer_sync(&padapter->mlmepriv.set_scan_deny_timer);
608 rtw_clear_scan_deny(padapter);
609 RT_TRACE(_module_os_intfs_c_, _drv_info_,
610 ("rtw_cancel_all_timer23a:cancel set_scan_deny_timer!\n"));
611
612 del_timer_sync(&padapter->recvpriv.signal_stat_timer);
613 /* cancel dm timer */
614 rtw_hal_dm_deinit23a(padapter);
615}
616
617u8 rtw_free_drv_sw23a(struct rtw_adapter *padapter)
618{
619#ifdef CONFIG_8723AU_P2P
620 struct wifidirect_info *pwdinfo;
621#endif
622
623 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("==>rtw_free_drv_sw23a"));
624
625 /* we can call rtw_p2p_enable23a here, but:
626 * 1. rtw_p2p_enable23a may have IO operation
627 * 2. rtw_p2p_enable23a is bundled with wext interface
628 */
629#ifdef CONFIG_8723AU_P2P
630 pwdinfo = &padapter->wdinfo;
631 if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) {
632 del_timer_sync(&pwdinfo->find_phase_timer);
633 del_timer_sync(&pwdinfo->restore_p2p_state_timer);
634 del_timer_sync(&pwdinfo->pre_tx_scan_timer);
635 rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE);
636 }
637#endif
638
639 free_mlme_ext_priv23a(&padapter->mlmeextpriv);
640
641 rtw_free_cmd_priv23a(&padapter->cmdpriv);
642
643 rtw_free_evt_priv23a(&padapter->evtpriv);
644
645 rtw_free_mlme_priv23a(&padapter->mlmepriv);
646
647 _rtw_free_xmit_priv23a(&padapter->xmitpriv);
648
649 _rtw_free_sta_priv23a(&padapter->stapriv);/* will free bcmc_stainfo here */
650
651 _rtw_free_recv_priv23a(&padapter->recvpriv);
652
653 rtw_free_pwrctrl_priv(padapter);
654
655 rtw_hal_free_data23a(padapter);
656
657 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("<== rtw_free_drv_sw23a\n"));
658
659 /* free the old_pnetdev */
660 if (padapter->rereg_nd_name_priv.old_pnetdev) {
661 free_netdev(padapter->rereg_nd_name_priv.old_pnetdev);
662 padapter->rereg_nd_name_priv.old_pnetdev = NULL;
663 }
664
665 /* clear pbuddy_adapter to avoid access wrong pointer. */
666 if (padapter->pbuddy_adapter != NULL)
667 padapter->pbuddy_adapter->pbuddy_adapter = NULL;
668 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-rtw_free_drv_sw23a\n"));
669 return _SUCCESS;
670}
671
672static int _rtw_drv_register_netdev(struct rtw_adapter *padapter, char *name)
673{
674 struct net_device *pnetdev = padapter->pnetdev;
675 int ret = _SUCCESS;
676
677 /* alloc netdev name */
678 rtw_init_netdev23a_name23a(pnetdev, name);
679
680 ether_addr_copy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr);
681
682 /* Tell the network stack we exist */
683 if (register_netdev(pnetdev)) {
684 DBG_8723A(FUNC_NDEV_FMT "Failed!\n", FUNC_NDEV_ARG(pnetdev));
685 ret = _FAIL;
686 goto error_register_netdev;
687 }
688 DBG_8723A("%s, MAC Address (if%d) = " MAC_FMT "\n", __func__,
689 (padapter->iface_id + 1), MAC_ARG(pnetdev->dev_addr));
690 return ret;
691
692error_register_netdev:
693
694 if (padapter->iface_id > IFACE_ID0) {
695 rtw_free_drv_sw23a(padapter);
696
697 free_netdev(pnetdev);
698 }
699 return ret;
700}
701
702int rtw_drv_register_netdev(struct rtw_adapter *if1)
703{
704 struct dvobj_priv *dvobj = if1->dvobj;
705 int i, status = _SUCCESS;
706
707 if (dvobj->iface_nums < IFACE_ID_MAX) {
708 for (i = 0; i < dvobj->iface_nums; i++) {
709 struct rtw_adapter *padapter = dvobj->padapters[i];
710
711 if (padapter) {
712 char *name;
713
714 if (padapter->iface_id == IFACE_ID0)
715 name = if1->registrypriv.ifname;
716 else if (padapter->iface_id == IFACE_ID1)
717 name = if1->registrypriv.if2name;
718 else
719 name = "wlan%d";
720 status = _rtw_drv_register_netdev(padapter,
721 name);
722 if (status != _SUCCESS)
723 break;
724 }
725 }
726 }
727 return status;
728}
729
730int netdev_open23a(struct net_device *pnetdev)
731{
732 struct rtw_adapter *padapter = netdev_priv(pnetdev);
733 struct pwrctrl_priv *pwrctrlpriv;
734 int ret = 0;
735 uint status;
736
737 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+871x_drv - dev_open\n"));
738 DBG_8723A("+871x_drv - drv_open, bup =%d\n", padapter->bup);
739
740 mutex_lock(&adapter_to_dvobj(padapter)->hw_init_mutex);
741
742 pwrctrlpriv = &padapter->pwrctrlpriv;
743 if (pwrctrlpriv->ps_flag) {
744 padapter->net_closed = false;
745 goto netdev_open23a_normal_process;
746 }
747
748 if (!padapter->bup) {
749 padapter->bDriverStopped = false;
750 padapter->bSurpriseRemoved = false;
751 padapter->bCardDisableWOHSM = false;
752
753 status = rtw_hal_init23a(padapter);
754 if (status == _FAIL) {
755 RT_TRACE(_module_os_intfs_c_, _drv_err_,
756 ("rtl871x_hal_init(): Can't init h/w!\n"));
757 goto netdev_open23a_error;
758 }
759
760 DBG_8723A("MAC Address = "MAC_FMT"\n",
761 MAC_ARG(pnetdev->dev_addr));
762
763 status = rtw_start_drv_threads23a(padapter);
764 if (status == _FAIL) {
765 DBG_8723A("Initialize driver software resource Failed!\n");
766 goto netdev_open23a_error;
767 }
768
769 if (init_hw_mlme_ext23a(padapter) == _FAIL) {
770 DBG_8723A("can't init mlme_ext_priv\n");
771 goto netdev_open23a_error;
772 }
773
774 if (padapter->intf_start)
775 padapter->intf_start(padapter);
776
777 rtw_cfg80211_init_wiphy(padapter);
778
779 rtw_led_control(padapter, LED_CTL_NO_LINK);
780
781 padapter->bup = true;
782 }
783 padapter->net_closed = false;
784
785 mod_timer(&padapter->mlmepriv.dynamic_chk_timer,
786 jiffies + msecs_to_jiffies(2000));
787
788 padapter->pwrctrlpriv.bips_processing = false;
789 rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv);
790
791 /* netif_carrier_on(pnetdev);call this func when
792 rtw23a_joinbss_event_cb return success */
793 if (!rtw_netif_queue_stopped(pnetdev))
794 netif_tx_start_all_queues(pnetdev);
795 else
796 netif_tx_wake_all_queues(pnetdev);
797
798netdev_open23a_normal_process:
799 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-871x_drv - dev_open\n"));
800 DBG_8723A("-871x_drv - drv_open, bup =%d\n", padapter->bup);
801exit:
802 mutex_unlock(&adapter_to_dvobj(padapter)->hw_init_mutex);
803 return ret;
804
805netdev_open23a_error:
806 padapter->bup = false;
807
808 netif_carrier_off(pnetdev);
809 netif_tx_stop_all_queues(pnetdev);
810
811 RT_TRACE(_module_os_intfs_c_, _drv_err_,
812 ("-871x_drv - dev_open, fail!\n"));
813 DBG_8723A("-871x_drv - drv_open fail, bup =%d\n", padapter->bup);
814
815 ret = -1;
816 goto exit;
817}
818
819static int ips_netdrv_open(struct rtw_adapter *padapter)
820{
821 int status = _SUCCESS;
822
823 padapter->net_closed = false;
824 DBG_8723A("===> %s.........\n", __func__);
825
826 padapter->bDriverStopped = false;
827 padapter->bSurpriseRemoved = false;
828 padapter->bCardDisableWOHSM = false;
829
830 status = rtw_hal_init23a(padapter);
831 if (status == _FAIL) {
832 RT_TRACE(_module_os_intfs_c_, _drv_err_,
833 ("ips_netdrv_open(): Can't init h/w!\n"));
834 goto netdev_open23a_error;
835 }
836
837 if (padapter->intf_start)
838 padapter->intf_start(padapter);
839
840 rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv);
841 mod_timer(&padapter->mlmepriv.dynamic_chk_timer,
842 jiffies + msecs_to_jiffies(5000));
843
844 return _SUCCESS;
845
846netdev_open23a_error:
847 /* padapter->bup = false; */
848 DBG_8723A("-ips_netdrv_open - drv_open failure, bup =%d\n",
849 padapter->bup);
850
851 return _FAIL;
852}
853
854int rtw_ips_pwr_up23a(struct rtw_adapter *padapter)
855{
856 int result;
857 unsigned long start_time = jiffies;
858
859 DBG_8723A("===> rtw_ips_pwr_up23a..............\n");
860 rtw_reset_drv_sw23a(padapter);
861
862 result = ips_netdrv_open(padapter);
863
864 rtw_led_control(padapter, LED_CTL_NO_LINK);
865
866 DBG_8723A("<=== rtw_ips_pwr_up23a.............. in %dms\n",
867 jiffies_to_msecs(jiffies - start_time));
868 return result;
869}
870
871void rtw_ips_pwr_down23a(struct rtw_adapter *padapter)
872{
873 unsigned long start_time = jiffies;
874
875 DBG_8723A("===> rtw_ips_pwr_down23a...................\n");
876
877 padapter->bCardDisableWOHSM = true;
878 padapter->net_closed = true;
879
880 rtw_led_control(padapter, LED_CTL_POWER_OFF);
881
882 rtw_ips_dev_unload23a(padapter);
883 padapter->bCardDisableWOHSM = false;
884 DBG_8723A("<=== rtw_ips_pwr_down23a..................... in %dms\n",
885 jiffies_to_msecs(jiffies - start_time));
886}
887
888void rtw_ips_dev_unload23a(struct rtw_adapter *padapter)
889{
890 rtw_hal_set_hwreg23a(padapter, HW_VAR_FIFO_CLEARN_UP, NULL);
891
892 if (padapter->intf_stop)
893 padapter->intf_stop(padapter);
894
895 /* s5. */
896 if (!padapter->bSurpriseRemoved)
897 rtw_hal_deinit23a(padapter);
898}
899
900int pm_netdev_open23a(struct net_device *pnetdev, u8 bnormal)
901{
902 int status;
903
904 if (bnormal)
905 status = netdev_open23a(pnetdev);
906 else
907 status = (_SUCCESS == ips_netdrv_open(netdev_priv(pnetdev))) ?
908 (0) : (-1);
909
910 return status;
911}
912
913static int netdev_close(struct net_device *pnetdev)
914{
915 struct rtw_adapter *padapter = netdev_priv(pnetdev);
916
917 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+871x_drv - drv_close\n"));
918
919 if (padapter->pwrctrlpriv.bInternalAutoSuspend) {
920 if (padapter->pwrctrlpriv.rf_pwrstate == rf_off)
921 padapter->pwrctrlpriv.ps_flag = true;
922 }
923 padapter->net_closed = true;
924
925 if (padapter->pwrctrlpriv.rf_pwrstate == rf_on) {
926 DBG_8723A("(2)871x_drv - drv_close, bup =%d, hw_init_completed =%d\n",
927 padapter->bup,
928 padapter->hw_init_completed);
929
930 /* s1. */
931 if (pnetdev) {
932 if (!rtw_netif_queue_stopped(pnetdev))
933 netif_tx_stop_all_queues(pnetdev);
934 }
935
936 /* s2. */
937 LeaveAllPowerSaveMode23a(padapter);
938 rtw_disassoc_cmd23a(padapter, 500, false);
939 /* s2-2. indicate disconnect to os */
940 rtw_indicate_disconnect23a(padapter);
941 /* s2-3. */
942 rtw_free_assoc_resources23a(padapter, 1);
943 /* s2-4. */
944 rtw_free_network_queue23a(padapter, true);
945 /* Close LED */
946 rtw_led_control(padapter, LED_CTL_POWER_OFF);
947 }
948
949#ifdef CONFIG_8723AU_P2P
950 if (wdev_to_priv(padapter->rtw_wdev)->p2p_enabled)
951 wdev_to_priv(padapter->rtw_wdev)->p2p_enabled = false;
952 rtw_p2p_enable23a(padapter, P2P_ROLE_DISABLE);
953#endif /* CONFIG_8723AU_P2P */
954
955 rtw_scan_abort23a(padapter);
b1925ad8
LF
956
957 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-871x_drv - drv_close\n"));
958 DBG_8723A("-871x_drv - drv_close, bup =%d\n", padapter->bup);
959
960 return 0;
961}
962
963void rtw_ndev_destructor(struct net_device *ndev)
964{
965 DBG_8723A(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev));
966 kfree(ndev->ieee80211_ptr);
967 free_netdev(ndev);
968}
This page took 0.077314 seconds and 5 git commands to generate.