]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/staging/rtl8723bs/os_dep/os_intfs.c
projects / mirror_ubuntu-artful-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge tag 'iio-for-4.13b' of git://git.kernel.org/pub/scm/linux/kernel/git/jic23...
[mirror_ubuntu-artful-kernel.git] / drivers / staging / rtl8723bs / os_dep / os_intfs.c
CommitLineData
554c0a3a
HG		 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 <drv_types.h>
18#include <rtw_debug.h>
19#include <hal_data.h>
20
21MODULE_LICENSE("GPL");
22MODULE_DESCRIPTION("Realtek Wireless Lan Driver");
23MODULE_AUTHOR("Realtek Semiconductor Corp.");
24MODULE_VERSION(DRIVERVERSION);
25
26/* module param defaults */
27static int rtw_chip_version = 0x00;
28static int rtw_rfintfs = HWPI;
29static int rtw_lbkmode = 0;/* RTL8712_AIR_TRX; */
30
31
32static int rtw_network_mode = Ndis802_11IBSS;/* Ndis802_11Infrastructure;infra, ad-hoc, auto */
33/* struct ndis_802_11_ssid ssid; */
34static int rtw_channel = 1;/* ad-hoc support requirement */
35static int rtw_wireless_mode = WIRELESS_MODE_MAX;
36static int rtw_vrtl_carrier_sense = AUTO_VCS;
37static int rtw_vcs_type = RTS_CTS;/* */
38static int rtw_rts_thresh = 2347;/* */
39static int rtw_frag_thresh = 2346;/* */
40static int rtw_preamble = PREAMBLE_LONG;/* long, short, auto */
41static int rtw_scan_mode = 1;/* active, passive */
42static int rtw_adhoc_tx_pwr = 1;
43static int rtw_soft_ap = 0;
44/* int smart_ps = 1; */
45static int rtw_power_mgnt = 1;
46static int rtw_ips_mode = IPS_NORMAL;
47module_param(rtw_ips_mode, int, 0644);
48MODULE_PARM_DESC(rtw_ips_mode,"The default IPS mode");
49
50static int rtw_smart_ps = 2;
51
52static int rtw_check_fw_ps = 1;
53
54static int rtw_usb_rxagg_mode = 2;/* USB_RX_AGG_DMA = 1, USB_RX_AGG_USB =2 */
55module_param(rtw_usb_rxagg_mode, int, 0644);
56
57static int rtw_radio_enable = 1;
58static int rtw_long_retry_lmt = 7;
59static int rtw_short_retry_lmt = 7;
60static int rtw_busy_thresh = 40;
61/* int qos_enable = 0; */
62static int rtw_ack_policy = NORMAL_ACK;
63
64static int rtw_software_encrypt = 0;
65static int rtw_software_decrypt = 0;
66
67static int rtw_acm_method = 0;/* 0:By SW 1:By HW. */
68
69static int rtw_wmm_enable = 1;/* default is set to enable the wmm. */
70static int rtw_uapsd_enable = 0;
71static int rtw_uapsd_max_sp = NO_LIMIT;
72static int rtw_uapsd_acbk_en = 0;
73static int rtw_uapsd_acbe_en = 0;
74static int rtw_uapsd_acvi_en = 0;
75static int rtw_uapsd_acvo_en = 0;
76
77int rtw_ht_enable = 1;
78/* 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz, 4: 80+80MHz */
79/* 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7 */
80/* 0x21 means enable 2.4G 40MHz & 5G 80MHz */
81static int rtw_bw_mode = 0x21;
82static int rtw_ampdu_enable = 1;/* for enable tx_ampdu ,0: disable, 0x1:enable (but wifi_spec should be 0), 0x2: force enable (don't care wifi_spec) */
83static int rtw_rx_stbc = 1;/* 0: disable, 1:enable 2.4g */
84static int rtw_ampdu_amsdu = 0;/* 0: disabled, 1:enabled, 2:auto . There is an IOT issu with DLINK DIR-629 when the flag turn on */
85/* Short GI support Bit Map */
86/* BIT0 - 20MHz, 0: non-support, 1: support */
87/* BIT1 - 40MHz, 0: non-support, 1: support */
88/* BIT2 - 80MHz, 0: non-support, 1: support */
89/* BIT3 - 160MHz, 0: non-support, 1: support */
90static int rtw_short_gi = 0xf;
91/* BIT0: Enable VHT LDPC Rx, BIT1: Enable VHT LDPC Tx, BIT4: Enable HT LDPC Rx, BIT5: Enable HT LDPC Tx */
92static int rtw_ldpc_cap = 0x33;
93/* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */
94static int rtw_stbc_cap = 0x13;
95/* BIT0: Enable VHT Beamformer, BIT1: Enable VHT Beamformee, BIT4: Enable HT Beamformer, BIT5: Enable HT Beamformee */
96static int rtw_beamform_cap = 0x2;
97
98static int rtw_lowrate_two_xmit = 1;/* Use 2 path Tx to transmit MCS0~7 and legacy mode */
99
100/* int rf_config = RF_1T2R; 1T2R */
101static int rtw_rf_config = RF_MAX_TYPE; /* auto */
102static int rtw_low_power = 0;
103static int rtw_wifi_spec = 0;
104static int rtw_channel_plan = RT_CHANNEL_DOMAIN_MAX;
105
106static int rtw_btcoex_enable = 1;
107module_param(rtw_btcoex_enable, int, 0644);
108MODULE_PARM_DESC(rtw_btcoex_enable, "Enable BT co-existence mechanism");
109static int rtw_bt_iso = 2;/* 0:Low, 1:High, 2:From Efuse */
110static int rtw_bt_sco = 3;/* 0:Idle, 1:None-SCO, 2:SCO, 3:From Counter, 4.Busy, 5.OtherBusy */
111static int rtw_bt_ampdu = 1 ;/* 0:Disable BT control A-MPDU, 1:Enable BT control A-MPDU. */
112static int rtw_ant_num = -1; /* <0: undefined, >0: Antenna number */
113module_param(rtw_ant_num, int, 0644);
114MODULE_PARM_DESC(rtw_ant_num, "Antenna number setting");
115
116static int rtw_AcceptAddbaReq = true;/* 0:Reject AP's Add BA req, 1:Accept AP's Add BA req. */
117
118static int rtw_antdiv_cfg = 1; /* 0:OFF , 1:ON, 2:decide by Efuse config */
119static int rtw_antdiv_type = 0 ; /* 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) */
120
121
122static int rtw_enusbss = 0;/* 0:disable, 1:enable */
123
124static int rtw_hwpdn_mode =2;/* 0:disable, 1:enable, 2: by EFUSE config */
125
126#ifdef CONFIG_HW_PWRP_DETECTION
127static int rtw_hwpwrp_detect = 1;
128#else
129static int rtw_hwpwrp_detect = 0; /* HW power ping detect 0:disable , 1:enable */
130#endif
131
132static int rtw_hw_wps_pbc = 0;
133
134int rtw_mc2u_disable = 0;
135
136static int rtw_80211d = 0;
137
138#ifdef CONFIG_QOS_OPTIMIZATION
139static int rtw_qos_opt_enable = 1;/* 0: disable, 1:enable */
140#else
141static int rtw_qos_opt_enable = 0;/* 0: disable, 1:enable */
142#endif
143module_param(rtw_qos_opt_enable, int, 0644);
144
145static char* ifname = "wlan%d";
146module_param(ifname, charp, 0644);
147MODULE_PARM_DESC(ifname, "The default name to allocate for first interface");
148
149char* rtw_initmac = NULL; /* temp mac address if users want to use instead of the mac address in Efuse */
150
151module_param(rtw_initmac, charp, 0644);
152module_param(rtw_channel_plan, int, 0644);
153module_param(rtw_chip_version, int, 0644);
154module_param(rtw_rfintfs, int, 0644);
155module_param(rtw_lbkmode, int, 0644);
156module_param(rtw_network_mode, int, 0644);
157module_param(rtw_channel, int, 0644);
158module_param(rtw_wmm_enable, int, 0644);
159module_param(rtw_vrtl_carrier_sense, int, 0644);
160module_param(rtw_vcs_type, int, 0644);
161module_param(rtw_busy_thresh, int, 0644);
162
163module_param(rtw_ht_enable, int, 0644);
164module_param(rtw_bw_mode, int, 0644);
165module_param(rtw_ampdu_enable, int, 0644);
166module_param(rtw_rx_stbc, int, 0644);
167module_param(rtw_ampdu_amsdu, int, 0644);
168
169module_param(rtw_lowrate_two_xmit, int, 0644);
170
171module_param(rtw_rf_config, int, 0644);
172module_param(rtw_power_mgnt, int, 0644);
173module_param(rtw_smart_ps, int, 0644);
174module_param(rtw_low_power, int, 0644);
175module_param(rtw_wifi_spec, int, 0644);
176
177module_param(rtw_antdiv_cfg, int, 0644);
178module_param(rtw_antdiv_type, int, 0644);
179
180module_param(rtw_enusbss, int, 0644);
181module_param(rtw_hwpdn_mode, int, 0644);
182module_param(rtw_hwpwrp_detect, int, 0644);
183
184module_param(rtw_hw_wps_pbc, int, 0644);
185
186static uint rtw_max_roaming_times =2;
187module_param(rtw_max_roaming_times, uint, 0644);
188MODULE_PARM_DESC(rtw_max_roaming_times,"The max roaming times to try");
189
190module_param(rtw_mc2u_disable, int, 0644);
191
192module_param(rtw_80211d, int, 0644);
193MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism");
194
195static uint rtw_notch_filter = 0;
196module_param(rtw_notch_filter, uint, 0644);
197MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P");
198
199#define CONFIG_RTW_HIQ_FILTER 1
200
201static uint rtw_hiq_filter = CONFIG_RTW_HIQ_FILTER;
202module_param(rtw_hiq_filter, uint, 0644);
203MODULE_PARM_DESC(rtw_hiq_filter, "0:allow all, 1:allow special, 2:deny all");
204
205static int rtw_tx_pwr_lmt_enable = 0;
206static int rtw_tx_pwr_by_rate = 0;
207
208module_param(rtw_tx_pwr_lmt_enable, int, 0644);
209MODULE_PARM_DESC(rtw_tx_pwr_lmt_enable,"0:Disable, 1:Enable, 2: Depend on efuse");
210
211module_param(rtw_tx_pwr_by_rate, int, 0644);
212MODULE_PARM_DESC(rtw_tx_pwr_by_rate,"0:Disable, 1:Enable, 2: Depend on efuse");
213
214char *rtw_phy_file_path = "";
215module_param(rtw_phy_file_path, charp, 0644);
216MODULE_PARM_DESC(rtw_phy_file_path, "The path of phy parameter");
217/* PHY FILE Bit Map */
218/* BIT0 - MAC, 0: non-support, 1: support */
219/* BIT1 - BB, 0: non-support, 1: support */
220/* BIT2 - BB_PG, 0: non-support, 1: support */
221/* BIT3 - BB_MP, 0: non-support, 1: support */
222/* BIT4 - RF, 0: non-support, 1: support */
223/* BIT5 - RF_TXPWR_TRACK, 0: non-support, 1: support */
224/* BIT6 - RF_TXPWR_LMT, 0: non-support, 1: support */
225static int rtw_load_phy_file = (BIT2|BIT6);
226module_param(rtw_load_phy_file, int, 0644);
227MODULE_PARM_DESC(rtw_load_phy_file,"PHY File Bit Map");
228static int rtw_decrypt_phy_file = 0;
229module_param(rtw_decrypt_phy_file, int, 0644);
230MODULE_PARM_DESC(rtw_decrypt_phy_file,"Enable Decrypt PHY File");
231
232int _netdev_open(struct net_device *pnetdev);
233int netdev_open (struct net_device *pnetdev);
234static int netdev_close (struct net_device *pnetdev);
235
236static uint loadparam(struct adapter *padapter, _nic_hdl pnetdev)
237{
238 uint status = _SUCCESS;
239 struct registry_priv *registry_par = &padapter->registrypriv;
240
241 registry_par->chip_version = (u8)rtw_chip_version;
242 registry_par->rfintfs = (u8)rtw_rfintfs;
243 registry_par->lbkmode = (u8)rtw_lbkmode;
244 /* registry_par->hci = (u8)hci; */
245 registry_par->network_mode = (u8)rtw_network_mode;
246
247 memcpy(registry_par->ssid.Ssid, "ANY", 3);
248 registry_par->ssid.SsidLength = 3;
249
250 registry_par->channel = (u8)rtw_channel;
251 registry_par->wireless_mode = (u8)rtw_wireless_mode;
252
253 if (registry_par->channel > 14)
254 registry_par->channel = 1;
255
256 registry_par->vrtl_carrier_sense = (u8)rtw_vrtl_carrier_sense ;
257 registry_par->vcs_type = (u8)rtw_vcs_type;
258 registry_par->rts_thresh =(u16)rtw_rts_thresh;
259 registry_par->frag_thresh =(u16)rtw_frag_thresh;
260 registry_par->preamble = (u8)rtw_preamble;
261 registry_par->scan_mode = (u8)rtw_scan_mode;
262 registry_par->adhoc_tx_pwr = (u8)rtw_adhoc_tx_pwr;
263 registry_par->soft_ap = (u8)rtw_soft_ap;
264 registry_par->smart_ps = (u8)rtw_smart_ps;
265 registry_par->check_fw_ps = (u8)rtw_check_fw_ps;
266 registry_par->power_mgnt = (u8)rtw_power_mgnt;
267 registry_par->ips_mode = (u8)rtw_ips_mode;
268 registry_par->radio_enable = (u8)rtw_radio_enable;
269 registry_par->long_retry_lmt = (u8)rtw_long_retry_lmt;
270 registry_par->short_retry_lmt = (u8)rtw_short_retry_lmt;
271 registry_par->busy_thresh = (u16)rtw_busy_thresh;
272 /* registry_par->qos_enable = (u8)rtw_qos_enable; */
273 registry_par->ack_policy = (u8)rtw_ack_policy;
274 registry_par->software_encrypt = (u8)rtw_software_encrypt;
275 registry_par->software_decrypt = (u8)rtw_software_decrypt;
276
277 registry_par->acm_method = (u8)rtw_acm_method;
278 registry_par->usb_rxagg_mode = (u8)rtw_usb_rxagg_mode;
279
280 /* UAPSD */
281 registry_par->wmm_enable = (u8)rtw_wmm_enable;
282 registry_par->uapsd_enable = (u8)rtw_uapsd_enable;
283 registry_par->uapsd_max_sp = (u8)rtw_uapsd_max_sp;
284 registry_par->uapsd_acbk_en = (u8)rtw_uapsd_acbk_en;
285 registry_par->uapsd_acbe_en = (u8)rtw_uapsd_acbe_en;
286 registry_par->uapsd_acvi_en = (u8)rtw_uapsd_acvi_en;
287 registry_par->uapsd_acvo_en = (u8)rtw_uapsd_acvo_en;
288
289 registry_par->ht_enable = (u8)rtw_ht_enable;
290 registry_par->bw_mode = (u8)rtw_bw_mode;
291 registry_par->ampdu_enable = (u8)rtw_ampdu_enable;
292 registry_par->rx_stbc = (u8)rtw_rx_stbc;
293 registry_par->ampdu_amsdu = (u8)rtw_ampdu_amsdu;
294 registry_par->short_gi = (u8)rtw_short_gi;
295 registry_par->ldpc_cap = (u8)rtw_ldpc_cap;
296 registry_par->stbc_cap = (u8)rtw_stbc_cap;
297 registry_par->beamform_cap = (u8)rtw_beamform_cap;
298
299 registry_par->lowrate_two_xmit = (u8)rtw_lowrate_two_xmit;
300 registry_par->rf_config = (u8)rtw_rf_config;
301 registry_par->low_power = (u8)rtw_low_power;
302
303
304 registry_par->wifi_spec = (u8)rtw_wifi_spec;
305
306 registry_par->channel_plan = (u8)rtw_channel_plan;
307
308 registry_par->btcoex = (u8)rtw_btcoex_enable;
309 registry_par->bt_iso = (u8)rtw_bt_iso;
310 registry_par->bt_sco = (u8)rtw_bt_sco;
311 registry_par->bt_ampdu = (u8)rtw_bt_ampdu;
312 registry_par->ant_num = (s8)rtw_ant_num;
313
314 registry_par->bAcceptAddbaReq = (u8)rtw_AcceptAddbaReq;
315
316 registry_par->antdiv_cfg = (u8)rtw_antdiv_cfg;
317 registry_par->antdiv_type = (u8)rtw_antdiv_type;
318
319 registry_par->hw_wps_pbc = (u8)rtw_hw_wps_pbc;
320
321 registry_par->max_roaming_times = (u8)rtw_max_roaming_times;
322#ifdef CONFIG_INTEL_WIDI
323 registry_par->max_roaming_times = (u8)rtw_max_roaming_times + 2;
324#endif /* CONFIG_INTEL_WIDI */
325
326 registry_par->enable80211d = (u8)rtw_80211d;
327
328 snprintf(registry_par->ifname, 16, "%s", ifname);
329
330 registry_par->notch_filter = (u8)rtw_notch_filter;
331
332 registry_par->RegEnableTxPowerLimit = (u8)rtw_tx_pwr_lmt_enable;
333 registry_par->RegEnableTxPowerByRate = (u8)rtw_tx_pwr_by_rate;
334
335 registry_par->RegPowerBase = 14;
336 registry_par->TxBBSwing_2G = 0xFF;
337 registry_par->TxBBSwing_5G = 0xFF;
338 registry_par->bEn_RFE = 1;
339 registry_par->RFE_Type = 64;
340
341 registry_par->load_phy_file = (u8)rtw_load_phy_file;
342 registry_par->RegDecryptCustomFile = (u8)rtw_decrypt_phy_file;
343 registry_par->qos_opt_enable = (u8)rtw_qos_opt_enable;
344
345 registry_par->hiq_filter = (u8)rtw_hiq_filter;
346 return status;
347}
348
349static int rtw_net_set_mac_address(struct net_device *pnetdev, void *p)
350{
351 struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
352 struct sockaddr *addr = p;
353
354 if (padapter->bup == false)
355 {
356 /* DBG_871X("r8711_net_set_mac_address(), MAC =%x:%x:%x:%x:%x:%x\n", addr->sa_data[0], addr->sa_data[1], addr->sa_data[2], addr->sa_data[3], */
357 /* addr->sa_data[4], addr->sa_data[5]); */
358 memcpy(padapter->eeprompriv.mac_addr, addr->sa_data, ETH_ALEN);
359 /* memcpy(pnetdev->dev_addr, addr->sa_data, ETH_ALEN); */
360 /* padapter->bset_hwaddr = true; */
361 }
362
363 return 0;
364}
365
366static struct net_device_stats *rtw_net_get_stats(struct net_device *pnetdev)
367{
368 struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
369 struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
370 struct recv_priv *precvpriv = &(padapter->recvpriv);
371
372 padapter->stats.tx_packets = pxmitpriv->tx_pkts;/* pxmitpriv->tx_pkts++; */
373 padapter->stats.rx_packets = precvpriv->rx_pkts;/* precvpriv->rx_pkts++; */
374 padapter->stats.tx_dropped = pxmitpriv->tx_drop;
375 padapter->stats.rx_dropped = precvpriv->rx_drop;
376 padapter->stats.tx_bytes = pxmitpriv->tx_bytes;
377 padapter->stats.rx_bytes = precvpriv->rx_bytes;
378
379 return &padapter->stats;
380}
381
382/*
383 * AC to queue mapping
384 *
385 * AC_VO -> queue 0
386 * AC_VI -> queue 1
387 * AC_BE -> queue 2
388 * AC_BK -> queue 3
389 */
390static const u16 rtw_1d_to_queue[8] = { 2, 3, 3, 2, 1, 1, 0, 0 };
391
392/* Given a data frame determine the 802.1p/1d tag to use. */
393static unsigned int rtw_classify8021d(struct sk_buff *skb)
394{
395 unsigned int dscp;
396
397 /* skb->priority values from 256->263 are magic values to
398 * directly indicate a specific 802.1d priority. This is used
399 * to allow 802.1d priority to be passed directly in from VLAN
400 * tags, etc.
401 */
402 if (skb->priority >= 256 && skb->priority <= 263)
403 return skb->priority - 256;
404
405 switch (skb->protocol) {
406 case htons(ETH_P_IP):
407 dscp = ip_hdr(skb)->tos & 0xfc;
408 break;
409 default:
410 return 0;
411 }
412
413 return dscp >> 5;
414}
415
416
417static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb
418 , void *accel_priv
419 , select_queue_fallback_t fallback
420)
421{
422 struct adapter *padapter = rtw_netdev_priv(dev);
423 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
424
425 skb->priority = rtw_classify8021d(skb);
426
427 if (pmlmepriv->acm_mask != 0)
428 {
429 skb->priority = qos_acm(pmlmepriv->acm_mask, skb->priority);
430 }
431
432 return rtw_1d_to_queue[skb->priority];
433}
434
435u16 rtw_recv_select_queue(struct sk_buff *skb)
436{
437 struct iphdr *piphdr;
438 unsigned int dscp;
439 __be16 eth_type;
440 u32 priority;
441 u8 *pdata = skb->data;
442
443 memcpy(&eth_type, pdata+(ETH_ALEN<<1), 2);
444
445 switch (be16_to_cpu(eth_type)) {
446 case ETH_P_IP:
447
448 piphdr = (struct iphdr *)(pdata+ETH_HLEN);
449
450 dscp = piphdr->tos & 0xfc;
451
452 priority = dscp >> 5;
453
454 break;
455 default:
456 priority = 0;
457 }
458
459 return rtw_1d_to_queue[priority];
460
461}
462
463static int rtw_ndev_notifier_call(struct notifier_block * nb, unsigned long state, void *ptr)
464{
465 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
466
467 if (dev->netdev_ops->ndo_do_ioctl != rtw_ioctl)
468 return NOTIFY_DONE;
469
470 DBG_871X_LEVEL(_drv_info_, FUNC_NDEV_FMT" state:%lu\n", FUNC_NDEV_ARG(dev), state);
471
472 switch (state) {
473 case NETDEV_CHANGENAME:
474 rtw_adapter_proc_replace(dev);
475 break;
476 }
477
478 return NOTIFY_DONE;
479}
480
481static struct notifier_block rtw_ndev_notifier = {
482 .notifier_call = rtw_ndev_notifier_call,
483};
484
485int rtw_ndev_notifier_register(void)
486{
487 return register_netdevice_notifier(&rtw_ndev_notifier);
488}
489
490void rtw_ndev_notifier_unregister(void)
491{
492 unregister_netdevice_notifier(&rtw_ndev_notifier);
493}
494
495
496static int rtw_ndev_init(struct net_device *dev)
497{
498 struct adapter *adapter = rtw_netdev_priv(dev);
499
500 DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter));
501 strncpy(adapter->old_ifname, dev->name, IFNAMSIZ);
502 rtw_adapter_proc_init(dev);
503
504 return 0;
505}
506
507static void rtw_ndev_uninit(struct net_device *dev)
508{
509 struct adapter *adapter = rtw_netdev_priv(dev);
510
511 DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter));
512 rtw_adapter_proc_deinit(dev);
513}
514
515static const struct net_device_ops rtw_netdev_ops = {
516 .ndo_init = rtw_ndev_init,
517 .ndo_uninit = rtw_ndev_uninit,
518 .ndo_open = netdev_open,
519 .ndo_stop = netdev_close,
520 .ndo_start_xmit = rtw_xmit_entry,
521 .ndo_select_queue = rtw_select_queue,
522 .ndo_set_mac_address = rtw_net_set_mac_address,
523 .ndo_get_stats = rtw_net_get_stats,
524 .ndo_do_ioctl = rtw_ioctl,
525};
526
527int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname)
528{
529 if (dev_alloc_name(pnetdev, ifname) < 0) {
530 pr_err("dev_alloc_name, fail for %s\n", ifname);
531 return 1;
532 }
533 netif_carrier_off(pnetdev);
534 /* rtw_netif_stop_queue(pnetdev); */
535
536 return 0;
537}
538
539struct net_device *rtw_init_netdev(struct adapter *old_padapter)
540{
541 struct adapter *padapter;
542 struct net_device *pnetdev;
543
544 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+init_net_dev\n"));
545
546 if (old_padapter != NULL)
547 pnetdev = rtw_alloc_etherdev_with_old_priv(sizeof(struct adapter), (void *)old_padapter);
548 else
549 pnetdev = rtw_alloc_etherdev(sizeof(struct adapter));
550
551 pr_info("pnetdev = %p\n", pnetdev);
552 if (!pnetdev)
553 return NULL;
554
555 padapter = rtw_netdev_priv(pnetdev);
556 padapter->pnetdev = pnetdev;
557
558 /* pnetdev->init = NULL; */
559
560 DBG_871X("register rtw_netdev_ops to netdev_ops\n");
561 pnetdev->netdev_ops = &rtw_netdev_ops;
562
563 /* pnetdev->tx_timeout = NULL; */
564 pnetdev->watchdog_timeo = HZ*3; /* 3 second timeout */
565 pnetdev->wireless_handlers = (struct iw_handler_def *)&rtw_handlers_def;
566
567 /* step 2. */
568 loadparam(padapter, pnetdev);
569
570 return pnetdev;
571}
572
573void rtw_unregister_netdevs(struct dvobj_priv *dvobj)
574{
575 struct adapter *padapter = NULL;
576 struct net_device *pnetdev = NULL;
577
578 padapter = dvobj->padapters;
579
580 if (padapter == NULL)
581 return;
582
583 pnetdev = padapter->pnetdev;
584
585 if ((padapter->DriverState != DRIVER_DISAPPEAR) && pnetdev)
586 unregister_netdev(pnetdev); /* will call netdev_close() */
587 rtw_wdev_unregister(padapter->rtw_wdev);
588}
589
590u32 rtw_start_drv_threads(struct adapter *padapter)
591{
592 u32 _status = _SUCCESS;
593
594 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_start_drv_threads\n"));
595 padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD");
596 if (IS_ERR(padapter->xmitThread))
597 _status = _FAIL;
598
599 padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD");
600 if (IS_ERR(padapter->cmdThread))
601 _status = _FAIL;
602 else
603 down(&padapter->cmdpriv.terminate_cmdthread_sema); /* wait for cmd_thread to run */
604
605 rtw_hal_start_thread(padapter);
606 return _status;
607}
608
609void rtw_stop_drv_threads (struct adapter *padapter)
610{
611 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_stop_drv_threads\n"));
612
613 rtw_stop_cmd_thread(padapter);
614
615 /* Below is to termindate tx_thread... */
616 up(&padapter->xmitpriv.xmit_sema);
617 down(&padapter->xmitpriv.terminate_xmitthread_sema);
618 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("\n drv_halt: rtw_xmit_thread can be terminated !\n"));
619
620 rtw_hal_stop_thread(padapter);
621}
622
623static u8 rtw_init_default_value(struct adapter *padapter)
624{
625 u8 ret = _SUCCESS;
626 struct registry_priv* pregistrypriv = &padapter->registrypriv;
627 struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
628 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
629 struct security_priv *psecuritypriv = &padapter->securitypriv;
630
631 /* xmit_priv */
632 pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense;
633 pxmitpriv->vcs = pregistrypriv->vcs_type;
634 pxmitpriv->vcs_type = pregistrypriv->vcs_type;
635 /* pxmitpriv->rts_thresh = pregistrypriv->rts_thresh; */
636 pxmitpriv->frag_len = pregistrypriv->frag_thresh;
637
638 /* recv_priv */
639
640 /* mlme_priv */
641 pmlmepriv->scan_mode = SCAN_ACTIVE;
642
643 /* qos_priv */
644 /* pmlmepriv->qospriv.qos_option = pregistrypriv->wmm_enable; */
645
646 /* ht_priv */
647 pmlmepriv->htpriv.ampdu_enable = false;/* set to disabled */
648
649 /* security_priv */
650 /* rtw_get_encrypt_decrypt_from_registrypriv(padapter); */
651 psecuritypriv->binstallGrpkey = _FAIL;
652#ifdef CONFIG_GTK_OL
653 psecuritypriv->binstallKCK_KEK = _FAIL;
654#endif /* CONFIG_GTK_OL */
655 psecuritypriv->sw_encrypt =pregistrypriv->software_encrypt;
656 psecuritypriv->sw_decrypt =pregistrypriv->software_decrypt;
657
658 psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */
659 psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
660
661 psecuritypriv->dot11PrivacyKeyIndex = 0;
662
663 psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_;
664 psecuritypriv->dot118021XGrpKeyid = 1;
665
666 psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen;
667 psecuritypriv->ndisencryptstatus = Ndis802_11WEPDisabled;
668
669 /* registry_priv */
670 rtw_init_registrypriv_dev_network(padapter);
671 rtw_update_registrypriv_dev_network(padapter);
672
673 /* hal_priv */
674 rtw_hal_def_value_init(padapter);
675
676 /* misc. */
677 RTW_ENABLE_FUNC(padapter, DF_RX_BIT);
678 RTW_ENABLE_FUNC(padapter, DF_TX_BIT);
679 padapter->bLinkInfoDump = 0;
680 padapter->bNotifyChannelChange = 0;
681
682 /* for debug purpose */
683 padapter->fix_rate = 0xFF;
684 padapter->driver_ampdu_spacing = 0xFF;
685 padapter->driver_rx_ampdu_factor = 0xFF;
686
687 return ret;
688}
689
690struct dvobj_priv *devobj_init(void)
691{
692 struct dvobj_priv *pdvobj = NULL;
693
694 if ((pdvobj = (struct dvobj_priv*)rtw_zmalloc(sizeof(*pdvobj))) == NULL)
695 return NULL;
696
697 mutex_init(&pdvobj->hw_init_mutex);
698 mutex_init(&pdvobj->h2c_fwcmd_mutex);
699 mutex_init(&pdvobj->setch_mutex);
700 mutex_init(&pdvobj->setbw_mutex);
701
702 spin_lock_init(&pdvobj->lock);
703
704 pdvobj->macid[1] = true; /* macid = 1 for bc/mc stainfo */
705
706 pdvobj->processing_dev_remove = false;
707
708 atomic_set(&pdvobj->disable_func, 0);
709
710 spin_lock_init(&pdvobj->cam_ctl.lock);
711
712 return pdvobj;
713}
714
715void devobj_deinit(struct dvobj_priv *pdvobj)
716{
717 if (!pdvobj)
718 return;
719
720 mutex_destroy(&pdvobj->hw_init_mutex);
721 mutex_destroy(&pdvobj->h2c_fwcmd_mutex);
722 mutex_destroy(&pdvobj->setch_mutex);
723 mutex_destroy(&pdvobj->setbw_mutex);
724
725 kfree((u8 *)pdvobj);
726}
727
728u8 rtw_reset_drv_sw(struct adapter *padapter)
729{
730 u8 ret8 = _SUCCESS;
731 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
732 struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter);
733
734 /* hal_priv */
735 if (is_primary_adapter(padapter))
736 rtw_hal_def_value_init(padapter);
737
738 RTW_ENABLE_FUNC(padapter, DF_RX_BIT);
739 RTW_ENABLE_FUNC(padapter, DF_TX_BIT);
740 padapter->bLinkInfoDump = 0;
741
742 padapter->xmitpriv.tx_pkts = 0;
743 padapter->recvpriv.rx_pkts = 0;
744
745 pmlmepriv->LinkDetectInfo.bBusyTraffic = false;
746
747 /* pmlmepriv->LinkDetectInfo.TrafficBusyState = false; */
748 pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0;
749 pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0;
750
751 _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY |_FW_UNDER_LINKING);
752
753 pwrctrlpriv->pwr_state_check_cnts = 0;
754
755 /* mlmeextpriv */
756 padapter->mlmeextpriv.sitesurvey_res.state = SCAN_DISABLE;
757
758 rtw_set_signal_stat_timer(&padapter->recvpriv);
759
760 return ret8;
761}
762
763
764u8 rtw_init_drv_sw(struct adapter *padapter)
765{
766 u8 ret8 = _SUCCESS;
767
768 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_init_drv_sw\n"));
769
770 ret8 = rtw_init_default_value(padapter);
771
772 rtw_init_hal_com_default_value(padapter);
773
774 if ((rtw_init_cmd_priv(&padapter->cmdpriv)) == _FAIL) {
775 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init cmd_priv\n"));
776 ret8 = _FAIL;
777 goto exit;
778 }
779
780 padapter->cmdpriv.padapter =padapter;
781
782 if ((rtw_init_evt_priv(&padapter->evtpriv)) == _FAIL) {
783 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init evt_priv\n"));
784 ret8 = _FAIL;
785 goto exit;
786 }
787
788
789 if (rtw_init_mlme_priv(padapter) == _FAIL) {
790 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init mlme_priv\n"));
791 ret8 = _FAIL;
792 goto exit;
793 }
794
795 if (init_mlme_ext_priv(padapter) == _FAIL) {
796 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init mlme_ext_priv\n"));
797 ret8 = _FAIL;
798 goto exit;
799 }
800
801 if (_rtw_init_xmit_priv(&padapter->xmitpriv, padapter) == _FAIL) {
802 DBG_871X("Can't _rtw_init_xmit_priv\n");
803 ret8 = _FAIL;
804 goto exit;
805 }
806
807 if (_rtw_init_recv_priv(&padapter->recvpriv, padapter) == _FAIL) {
808 DBG_871X("Can't _rtw_init_recv_priv\n");
809 ret8 = _FAIL;
810 goto exit;
811 }
812 /* add for CONFIG_IEEE80211W, none 11w also can use */
813 spin_lock_init(&padapter->security_key_mutex);
814
815 /* We don't need to memset padapter->XXX to zero, because adapter is allocated by vzalloc(). */
816 /* memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv)); */
817
818 if (_rtw_init_sta_priv(&padapter->stapriv) == _FAIL) {
819 DBG_871X("Can't _rtw_init_sta_priv\n");
820 ret8 = _FAIL;
821 goto exit;
822 }
823
824 padapter->stapriv.padapter = padapter;
825 padapter->setband = GHZ24_50;
826 padapter->fix_rate = 0xFF;
827 rtw_init_bcmc_stainfo(padapter);
828
829 rtw_init_pwrctrl_priv(padapter);
830
831 rtw_hal_dm_init(padapter);
832
833#ifdef CONFIG_INTEL_WIDI
834 if (rtw_init_intel_widi(padapter) == _FAIL) {
835 DBG_871X("Can't rtw_init_intel_widi\n");
836 ret8 = _FAIL;
837 goto exit;
838 }
839#endif /* CONFIG_INTEL_WIDI */
840
841exit:
842
843 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-rtw_init_drv_sw\n"));
844
845 return ret8;
846}
847
848void rtw_cancel_all_timer(struct adapter *padapter)
849{
850 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_cancel_all_timer\n"));
851
852 del_timer_sync(&padapter->mlmepriv.assoc_timer);
853 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel association timer complete!\n"));
854
855 del_timer_sync(&padapter->mlmepriv.scan_to_timer);
856 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel scan_to_timer!\n"));
857
858 del_timer_sync(&padapter->mlmepriv.dynamic_chk_timer);
859 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel dynamic_chk_timer!\n"));
860
861 del_timer_sync(&(adapter_to_pwrctl(padapter)->pwr_state_check_timer));
862
863 del_timer_sync(&padapter->mlmepriv.set_scan_deny_timer);
864 rtw_clear_scan_deny(padapter);
865 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel set_scan_deny_timer!\n"));
866
867 del_timer_sync(&padapter->recvpriv.signal_stat_timer);
868
869 /* cancel dm timer */
870 rtw_hal_dm_deinit(padapter);
871}
872
873u8 rtw_free_drv_sw(struct adapter *padapter)
874{
875 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("==>rtw_free_drv_sw"));
876
877#ifdef CONFIG_INTEL_WIDI
878 rtw_free_intel_widi(padapter);
879#endif /* CONFIG_INTEL_WIDI */
880
881 free_mlme_ext_priv(&padapter->mlmeextpriv);
882
883 rtw_free_cmd_priv(&padapter->cmdpriv);
884
885 rtw_free_evt_priv(&padapter->evtpriv);
886
887 rtw_free_mlme_priv(&padapter->mlmepriv);
888
889 /* free_io_queue(padapter); */
890
891 _rtw_free_xmit_priv(&padapter->xmitpriv);
892
893 _rtw_free_sta_priv(&padapter->stapriv); /* will free bcmc_stainfo here */
894
895 _rtw_free_recv_priv(&padapter->recvpriv);
896
897 rtw_free_pwrctrl_priv(padapter);
898
899 /* kfree((void *)padapter); */
900
901 rtw_hal_free_data(padapter);
902
903 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("<==rtw_free_drv_sw\n"));
904
905 /* free the old_pnetdev */
906 if (padapter->rereg_nd_name_priv.old_pnetdev) {
907 free_netdev(padapter->rereg_nd_name_priv.old_pnetdev);
908 padapter->rereg_nd_name_priv.old_pnetdev = NULL;
909 }
910
911 /* clear pbuddystruct adapter to avoid access wrong pointer. */
912 if (padapter->pbuddy_adapter != NULL)
913 padapter->pbuddy_adapter->pbuddy_adapter = NULL;
914
915 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-rtw_free_drv_sw\n"));
916
917 return _SUCCESS;
918}
919
920static int _rtw_drv_register_netdev(struct adapter *padapter, char *name)
921{
922 int ret = _SUCCESS;
923 struct net_device *pnetdev = padapter->pnetdev;
924
925 /* alloc netdev name */
926 if (rtw_init_netdev_name(pnetdev, name))
927 return _FAIL;
928
929 memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN);
930
931 /* Tell the network stack we exist */
932 if (register_netdev(pnetdev) != 0) {
933 DBG_871X(FUNC_NDEV_FMT "Failed!\n", FUNC_NDEV_ARG(pnetdev));
934 ret = _FAIL;
935 goto error_register_netdev;
936 }
937
938 DBG_871X("%s, MAC Address (if%d) = " MAC_FMT "\n", __func__, (padapter->iface_id+1), MAC_ARG(pnetdev->dev_addr));
939
940 return ret;
941
942error_register_netdev:
943
944 rtw_free_drv_sw(padapter);
945
946 rtw_free_netdev(pnetdev);
947
948 return ret;
949}
950
951int rtw_drv_register_netdev(struct adapter *if1)
952{
953 struct dvobj_priv *dvobj = if1->dvobj;
954 struct adapter *padapter = dvobj->padapters;
955 char *name = if1->registrypriv.ifname;
956
957 return _rtw_drv_register_netdev(padapter, name);
958}
959
960int _netdev_open(struct net_device *pnetdev)
961{
962 uint status;
963 struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
964 struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter);
965
966 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+871x_drv - dev_open\n"));
967 DBG_871X("+871x_drv - drv_open, bup =%d\n", padapter->bup);
968
969 padapter->netif_up = true;
970
971 if (pwrctrlpriv->ps_flag == true) {
972 padapter->net_closed = false;
973 goto netdev_open_normal_process;
974 }
975
976 if (padapter->bup == false) {
977 padapter->bDriverStopped = false;
978 padapter->bSurpriseRemoved = false;
979 padapter->bCardDisableWOHSM = false;
980
981 status = rtw_hal_init(padapter);
982 if (status == _FAIL) {
983 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("rtl871x_hal_init(): Can't init h/w!\n"));
984 goto netdev_open_error;
985 }
986
987 DBG_871X("MAC Address = "MAC_FMT"\n", MAC_ARG(pnetdev->dev_addr));
988
989 status =rtw_start_drv_threads(padapter);
990 if (status == _FAIL) {
991 DBG_871X("Initialize driver software resource Failed!\n");
992 goto netdev_open_error;
993 }
994
995 if (padapter->intf_start)
996 padapter->intf_start(padapter);
997
998 rtw_cfg80211_init_wiphy(padapter);
999
1000 padapter->bup = true;
1001 pwrctrlpriv->bips_processing = false;
1002 }
1003 padapter->net_closed = false;
1004
1005 _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);
1006
1007 if (!rtw_netif_queue_stopped(pnetdev))
1008 rtw_netif_start_queue(pnetdev);
1009 else
1010 rtw_netif_wake_queue(pnetdev);
1011
1012netdev_open_normal_process:
1013
1014 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-871x_drv - dev_open\n"));
1015 DBG_871X("-871x_drv - drv_open, bup =%d\n", padapter->bup);
1016
1017 return 0;
1018
1019netdev_open_error:
1020
1021 padapter->bup = false;
1022
1023 netif_carrier_off(pnetdev);
1024 rtw_netif_stop_queue(pnetdev);
1025
1026 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("-871x_drv - dev_open, fail!\n"));
1027 DBG_871X("-871x_drv - drv_open fail, bup =%d\n", padapter->bup);
1028
1029 return (-1);
1030
1031}
1032
1033int netdev_open(struct net_device *pnetdev)
1034{
1035 int ret;
1036 struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
1037 struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter);
1038
1039 if (pwrctrlpriv->bInSuspend == true)
1040 {
1041 DBG_871X("+871x_drv - drv_open, bInSuspend =%d\n", pwrctrlpriv->bInSuspend);
1042 return 0;
1043 }
1044
1045 if (mutex_lock_interruptible(&(adapter_to_dvobj(padapter)->hw_init_mutex)))
1046 return -1;
1047
1048 ret = _netdev_open(pnetdev);
1049 mutex_unlock(&(adapter_to_dvobj(padapter)->hw_init_mutex));
1050
1051 return ret;
1052}
1053
1054static int ips_netdrv_open(struct adapter *padapter)
1055{
1056 int status = _SUCCESS;
1057 /* struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); */
1058
1059 padapter->net_closed = false;
1060
1061 DBG_871X("===> %s.........\n", __func__);
1062
1063
1064 padapter->bDriverStopped = false;
1065 padapter->bCardDisableWOHSM = false;
1066 /* padapter->bup = true; */
1067
1068 status = rtw_hal_init(padapter);
1069 if (status == _FAIL)
1070 {
1071 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("ips_netdrv_open(): Can't init h/w!\n"));
1072 goto netdev_open_error;
1073 }
1074
1075 if (padapter->intf_start)
1076 {
1077 padapter->intf_start(padapter);
1078 }
1079
1080 _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);
1081
72544c5f 1082 return _SUCCESS;
554c0a3a
HG		 1083
1084netdev_open_error:
1085 /* padapter->bup = false; */
1086 DBG_871X("-ips_netdrv_open - drv_open failure, bup =%d\n", padapter->bup);
1087
1088 return _FAIL;
1089}
1090
1091
1092int rtw_ips_pwr_up(struct adapter *padapter)
1093{
1094 int result;
1095 DBG_871X("===> rtw_ips_pwr_up..............\n");
1096
1097 result = ips_netdrv_open(padapter);
1098
1099 DBG_871X("<=== rtw_ips_pwr_up..............\n");
1100 return result;
1101
1102}
1103
1104void rtw_ips_pwr_down(struct adapter *padapter)
1105{
1106 DBG_871X("===> rtw_ips_pwr_down...................\n");
1107
1108 padapter->bCardDisableWOHSM = true;
1109 padapter->net_closed = true;
1110
1111 rtw_ips_dev_unload(padapter);
1112 padapter->bCardDisableWOHSM = false;
1113 DBG_871X("<=== rtw_ips_pwr_down.....................\n");
1114}
1115
1116void rtw_ips_dev_unload(struct adapter *padapter)
1117{
1118 DBG_871X("====> %s...\n", __func__);
1119
1120
1121 if (padapter->bSurpriseRemoved == false)
1122 {
1123 rtw_hal_deinit(padapter);
1124 }
1125
1126}
1127
1128
1129static int pm_netdev_open(struct net_device *pnetdev, u8 bnormal)
1130{
1131 int status = -1;
1132
1133 struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
1134
1135 if (true == bnormal)
1136 {
1137 if (mutex_lock_interruptible(&(adapter_to_dvobj(padapter)->hw_init_mutex)) == 0) {
1138 status = _netdev_open(pnetdev);
1139 mutex_unlock(&(adapter_to_dvobj(padapter)->hw_init_mutex));
1140 }
1141 }
1142 else
1143 status = (_SUCCESS == ips_netdrv_open(padapter))?(0):(-1);
1144
1145 return status;
1146}
1147
1148static int netdev_close(struct net_device *pnetdev)
1149{
1150 struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
1151 struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter);
1152
1153 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+871x_drv - drv_close\n"));
1154
1155 if (pwrctl->bInternalAutoSuspend == true)
1156 {
1157 /* rtw_pwr_wakeup(padapter); */
1158 if (pwrctl->rf_pwrstate == rf_off)
1159 pwrctl->ps_flag = true;
1160 }
1161 padapter->net_closed = true;
1162 padapter->netif_up = false;
1163
1164/*if (!padapter->hw_init_completed)
1165 {
1166 DBG_871X("(1)871x_drv - drv_close, bup =%d, hw_init_completed =%d\n", padapter->bup, padapter->hw_init_completed);
1167
1168 padapter->bDriverStopped = true;
1169
1170 rtw_dev_unload(padapter);
1171 }
1172 else*/
1173 if (pwrctl->rf_pwrstate == rf_on) {
1174 DBG_871X("(2)871x_drv - drv_close, bup =%d, hw_init_completed =%d\n", padapter->bup, padapter->hw_init_completed);
1175
1176 /* s1. */
1177 if (pnetdev)
1178 {
1179 if (!rtw_netif_queue_stopped(pnetdev))
1180 rtw_netif_stop_queue(pnetdev);
1181 }
1182
1183 /* s2. */
1184 LeaveAllPowerSaveMode(padapter);
1185 rtw_disassoc_cmd(padapter, 500, false);
1186 /* s2-2. indicate disconnect to os */
1187 rtw_indicate_disconnect(padapter);
1188 /* s2-3. */
1189 rtw_free_assoc_resources(padapter, 1);
1190 /* s2-4. */
1191 rtw_free_network_queue(padapter, true);
1192 }
1193
1194 rtw_scan_abort(padapter);
1195 adapter_wdev_data(padapter)->bandroid_scan = false;
1196
1197 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-871x_drv - drv_close\n"));
1198 DBG_871X("-871x_drv - drv_close, bup =%d\n", padapter->bup);
1199
1200 return 0;
1201
1202}
1203
1204void rtw_ndev_destructor(struct net_device *ndev)
1205{
1206 DBG_871X(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev));
1207
1208 if (ndev->ieee80211_ptr)
1209 kfree((u8 *)ndev->ieee80211_ptr);
554c0a3a
HG		 1210}
1211
1212void rtw_dev_unload(struct adapter *padapter)
1213{
1214 struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter);
1215 struct dvobj_priv *pobjpriv = padapter->dvobj;
1216 struct debug_priv *pdbgpriv = &pobjpriv->drv_dbg;
1217 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1218 u8 cnt = 0;
1219
1220 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("+%s\n", __func__));
1221
1222 if (padapter->bup == true)
1223 {
1224 DBG_871X("===> %s\n", __func__);
1225
1226 padapter->bDriverStopped = true;
1227 if (padapter->xmitpriv.ack_tx)
1228 rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP);
1229
1230 if (padapter->intf_stop)
1231 padapter->intf_stop(padapter);
1232
1233 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("@ rtw_dev_unload: stop intf complete!\n"));
1234
1235 if (!pwrctl->bInternalAutoSuspend)
1236 rtw_stop_drv_threads(padapter);
1237
1238 while (atomic_read(&(pcmdpriv->cmdthd_running)) == true) {
1239 if (cnt > 5) {
1240 DBG_871X("stop cmdthd timeout\n");
1241 break;
1242 } else {
1243 cnt ++;
1244 DBG_871X("cmdthd is running(%d)\n", cnt);
1245 msleep(10);
1246 }
1247 }
1248
1249 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("@ %s: stop thread complete!\n", __func__));
1250
1251 /* check the status of IPS */
1252 if (rtw_hal_check_ips_status(padapter) == true || pwrctl->rf_pwrstate == rf_off) { /* check HW status and SW state */
1253 DBG_871X_LEVEL(_drv_always_, "%s: driver in IPS-FWLPS\n", __func__);
1254 pdbgpriv->dbg_dev_unload_inIPS_cnt++;
1255 LeaveAllPowerSaveMode(padapter);
1256 } else {
1257 DBG_871X_LEVEL(_drv_always_, "%s: driver not in IPS\n", __func__);
1258 }
1259
1260 if (padapter->bSurpriseRemoved == false)
1261 {
1262 rtw_btcoex_IpsNotify(padapter, pwrctl->ips_mode_req);
1263#ifdef CONFIG_WOWLAN
1264 if (pwrctl->bSupportRemoteWakeup == true &&
1265 pwrctl->wowlan_mode ==true) {
1266 DBG_871X_LEVEL(_drv_always_, "%s bSupportRemoteWakeup ==true do not run rtw_hal_deinit()\n", __func__);
1267 }
1268 else
1269#endif
1270 {
1271 /* amy modify 20120221 for power seq is different between driver open and ips */
1272 rtw_hal_deinit(padapter);
1273 }
1274 padapter->bSurpriseRemoved = true;
1275 }
103ab687
CIK		 1276 RT_TRACE(_module_hci_intfs_c_, _drv_notice_,
1277 ("@ %s: deinit hal complete!\n", __func__));
554c0a3a
HG		 1278
1279 padapter->bup = false;
1280
1281 DBG_871X("<=== %s\n", __func__);
1282 }
1283 else {
1284 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("%s: bup ==false\n", __func__));
1285 DBG_871X("%s: bup ==false\n", __func__);
1286 }
1287
1288 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("-%s\n", __func__));
1289}
1290
1291static int rtw_suspend_free_assoc_resource(struct adapter *padapter)
1292{
1293 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1294
1295 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1296
1297 if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) {
1298 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)
1299 && check_fwstate(pmlmepriv, _FW_LINKED))
1300 {
1301 DBG_871X("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n", __func__,
1302 pmlmepriv->cur_network.network.Ssid.Ssid,
1303 MAC_ARG(pmlmepriv->cur_network.network.MacAddress),
1304 pmlmepriv->cur_network.network.Ssid.SsidLength,
1305 pmlmepriv->assoc_ssid.SsidLength);
1306 rtw_set_to_roam(padapter, 1);
1307 }
1308 }
1309
1310 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED))
1311 {
1312 rtw_disassoc_cmd(padapter, 0, false);
1313 /* s2-2. indicate disconnect to os */
1314 rtw_indicate_disconnect(padapter);
1315 }
1316 else if (check_fwstate(pmlmepriv, WIFI_AP_STATE))
1317 {
1318 rtw_sta_flush(padapter);
1319 }
1320
1321 /* s2-3. */
1322 rtw_free_assoc_resources(padapter, 1);
1323
1324 /* s2-4. */
1325 rtw_free_network_queue(padapter, true);
1326
1327 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
1328 rtw_indicate_scan_done(padapter, 1);
1329
1330 if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true)
1331 {
1332 DBG_871X_LEVEL(_drv_always_, "%s: fw_under_linking\n", __func__);
1333 rtw_indicate_disconnect(padapter);
1334 }
1335
1336 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1337 return _SUCCESS;
1338}
1339
1340#ifdef CONFIG_WOWLAN
1341int rtw_suspend_wow(struct adapter *padapter)
1342{
1343 u8 ch, bw, offset;
1344 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1345 struct net_device *pnetdev = padapter->pnetdev;
1346 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
1347 struct wowlan_ioctl_param poidparam;
1348 int ret = _SUCCESS;
1349
1350 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1351
1352
1353 DBG_871X("wowlan_mode: %d\n", pwrpriv->wowlan_mode);
1354 DBG_871X("wowlan_pno_enable: %d\n", pwrpriv->wowlan_pno_enable);
1355
1356 if (pwrpriv->wowlan_mode == true) {
1357 if (pnetdev)
1358 rtw_netif_stop_queue(pnetdev);
1359 /* 1. stop thread */
1360 padapter->bDriverStopped = true; /* for stop thread */
1361 rtw_stop_drv_threads(padapter);
1362 padapter->bDriverStopped = false; /* for 32k command */
1363
1364 /* 2. disable interrupt */
1365 if (padapter->intf_stop) {
1366 padapter->intf_stop(padapter);
1367 }
1368
1369 /* 2.1 clean interupt */
1370 if (padapter->HalFunc.clear_interrupt)
1371 padapter->HalFunc.clear_interrupt(padapter);
1372
1373 /* 2.2 free irq */
1374 /* sdio_free_irq(adapter_to_dvobj(padapter)); */
1375 if (padapter->intf_free_irq)
1376 padapter->intf_free_irq(adapter_to_dvobj(padapter));
1377
1378 poidparam.subcode = WOWLAN_ENABLE;
1379 padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam);
1380 if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) {
1381 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)
1382 && check_fwstate(pmlmepriv, _FW_LINKED))
1383 {
1384 DBG_871X("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n", __func__,
1385 pmlmepriv->cur_network.network.Ssid.Ssid,
1386 MAC_ARG(pmlmepriv->cur_network.network.MacAddress),
1387 pmlmepriv->cur_network.network.Ssid.SsidLength,
1388 pmlmepriv->assoc_ssid.SsidLength);
1389
1390 rtw_set_to_roam(padapter, 0);
1391 }
1392 }
1393
1394 DBG_871X_LEVEL(_drv_always_, "%s: wowmode suspending\n", __func__);
1395
1396 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true)
1397 {
1398 DBG_871X_LEVEL(_drv_always_, "%s: fw_under_survey\n", __func__);
1399 rtw_indicate_scan_done(padapter, 1);
1400 clr_fwstate(pmlmepriv, _FW_UNDER_SURVEY);
1401 }
1402
1403 if (rtw_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) {
1404 DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n",
1405 FUNC_ADPT_ARG(padapter), ch, bw, offset);
1406 set_channel_bwmode(padapter, ch, offset, bw);
1407 }
1408
1409 if (pwrpriv->wowlan_pno_enable)
1410 DBG_871X_LEVEL(_drv_always_, "%s: pno: %d\n", __func__, pwrpriv->wowlan_pno_enable);
1411 else
1412 rtw_set_ps_mode(padapter, PS_MODE_DTIM, 0, 0, "WOWLAN");
1413
1414 }
1415 else
1416 {
1417 DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR ### wowlan_mode =%d\n", __func__, pwrpriv->wowlan_mode);
1418 }
1419 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1420 return ret;
1421}
1422#endif /* ifdef CONFIG_WOWLAN */
1423
1424#ifdef CONFIG_AP_WOWLAN
1425int rtw_suspend_ap_wow(struct adapter *padapter)
1426{
1427 u8 ch, bw, offset;
1428 struct net_device *pnetdev = padapter->pnetdev;
1429 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
1430 struct wowlan_ioctl_param poidparam;
1431 int ret = _SUCCESS;
1432
1433 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1434
1435 pwrpriv->wowlan_ap_mode = true;
1436
1437 DBG_871X("wowlan_ap_mode: %d\n", pwrpriv->wowlan_ap_mode);
1438
1439 if (pnetdev)
1440 rtw_netif_stop_queue(pnetdev);
1441 /* 1. stop thread */
1442 padapter->bDriverStopped = true; /* for stop thread */
1443 rtw_stop_drv_threads(padapter);
1444 padapter->bDriverStopped = false; /* for 32k command */
1445
1446 /* 2. disable interrupt */
1447 rtw_hal_disable_interrupt(padapter); /* It need wait for leaving 32K. */
1448
1449 /* 2.1 clean interupt */
1450 if (padapter->HalFunc.clear_interrupt)
1451 padapter->HalFunc.clear_interrupt(padapter);
1452
1453 /* 2.2 free irq */
1454 /* sdio_free_irq(adapter_to_dvobj(padapter)); */
1455 if (padapter->intf_free_irq)
1456 padapter->intf_free_irq(adapter_to_dvobj(padapter));
1457
1458 poidparam.subcode = WOWLAN_AP_ENABLE;
1459 padapter->HalFunc.SetHwRegHandler(padapter,
1460 HW_VAR_AP_WOWLAN, (u8 *)&poidparam);
1461
1462 DBG_871X_LEVEL(_drv_always_, "%s: wowmode suspending\n", __func__);
1463
1464 if (rtw_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) {
1465 DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n",
1466 FUNC_ADPT_ARG(padapter), ch, bw, offset);
1467 set_channel_bwmode(padapter, ch, offset, bw);
1468 }
1469
1470 rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, 0, "AP-WOWLAN");
1471
1472 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1473 return ret;
1474}
1475#endif /* ifdef CONFIG_AP_WOWLAN */
1476
1477
1478static int rtw_suspend_normal(struct adapter *padapter)
1479{
1480 struct net_device *pnetdev = padapter->pnetdev;
1481 int ret = _SUCCESS;
1482
1483 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1484 if (pnetdev) {
1485 netif_carrier_off(pnetdev);
1486 rtw_netif_stop_queue(pnetdev);
1487 }
1488
1489 rtw_suspend_free_assoc_resource(padapter);
1490
1491 if ((rtw_hal_check_ips_status(padapter) == true)
1492 || (adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off))
1493 {
1494 DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR #### driver in IPS ####ERROR###!!!\n", __func__);
1495
1496 }
1497
1498 rtw_dev_unload(padapter);
1499
1500 /* sdio_deinit(adapter_to_dvobj(padapter)); */
1501 if (padapter->intf_deinit)
1502 padapter->intf_deinit(adapter_to_dvobj(padapter));
1503
1504 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1505 return ret;
1506}
1507
1508int rtw_suspend_common(struct adapter *padapter)
1509{
1510 struct dvobj_priv *psdpriv = padapter->dvobj;
1511 struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;
1512 struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(psdpriv);
1513 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1514
1515 int ret = 0;
1516 unsigned long start_time = jiffies;
1517
1518 DBG_871X_LEVEL(_drv_always_, " suspend start\n");
1519 DBG_871X("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
1520 pdbgpriv->dbg_suspend_cnt++;
1521
1522 pwrpriv->bInSuspend = true;
1523
1524 while (pwrpriv->bips_processing == true)
1525 msleep(1);
1526
1527 if ((!padapter->bup) || (padapter->bDriverStopped)||(padapter->bSurpriseRemoved))
1528 {
1529 DBG_871X("%s bup =%d bDriverStopped =%d bSurpriseRemoved = %d\n", __func__
1530 , padapter->bup, padapter->bDriverStopped, padapter->bSurpriseRemoved);
1531 pdbgpriv->dbg_suspend_error_cnt++;
1532 goto exit;
1533 }
1534 rtw_ps_deny(padapter, PS_DENY_SUSPEND);
1535
1536 rtw_cancel_all_timer(padapter);
1537
1538 LeaveAllPowerSaveModeDirect(padapter);
1539
1540 rtw_stop_cmd_thread(padapter);
1541
1542 /* wait for the latest FW to remove this condition. */
1543 if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) {
1544 rtw_btcoex_SuspendNotify(padapter, 0);
1545 DBG_871X("WIFI_AP_STATE\n");
1546 } else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) {
1547 rtw_btcoex_SuspendNotify(padapter, 1);
1548 DBG_871X("STATION\n");
1549 }
1550
1551 rtw_ps_deny_cancel(padapter, PS_DENY_SUSPEND);
1552
1553 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) {
1554 #ifdef CONFIG_WOWLAN
1555 if (check_fwstate(pmlmepriv, _FW_LINKED)) {
1556 pwrpriv->wowlan_mode = true;
1557 } else if (pwrpriv->wowlan_pno_enable == true) {
1558 pwrpriv->wowlan_mode |= pwrpriv->wowlan_pno_enable;
1559 }
1560
1561 if (pwrpriv->wowlan_mode == true)
1562 rtw_suspend_wow(padapter);
1563 else
1564 rtw_suspend_normal(padapter);
1565
1566 #else /* CONFIG_WOWLAN */
1567 rtw_suspend_normal(padapter);
1568 #endif /* CONFIG_WOWLAN */
1569 } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) {
1570 #ifdef CONFIG_AP_WOWLAN
1571 rtw_suspend_ap_wow(padapter);
1572 #else
1573 rtw_suspend_normal(padapter);
1574 #endif /* CONFIG_AP_WOWLAN */
1575 } else {
1576 rtw_suspend_normal(padapter);
1577 }
1578
1579 DBG_871X_LEVEL(_drv_always_, "rtw suspend success in %d ms\n",
1580 jiffies_to_msecs(jiffies - start_time));
1581
1582exit:
1583 DBG_871X("<=== %s return %d.............. in %dms\n", __func__
1584 , ret, jiffies_to_msecs(jiffies - start_time));
1585
1586 return ret;
1587}
1588
1589#ifdef CONFIG_WOWLAN
1590int rtw_resume_process_wow(struct adapter *padapter)
1591{
1592 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1593 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1594 struct net_device *pnetdev = padapter->pnetdev;
1595 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
1596 struct dvobj_priv *psdpriv = padapter->dvobj;
1597 struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;
1598 struct wowlan_ioctl_param poidparam;
1599 struct sta_info *psta = NULL;
1600 int ret = _SUCCESS;
1601
1602 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1603
1604 if (padapter) {
1605 pnetdev = padapter->pnetdev;
1606 pwrpriv = adapter_to_pwrctl(padapter);
1607 } else {
1608 pdbgpriv->dbg_resume_error_cnt++;
1609 ret = -1;
1610 goto exit;
1611 }
1612
1613 if (padapter->bDriverStopped || padapter->bSurpriseRemoved) {
1614 DBG_871X("%s pdapter %p bDriverStopped %d bSurpriseRemoved %d\n",
1615 __func__, padapter, padapter->bDriverStopped,
1616 padapter->bSurpriseRemoved);
1617 goto exit;
1618 }
1619
1620#ifdef CONFIG_PNO_SUPPORT
1621 pwrpriv->pno_in_resume = true;
1622#endif
1623
1624 if (pwrpriv->wowlan_mode == true) {
1625 rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN");
1626
1627 pwrpriv->bFwCurrentInPSMode = false;
1628
1629 if (padapter->intf_stop) {
1630 padapter->intf_stop(padapter);
1631 }
1632
1633 if (padapter->HalFunc.clear_interrupt)
1634 padapter->HalFunc.clear_interrupt(padapter);
1635
1636 /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */
1637 if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) {
1638 ret = -1;
1639 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __func__));
1640 goto exit;
1641 }
1642
1643 /* Disable WOW, set H2C command */
1644 poidparam.subcode =WOWLAN_DISABLE;
1645 padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam);
1646
1647 psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv));
1648 if (psta) {
1649 set_sta_rate(padapter, psta);
1650 }
1651
1652
1653 padapter->bDriverStopped = false;
1654 DBG_871X("%s: wowmode resuming, DriverStopped:%d\n", __func__, padapter->bDriverStopped);
1655 rtw_start_drv_threads(padapter);
1656
1657 if (padapter->intf_start) {
1658 padapter->intf_start(padapter);
1659 }
1660
1661 /* start netif queue */
1662 if (pnetdev) {
1663 if (!rtw_netif_queue_stopped(pnetdev))
1664 rtw_netif_start_queue(pnetdev);
1665 else
1666 rtw_netif_wake_queue(pnetdev);
1667 }
1668 }
1669 else {
1670
1671 DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR ### wowlan_mode =%d\n", __func__, pwrpriv->wowlan_mode);
1672 }
1673
1674 if (padapter->pid[1]!= 0) {
1675 DBG_871X("pid[1]:%d\n", padapter->pid[1]);
1676 rtw_signal_process(padapter->pid[1], SIGUSR2);
1677 }
1678
1679 if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) {
1680 if (pwrpriv->wowlan_wake_reason == FWDecisionDisconnect ||
1681 pwrpriv->wowlan_wake_reason == Rx_DisAssoc ||
1682 pwrpriv->wowlan_wake_reason == Rx_DeAuth) {
1683
1684 DBG_871X("%s: disconnect reason: %02x\n", __func__,
1685 pwrpriv->wowlan_wake_reason);
1686 rtw_indicate_disconnect(padapter);
1687
1688 rtw_sta_media_status_rpt(padapter,
1689 rtw_get_stainfo(&padapter->stapriv,
1690 get_bssid(&padapter->mlmepriv)), 0);
1691
1692 rtw_free_assoc_resources(padapter, 1);
1693 pmlmeinfo->state = WIFI_FW_NULL_STATE;
1694
1695 } else {
1696 DBG_871X("%s: do roaming\n", __func__);
1697 rtw_roaming(padapter, NULL);
1698 }
1699 }
1700
1701 if (pwrpriv->wowlan_mode == true) {
1702 pwrpriv->bips_processing = false;
1703 _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);
1704 } else {
1705 DBG_871X_LEVEL(_drv_always_, "do not reset timer\n");
1706 }
1707
1708 pwrpriv->wowlan_mode =false;
1709
1710 /* clean driver side wake up reason. */
1711 pwrpriv->wowlan_wake_reason = 0;
1712exit:
1713 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1714 return ret;
1715}
1716#endif /* ifdef CONFIG_WOWLAN */
1717
1718#ifdef CONFIG_AP_WOWLAN
1719int rtw_resume_process_ap_wow(struct adapter *padapter)
1720{
1721 struct net_device *pnetdev = padapter->pnetdev;
1722 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
1723 struct dvobj_priv *psdpriv = padapter->dvobj;
1724 struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;
1725 struct wowlan_ioctl_param poidparam;
1726 int ret = _SUCCESS;
1727
1728 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1729
1730 if (padapter) {
1731 pnetdev = padapter->pnetdev;
1732 pwrpriv = adapter_to_pwrctl(padapter);
1733 } else {
1734 pdbgpriv->dbg_resume_error_cnt++;
1735 ret = -1;
1736 goto exit;
1737 }
1738
1739 rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "AP-WOWLAN");
1740
1741 pwrpriv->bFwCurrentInPSMode = false;
1742
1743 rtw_hal_disable_interrupt(padapter);
1744
1745 if (padapter->HalFunc.clear_interrupt)
1746 padapter->HalFunc.clear_interrupt(padapter);
1747
1748 /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */
1749 if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) {
1750 ret = -1;
1751 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __func__));
1752 goto exit;
1753 }
1754
1755 /* Disable WOW, set H2C command */
1756 poidparam.subcode = WOWLAN_AP_DISABLE;
1757 padapter->HalFunc.SetHwRegHandler(padapter,
1758 HW_VAR_AP_WOWLAN, (u8 *)&poidparam);
1759 pwrpriv->wowlan_ap_mode = false;
1760
1761 padapter->bDriverStopped = false;
1762 DBG_871X("%s: wowmode resuming, DriverStopped:%d\n", __func__, padapter->bDriverStopped);
1763 rtw_start_drv_threads(padapter);
1764
1765 if (padapter->intf_start) {
1766 padapter->intf_start(padapter);
1767 }
1768
1769 /* start netif queue */
1770 if (pnetdev) {
1771 if (!rtw_netif_queue_stopped(pnetdev))
1772 rtw_netif_start_queue(pnetdev);
1773 else
1774 rtw_netif_wake_queue(pnetdev);
1775 }
1776
1777 if (padapter->pid[1]!= 0) {
1778 DBG_871X("pid[1]:%d\n", padapter->pid[1]);
1779 rtw_signal_process(padapter->pid[1], SIGUSR2);
1780 }
1781
1782 pwrpriv->bips_processing = false;
1783 _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);
1784
1785 /* clean driver side wake up reason. */
1786 pwrpriv->wowlan_wake_reason = 0;
1787exit:
1788 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1789 return ret;
1790}
1791#endif /* ifdef CONFIG_APWOWLAN */
1792
1793static int rtw_resume_process_normal(struct adapter *padapter)
1794{
1795 struct net_device *pnetdev;
1796 struct pwrctrl_priv *pwrpriv;
1797 struct mlme_priv *pmlmepriv;
1798 struct dvobj_priv *psdpriv;
1799 struct debug_priv *pdbgpriv;
1800
1801 int ret = _SUCCESS;
1802
1803 if (!padapter) {
1804 ret = -1;
1805 goto exit;
1806 }
1807
1808 pnetdev = padapter->pnetdev;
1809 pwrpriv = adapter_to_pwrctl(padapter);
1810 pmlmepriv = &padapter->mlmepriv;
1811 psdpriv = padapter->dvobj;
1812 pdbgpriv = &psdpriv->drv_dbg;
1813
1814 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1815 /* interface init */
1816 /* if (sdio_init(adapter_to_dvobj(padapter)) != _SUCCESS) */
1817 if ((padapter->intf_init) && (padapter->intf_init(adapter_to_dvobj(padapter)) != _SUCCESS))
1818 {
1819 ret = -1;
1820 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: initialize SDIO Failed!!\n", __func__));
1821 goto exit;
1822 }
1823 rtw_hal_disable_interrupt(padapter);
1824 /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) */
1825 if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS))
1826 {
1827 ret = -1;
1828 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __func__));
1829 goto exit;
1830 }
1831
1832 rtw_reset_drv_sw(padapter);
1833 pwrpriv->bkeepfwalive = false;
1834
1835 DBG_871X("bkeepfwalive(%x)\n", pwrpriv->bkeepfwalive);
1836 if (pm_netdev_open(pnetdev, true) != 0) {
1837 ret = -1;
1838 pdbgpriv->dbg_resume_error_cnt++;
1839 goto exit;
1840 }
1841
1842 netif_device_attach(pnetdev);
1843 netif_carrier_on(pnetdev);
1844
1845 if (padapter->pid[1]!= 0) {
1846 DBG_871X("pid[1]:%d\n", padapter->pid[1]);
1847 rtw_signal_process(padapter->pid[1], SIGUSR2);
1848 }
1849
1850
1851 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) {
1852 DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv));
1853
1854 if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME))
1855 rtw_roaming(padapter, NULL);
1856
1857 } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) {
1858 DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv));
1859 rtw_ap_restore_network(padapter);
1860 } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) {
1861 DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv));
1862 } else {
1863 DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv));
1864 }
1865
1866 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1867
1868exit:
1869 return ret;
1870}
1871
1872int rtw_resume_common(struct adapter *padapter)
1873{
1874 int ret = 0;
1875 unsigned long start_time = jiffies;
1876 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
1877 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1878
1879 DBG_871X_LEVEL(_drv_always_, "resume start\n");
1880 DBG_871X("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
1881
1882 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) {
1883 #ifdef CONFIG_WOWLAN
1884 if (pwrpriv->wowlan_mode == true)
1885 rtw_resume_process_wow(padapter);
1886 else
1887 rtw_resume_process_normal(padapter);
1888 #else
1889 rtw_resume_process_normal(padapter);
1890 #endif
1891
1892 } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) {
1893 #ifdef CONFIG_AP_WOWLAN
1894 rtw_resume_process_ap_wow(padapter);
1895 #else
1896 rtw_resume_process_normal(padapter);
1897 #endif /* CONFIG_AP_WOWLAN */
1898 } else {
1899 rtw_resume_process_normal(padapter);
1900 }
1901
1902 rtw_btcoex_SuspendNotify(padapter, 0);
1903
1904 if (pwrpriv) {
1905 pwrpriv->bInSuspend = false;
1906 #ifdef CONFIG_PNO_SUPPORT
1907 pwrpriv->pno_in_resume = false;
1908 #endif
1909 }
1910 DBG_871X_LEVEL(_drv_always_, "%s:%d in %d ms\n", __func__ , ret,
1911 jiffies_to_msecs(jiffies - start_time));
1912
1913 return ret;
1914}
Ubuntu Artful kernel mirror