]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/staging/rtl8723bs/os_dep/os_intfs.c
projects / mirror_ubuntu-artful-kernel.git / blob
? search:


843be2cc6c1035472b7021b85cb21aed77a5e5e8
[mirror_ubuntu-artful-kernel.git] / drivers / staging / rtl8723bs / os_dep / os_intfs.c
1 /******************************************************************************
2 *
3 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of version 2 of the GNU General Public License as
7 * published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 ******************************************************************************/
15 #define _OS_INTFS_C_
16
17 #include <drv_types.h>
18 #include <rtw_debug.h>
19 #include <hal_data.h>
20
21 MODULE_LICENSE("GPL");
22 MODULE_DESCRIPTION("Realtek Wireless Lan Driver");
23 MODULE_AUTHOR("Realtek Semiconductor Corp.");
24 MODULE_VERSION(DRIVERVERSION);
25
26 /* module param defaults */
27 static int rtw_chip_version = 0x00;
28 static int rtw_rfintfs = HWPI;
29 static int rtw_lbkmode = 0;/* RTL8712_AIR_TRX; */
30
31
32 static int rtw_network_mode = Ndis802_11IBSS;/* Ndis802_11Infrastructure;infra, ad-hoc, auto */
33 /* struct ndis_802_11_ssid ssid; */
34 static int rtw_channel = 1;/* ad-hoc support requirement */
35 static int rtw_wireless_mode = WIRELESS_MODE_MAX;
36 static int rtw_vrtl_carrier_sense = AUTO_VCS;
37 static int rtw_vcs_type = RTS_CTS;/* */
38 static int rtw_rts_thresh = 2347;/* */
39 static int rtw_frag_thresh = 2346;/* */
40 static int rtw_preamble = PREAMBLE_LONG;/* long, short, auto */
41 static int rtw_scan_mode = 1;/* active, passive */
42 static int rtw_adhoc_tx_pwr = 1;
43 static int rtw_soft_ap = 0;
44 /* int smart_ps = 1; */
45 static int rtw_power_mgnt = 1;
46 static int rtw_ips_mode = IPS_NORMAL;
47 module_param(rtw_ips_mode, int, 0644);
48 MODULE_PARM_DESC(rtw_ips_mode,"The default IPS mode");
49
50 static int rtw_smart_ps = 2;
51
52 static int rtw_check_fw_ps = 1;
53
54 static int rtw_usb_rxagg_mode = 2;/* USB_RX_AGG_DMA = 1, USB_RX_AGG_USB =2 */
55 module_param(rtw_usb_rxagg_mode, int, 0644);
56
57 static int rtw_radio_enable = 1;
58 static int rtw_long_retry_lmt = 7;
59 static int rtw_short_retry_lmt = 7;
60 static int rtw_busy_thresh = 40;
61 /* int qos_enable = 0; */
62 static int rtw_ack_policy = NORMAL_ACK;
63
64 static int rtw_software_encrypt = 0;
65 static int rtw_software_decrypt = 0;
66
67 static int rtw_acm_method = 0;/* 0:By SW 1:By HW. */
68
69 static int rtw_wmm_enable = 1;/* default is set to enable the wmm. */
70 static int rtw_uapsd_enable = 0;
71 static int rtw_uapsd_max_sp = NO_LIMIT;
72 static int rtw_uapsd_acbk_en = 0;
73 static int rtw_uapsd_acbe_en = 0;
74 static int rtw_uapsd_acvi_en = 0;
75 static int rtw_uapsd_acvo_en = 0;
76
77 int 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 */
81 static int rtw_bw_mode = 0x21;
82 static 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) */
83 static int rtw_rx_stbc = 1;/* 0: disable, 1:enable 2.4g */
84 static 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 */
90 static 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 */
92 static 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 */
94 static int rtw_stbc_cap = 0x13;
95 /* BIT0: Enable VHT Beamformer, BIT1: Enable VHT Beamformee, BIT4: Enable HT Beamformer, BIT5: Enable HT Beamformee */
96 static int rtw_beamform_cap = 0x2;
97
98 static 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 */
101 static int rtw_rf_config = RF_MAX_TYPE; /* auto */
102 static int rtw_low_power = 0;
103 static int rtw_wifi_spec = 0;
104 static int rtw_channel_plan = RT_CHANNEL_DOMAIN_MAX;
105
106 static int rtw_btcoex_enable = 1;
107 module_param(rtw_btcoex_enable, int, 0644);
108 MODULE_PARM_DESC(rtw_btcoex_enable, "Enable BT co-existence mechanism");
109 static int rtw_bt_iso = 2;/* 0:Low, 1:High, 2:From Efuse */
110 static int rtw_bt_sco = 3;/* 0:Idle, 1:None-SCO, 2:SCO, 3:From Counter, 4.Busy, 5.OtherBusy */
111 static int rtw_bt_ampdu = 1 ;/* 0:Disable BT control A-MPDU, 1:Enable BT control A-MPDU. */
112 static int rtw_ant_num = -1; /* <0: undefined, >0: Antenna number */
113 module_param(rtw_ant_num, int, 0644);
114 MODULE_PARM_DESC(rtw_ant_num, "Antenna number setting");
115
116 static int rtw_AcceptAddbaReq = true;/* 0:Reject AP's Add BA req, 1:Accept AP's Add BA req. */
117
118 static int rtw_antdiv_cfg = 1; /* 0:OFF , 1:ON, 2:decide by Efuse config */
119 static 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
122 static int rtw_enusbss = 0;/* 0:disable, 1:enable */
123
124 static int rtw_hwpdn_mode =2;/* 0:disable, 1:enable, 2: by EFUSE config */
125
126 #ifdef CONFIG_HW_PWRP_DETECTION
127 static int rtw_hwpwrp_detect = 1;
128 #else
129 static int rtw_hwpwrp_detect = 0; /* HW power ping detect 0:disable , 1:enable */
130 #endif
131
132 static int rtw_hw_wps_pbc = 0;
133
134 int rtw_mc2u_disable = 0;
135
136 static int rtw_80211d = 0;
137
138 #ifdef CONFIG_QOS_OPTIMIZATION
139 static int rtw_qos_opt_enable = 1;/* 0: disable, 1:enable */
140 #else
141 static int rtw_qos_opt_enable = 0;/* 0: disable, 1:enable */
142 #endif
143 module_param(rtw_qos_opt_enable, int, 0644);
144
145 static char* ifname = "wlan%d";
146 module_param(ifname, charp, 0644);
147 MODULE_PARM_DESC(ifname, "The default name to allocate for first interface");
148
149 char* rtw_initmac = NULL; /* temp mac address if users want to use instead of the mac address in Efuse */
150
151 module_param(rtw_initmac, charp, 0644);
152 module_param(rtw_channel_plan, int, 0644);
153 module_param(rtw_chip_version, int, 0644);
154 module_param(rtw_rfintfs, int, 0644);
155 module_param(rtw_lbkmode, int, 0644);
156 module_param(rtw_network_mode, int, 0644);
157 module_param(rtw_channel, int, 0644);
158 module_param(rtw_wmm_enable, int, 0644);
159 module_param(rtw_vrtl_carrier_sense, int, 0644);
160 module_param(rtw_vcs_type, int, 0644);
161 module_param(rtw_busy_thresh, int, 0644);
162
163 module_param(rtw_ht_enable, int, 0644);
164 module_param(rtw_bw_mode, int, 0644);
165 module_param(rtw_ampdu_enable, int, 0644);
166 module_param(rtw_rx_stbc, int, 0644);
167 module_param(rtw_ampdu_amsdu, int, 0644);
168
169 module_param(rtw_lowrate_two_xmit, int, 0644);
170
171 module_param(rtw_rf_config, int, 0644);
172 module_param(rtw_power_mgnt, int, 0644);
173 module_param(rtw_smart_ps, int, 0644);
174 module_param(rtw_low_power, int, 0644);
175 module_param(rtw_wifi_spec, int, 0644);
176
177 module_param(rtw_antdiv_cfg, int, 0644);
178 module_param(rtw_antdiv_type, int, 0644);
179
180 module_param(rtw_enusbss, int, 0644);
181 module_param(rtw_hwpdn_mode, int, 0644);
182 module_param(rtw_hwpwrp_detect, int, 0644);
183
184 module_param(rtw_hw_wps_pbc, int, 0644);
185
186 static uint rtw_max_roaming_times =2;
187 module_param(rtw_max_roaming_times, uint, 0644);
188 MODULE_PARM_DESC(rtw_max_roaming_times,"The max roaming times to try");
189
190 module_param(rtw_mc2u_disable, int, 0644);
191
192 module_param(rtw_80211d, int, 0644);
193 MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism");
194
195 static uint rtw_notch_filter = 0;
196 module_param(rtw_notch_filter, uint, 0644);
197 MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P");
198
199 #define CONFIG_RTW_HIQ_FILTER 1
200
201 static uint rtw_hiq_filter = CONFIG_RTW_HIQ_FILTER;
202 module_param(rtw_hiq_filter, uint, 0644);
203 MODULE_PARM_DESC(rtw_hiq_filter, "0:allow all, 1:allow special, 2:deny all");
204
205 static int rtw_tx_pwr_lmt_enable = 0;
206 static int rtw_tx_pwr_by_rate = 0;
207
208 module_param(rtw_tx_pwr_lmt_enable, int, 0644);
209 MODULE_PARM_DESC(rtw_tx_pwr_lmt_enable,"0:Disable, 1:Enable, 2: Depend on efuse");
210
211 module_param(rtw_tx_pwr_by_rate, int, 0644);
212 MODULE_PARM_DESC(rtw_tx_pwr_by_rate,"0:Disable, 1:Enable, 2: Depend on efuse");
213
214 char *rtw_phy_file_path = "";
215 module_param(rtw_phy_file_path, charp, 0644);
216 MODULE_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 */
225 static int rtw_load_phy_file = (BIT2|BIT6);
226 module_param(rtw_load_phy_file, int, 0644);
227 MODULE_PARM_DESC(rtw_load_phy_file,"PHY File Bit Map");
228 static int rtw_decrypt_phy_file = 0;
229 module_param(rtw_decrypt_phy_file, int, 0644);
230 MODULE_PARM_DESC(rtw_decrypt_phy_file,"Enable Decrypt PHY File");
231
232 int _netdev_open(struct net_device *pnetdev);
233 int netdev_open (struct net_device *pnetdev);
234 static int netdev_close (struct net_device *pnetdev);
235
236 static 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
349 static 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
366 static 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 */
390 static 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. */
393 static 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
417 static 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
435 u16 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
463 static 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
481 static struct notifier_block rtw_ndev_notifier = {
482 .notifier_call = rtw_ndev_notifier_call,
483 };
484
485 int rtw_ndev_notifier_register(void)
486 {
487 return register_netdevice_notifier(&rtw_ndev_notifier);
488 }
489
490 void rtw_ndev_notifier_unregister(void)
491 {
492 unregister_netdevice_notifier(&rtw_ndev_notifier);
493 }
494
495
496 static 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
507 static 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
515 static 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
527 int 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
539 struct 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
573 void 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
590 u32 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
609 void 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
623 static 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
690 struct 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
715 void 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
728 u8 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
764 u8 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
841 exit:
842
843 RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-rtw_init_drv_sw\n"));
844
845 return ret8;
846 }
847
848 void 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
873 u8 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
920 static 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
942 error_register_netdev:
943
944 rtw_free_drv_sw(padapter);
945
946 rtw_free_netdev(pnetdev);
947
948 return ret;
949 }
950
951 int 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
960 int _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
1012 netdev_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
1019 netdev_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
1033 int 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
1054 static 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
1082 return _SUCCESS;
1083
1084 netdev_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
1092 int 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
1104 void 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
1116 void 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
1129 static 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
1148 static 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
1204 void 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);
1210
1211 free_netdev(ndev);
1212 }
1213
1214 void rtw_dev_unload(struct adapter *padapter)
1215 {
1216 struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter);
1217 struct dvobj_priv *pobjpriv = padapter->dvobj;
1218 struct debug_priv *pdbgpriv = &pobjpriv->drv_dbg;
1219 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1220 u8 cnt = 0;
1221
1222 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("+%s\n", __func__));
1223
1224 if (padapter->bup == true)
1225 {
1226 DBG_871X("===> %s\n", __func__);
1227
1228 padapter->bDriverStopped = true;
1229 if (padapter->xmitpriv.ack_tx)
1230 rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP);
1231
1232 if (padapter->intf_stop)
1233 padapter->intf_stop(padapter);
1234
1235 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("@ rtw_dev_unload: stop intf complete!\n"));
1236
1237 if (!pwrctl->bInternalAutoSuspend)
1238 rtw_stop_drv_threads(padapter);
1239
1240 while (atomic_read(&(pcmdpriv->cmdthd_running)) == true) {
1241 if (cnt > 5) {
1242 DBG_871X("stop cmdthd timeout\n");
1243 break;
1244 } else {
1245 cnt ++;
1246 DBG_871X("cmdthd is running(%d)\n", cnt);
1247 msleep(10);
1248 }
1249 }
1250
1251 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("@ %s: stop thread complete!\n", __func__));
1252
1253 /* check the status of IPS */
1254 if (rtw_hal_check_ips_status(padapter) == true || pwrctl->rf_pwrstate == rf_off) { /* check HW status and SW state */
1255 DBG_871X_LEVEL(_drv_always_, "%s: driver in IPS-FWLPS\n", __func__);
1256 pdbgpriv->dbg_dev_unload_inIPS_cnt++;
1257 LeaveAllPowerSaveMode(padapter);
1258 } else {
1259 DBG_871X_LEVEL(_drv_always_, "%s: driver not in IPS\n", __func__);
1260 }
1261
1262 if (padapter->bSurpriseRemoved == false)
1263 {
1264 rtw_btcoex_IpsNotify(padapter, pwrctl->ips_mode_req);
1265 #ifdef CONFIG_WOWLAN
1266 if (pwrctl->bSupportRemoteWakeup == true &&
1267 pwrctl->wowlan_mode ==true) {
1268 DBG_871X_LEVEL(_drv_always_, "%s bSupportRemoteWakeup ==true do not run rtw_hal_deinit()\n", __func__);
1269 }
1270 else
1271 #endif
1272 {
1273 /* amy modify 20120221 for power seq is different between driver open and ips */
1274 rtw_hal_deinit(padapter);
1275 }
1276 padapter->bSurpriseRemoved = true;
1277 }
1278 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("@ %s: deinit hal complelt!\n", __func__));
1279
1280 padapter->bup = false;
1281
1282 DBG_871X("<=== %s\n", __func__);
1283 }
1284 else {
1285 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("%s: bup ==false\n", __func__));
1286 DBG_871X("%s: bup ==false\n", __func__);
1287 }
1288
1289 RT_TRACE(_module_hci_intfs_c_, _drv_notice_, ("-%s\n", __func__));
1290 }
1291
1292 static int rtw_suspend_free_assoc_resource(struct adapter *padapter)
1293 {
1294 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1295
1296 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1297
1298 if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) {
1299 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)
1300 && check_fwstate(pmlmepriv, _FW_LINKED))
1301 {
1302 DBG_871X("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n", __func__,
1303 pmlmepriv->cur_network.network.Ssid.Ssid,
1304 MAC_ARG(pmlmepriv->cur_network.network.MacAddress),
1305 pmlmepriv->cur_network.network.Ssid.SsidLength,
1306 pmlmepriv->assoc_ssid.SsidLength);
1307 rtw_set_to_roam(padapter, 1);
1308 }
1309 }
1310
1311 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED))
1312 {
1313 rtw_disassoc_cmd(padapter, 0, false);
1314 /* s2-2. indicate disconnect to os */
1315 rtw_indicate_disconnect(padapter);
1316 }
1317 else if (check_fwstate(pmlmepriv, WIFI_AP_STATE))
1318 {
1319 rtw_sta_flush(padapter);
1320 }
1321
1322 /* s2-3. */
1323 rtw_free_assoc_resources(padapter, 1);
1324
1325 /* s2-4. */
1326 rtw_free_network_queue(padapter, true);
1327
1328 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
1329 rtw_indicate_scan_done(padapter, 1);
1330
1331 if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true)
1332 {
1333 DBG_871X_LEVEL(_drv_always_, "%s: fw_under_linking\n", __func__);
1334 rtw_indicate_disconnect(padapter);
1335 }
1336
1337 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1338 return _SUCCESS;
1339 }
1340
1341 #ifdef CONFIG_WOWLAN
1342 int rtw_suspend_wow(struct adapter *padapter)
1343 {
1344 u8 ch, bw, offset;
1345 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1346 struct net_device *pnetdev = padapter->pnetdev;
1347 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
1348 struct wowlan_ioctl_param poidparam;
1349 int ret = _SUCCESS;
1350
1351 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1352
1353
1354 DBG_871X("wowlan_mode: %d\n", pwrpriv->wowlan_mode);
1355 DBG_871X("wowlan_pno_enable: %d\n", pwrpriv->wowlan_pno_enable);
1356
1357 if (pwrpriv->wowlan_mode == true) {
1358 if (pnetdev)
1359 rtw_netif_stop_queue(pnetdev);
1360 /* 1. stop thread */
1361 padapter->bDriverStopped = true; /* for stop thread */
1362 rtw_stop_drv_threads(padapter);
1363 padapter->bDriverStopped = false; /* for 32k command */
1364
1365 /* 2. disable interrupt */
1366 if (padapter->intf_stop) {
1367 padapter->intf_stop(padapter);
1368 }
1369
1370 /* 2.1 clean interupt */
1371 if (padapter->HalFunc.clear_interrupt)
1372 padapter->HalFunc.clear_interrupt(padapter);
1373
1374 /* 2.2 free irq */
1375 /* sdio_free_irq(adapter_to_dvobj(padapter)); */
1376 if (padapter->intf_free_irq)
1377 padapter->intf_free_irq(adapter_to_dvobj(padapter));
1378
1379 poidparam.subcode = WOWLAN_ENABLE;
1380 padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam);
1381 if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) {
1382 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)
1383 && check_fwstate(pmlmepriv, _FW_LINKED))
1384 {
1385 DBG_871X("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n", __func__,
1386 pmlmepriv->cur_network.network.Ssid.Ssid,
1387 MAC_ARG(pmlmepriv->cur_network.network.MacAddress),
1388 pmlmepriv->cur_network.network.Ssid.SsidLength,
1389 pmlmepriv->assoc_ssid.SsidLength);
1390
1391 rtw_set_to_roam(padapter, 0);
1392 }
1393 }
1394
1395 DBG_871X_LEVEL(_drv_always_, "%s: wowmode suspending\n", __func__);
1396
1397 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true)
1398 {
1399 DBG_871X_LEVEL(_drv_always_, "%s: fw_under_survey\n", __func__);
1400 rtw_indicate_scan_done(padapter, 1);
1401 clr_fwstate(pmlmepriv, _FW_UNDER_SURVEY);
1402 }
1403
1404 if (rtw_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) {
1405 DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n",
1406 FUNC_ADPT_ARG(padapter), ch, bw, offset);
1407 set_channel_bwmode(padapter, ch, offset, bw);
1408 }
1409
1410 if (pwrpriv->wowlan_pno_enable)
1411 DBG_871X_LEVEL(_drv_always_, "%s: pno: %d\n", __func__, pwrpriv->wowlan_pno_enable);
1412 else
1413 rtw_set_ps_mode(padapter, PS_MODE_DTIM, 0, 0, "WOWLAN");
1414
1415 }
1416 else
1417 {
1418 DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR ### wowlan_mode =%d\n", __func__, pwrpriv->wowlan_mode);
1419 }
1420 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1421 return ret;
1422 }
1423 #endif /* ifdef CONFIG_WOWLAN */
1424
1425 #ifdef CONFIG_AP_WOWLAN
1426 int rtw_suspend_ap_wow(struct adapter *padapter)
1427 {
1428 u8 ch, bw, offset;
1429 struct net_device *pnetdev = padapter->pnetdev;
1430 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
1431 struct wowlan_ioctl_param poidparam;
1432 int ret = _SUCCESS;
1433
1434 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1435
1436 pwrpriv->wowlan_ap_mode = true;
1437
1438 DBG_871X("wowlan_ap_mode: %d\n", pwrpriv->wowlan_ap_mode);
1439
1440 if (pnetdev)
1441 rtw_netif_stop_queue(pnetdev);
1442 /* 1. stop thread */
1443 padapter->bDriverStopped = true; /* for stop thread */
1444 rtw_stop_drv_threads(padapter);
1445 padapter->bDriverStopped = false; /* for 32k command */
1446
1447 /* 2. disable interrupt */
1448 rtw_hal_disable_interrupt(padapter); /* It need wait for leaving 32K. */
1449
1450 /* 2.1 clean interupt */
1451 if (padapter->HalFunc.clear_interrupt)
1452 padapter->HalFunc.clear_interrupt(padapter);
1453
1454 /* 2.2 free irq */
1455 /* sdio_free_irq(adapter_to_dvobj(padapter)); */
1456 if (padapter->intf_free_irq)
1457 padapter->intf_free_irq(adapter_to_dvobj(padapter));
1458
1459 poidparam.subcode = WOWLAN_AP_ENABLE;
1460 padapter->HalFunc.SetHwRegHandler(padapter,
1461 HW_VAR_AP_WOWLAN, (u8 *)&poidparam);
1462
1463 DBG_871X_LEVEL(_drv_always_, "%s: wowmode suspending\n", __func__);
1464
1465 if (rtw_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) {
1466 DBG_871X(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n",
1467 FUNC_ADPT_ARG(padapter), ch, bw, offset);
1468 set_channel_bwmode(padapter, ch, offset, bw);
1469 }
1470
1471 rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, 0, "AP-WOWLAN");
1472
1473 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1474 return ret;
1475 }
1476 #endif /* ifdef CONFIG_AP_WOWLAN */
1477
1478
1479 static int rtw_suspend_normal(struct adapter *padapter)
1480 {
1481 struct net_device *pnetdev = padapter->pnetdev;
1482 int ret = _SUCCESS;
1483
1484 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1485 if (pnetdev) {
1486 netif_carrier_off(pnetdev);
1487 rtw_netif_stop_queue(pnetdev);
1488 }
1489
1490 rtw_suspend_free_assoc_resource(padapter);
1491
1492 if ((rtw_hal_check_ips_status(padapter) == true)
1493 || (adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off))
1494 {
1495 DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR #### driver in IPS ####ERROR###!!!\n", __func__);
1496
1497 }
1498
1499 rtw_dev_unload(padapter);
1500
1501 /* sdio_deinit(adapter_to_dvobj(padapter)); */
1502 if (padapter->intf_deinit)
1503 padapter->intf_deinit(adapter_to_dvobj(padapter));
1504
1505 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1506 return ret;
1507 }
1508
1509 int rtw_suspend_common(struct adapter *padapter)
1510 {
1511 struct dvobj_priv *psdpriv = padapter->dvobj;
1512 struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;
1513 struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(psdpriv);
1514 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1515
1516 int ret = 0;
1517 unsigned long start_time = jiffies;
1518
1519 DBG_871X_LEVEL(_drv_always_, " suspend start\n");
1520 DBG_871X("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
1521 pdbgpriv->dbg_suspend_cnt++;
1522
1523 pwrpriv->bInSuspend = true;
1524
1525 while (pwrpriv->bips_processing == true)
1526 msleep(1);
1527
1528 if ((!padapter->bup) || (padapter->bDriverStopped)||(padapter->bSurpriseRemoved))
1529 {
1530 DBG_871X("%s bup =%d bDriverStopped =%d bSurpriseRemoved = %d\n", __func__
1531 , padapter->bup, padapter->bDriverStopped, padapter->bSurpriseRemoved);
1532 pdbgpriv->dbg_suspend_error_cnt++;
1533 goto exit;
1534 }
1535 rtw_ps_deny(padapter, PS_DENY_SUSPEND);
1536
1537 rtw_cancel_all_timer(padapter);
1538
1539 LeaveAllPowerSaveModeDirect(padapter);
1540
1541 rtw_stop_cmd_thread(padapter);
1542
1543 /* wait for the latest FW to remove this condition. */
1544 if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) {
1545 rtw_btcoex_SuspendNotify(padapter, 0);
1546 DBG_871X("WIFI_AP_STATE\n");
1547 } else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) {
1548 rtw_btcoex_SuspendNotify(padapter, 1);
1549 DBG_871X("STATION\n");
1550 }
1551
1552 rtw_ps_deny_cancel(padapter, PS_DENY_SUSPEND);
1553
1554 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) {
1555 #ifdef CONFIG_WOWLAN
1556 if (check_fwstate(pmlmepriv, _FW_LINKED)) {
1557 pwrpriv->wowlan_mode = true;
1558 } else if (pwrpriv->wowlan_pno_enable == true) {
1559 pwrpriv->wowlan_mode |= pwrpriv->wowlan_pno_enable;
1560 }
1561
1562 if (pwrpriv->wowlan_mode == true)
1563 rtw_suspend_wow(padapter);
1564 else
1565 rtw_suspend_normal(padapter);
1566
1567 #else /* CONFIG_WOWLAN */
1568 rtw_suspend_normal(padapter);
1569 #endif /* CONFIG_WOWLAN */
1570 } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) {
1571 #ifdef CONFIG_AP_WOWLAN
1572 rtw_suspend_ap_wow(padapter);
1573 #else
1574 rtw_suspend_normal(padapter);
1575 #endif /* CONFIG_AP_WOWLAN */
1576 } else {
1577 rtw_suspend_normal(padapter);
1578 }
1579
1580 DBG_871X_LEVEL(_drv_always_, "rtw suspend success in %d ms\n",
1581 jiffies_to_msecs(jiffies - start_time));
1582
1583 exit:
1584 DBG_871X("<=== %s return %d.............. in %dms\n", __func__
1585 , ret, jiffies_to_msecs(jiffies - start_time));
1586
1587 return ret;
1588 }
1589
1590 #ifdef CONFIG_WOWLAN
1591 int rtw_resume_process_wow(struct adapter *padapter)
1592 {
1593 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1594 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1595 struct net_device *pnetdev = padapter->pnetdev;
1596 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
1597 struct dvobj_priv *psdpriv = padapter->dvobj;
1598 struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;
1599 struct wowlan_ioctl_param poidparam;
1600 struct sta_info *psta = NULL;
1601 int ret = _SUCCESS;
1602
1603 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1604
1605 if (padapter) {
1606 pnetdev = padapter->pnetdev;
1607 pwrpriv = adapter_to_pwrctl(padapter);
1608 } else {
1609 pdbgpriv->dbg_resume_error_cnt++;
1610 ret = -1;
1611 goto exit;
1612 }
1613
1614 if (padapter->bDriverStopped || padapter->bSurpriseRemoved) {
1615 DBG_871X("%s pdapter %p bDriverStopped %d bSurpriseRemoved %d\n",
1616 __func__, padapter, padapter->bDriverStopped,
1617 padapter->bSurpriseRemoved);
1618 goto exit;
1619 }
1620
1621 #ifdef CONFIG_PNO_SUPPORT
1622 pwrpriv->pno_in_resume = true;
1623 #endif
1624
1625 if (pwrpriv->wowlan_mode == true) {
1626 rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN");
1627
1628 pwrpriv->bFwCurrentInPSMode = false;
1629
1630 if (padapter->intf_stop) {
1631 padapter->intf_stop(padapter);
1632 }
1633
1634 if (padapter->HalFunc.clear_interrupt)
1635 padapter->HalFunc.clear_interrupt(padapter);
1636
1637 /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */
1638 if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) {
1639 ret = -1;
1640 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __func__));
1641 goto exit;
1642 }
1643
1644 /* Disable WOW, set H2C command */
1645 poidparam.subcode =WOWLAN_DISABLE;
1646 padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam);
1647
1648 psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv));
1649 if (psta) {
1650 set_sta_rate(padapter, psta);
1651 }
1652
1653
1654 padapter->bDriverStopped = false;
1655 DBG_871X("%s: wowmode resuming, DriverStopped:%d\n", __func__, padapter->bDriverStopped);
1656 rtw_start_drv_threads(padapter);
1657
1658 if (padapter->intf_start) {
1659 padapter->intf_start(padapter);
1660 }
1661
1662 /* start netif queue */
1663 if (pnetdev) {
1664 if (!rtw_netif_queue_stopped(pnetdev))
1665 rtw_netif_start_queue(pnetdev);
1666 else
1667 rtw_netif_wake_queue(pnetdev);
1668 }
1669 }
1670 else {
1671
1672 DBG_871X_LEVEL(_drv_always_, "%s: ### ERROR ### wowlan_mode =%d\n", __func__, pwrpriv->wowlan_mode);
1673 }
1674
1675 if (padapter->pid[1]!= 0) {
1676 DBG_871X("pid[1]:%d\n", padapter->pid[1]);
1677 rtw_signal_process(padapter->pid[1], SIGUSR2);
1678 }
1679
1680 if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) {
1681 if (pwrpriv->wowlan_wake_reason == FWDecisionDisconnect ||
1682 pwrpriv->wowlan_wake_reason == Rx_DisAssoc ||
1683 pwrpriv->wowlan_wake_reason == Rx_DeAuth) {
1684
1685 DBG_871X("%s: disconnect reason: %02x\n", __func__,
1686 pwrpriv->wowlan_wake_reason);
1687 rtw_indicate_disconnect(padapter);
1688
1689 rtw_sta_media_status_rpt(padapter,
1690 rtw_get_stainfo(&padapter->stapriv,
1691 get_bssid(&padapter->mlmepriv)), 0);
1692
1693 rtw_free_assoc_resources(padapter, 1);
1694 pmlmeinfo->state = WIFI_FW_NULL_STATE;
1695
1696 } else {
1697 DBG_871X("%s: do roaming\n", __func__);
1698 rtw_roaming(padapter, NULL);
1699 }
1700 }
1701
1702 if (pwrpriv->wowlan_mode == true) {
1703 pwrpriv->bips_processing = false;
1704 _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);
1705 } else {
1706 DBG_871X_LEVEL(_drv_always_, "do not reset timer\n");
1707 }
1708
1709 pwrpriv->wowlan_mode =false;
1710
1711 /* clean driver side wake up reason. */
1712 pwrpriv->wowlan_wake_reason = 0;
1713 exit:
1714 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1715 return ret;
1716 }
1717 #endif /* ifdef CONFIG_WOWLAN */
1718
1719 #ifdef CONFIG_AP_WOWLAN
1720 int rtw_resume_process_ap_wow(struct adapter *padapter)
1721 {
1722 struct net_device *pnetdev = padapter->pnetdev;
1723 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
1724 struct dvobj_priv *psdpriv = padapter->dvobj;
1725 struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;
1726 struct wowlan_ioctl_param poidparam;
1727 int ret = _SUCCESS;
1728
1729 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1730
1731 if (padapter) {
1732 pnetdev = padapter->pnetdev;
1733 pwrpriv = adapter_to_pwrctl(padapter);
1734 } else {
1735 pdbgpriv->dbg_resume_error_cnt++;
1736 ret = -1;
1737 goto exit;
1738 }
1739
1740 rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "AP-WOWLAN");
1741
1742 pwrpriv->bFwCurrentInPSMode = false;
1743
1744 rtw_hal_disable_interrupt(padapter);
1745
1746 if (padapter->HalFunc.clear_interrupt)
1747 padapter->HalFunc.clear_interrupt(padapter);
1748
1749 /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */
1750 if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) {
1751 ret = -1;
1752 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __func__));
1753 goto exit;
1754 }
1755
1756 /* Disable WOW, set H2C command */
1757 poidparam.subcode = WOWLAN_AP_DISABLE;
1758 padapter->HalFunc.SetHwRegHandler(padapter,
1759 HW_VAR_AP_WOWLAN, (u8 *)&poidparam);
1760 pwrpriv->wowlan_ap_mode = false;
1761
1762 padapter->bDriverStopped = false;
1763 DBG_871X("%s: wowmode resuming, DriverStopped:%d\n", __func__, padapter->bDriverStopped);
1764 rtw_start_drv_threads(padapter);
1765
1766 if (padapter->intf_start) {
1767 padapter->intf_start(padapter);
1768 }
1769
1770 /* start netif queue */
1771 if (pnetdev) {
1772 if (!rtw_netif_queue_stopped(pnetdev))
1773 rtw_netif_start_queue(pnetdev);
1774 else
1775 rtw_netif_wake_queue(pnetdev);
1776 }
1777
1778 if (padapter->pid[1]!= 0) {
1779 DBG_871X("pid[1]:%d\n", padapter->pid[1]);
1780 rtw_signal_process(padapter->pid[1], SIGUSR2);
1781 }
1782
1783 pwrpriv->bips_processing = false;
1784 _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);
1785
1786 /* clean driver side wake up reason. */
1787 pwrpriv->wowlan_wake_reason = 0;
1788 exit:
1789 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1790 return ret;
1791 }
1792 #endif /* ifdef CONFIG_APWOWLAN */
1793
1794 static int rtw_resume_process_normal(struct adapter *padapter)
1795 {
1796 struct net_device *pnetdev;
1797 struct pwrctrl_priv *pwrpriv;
1798 struct mlme_priv *pmlmepriv;
1799 struct dvobj_priv *psdpriv;
1800 struct debug_priv *pdbgpriv;
1801
1802 int ret = _SUCCESS;
1803
1804 if (!padapter) {
1805 ret = -1;
1806 goto exit;
1807 }
1808
1809 pnetdev = padapter->pnetdev;
1810 pwrpriv = adapter_to_pwrctl(padapter);
1811 pmlmepriv = &padapter->mlmepriv;
1812 psdpriv = padapter->dvobj;
1813 pdbgpriv = &psdpriv->drv_dbg;
1814
1815 DBG_871X("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter));
1816 /* interface init */
1817 /* if (sdio_init(adapter_to_dvobj(padapter)) != _SUCCESS) */
1818 if ((padapter->intf_init) && (padapter->intf_init(adapter_to_dvobj(padapter)) != _SUCCESS))
1819 {
1820 ret = -1;
1821 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: initialize SDIO Failed!!\n", __func__));
1822 goto exit;
1823 }
1824 rtw_hal_disable_interrupt(padapter);
1825 /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) */
1826 if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS))
1827 {
1828 ret = -1;
1829 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: sdio_alloc_irq Failed!!\n", __func__));
1830 goto exit;
1831 }
1832
1833 rtw_reset_drv_sw(padapter);
1834 pwrpriv->bkeepfwalive = false;
1835
1836 DBG_871X("bkeepfwalive(%x)\n", pwrpriv->bkeepfwalive);
1837 if (pm_netdev_open(pnetdev, true) != 0) {
1838 ret = -1;
1839 pdbgpriv->dbg_resume_error_cnt++;
1840 goto exit;
1841 }
1842
1843 netif_device_attach(pnetdev);
1844 netif_carrier_on(pnetdev);
1845
1846 if (padapter->pid[1]!= 0) {
1847 DBG_871X("pid[1]:%d\n", padapter->pid[1]);
1848 rtw_signal_process(padapter->pid[1], SIGUSR2);
1849 }
1850
1851
1852 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) {
1853 DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv));
1854
1855 if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME))
1856 rtw_roaming(padapter, NULL);
1857
1858 } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) {
1859 DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv));
1860 rtw_ap_restore_network(padapter);
1861 } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) {
1862 DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv));
1863 } else {
1864 DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv));
1865 }
1866
1867 DBG_871X("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter));
1868
1869 exit:
1870 return ret;
1871 }
1872
1873 int rtw_resume_common(struct adapter *padapter)
1874 {
1875 int ret = 0;
1876 unsigned long start_time = jiffies;
1877 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
1878 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1879
1880 DBG_871X_LEVEL(_drv_always_, "resume start\n");
1881 DBG_871X("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
1882
1883 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == true) {
1884 #ifdef CONFIG_WOWLAN
1885 if (pwrpriv->wowlan_mode == true)
1886 rtw_resume_process_wow(padapter);
1887 else
1888 rtw_resume_process_normal(padapter);
1889 #else
1890 rtw_resume_process_normal(padapter);
1891 #endif
1892
1893 } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == true) {
1894 #ifdef CONFIG_AP_WOWLAN
1895 rtw_resume_process_ap_wow(padapter);
1896 #else
1897 rtw_resume_process_normal(padapter);
1898 #endif /* CONFIG_AP_WOWLAN */
1899 } else {
1900 rtw_resume_process_normal(padapter);
1901 }
1902
1903 rtw_btcoex_SuspendNotify(padapter, 0);
1904
1905 if (pwrpriv) {
1906 pwrpriv->bInSuspend = false;
1907 #ifdef CONFIG_PNO_SUPPORT
1908 pwrpriv->pno_in_resume = false;
1909 #endif
1910 }
1911 DBG_871X_LEVEL(_drv_always_, "%s:%d in %d ms\n", __func__ , ret,
1912 jiffies_to_msecs(jiffies - start_time));
1913
1914 return ret;
1915 }
Ubuntu Artful kernel mirror