Pileus Git - ~andy/linux/blob - drivers/staging/rtl8188eu/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  * You should have received a copy of the GNU General Public License along with
  15  * this program; if not, write to the Free Software Foundation, Inc.,
  16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  17  *
  18  *
  19  ******************************************************************************/
  20 #define _OS_INTFS_C_
  21
  22 #include <osdep_service.h>
  23 #include <drv_types.h>
  24 #include <xmit_osdep.h>
  25 #include <recv_osdep.h>
  26 #include <hal_intf.h>
  27 #include <rtw_ioctl.h>
  28 #include <rtw_version.h>
  29
  30 #include <usb_osintf.h>
  31 #include <usb_hal.h>
  32 #include <rtw_br_ext.h>
  33
  34 MODULE_LICENSE("GPL");
  35 MODULE_DESCRIPTION("Realtek Wireless Lan Driver");
  36 MODULE_AUTHOR("Realtek Semiconductor Corp.");
  37 MODULE_VERSION(DRIVERVERSION);
  38
  39 #define CONFIG_BR_EXT_BRNAME "br0"
  40 #define RTW_NOTCH_FILTER 0 /* 0:Disable, 1:Enable, */
  41
  42 /* module param defaults */
  43 static int rtw_chip_version = 0x00;
  44 static int rtw_rfintfs = HWPI;
  45 static int rtw_lbkmode;/* RTL8712_AIR_TRX; */
  46 static int rtw_network_mode = Ndis802_11IBSS;/* Ndis802_11Infrastructure; infra, ad-hoc, auto */
  47 static int rtw_channel = 1;/* ad-hoc support requirement */
  48 static int rtw_wireless_mode = WIRELESS_11BG_24N;
  49 static int rtw_vrtl_carrier_sense = AUTO_VCS;
  50 static int rtw_vcs_type = RTS_CTS;/*  */
  51 static int rtw_rts_thresh = 2347;/*  */
  52 static int rtw_frag_thresh = 2346;/*  */
  53 static int rtw_preamble = PREAMBLE_LONG;/* long, short, auto */
  54 static int rtw_scan_mode = 1;/* active, passive */
  55 static int rtw_adhoc_tx_pwr = 1;
  56 static int rtw_soft_ap;
  57 static int rtw_power_mgnt = 1;
  58 static int rtw_ips_mode = IPS_NORMAL;
  59
  60 static int rtw_smart_ps = 2;
  61
  62 module_param(rtw_ips_mode, int, 0644);
  63 MODULE_PARM_DESC(rtw_ips_mode, "The default IPS mode");
  64
  65 static int rtw_debug = 1;
  66 static int rtw_radio_enable = 1;
  67 static int rtw_long_retry_lmt = 7;
  68 static int rtw_short_retry_lmt = 7;
  69 static int rtw_busy_thresh = 40;
  70 static int rtw_ack_policy = NORMAL_ACK;
  71
  72 static int rtw_mp_mode;
  73
  74 static int rtw_software_encrypt;
  75 static int rtw_software_decrypt;
  76
  77 static int rtw_acm_method;/*  0:By SW 1:By HW. */
  78
  79 static int rtw_wmm_enable = 1;/*  default is set to enable the wmm. */
  80 static int rtw_uapsd_enable;
  81 static int rtw_uapsd_max_sp = NO_LIMIT;
  82 static int rtw_uapsd_acbk_en;
  83 static int rtw_uapsd_acbe_en;
  84 static int rtw_uapsd_acvi_en;
  85 static int rtw_uapsd_acvo_en;
  86
  87 int rtw_ht_enable = 1;
  88 int rtw_cbw40_enable = 3; /*  0 :disable, bit(0): enable 2.4g, bit(1): enable 5g */
  89 int rtw_ampdu_enable = 1;/* for enable tx_ampdu */
  90 static int rtw_rx_stbc = 1;/*  0: disable, bit(0):enable 2.4g, bit(1):enable 5g, default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ */
  91 static int rtw_ampdu_amsdu;/*  0: disabled, 1:enabled, 2:auto */
  92
  93 static int rtw_lowrate_two_xmit = 1;/* Use 2 path Tx to transmit MCS0~7 and legacy mode */
  94
  95 static int rtw_rf_config = RF_819X_MAX_TYPE;  /* auto */
  96 static int rtw_low_power;
  97 static int rtw_wifi_spec;
  98 static int rtw_channel_plan = RT_CHANNEL_DOMAIN_MAX;
  99 static int rtw_AcceptAddbaReq = true;/*  0:Reject AP's Add BA req, 1:Accept AP's Add BA req. */
 100
 101 static int rtw_antdiv_cfg = 2; /*  0:OFF , 1:ON, 2:decide by Efuse config */
 102 static int rtw_antdiv_type; /* 0:decide by efuse  1: for 88EE, 1Tx and 1RxCG are diversity.(2 Ant with SPDT), 2:  for 88EE, 1Tx and 2Rx are diversity.(2 Ant, Tx and RxCG are both on aux port, RxCS is on main port), 3: for 88EE, 1Tx and 1RxCG are fixed.(1Ant, Tx and RxCG are both on aux port) */
 103
 104 static int rtw_enusbss;/* 0:disable, 1:enable */
 105
 106 static int rtw_hwpdn_mode = 2;/* 0:disable, 1:enable, 2: by EFUSE config */
 107
 108 static int rtw_hwpwrp_detect; /* HW power  ping detect 0:disable , 1:enable */
 109
 110 static int rtw_hw_wps_pbc = 1;
 111
 112 int rtw_mc2u_disable;
 113
 114 static int rtw_80211d;
 115
 116 static char *ifname = "wlan%d";
 117 module_param(ifname, charp, 0644);
 118 MODULE_PARM_DESC(ifname, "The default name to allocate for first interface");
 119
 120 static char *if2name = "wlan%d";
 121 module_param(if2name, charp, 0644);
 122 MODULE_PARM_DESC(if2name, "The default name to allocate for second interface");
 123
 124 char *rtw_initmac;  /*  temp mac address if users want to use instead of the mac address in Efuse */
 125
 126 module_param(rtw_initmac, charp, 0644);
 127 module_param(rtw_channel_plan, int, 0644);
 128 module_param(rtw_chip_version, int, 0644);
 129 module_param(rtw_rfintfs, int, 0644);
 130 module_param(rtw_lbkmode, int, 0644);
 131 module_param(rtw_network_mode, int, 0644);
 132 module_param(rtw_channel, int, 0644);
 133 module_param(rtw_mp_mode, int, 0644);
 134 module_param(rtw_wmm_enable, int, 0644);
 135 module_param(rtw_vrtl_carrier_sense, int, 0644);
 136 module_param(rtw_vcs_type, int, 0644);
 137 module_param(rtw_busy_thresh, int, 0644);
 138 module_param(rtw_ht_enable, int, 0644);
 139 module_param(rtw_cbw40_enable, int, 0644);
 140 module_param(rtw_ampdu_enable, int, 0644);
 141 module_param(rtw_rx_stbc, int, 0644);
 142 module_param(rtw_ampdu_amsdu, int, 0644);
 143 module_param(rtw_lowrate_two_xmit, int, 0644);
 144 module_param(rtw_rf_config, int, 0644);
 145 module_param(rtw_power_mgnt, int, 0644);
 146 module_param(rtw_smart_ps, int, 0644);
 147 module_param(rtw_low_power, int, 0644);
 148 module_param(rtw_wifi_spec, int, 0644);
 149 module_param(rtw_antdiv_cfg, int, 0644);
 150 module_param(rtw_antdiv_type, int, 0644);
 151 module_param(rtw_enusbss, int, 0644);
 152 module_param(rtw_hwpdn_mode, int, 0644);
 153 module_param(rtw_hwpwrp_detect, int, 0644);
 154 module_param(rtw_hw_wps_pbc, int, 0644);
 155
 156 static uint rtw_max_roaming_times = 2;
 157 module_param(rtw_max_roaming_times, uint, 0644);
 158 MODULE_PARM_DESC(rtw_max_roaming_times, "The max roaming times to try");
 159
 160 static int rtw_fw_iol = 1;/*  0:Disable, 1:enable, 2:by usb speed */
 161 module_param(rtw_fw_iol, int, 0644);
 162 MODULE_PARM_DESC(rtw_fw_iol, "FW IOL");
 163
 164 module_param(rtw_mc2u_disable, int, 0644);
 165
 166 module_param(rtw_80211d, int, 0644);
 167 MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism");
 168
 169 static uint rtw_notch_filter = RTW_NOTCH_FILTER;
 170 module_param(rtw_notch_filter, uint, 0644);
 171 MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P");
 172 module_param_named(debug, rtw_debug, int, 0444);
 173 MODULE_PARM_DESC(debug, "Set debug level (1-9) (default 1)");
 174
 175 /* dummy routines */
 176 void rtw_proc_remove_one(struct net_device *dev)
 177 {
 178 }
 179
 180 void rtw_proc_init_one(struct net_device *dev)
 181 {
 182 }
 183
 184 #if 0   /* TODO: Convert these to /sys */
 185 void rtw_proc_init_one(struct net_device *dev)
 186 {
 187         struct proc_dir_entry *dir_dev = NULL;
 188         struct proc_dir_entry *entry = NULL;
 189         struct adapter  *padapter = rtw_netdev_priv(dev);
 190         u8 rf_type;
 191
 192         if (rtw_proc == NULL) {
 193                 memcpy(rtw_proc_name, DRV_NAME, sizeof(DRV_NAME));
 194
 195                 rtw_proc = create_proc_entry(rtw_proc_name, S_IFDIR, init_net.proc_net);
 196                 if (rtw_proc == NULL) {
 197                         DBG_88E(KERN_ERR "Unable to create rtw_proc directory\n");
 198                         return;
 199                 }
 200
 201                 entry = create_proc_read_entry("ver_info", S_IFREG | S_IRUGO, rtw_proc, proc_get_drv_version, dev);
 202                 if (!entry) {
 203                         pr_info("Unable to create_proc_read_entry!\n");
 204                         return;
 205                 }
 206         }
 207
 208         if (padapter->dir_dev == NULL) {
 209                 padapter->dir_dev = create_proc_entry(dev->name,
 210                                           S_IFDIR | S_IRUGO | S_IXUGO,
 211                                           rtw_proc);
 212                 dir_dev = padapter->dir_dev;
 213                 if (dir_dev == NULL) {
 214                         if (rtw_proc_cnt == 0) {
 215                                 if (rtw_proc) {
 216                                         remove_proc_entry(rtw_proc_name, init_net.proc_net);
 217                                         rtw_proc = NULL;
 218                                 }
 219                         }
 220
 221                         pr_info("Unable to create dir_dev directory\n");
 222                         return;
 223                 }
 224         } else {
 225                 return;
 226         }
 227
 228         rtw_proc_cnt++;
 229
 230         entry = create_proc_read_entry("write_reg", S_IFREG | S_IRUGO,
 231                                    dir_dev, proc_get_write_reg, dev);
 232         if (!entry) {
 233                 pr_info("Unable to create_proc_read_entry!\n");
 234                 return;
 235         }
 236         entry->write_proc = proc_set_write_reg;
 237
 238         entry = create_proc_read_entry("read_reg", S_IFREG | S_IRUGO,
 239                                    dir_dev, proc_get_read_reg, dev);
 240         if (!entry) {
 241                 pr_info("Unable to create_proc_read_entry!\n");
 242                 return;
 243         }
 244         entry->write_proc = proc_set_read_reg;
 245
 246
 247         entry = create_proc_read_entry("fwstate", S_IFREG | S_IRUGO,
 248                                    dir_dev, proc_get_fwstate, dev);
 249         if (!entry) {
 250                 pr_info("Unable to create_proc_read_entry!\n");
 251                 return;
 252         }
 253
 254         entry = create_proc_read_entry("sec_info", S_IFREG | S_IRUGO,
 255                                    dir_dev, proc_get_sec_info, dev);
 256         if (!entry) {
 257                 pr_info("Unable to create_proc_read_entry!\n");
 258                 return;
 259         }
 260
 261         entry = create_proc_read_entry("mlmext_state", S_IFREG | S_IRUGO,
 262                                    dir_dev, proc_get_mlmext_state, dev);
 263         if (!entry) {
 264                 pr_info("Unable to create_proc_read_entry!\n");
 265                 return;
 266         }
 267
 268         entry = create_proc_read_entry("qos_option", S_IFREG | S_IRUGO,
 269                                    dir_dev, proc_get_qos_option, dev);
 270         if (!entry) {
 271                 pr_info("Unable to create_proc_read_entry!\n");
 272                 return;
 273         }
 274
 275         entry = create_proc_read_entry("ht_option", S_IFREG | S_IRUGO,
 276                                    dir_dev, proc_get_ht_option, dev);
 277         if (!entry) {
 278                 pr_info("Unable to create_proc_read_entry!\n");
 279                 return;
 280         }
 281
 282         entry = create_proc_read_entry("rf_info", S_IFREG | S_IRUGO,
 283                                    dir_dev, proc_get_rf_info, dev);
 284         if (!entry) {
 285                 pr_info("Unable to create_proc_read_entry!\n");
 286                 return;
 287         }
 288
 289         entry = create_proc_read_entry("ap_info", S_IFREG | S_IRUGO,
 290                                    dir_dev, proc_get_ap_info, dev);
 291         if (!entry) {
 292                 pr_info("Unable to create_proc_read_entry!\n");
 293                 return;
 294         }
 295
 296         entry = create_proc_read_entry("adapter_state", S_IFREG | S_IRUGO,
 297                                    dir_dev, proc_getstruct adapter_state, dev);
 298         if (!entry) {
 299                 pr_info("Unable to create_proc_read_entry!\n");
 300                 return;
 301         }
 302
 303         entry = create_proc_read_entry("trx_info", S_IFREG | S_IRUGO,
 304                                    dir_dev, proc_get_trx_info, dev);
 305         if (!entry) {
 306                 pr_info("Unable to create_proc_read_entry!\n");
 307                 return;
 308         }
 309
 310         entry = create_proc_read_entry("mac_reg_dump1", S_IFREG | S_IRUGO,
 311                                    dir_dev, proc_get_mac_reg_dump1, dev);
 312         if (!entry) {
 313                 pr_info("Unable to create_proc_read_entry!\n");
 314                 return;
 315         }
 316
 317         entry = create_proc_read_entry("mac_reg_dump2", S_IFREG | S_IRUGO,
 318                                    dir_dev, proc_get_mac_reg_dump2, dev);
 319         if (!entry) {
 320                 pr_info("Unable to create_proc_read_entry!\n");
 321                 return;
 322         }
 323
 324         entry = create_proc_read_entry("mac_reg_dump3", S_IFREG | S_IRUGO,
 325                                    dir_dev, proc_get_mac_reg_dump3, dev);
 326         if (!entry) {
 327                 pr_info("Unable to create_proc_read_entry!\n");
 328                 return;
 329         }
 330
 331         entry = create_proc_read_entry("bb_reg_dump1", S_IFREG | S_IRUGO,
 332                                    dir_dev, proc_get_bb_reg_dump1, dev);
 333         if (!entry) {
 334                 pr_info("Unable to create_proc_read_entry!\n");
 335                 return;
 336         }
 337
 338         entry = create_proc_read_entry("bb_reg_dump2", S_IFREG | S_IRUGO,
 339                                    dir_dev, proc_get_bb_reg_dump2, dev);
 340         if (!entry) {
 341                 pr_info("Unable to create_proc_read_entry!\n");
 342                 return;
 343         }
 344
 345         entry = create_proc_read_entry("bb_reg_dump3", S_IFREG | S_IRUGO,
 346                                    dir_dev, proc_get_bb_reg_dump3, dev);
 347         if (!entry) {
 348                 pr_info("Unable to create_proc_read_entry!\n");
 349                 return;
 350         }
 351
 352         entry = create_proc_read_entry("rf_reg_dump1", S_IFREG | S_IRUGO,
 353                                    dir_dev, proc_get_rf_reg_dump1, dev);
 354         if (!entry) {
 355                 pr_info("Unable to create_proc_read_entry!\n");
 356                 return;
 357         }
 358
 359         entry = create_proc_read_entry("rf_reg_dump2", S_IFREG | S_IRUGO,
 360                                    dir_dev, proc_get_rf_reg_dump2, dev);
 361         if (!entry) {
 362                 pr_info("Unable to create_proc_read_entry!\n");
 363                 return;
 364         }
 365
 366         rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type));
 367         if ((RF_1T2R == rf_type) || (RF_1T1R == rf_type)) {
 368                 entry = create_proc_read_entry("rf_reg_dump3", S_IFREG | S_IRUGO,
 369                                            dir_dev, proc_get_rf_reg_dump3, dev);
 370                 if (!entry) {
 371                         pr_info("Unable to create_proc_read_entry!\n");
 372                         return;
 373                 }
 374
 375                 entry = create_proc_read_entry("rf_reg_dump4", S_IFREG | S_IRUGO,
 376                                            dir_dev, proc_get_rf_reg_dump4, dev);
 377                 if (!entry) {
 378                         pr_info("Unable to create_proc_read_entry!\n");
 379                         return;
 380                 }
 381         }
 382
 383 #ifdef CONFIG_88EU_AP_MODE
 384
 385         entry = create_proc_read_entry("all_sta_info", S_IFREG | S_IRUGO,
 386                                    dir_dev, proc_get_all_sta_info, dev);
 387         if (!entry) {
 388                 pr_info("Unable to create_proc_read_entry!\n");
 389                 return;
 390         }
 391 #endif
 392
 393         entry = create_proc_read_entry("best_channel", S_IFREG | S_IRUGO,
 394                                    dir_dev, proc_get_best_channel, dev);
 395         if (!entry) {
 396                 pr_info("Unable to create_proc_read_entry!\n");
 397                 return;
 398         }
 399
 400         entry = create_proc_read_entry("rx_signal", S_IFREG | S_IRUGO,
 401                                    dir_dev, proc_get_rx_signal, dev);
 402         if (!entry) {
 403                 pr_info("Unable to create_proc_read_entry!\n");
 404                 return;
 405         }
 406         entry->write_proc = proc_set_rx_signal;
 407         entry = create_proc_read_entry("ht_enable", S_IFREG | S_IRUGO,
 408                                    dir_dev, proc_get_ht_enable, dev);
 409         if (!entry) {
 410                 pr_info("Unable to create_proc_read_entry!\n");
 411                 return;
 412         }
 413         entry->write_proc = proc_set_ht_enable;
 414
 415         entry = create_proc_read_entry("cbw40_enable", S_IFREG | S_IRUGO,
 416                                    dir_dev, proc_get_cbw40_enable, dev);
 417         if (!entry) {
 418                 pr_info("Unable to create_proc_read_entry!\n");
 419                 return;
 420         }
 421         entry->write_proc = proc_set_cbw40_enable;
 422
 423         entry = create_proc_read_entry("ampdu_enable", S_IFREG | S_IRUGO,
 424                                    dir_dev, proc_get_ampdu_enable, dev);
 425         if (!entry) {
 426                 pr_info("Unable to create_proc_read_entry!\n");
 427                 return;
 428         }
 429         entry->write_proc = proc_set_ampdu_enable;
 430
 431         entry = create_proc_read_entry("rx_stbc", S_IFREG | S_IRUGO,
 432                                    dir_dev, proc_get_rx_stbc, dev);
 433         if (!entry) {
 434                 pr_info("Unable to create_proc_read_entry!\n");
 435                 return;
 436         }
 437         entry->write_proc = proc_set_rx_stbc;
 438
 439         entry = create_proc_read_entry("path_rssi", S_IFREG | S_IRUGO,
 440                                         dir_dev, proc_get_two_path_rssi, dev);
 441         if (!entry) {
 442                 pr_info("Unable to create_proc_read_entry!\n");
 443                 return;
 444         }
 445         entry = create_proc_read_entry("rssi_disp", S_IFREG | S_IRUGO,
 446                                    dir_dev, proc_get_rssi_disp, dev);
 447         if (!entry) {
 448                 pr_info("Unable to create_proc_read_entry!\n");
 449                 return;
 450         }
 451         entry->write_proc = proc_set_rssi_disp;
 452 }
 453
 454 void rtw_proc_remove_one(struct net_device *dev)
 455 {
 456         struct proc_dir_entry *dir_dev = NULL;
 457         struct adapter  *padapter = rtw_netdev_priv(dev);
 458         u8 rf_type;
 459
 460         dir_dev = padapter->dir_dev;
 461         padapter->dir_dev = NULL;
 462
 463         if (dir_dev) {
 464                 remove_proc_entry("write_reg", dir_dev);
 465                 remove_proc_entry("read_reg", dir_dev);
 466                 remove_proc_entry("fwstate", dir_dev);
 467                 remove_proc_entry("sec_info", dir_dev);
 468                 remove_proc_entry("mlmext_state", dir_dev);
 469                 remove_proc_entry("qos_option", dir_dev);
 470                 remove_proc_entry("ht_option", dir_dev);
 471                 remove_proc_entry("rf_info", dir_dev);
 472                 remove_proc_entry("ap_info", dir_dev);
 473                 remove_proc_entry("adapter_state", dir_dev);
 474                 remove_proc_entry("trx_info", dir_dev);
 475                 remove_proc_entry("mac_reg_dump1", dir_dev);
 476                 remove_proc_entry("mac_reg_dump2", dir_dev);
 477                 remove_proc_entry("mac_reg_dump3", dir_dev);
 478                 remove_proc_entry("bb_reg_dump1", dir_dev);
 479                 remove_proc_entry("bb_reg_dump2", dir_dev);
 480                 remove_proc_entry("bb_reg_dump3", dir_dev);
 481                 remove_proc_entry("rf_reg_dump1", dir_dev);
 482                 remove_proc_entry("rf_reg_dump2", dir_dev);
 483                 rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type));
 484                 if ((RF_1T2R == rf_type) || (RF_1T1R == rf_type)) {
 485                         remove_proc_entry("rf_reg_dump3", dir_dev);
 486                         remove_proc_entry("rf_reg_dump4", dir_dev);
 487                 }
 488 #ifdef CONFIG_88EU_AP_MODE
 489                 remove_proc_entry("all_sta_info", dir_dev);
 490 #endif
 491
 492                 remove_proc_entry("best_channel", dir_dev);
 493                 remove_proc_entry("rx_signal", dir_dev);
 494                 remove_proc_entry("cbw40_enable", dir_dev);
 495                 remove_proc_entry("ht_enable", dir_dev);
 496                 remove_proc_entry("ampdu_enable", dir_dev);
 497                 remove_proc_entry("rx_stbc", dir_dev);
 498                 remove_proc_entry("path_rssi", dir_dev);
 499                 remove_proc_entry("rssi_disp", dir_dev);
 500                 remove_proc_entry(dev->name, rtw_proc);
 501                 dir_dev = NULL;
 502         } else {
 503                 return;
 504         }
 505         rtw_proc_cnt--;
 506
 507         if (rtw_proc_cnt == 0) {
 508                 if (rtw_proc) {
 509                         remove_proc_entry("ver_info", rtw_proc);
 510
 511                         remove_proc_entry(rtw_proc_name, init_net.proc_net);
 512                         rtw_proc = NULL;
 513                 }
 514         }
 515 }
 516 #endif
 517
 518 static uint loadparam(struct adapter *padapter,  struct  net_device *pnetdev)
 519 {
 520         uint status = _SUCCESS;
 521         struct registry_priv  *registry_par = &padapter->registrypriv;
 522
 523 _func_enter_;
 524
 525         GlobalDebugLevel = rtw_debug;
 526         registry_par->chip_version = (u8)rtw_chip_version;
 527         registry_par->rfintfs = (u8)rtw_rfintfs;
 528         registry_par->lbkmode = (u8)rtw_lbkmode;
 529         registry_par->network_mode  = (u8)rtw_network_mode;
 530
 531         memcpy(registry_par->ssid.Ssid, "ANY", 3);
 532         registry_par->ssid.SsidLength = 3;
 533
 534         registry_par->channel = (u8)rtw_channel;
 535         registry_par->wireless_mode = (u8)rtw_wireless_mode;
 536         registry_par->vrtl_carrier_sense = (u8)rtw_vrtl_carrier_sense ;
 537         registry_par->vcs_type = (u8)rtw_vcs_type;
 538         registry_par->rts_thresh = (u16)rtw_rts_thresh;
 539         registry_par->frag_thresh = (u16)rtw_frag_thresh;
 540         registry_par->preamble = (u8)rtw_preamble;
 541         registry_par->scan_mode = (u8)rtw_scan_mode;
 542         registry_par->adhoc_tx_pwr = (u8)rtw_adhoc_tx_pwr;
 543         registry_par->soft_ap =  (u8)rtw_soft_ap;
 544         registry_par->smart_ps =  (u8)rtw_smart_ps;
 545         registry_par->power_mgnt = (u8)rtw_power_mgnt;
 546         registry_par->ips_mode = (u8)rtw_ips_mode;
 547         registry_par->radio_enable = (u8)rtw_radio_enable;
 548         registry_par->long_retry_lmt = (u8)rtw_long_retry_lmt;
 549         registry_par->short_retry_lmt = (u8)rtw_short_retry_lmt;
 550         registry_par->busy_thresh = (u16)rtw_busy_thresh;
 551         registry_par->ack_policy = (u8)rtw_ack_policy;
 552         registry_par->mp_mode = (u8)rtw_mp_mode;
 553         registry_par->software_encrypt = (u8)rtw_software_encrypt;
 554         registry_par->software_decrypt = (u8)rtw_software_decrypt;
 555         registry_par->acm_method = (u8)rtw_acm_method;
 556
 557          /* UAPSD */
 558         registry_par->wmm_enable = (u8)rtw_wmm_enable;
 559         registry_par->uapsd_enable = (u8)rtw_uapsd_enable;
 560         registry_par->uapsd_max_sp = (u8)rtw_uapsd_max_sp;
 561         registry_par->uapsd_acbk_en = (u8)rtw_uapsd_acbk_en;
 562         registry_par->uapsd_acbe_en = (u8)rtw_uapsd_acbe_en;
 563         registry_par->uapsd_acvi_en = (u8)rtw_uapsd_acvi_en;
 564         registry_par->uapsd_acvo_en = (u8)rtw_uapsd_acvo_en;
 565
 566         registry_par->ht_enable = (u8)rtw_ht_enable;
 567         registry_par->cbw40_enable = (u8)rtw_cbw40_enable;
 568         registry_par->ampdu_enable = (u8)rtw_ampdu_enable;
 569         registry_par->rx_stbc = (u8)rtw_rx_stbc;
 570         registry_par->ampdu_amsdu = (u8)rtw_ampdu_amsdu;
 571         registry_par->lowrate_two_xmit = (u8)rtw_lowrate_two_xmit;
 572         registry_par->rf_config = (u8)rtw_rf_config;
 573         registry_par->low_power = (u8)rtw_low_power;
 574         registry_par->wifi_spec = (u8)rtw_wifi_spec;
 575         registry_par->channel_plan = (u8)rtw_channel_plan;
 576         registry_par->bAcceptAddbaReq = (u8)rtw_AcceptAddbaReq;
 577         registry_par->antdiv_cfg = (u8)rtw_antdiv_cfg;
 578         registry_par->antdiv_type = (u8)rtw_antdiv_type;
 579         registry_par->hwpdn_mode = (u8)rtw_hwpdn_mode;/* 0:disable, 1:enable, 2:by EFUSE config */
 580         registry_par->hwpwrp_detect = (u8)rtw_hwpwrp_detect;/* 0:disable, 1:enable */
 581         registry_par->hw_wps_pbc = (u8)rtw_hw_wps_pbc;
 582
 583         registry_par->max_roaming_times = (u8)rtw_max_roaming_times;
 584
 585         registry_par->fw_iol = rtw_fw_iol;
 586
 587         registry_par->enable80211d = (u8)rtw_80211d;
 588         snprintf(registry_par->ifname, 16, "%s", ifname);
 589         snprintf(registry_par->if2name, 16, "%s", if2name);
 590         registry_par->notch_filter = (u8)rtw_notch_filter;
 591 _func_exit_;
 592         return status;
 593 }
 594
 595 static int rtw_net_set_mac_address(struct net_device *pnetdev, void *p)
 596 {
 597         struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
 598         struct sockaddr *addr = p;
 599
 600         if (!padapter->bup)
 601                 memcpy(padapter->eeprompriv.mac_addr, addr->sa_data, ETH_ALEN);
 602
 603         return 0;
 604 }
 605
 606 static struct net_device_stats *rtw_net_get_stats(struct net_device *pnetdev)
 607 {
 608         struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
 609         struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
 610         struct recv_priv *precvpriv = &(padapter->recvpriv);
 611
 612         padapter->stats.tx_packets = pxmitpriv->tx_pkts;/* pxmitpriv->tx_pkts++; */
 613         padapter->stats.rx_packets = precvpriv->rx_pkts;/* precvpriv->rx_pkts++; */
 614         padapter->stats.tx_dropped = pxmitpriv->tx_drop;
 615         padapter->stats.rx_dropped = precvpriv->rx_drop;
 616         padapter->stats.tx_bytes = pxmitpriv->tx_bytes;
 617         padapter->stats.rx_bytes = precvpriv->rx_bytes;
 618         return &padapter->stats;
 619 }
 620
 621 /*
 622  * AC to queue mapping
 623  *
 624  * AC_VO -> queue 0
 625  * AC_VI -> queue 1
 626  * AC_BE -> queue 2
 627  * AC_BK -> queue 3
 628  */
 629 static const u16 rtw_1d_to_queue[8] = { 2, 3, 3, 2, 1, 1, 0, 0 };
 630
 631 /* Given a data frame determine the 802.1p/1d tag to use. */
 632 static unsigned int rtw_classify8021d(struct sk_buff *skb)
 633 {
 634         unsigned int dscp;
 635
 636         /* skb->priority values from 256->263 are magic values to
 637          * directly indicate a specific 802.1d priority.  This is used
 638          * to allow 802.1d priority to be passed directly in from VLAN
 639          * tags, etc.
 640          */
 641         if (skb->priority >= 256 && skb->priority <= 263)
 642                 return skb->priority - 256;
 643
 644         switch (skb->protocol) {
 645         case htons(ETH_P_IP):
 646                 dscp = ip_hdr(skb)->tos & 0xfc;
 647                 break;
 648         default:
 649                 return 0;
 650         }
 651
 652         return dscp >> 5;
 653 }
 654
 655 static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb,
 656                             void *accel_priv)
 657 {
 658         struct adapter  *padapter = rtw_netdev_priv(dev);
 659         struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 660
 661         skb->priority = rtw_classify8021d(skb);
 662
 663         if (pmlmepriv->acm_mask != 0)
 664                 skb->priority = qos_acm(pmlmepriv->acm_mask, skb->priority);
 665
 666         return rtw_1d_to_queue[skb->priority];
 667 }
 668
 669 u16 rtw_recv_select_queue(struct sk_buff *skb)
 670 {
 671         struct iphdr *piphdr;
 672         unsigned int dscp;
 673         __be16  eth_type;
 674         u32 priority;
 675         u8 *pdata = skb->data;
 676
 677         memcpy(&eth_type, pdata+(ETH_ALEN<<1), 2);
 678
 679         switch (eth_type) {
 680         case htons(ETH_P_IP):
 681                 piphdr = (struct iphdr *)(pdata+ETH_HLEN);
 682                 dscp = piphdr->tos & 0xfc;
 683                 priority = dscp >> 5;
 684                 break;
 685         default:
 686                 priority = 0;
 687         }
 688
 689         return rtw_1d_to_queue[priority];
 690 }
 691
 692 static const struct net_device_ops rtw_netdev_ops = {
 693         .ndo_open = netdev_open,
 694         .ndo_stop = netdev_close,
 695         .ndo_start_xmit = rtw_xmit_entry,
 696         .ndo_select_queue       = rtw_select_queue,
 697         .ndo_set_mac_address = rtw_net_set_mac_address,
 698         .ndo_get_stats = rtw_net_get_stats,
 699         .ndo_do_ioctl = rtw_ioctl,
 700 };
 701
 702 int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname)
 703 {
 704         if (dev_alloc_name(pnetdev, ifname) < 0)
 705                 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("dev_alloc_name, fail!\n"));
 706
 707         netif_carrier_off(pnetdev);
 708         return 0;
 709 }
 710
 711 static const struct device_type wlan_type = {
 712         .name = "wlan",
 713 };
 714
 715 struct net_device *rtw_init_netdev(struct adapter *old_padapter)
 716 {
 717         struct adapter *padapter;
 718         struct net_device *pnetdev;
 719
 720         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+init_net_dev\n"));
 721
 722         if (old_padapter != NULL)
 723                 pnetdev = rtw_alloc_etherdev_with_old_priv(sizeof(struct adapter), (void *)old_padapter);
 724         else
 725                 pnetdev = rtw_alloc_etherdev(sizeof(struct adapter));
 726
 727         if (!pnetdev)
 728                 return NULL;
 729
 730         pnetdev->dev.type = &wlan_type;
 731         padapter = rtw_netdev_priv(pnetdev);
 732         padapter->pnetdev = pnetdev;
 733         DBG_88E("register rtw_netdev_ops to netdev_ops\n");
 734         pnetdev->netdev_ops = &rtw_netdev_ops;
 735         pnetdev->watchdog_timeo = HZ*3; /* 3 second timeout */
 736         pnetdev->wireless_handlers = (struct iw_handler_def *)&rtw_handlers_def;
 737
 738         /* step 2. */
 739         loadparam(padapter, pnetdev);
 740
 741         return pnetdev;
 742 }
 743
 744 u32 rtw_start_drv_threads(struct adapter *padapter)
 745 {
 746         u32 _status = _SUCCESS;
 747
 748         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_start_drv_threads\n"));
 749
 750         padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD");
 751         if (IS_ERR(padapter->cmdThread))
 752                 _status = _FAIL;
 753         else
 754                 _rtw_down_sema(&padapter->cmdpriv.terminate_cmdthread_sema); /* wait for cmd_thread to run */
 755
 756         rtw_hal_start_thread(padapter);
 757         return _status;
 758 }
 759
 760 void rtw_stop_drv_threads(struct adapter *padapter)
 761 {
 762         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_stop_drv_threads\n"));
 763
 764         /* Below is to termindate rtw_cmd_thread & event_thread... */
 765         _rtw_up_sema(&padapter->cmdpriv.cmd_queue_sema);
 766         if (padapter->cmdThread)
 767                 _rtw_down_sema(&padapter->cmdpriv.terminate_cmdthread_sema);
 768
 769         rtw_hal_stop_thread(padapter);
 770 }
 771
 772 static u8 rtw_init_default_value(struct adapter *padapter)
 773 {
 774         u8 ret  = _SUCCESS;
 775         struct registry_priv *pregistrypriv = &padapter->registrypriv;
 776         struct xmit_priv        *pxmitpriv = &padapter->xmitpriv;
 777         struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 778         struct security_priv *psecuritypriv = &padapter->securitypriv;
 779
 780         /* xmit_priv */
 781         pxmitpriv->vcs_setting = pregistrypriv->vrtl_carrier_sense;
 782         pxmitpriv->vcs = pregistrypriv->vcs_type;
 783         pxmitpriv->vcs_type = pregistrypriv->vcs_type;
 784         pxmitpriv->frag_len = pregistrypriv->frag_thresh;
 785
 786         /* mlme_priv */
 787         pmlmepriv->scan_interval = SCAN_INTERVAL;/*  30*2 sec = 60sec */
 788         pmlmepriv->scan_mode = SCAN_ACTIVE;
 789
 790         /* ht_priv */
 791         pmlmepriv->htpriv.ampdu_enable = false;/* set to disabled */
 792
 793         /* security_priv */
 794         psecuritypriv->binstallGrpkey = _FAIL;
 795         psecuritypriv->sw_encrypt = pregistrypriv->software_encrypt;
 796         psecuritypriv->sw_decrypt = pregistrypriv->software_decrypt;
 797         psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */
 798         psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
 799         psecuritypriv->dot11PrivacyKeyIndex = 0;
 800         psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_;
 801         psecuritypriv->dot118021XGrpKeyid = 1;
 802         psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen;
 803         psecuritypriv->ndisencryptstatus = Ndis802_11WEPDisabled;
 804
 805         /* registry_priv */
 806         rtw_init_registrypriv_dev_network(padapter);
 807         rtw_update_registrypriv_dev_network(padapter);
 808
 809         /* hal_priv */
 810         rtw_hal_def_value_init(padapter);
 811
 812         /* misc. */
 813         padapter->bReadPortCancel = false;
 814         padapter->bWritePortCancel = false;
 815         padapter->bRxRSSIDisplay = 0;
 816         padapter->bNotifyChannelChange = 0;
 817 #ifdef CONFIG_88EU_P2P
 818         padapter->bShowGetP2PState = 1;
 819 #endif
 820         return ret;
 821 }
 822
 823 u8 rtw_reset_drv_sw(struct adapter *padapter)
 824 {
 825         u8      ret8 = _SUCCESS;
 826         struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 827         struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv;
 828
 829         /* hal_priv */
 830         rtw_hal_def_value_init(padapter);
 831         padapter->bReadPortCancel = false;
 832         padapter->bWritePortCancel = false;
 833         padapter->bRxRSSIDisplay = 0;
 834         pmlmepriv->scan_interval = SCAN_INTERVAL;/*  30*2 sec = 60sec */
 835
 836         padapter->xmitpriv.tx_pkts = 0;
 837         padapter->recvpriv.rx_pkts = 0;
 838
 839         pmlmepriv->LinkDetectInfo.bBusyTraffic = false;
 840
 841         _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING);
 842
 843         rtw_hal_sreset_reset_value(padapter);
 844         pwrctrlpriv->pwr_state_check_cnts = 0;
 845
 846         /* mlmeextpriv */
 847         padapter->mlmeextpriv.sitesurvey_res.state = SCAN_DISABLE;
 848
 849         rtw_set_signal_stat_timer(&padapter->recvpriv);
 850
 851         return ret8;
 852 }
 853
 854 u8 rtw_init_drv_sw(struct adapter *padapter)
 855 {
 856         u8      ret8 = _SUCCESS;
 857
 858 _func_enter_;
 859
 860         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_init_drv_sw\n"));
 861
 862         if ((rtw_init_cmd_priv(&padapter->cmdpriv)) == _FAIL) {
 863                 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init cmd_priv\n"));
 864                 ret8 = _FAIL;
 865                 goto exit;
 866         }
 867
 868         padapter->cmdpriv.padapter = padapter;
 869
 870         if ((rtw_init_evt_priv(&padapter->evtpriv)) == _FAIL) {
 871                 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init evt_priv\n"));
 872                 ret8 = _FAIL;
 873                 goto exit;
 874         }
 875
 876         if (rtw_init_mlme_priv(padapter) == _FAIL) {
 877                 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init mlme_priv\n"));
 878                 ret8 = _FAIL;
 879                 goto exit;
 880         }
 881
 882 #ifdef CONFIG_88EU_P2P
 883         rtw_init_wifidirect_timers(padapter);
 884         init_wifidirect_info(padapter, P2P_ROLE_DISABLE);
 885         reset_global_wifidirect_info(padapter);
 886 #endif /* CONFIG_88EU_P2P */
 887
 888         if (init_mlme_ext_priv(padapter) == _FAIL) {
 889                 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("\n Can't init mlme_ext_priv\n"));
 890                 ret8 = _FAIL;
 891                 goto exit;
 892         }
 893
 894         if (_rtw_init_xmit_priv(&padapter->xmitpriv, padapter) == _FAIL) {
 895                 DBG_88E("Can't _rtw_init_xmit_priv\n");
 896                 ret8 = _FAIL;
 897                 goto exit;
 898         }
 899
 900         if (_rtw_init_recv_priv(&padapter->recvpriv, padapter) == _FAIL) {
 901                 DBG_88E("Can't _rtw_init_recv_priv\n");
 902                 ret8 = _FAIL;
 903                 goto exit;
 904         }
 905
 906         if (_rtw_init_sta_priv(&padapter->stapriv) == _FAIL) {
 907                 DBG_88E("Can't _rtw_init_sta_priv\n");
 908                 ret8 = _FAIL;
 909                 goto exit;
 910         }
 911
 912         padapter->stapriv.padapter = padapter;
 913
 914         rtw_init_bcmc_stainfo(padapter);
 915
 916         rtw_init_pwrctrl_priv(padapter);
 917
 918         if (init_mp_priv(padapter) == _FAIL)
 919                 DBG_88E("%s: initialize MP private data Fail!\n", __func__);
 920
 921         ret8 = rtw_init_default_value(padapter);
 922
 923         rtw_hal_dm_init(padapter);
 924         rtw_hal_sw_led_init(padapter);
 925
 926         rtw_hal_sreset_init(padapter);
 927
 928         _rtw_spinlock_init(&padapter->br_ext_lock);
 929
 930 exit:
 931         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-rtw_init_drv_sw\n"));
 932
 933         _func_exit_;
 934
 935         return ret8;
 936 }
 937
 938 void rtw_cancel_all_timer(struct adapter *padapter)
 939 {
 940         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+rtw_cancel_all_timer\n"));
 941
 942         _cancel_timer_ex(&padapter->mlmepriv.assoc_timer);
 943         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel association timer complete!\n"));
 944
 945         _cancel_timer_ex(&padapter->mlmepriv.scan_to_timer);
 946         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel scan_to_timer!\n"));
 947
 948         _cancel_timer_ex(&padapter->mlmepriv.dynamic_chk_timer);
 949         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel dynamic_chk_timer!\n"));
 950
 951         /*  cancel sw led timer */
 952         rtw_hal_sw_led_deinit(padapter);
 953         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("rtw_cancel_all_timer:cancel DeInitSwLeds!\n"));
 954
 955         _cancel_timer_ex(&padapter->pwrctrlpriv.pwr_state_check_timer);
 956
 957         _cancel_timer_ex(&padapter->recvpriv.signal_stat_timer);
 958         /* cancel dm timer */
 959         rtw_hal_dm_deinit(padapter);
 960 }
 961
 962 u8 rtw_free_drv_sw(struct adapter *padapter)
 963 {
 964         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("==>rtw_free_drv_sw"));
 965
 966         /* we can call rtw_p2p_enable here, but: */
 967         /*  1. rtw_p2p_enable may have IO operation */
 968         /*  2. rtw_p2p_enable is bundled with wext interface */
 969         #ifdef CONFIG_88EU_P2P
 970         {
 971                 struct wifidirect_info *pwdinfo = &padapter->wdinfo;
 972                 if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) {
 973                         _cancel_timer_ex(&pwdinfo->find_phase_timer);
 974                         _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer);
 975                         _cancel_timer_ex(&pwdinfo->pre_tx_scan_timer);
 976                         rtw_p2p_set_state(pwdinfo, P2P_STATE_NONE);
 977                 }
 978         }
 979         #endif
 980
 981
 982         _rtw_spinlock_free(&padapter->br_ext_lock);
 983
 984         free_mlme_ext_priv(&padapter->mlmeextpriv);
 985
 986         rtw_free_cmd_priv(&padapter->cmdpriv);
 987
 988         rtw_free_evt_priv(&padapter->evtpriv);
 989
 990         rtw_free_mlme_priv(&padapter->mlmepriv);
 991         _rtw_free_xmit_priv(&padapter->xmitpriv);
 992
 993         _rtw_free_sta_priv(&padapter->stapriv); /* will free bcmc_stainfo here */
 994
 995         _rtw_free_recv_priv(&padapter->recvpriv);
 996
 997         rtw_free_pwrctrl_priv(padapter);
 998
 999         rtw_hal_free_data(padapter);
1000
1001         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("<== rtw_free_drv_sw\n"));
1002
1003         /* free the old_pnetdev */
1004         if (padapter->rereg_nd_name_priv.old_pnetdev) {
1005                 free_netdev(padapter->rereg_nd_name_priv.old_pnetdev);
1006                 padapter->rereg_nd_name_priv.old_pnetdev = NULL;
1007         }
1008
1009         /*  clear pbuddystruct adapter to avoid access wrong pointer. */
1010         if (padapter->pbuddy_adapter != NULL)
1011                 padapter->pbuddy_adapter->pbuddy_adapter = NULL;
1012
1013         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-rtw_free_drv_sw\n"));
1014
1015         return _SUCCESS;
1016 }
1017
1018 void netdev_br_init(struct net_device *netdev)
1019 {
1020         struct adapter *adapter = (struct adapter *)rtw_netdev_priv(netdev);
1021
1022         rcu_read_lock();
1023
1024         if (rcu_dereference(adapter->pnetdev->rx_handler_data)) {
1025                 struct net_device *br_netdev;
1026                 struct net *devnet = NULL;
1027
1028                 devnet = dev_net(netdev);
1029                 br_netdev = dev_get_by_name(devnet, CONFIG_BR_EXT_BRNAME);
1030                 if (br_netdev) {
1031                         memcpy(adapter->br_mac, br_netdev->dev_addr, ETH_ALEN);
1032                         dev_put(br_netdev);
1033                 } else {
1034                         pr_info("%s()-%d: dev_get_by_name(%s) failed!",
1035                                 __func__, __LINE__, CONFIG_BR_EXT_BRNAME);
1036                 }
1037         }
1038         adapter->ethBrExtInfo.addPPPoETag = 1;
1039
1040         rcu_read_unlock();
1041 }
1042
1043 int _netdev_open(struct net_device *pnetdev)
1044 {
1045         uint status;
1046         struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
1047         struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv;
1048
1049         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+88eu_drv - dev_open\n"));
1050         DBG_88E("+88eu_drv - drv_open, bup =%d\n", padapter->bup);
1051
1052         if (pwrctrlpriv->ps_flag) {
1053                 padapter->net_closed = false;
1054                 goto netdev_open_normal_process;
1055         }
1056
1057         if (!padapter->bup) {
1058                 padapter->bDriverStopped = false;
1059                 padapter->bSurpriseRemoved = false;
1060                 padapter->bCardDisableWOHSM = false;
1061
1062                 status = rtw_hal_init(padapter);
1063                 if (status == _FAIL) {
1064                         RT_TRACE(_module_os_intfs_c_, _drv_err_, ("rtl88eu_hal_init(): Can't init h/w!\n"));
1065                         goto netdev_open_error;
1066                 }
1067
1068                 pr_info("MAC Address = %pM\n", pnetdev->dev_addr);
1069
1070                 status = rtw_start_drv_threads(padapter);
1071                 if (status == _FAIL) {
1072                         pr_info("Initialize driver software resource Failed!\n");
1073                         goto netdev_open_error;
1074                 }
1075
1076                 if (init_hw_mlme_ext(padapter) == _FAIL) {
1077                         pr_info("can't init mlme_ext_priv\n");
1078                         goto netdev_open_error;
1079                 }
1080                 if (padapter->intf_start)
1081                         padapter->intf_start(padapter);
1082                 rtw_proc_init_one(pnetdev);
1083
1084                 rtw_led_control(padapter, LED_CTL_NO_LINK);
1085
1086                 padapter->bup = true;
1087         }
1088         padapter->net_closed = false;
1089
1090         _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);
1091
1092         padapter->pwrctrlpriv.bips_processing = false;
1093         rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv);
1094
1095         if (!rtw_netif_queue_stopped(pnetdev))
1096                 rtw_netif_start_queue(pnetdev);
1097         else
1098                 rtw_netif_wake_queue(pnetdev);
1099
1100         netdev_br_init(pnetdev);
1101
1102 netdev_open_normal_process:
1103         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-88eu_drv - dev_open\n"));
1104         DBG_88E("-88eu_drv - drv_open, bup =%d\n", padapter->bup);
1105         return 0;
1106
1107 netdev_open_error:
1108         padapter->bup = false;
1109         netif_carrier_off(pnetdev);
1110         rtw_netif_stop_queue(pnetdev);
1111         RT_TRACE(_module_os_intfs_c_, _drv_err_, ("-88eu_drv - dev_open, fail!\n"));
1112         DBG_88E("-88eu_drv - drv_open fail, bup =%d\n", padapter->bup);
1113         return -1;
1114 }
1115
1116 int netdev_open(struct net_device *pnetdev)
1117 {
1118         int ret;
1119         struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
1120
1121         _enter_critical_mutex(padapter->hw_init_mutex, NULL);
1122         ret = _netdev_open(pnetdev);
1123         _exit_critical_mutex(padapter->hw_init_mutex, NULL);
1124         return ret;
1125 }
1126
1127 static int  ips_netdrv_open(struct adapter *padapter)
1128 {
1129         int status = _SUCCESS;
1130         padapter->net_closed = false;
1131         DBG_88E("===> %s.........\n", __func__);
1132
1133         padapter->bDriverStopped = false;
1134         padapter->bSurpriseRemoved = false;
1135         padapter->bCardDisableWOHSM = false;
1136
1137         status = rtw_hal_init(padapter);
1138         if (status == _FAIL) {
1139                 RT_TRACE(_module_os_intfs_c_, _drv_err_, ("ips_netdrv_open(): Can't init h/w!\n"));
1140                 goto netdev_open_error;
1141         }
1142
1143         if (padapter->intf_start)
1144                 padapter->intf_start(padapter);
1145
1146         rtw_set_pwr_state_check_timer(&padapter->pwrctrlpriv);
1147         _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 5000);
1148
1149          return _SUCCESS;
1150
1151 netdev_open_error:
1152         DBG_88E("-ips_netdrv_open - drv_open failure, bup =%d\n", padapter->bup);
1153
1154         return _FAIL;
1155 }
1156
1157
1158 int rtw_ips_pwr_up(struct adapter *padapter)
1159 {
1160         int result;
1161         u32 start_time = rtw_get_current_time();
1162         DBG_88E("===>  rtw_ips_pwr_up..............\n");
1163         rtw_reset_drv_sw(padapter);
1164
1165         result = ips_netdrv_open(padapter);
1166
1167         rtw_led_control(padapter, LED_CTL_NO_LINK);
1168
1169         DBG_88E("<===  rtw_ips_pwr_up.............. in %dms\n", rtw_get_passing_time_ms(start_time));
1170         return result;
1171 }
1172
1173 void rtw_ips_pwr_down(struct adapter *padapter)
1174 {
1175         u32 start_time = rtw_get_current_time();
1176         DBG_88E("===> rtw_ips_pwr_down...................\n");
1177
1178         padapter->bCardDisableWOHSM = true;
1179         padapter->net_closed = true;
1180
1181         rtw_led_control(padapter, LED_CTL_POWER_OFF);
1182
1183         rtw_ips_dev_unload(padapter);
1184         padapter->bCardDisableWOHSM = false;
1185         DBG_88E("<=== rtw_ips_pwr_down..................... in %dms\n", rtw_get_passing_time_ms(start_time));
1186 }
1187
1188 void rtw_ips_dev_unload(struct adapter *padapter)
1189 {
1190         DBG_88E("====> %s...\n", __func__);
1191
1192         rtw_hal_set_hwreg(padapter, HW_VAR_FIFO_CLEARN_UP, NULL);
1193
1194         if (padapter->intf_stop)
1195                 padapter->intf_stop(padapter);
1196
1197         /* s5. */
1198         if (!padapter->bSurpriseRemoved)
1199                 rtw_hal_deinit(padapter);
1200 }
1201
1202 int pm_netdev_open(struct net_device *pnetdev, u8 bnormal)
1203 {
1204         int status;
1205
1206         if (bnormal)
1207                 status = netdev_open(pnetdev);
1208         else
1209                 status =  (_SUCCESS == ips_netdrv_open((struct adapter *)rtw_netdev_priv(pnetdev))) ? (0) : (-1);
1210         return status;
1211 }
1212
1213 int netdev_close(struct net_device *pnetdev)
1214 {
1215         struct adapter *padapter = (struct adapter *)rtw_netdev_priv(pnetdev);
1216
1217         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("+88eu_drv - drv_close\n"));
1218
1219         if (padapter->pwrctrlpriv.bInternalAutoSuspend) {
1220                 if (padapter->pwrctrlpriv.rf_pwrstate == rf_off)
1221                         padapter->pwrctrlpriv.ps_flag = true;
1222         }
1223         padapter->net_closed = true;
1224
1225         if (padapter->pwrctrlpriv.rf_pwrstate == rf_on) {
1226                 DBG_88E("(2)88eu_drv - drv_close, bup =%d, hw_init_completed =%d\n",
1227                         padapter->bup, padapter->hw_init_completed);
1228
1229                 /* s1. */
1230                 if (pnetdev) {
1231                         if (!rtw_netif_queue_stopped(pnetdev))
1232                                 rtw_netif_stop_queue(pnetdev);
1233                 }
1234
1235                 /* s2. */
1236                 LeaveAllPowerSaveMode(padapter);
1237                 rtw_disassoc_cmd(padapter, 500, false);
1238                 /* s2-2.  indicate disconnect to os */
1239                 rtw_indicate_disconnect(padapter);
1240                 /* s2-3. */
1241                 rtw_free_assoc_resources(padapter, 1);
1242                 /* s2-4. */
1243                 rtw_free_network_queue(padapter, true);
1244                 /*  Close LED */
1245                 rtw_led_control(padapter, LED_CTL_POWER_OFF);
1246         }
1247
1248         nat25_db_cleanup(padapter);
1249
1250 #ifdef CONFIG_88EU_P2P
1251         rtw_p2p_enable(padapter, P2P_ROLE_DISABLE);
1252 #endif /* CONFIG_88EU_P2P */
1253
1254         RT_TRACE(_module_os_intfs_c_, _drv_info_, ("-88eu_drv - drv_close\n"));
1255         DBG_88E("-88eu_drv - drv_close, bup =%d\n", padapter->bup);
1256         return 0;
1257 }