1 /* 2 * NXP Wireless LAN device driver: major functions 3 * 4 * Copyright 2011-2020 NXP 5 * 6 * This software file (the "File") is distributed by NXP 7 * under the terms of the GNU General Public License Version 2, June 1991 8 * (the "License"). You may use, redistribute and/or modify this File in 9 * accordance with the terms and conditions of the License, a copy of which 10 * is available by writing to the Free Software Foundation, Inc., 11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the 12 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt. 13 * 14 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE 15 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE 16 * ARE EXPRESSLY DISCLAIMED. The License provides additional details about 17 * this warranty disclaimer. 18 */ 19 20 #include <linux/suspend.h> 21 22 #include "main.h" 23 #include "wmm.h" 24 #include "cfg80211.h" 25 #include "11n.h" 26 27 #define VERSION "1.0" 28 #define MFG_FIRMWARE "mwifiex_mfg.bin" 29 30 static unsigned int debug_mask = MWIFIEX_DEFAULT_DEBUG_MASK; 31 module_param(debug_mask, uint, 0); 32 MODULE_PARM_DESC(debug_mask, "bitmap for debug flags"); 33 34 const char driver_version[] = "mwifiex " VERSION " (%s) "; 35 static char *cal_data_cfg; 36 module_param(cal_data_cfg, charp, 0); 37 38 static unsigned short driver_mode; 39 module_param(driver_mode, ushort, 0); 40 MODULE_PARM_DESC(driver_mode, 41 "station=0x1(default), ap-sta=0x3, station-p2p=0x5, ap-sta-p2p=0x7"); 42 43 bool mfg_mode; 44 module_param(mfg_mode, bool, 0); 45 MODULE_PARM_DESC(mfg_mode, "manufacturing mode enable:1, disable:0"); 46 47 bool aggr_ctrl; 48 module_param(aggr_ctrl, bool, 0000); 49 MODULE_PARM_DESC(aggr_ctrl, "usb tx aggregation enable:1, disable:0"); 50 51 /* 52 * This function registers the device and performs all the necessary 53 * initializations. 54 * 55 * The following initialization operations are performed - 56 * - Allocate adapter structure 57 * - Save interface specific operations table in adapter 58 * - Call interface specific initialization routine 59 * - Allocate private structures 60 * - Set default adapter structure parameters 61 * - Initialize locks 62 * 63 * In case of any errors during inittialization, this function also ensures 64 * proper cleanup before exiting. 65 */ 66 static int mwifiex_register(void *card, struct device *dev, 67 struct mwifiex_if_ops *if_ops, void **padapter) 68 { 69 struct mwifiex_adapter *adapter; 70 int i; 71 72 adapter = kzalloc(sizeof(struct mwifiex_adapter), GFP_KERNEL); 73 if (!adapter) 74 return -ENOMEM; 75 76 *padapter = adapter; 77 adapter->dev = dev; 78 adapter->card = card; 79 80 /* Save interface specific operations in adapter */ 81 memmove(&adapter->if_ops, if_ops, sizeof(struct mwifiex_if_ops)); 82 adapter->debug_mask = debug_mask; 83 84 /* card specific initialization has been deferred until now .. */ 85 if (adapter->if_ops.init_if) 86 if (adapter->if_ops.init_if(adapter)) 87 goto error; 88 89 adapter->priv_num = 0; 90 91 for (i = 0; i < MWIFIEX_MAX_BSS_NUM; i++) { 92 /* Allocate memory for private structure */ 93 adapter->priv[i] = 94 kzalloc(sizeof(struct mwifiex_private), GFP_KERNEL); 95 if (!adapter->priv[i]) 96 goto error; 97 98 adapter->priv[i]->adapter = adapter; 99 adapter->priv_num++; 100 } 101 mwifiex_init_lock_list(adapter); 102 103 timer_setup(&adapter->cmd_timer, mwifiex_cmd_timeout_func, 0); 104 105 return 0; 106 107 error: 108 mwifiex_dbg(adapter, ERROR, 109 "info: leave mwifiex_register with error\n"); 110 111 for (i = 0; i < adapter->priv_num; i++) 112 kfree(adapter->priv[i]); 113 114 kfree(adapter); 115 116 return -1; 117 } 118 119 /* 120 * This function unregisters the device and performs all the necessary 121 * cleanups. 122 * 123 * The following cleanup operations are performed - 124 * - Free the timers 125 * - Free beacon buffers 126 * - Free private structures 127 * - Free adapter structure 128 */ 129 static int mwifiex_unregister(struct mwifiex_adapter *adapter) 130 { 131 s32 i; 132 133 if (adapter->if_ops.cleanup_if) 134 adapter->if_ops.cleanup_if(adapter); 135 136 del_timer_sync(&adapter->cmd_timer); 137 138 /* Free private structures */ 139 for (i = 0; i < adapter->priv_num; i++) { 140 if (adapter->priv[i]) { 141 mwifiex_free_curr_bcn(adapter->priv[i]); 142 kfree(adapter->priv[i]); 143 } 144 } 145 146 if (adapter->nd_info) { 147 for (i = 0 ; i < adapter->nd_info->n_matches ; i++) 148 kfree(adapter->nd_info->matches[i]); 149 kfree(adapter->nd_info); 150 adapter->nd_info = NULL; 151 } 152 153 kfree(adapter->regd); 154 155 kfree(adapter); 156 return 0; 157 } 158 159 void mwifiex_queue_main_work(struct mwifiex_adapter *adapter) 160 { 161 unsigned long flags; 162 163 spin_lock_irqsave(&adapter->main_proc_lock, flags); 164 if (adapter->mwifiex_processing) { 165 adapter->more_task_flag = true; 166 spin_unlock_irqrestore(&adapter->main_proc_lock, flags); 167 } else { 168 spin_unlock_irqrestore(&adapter->main_proc_lock, flags); 169 queue_work(adapter->workqueue, &adapter->main_work); 170 } 171 } 172 EXPORT_SYMBOL_GPL(mwifiex_queue_main_work); 173 174 static void mwifiex_queue_rx_work(struct mwifiex_adapter *adapter) 175 { 176 spin_lock_bh(&adapter->rx_proc_lock); 177 if (adapter->rx_processing) { 178 spin_unlock_bh(&adapter->rx_proc_lock); 179 } else { 180 spin_unlock_bh(&adapter->rx_proc_lock); 181 queue_work(adapter->rx_workqueue, &adapter->rx_work); 182 } 183 } 184 185 static int mwifiex_process_rx(struct mwifiex_adapter *adapter) 186 { 187 struct sk_buff *skb; 188 struct mwifiex_rxinfo *rx_info; 189 190 spin_lock_bh(&adapter->rx_proc_lock); 191 if (adapter->rx_processing || adapter->rx_locked) { 192 spin_unlock_bh(&adapter->rx_proc_lock); 193 goto exit_rx_proc; 194 } else { 195 adapter->rx_processing = true; 196 spin_unlock_bh(&adapter->rx_proc_lock); 197 } 198 199 /* Check for Rx data */ 200 while ((skb = skb_dequeue(&adapter->rx_data_q))) { 201 atomic_dec(&adapter->rx_pending); 202 if ((adapter->delay_main_work || 203 adapter->iface_type == MWIFIEX_USB) && 204 (atomic_read(&adapter->rx_pending) < LOW_RX_PENDING)) { 205 if (adapter->if_ops.submit_rem_rx_urbs) 206 adapter->if_ops.submit_rem_rx_urbs(adapter); 207 adapter->delay_main_work = false; 208 mwifiex_queue_main_work(adapter); 209 } 210 rx_info = MWIFIEX_SKB_RXCB(skb); 211 if (rx_info->buf_type == MWIFIEX_TYPE_AGGR_DATA) { 212 if (adapter->if_ops.deaggr_pkt) 213 adapter->if_ops.deaggr_pkt(adapter, skb); 214 dev_kfree_skb_any(skb); 215 } else { 216 mwifiex_handle_rx_packet(adapter, skb); 217 } 218 } 219 spin_lock_bh(&adapter->rx_proc_lock); 220 adapter->rx_processing = false; 221 spin_unlock_bh(&adapter->rx_proc_lock); 222 223 exit_rx_proc: 224 return 0; 225 } 226 227 /* 228 * The main process. 229 * 230 * This function is the main procedure of the driver and handles various driver 231 * operations. It runs in a loop and provides the core functionalities. 232 * 233 * The main responsibilities of this function are - 234 * - Ensure concurrency control 235 * - Handle pending interrupts and call interrupt handlers 236 * - Wake up the card if required 237 * - Handle command responses and call response handlers 238 * - Handle events and call event handlers 239 * - Execute pending commands 240 * - Transmit pending data packets 241 */ 242 int mwifiex_main_process(struct mwifiex_adapter *adapter) 243 { 244 int ret = 0; 245 unsigned long flags; 246 247 spin_lock_irqsave(&adapter->main_proc_lock, flags); 248 249 /* Check if already processing */ 250 if (adapter->mwifiex_processing || adapter->main_locked) { 251 adapter->more_task_flag = true; 252 spin_unlock_irqrestore(&adapter->main_proc_lock, flags); 253 return 0; 254 } else { 255 adapter->mwifiex_processing = true; 256 spin_unlock_irqrestore(&adapter->main_proc_lock, flags); 257 } 258 process_start: 259 do { 260 if (adapter->hw_status == MWIFIEX_HW_STATUS_NOT_READY) 261 break; 262 263 /* For non-USB interfaces, If we process interrupts first, it 264 * would increase RX pending even further. Avoid this by 265 * checking if rx_pending has crossed high threshold and 266 * schedule rx work queue and then process interrupts. 267 * For USB interface, there are no interrupts. We already have 268 * HIGH_RX_PENDING check in usb.c 269 */ 270 if (atomic_read(&adapter->rx_pending) >= HIGH_RX_PENDING && 271 adapter->iface_type != MWIFIEX_USB) { 272 adapter->delay_main_work = true; 273 mwifiex_queue_rx_work(adapter); 274 break; 275 } 276 277 /* Handle pending interrupt if any */ 278 if (adapter->int_status) { 279 if (adapter->hs_activated) 280 mwifiex_process_hs_config(adapter); 281 if (adapter->if_ops.process_int_status) 282 adapter->if_ops.process_int_status(adapter); 283 } 284 285 if (adapter->rx_work_enabled && adapter->data_received) 286 mwifiex_queue_rx_work(adapter); 287 288 /* Need to wake up the card ? */ 289 if ((adapter->ps_state == PS_STATE_SLEEP) && 290 (adapter->pm_wakeup_card_req && 291 !adapter->pm_wakeup_fw_try) && 292 (is_command_pending(adapter) || 293 !skb_queue_empty(&adapter->tx_data_q) || 294 !mwifiex_bypass_txlist_empty(adapter) || 295 !mwifiex_wmm_lists_empty(adapter))) { 296 adapter->pm_wakeup_fw_try = true; 297 mod_timer(&adapter->wakeup_timer, jiffies + (HZ*3)); 298 adapter->if_ops.wakeup(adapter); 299 continue; 300 } 301 302 if (IS_CARD_RX_RCVD(adapter)) { 303 adapter->data_received = false; 304 adapter->pm_wakeup_fw_try = false; 305 del_timer(&adapter->wakeup_timer); 306 if (adapter->ps_state == PS_STATE_SLEEP) 307 adapter->ps_state = PS_STATE_AWAKE; 308 } else { 309 /* We have tried to wakeup the card already */ 310 if (adapter->pm_wakeup_fw_try) 311 break; 312 if (adapter->ps_state == PS_STATE_PRE_SLEEP) 313 mwifiex_check_ps_cond(adapter); 314 315 if (adapter->ps_state != PS_STATE_AWAKE) 316 break; 317 if (adapter->tx_lock_flag) { 318 if (adapter->iface_type == MWIFIEX_USB) { 319 if (!adapter->usb_mc_setup) 320 break; 321 } else 322 break; 323 } 324 325 if ((!adapter->scan_chan_gap_enabled && 326 adapter->scan_processing) || adapter->data_sent || 327 mwifiex_is_tdls_chan_switching 328 (mwifiex_get_priv(adapter, 329 MWIFIEX_BSS_ROLE_STA)) || 330 (mwifiex_wmm_lists_empty(adapter) && 331 mwifiex_bypass_txlist_empty(adapter) && 332 skb_queue_empty(&adapter->tx_data_q))) { 333 if (adapter->cmd_sent || adapter->curr_cmd || 334 !mwifiex_is_send_cmd_allowed 335 (mwifiex_get_priv(adapter, 336 MWIFIEX_BSS_ROLE_STA)) || 337 (!is_command_pending(adapter))) 338 break; 339 } 340 } 341 342 /* Check for event */ 343 if (adapter->event_received) { 344 adapter->event_received = false; 345 mwifiex_process_event(adapter); 346 } 347 348 /* Check for Cmd Resp */ 349 if (adapter->cmd_resp_received) { 350 adapter->cmd_resp_received = false; 351 mwifiex_process_cmdresp(adapter); 352 353 /* call mwifiex back when init_fw is done */ 354 if (adapter->hw_status == MWIFIEX_HW_STATUS_INIT_DONE) { 355 adapter->hw_status = MWIFIEX_HW_STATUS_READY; 356 mwifiex_init_fw_complete(adapter); 357 } 358 } 359 360 /* Check if we need to confirm Sleep Request 361 received previously */ 362 if (adapter->ps_state == PS_STATE_PRE_SLEEP) 363 mwifiex_check_ps_cond(adapter); 364 365 /* * The ps_state may have been changed during processing of 366 * Sleep Request event. 367 */ 368 if ((adapter->ps_state == PS_STATE_SLEEP) || 369 (adapter->ps_state == PS_STATE_PRE_SLEEP) || 370 (adapter->ps_state == PS_STATE_SLEEP_CFM)) { 371 continue; 372 } 373 374 if (adapter->tx_lock_flag) { 375 if (adapter->iface_type == MWIFIEX_USB) { 376 if (!adapter->usb_mc_setup) 377 continue; 378 } else 379 continue; 380 } 381 382 if (!adapter->cmd_sent && !adapter->curr_cmd && 383 mwifiex_is_send_cmd_allowed 384 (mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_STA))) { 385 if (mwifiex_exec_next_cmd(adapter) == -1) { 386 ret = -1; 387 break; 388 } 389 } 390 391 /** If USB Multi channel setup ongoing, 392 * wait for ready to tx data. 393 */ 394 if (adapter->iface_type == MWIFIEX_USB && 395 adapter->usb_mc_setup) 396 continue; 397 398 if ((adapter->scan_chan_gap_enabled || 399 !adapter->scan_processing) && 400 !adapter->data_sent && 401 !skb_queue_empty(&adapter->tx_data_q)) { 402 mwifiex_process_tx_queue(adapter); 403 if (adapter->hs_activated) { 404 clear_bit(MWIFIEX_IS_HS_CONFIGURED, 405 &adapter->work_flags); 406 mwifiex_hs_activated_event 407 (mwifiex_get_priv 408 (adapter, MWIFIEX_BSS_ROLE_ANY), 409 false); 410 } 411 } 412 413 if ((adapter->scan_chan_gap_enabled || 414 !adapter->scan_processing) && 415 !adapter->data_sent && 416 !mwifiex_bypass_txlist_empty(adapter) && 417 !mwifiex_is_tdls_chan_switching 418 (mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_STA))) { 419 mwifiex_process_bypass_tx(adapter); 420 if (adapter->hs_activated) { 421 clear_bit(MWIFIEX_IS_HS_CONFIGURED, 422 &adapter->work_flags); 423 mwifiex_hs_activated_event 424 (mwifiex_get_priv 425 (adapter, MWIFIEX_BSS_ROLE_ANY), 426 false); 427 } 428 } 429 430 if ((adapter->scan_chan_gap_enabled || 431 !adapter->scan_processing) && 432 !adapter->data_sent && !mwifiex_wmm_lists_empty(adapter) && 433 !mwifiex_is_tdls_chan_switching 434 (mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_STA))) { 435 mwifiex_wmm_process_tx(adapter); 436 if (adapter->hs_activated) { 437 clear_bit(MWIFIEX_IS_HS_CONFIGURED, 438 &adapter->work_flags); 439 mwifiex_hs_activated_event 440 (mwifiex_get_priv 441 (adapter, MWIFIEX_BSS_ROLE_ANY), 442 false); 443 } 444 } 445 446 if (adapter->delay_null_pkt && !adapter->cmd_sent && 447 !adapter->curr_cmd && !is_command_pending(adapter) && 448 (mwifiex_wmm_lists_empty(adapter) && 449 mwifiex_bypass_txlist_empty(adapter) && 450 skb_queue_empty(&adapter->tx_data_q))) { 451 if (!mwifiex_send_null_packet 452 (mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_STA), 453 MWIFIEX_TxPD_POWER_MGMT_NULL_PACKET | 454 MWIFIEX_TxPD_POWER_MGMT_LAST_PACKET)) { 455 adapter->delay_null_pkt = false; 456 adapter->ps_state = PS_STATE_SLEEP; 457 } 458 break; 459 } 460 } while (true); 461 462 spin_lock_irqsave(&adapter->main_proc_lock, flags); 463 if (adapter->more_task_flag) { 464 adapter->more_task_flag = false; 465 spin_unlock_irqrestore(&adapter->main_proc_lock, flags); 466 goto process_start; 467 } 468 adapter->mwifiex_processing = false; 469 spin_unlock_irqrestore(&adapter->main_proc_lock, flags); 470 471 return ret; 472 } 473 EXPORT_SYMBOL_GPL(mwifiex_main_process); 474 475 /* 476 * This function frees the adapter structure. 477 * 478 * Additionally, this closes the netlink socket, frees the timers 479 * and private structures. 480 */ 481 static void mwifiex_free_adapter(struct mwifiex_adapter *adapter) 482 { 483 if (!adapter) { 484 pr_err("%s: adapter is NULL\n", __func__); 485 return; 486 } 487 488 mwifiex_unregister(adapter); 489 pr_debug("info: %s: free adapter\n", __func__); 490 } 491 492 /* 493 * This function cancels all works in the queue and destroys 494 * the main workqueue. 495 */ 496 static void mwifiex_terminate_workqueue(struct mwifiex_adapter *adapter) 497 { 498 if (adapter->workqueue) { 499 flush_workqueue(adapter->workqueue); 500 destroy_workqueue(adapter->workqueue); 501 adapter->workqueue = NULL; 502 } 503 504 if (adapter->rx_workqueue) { 505 flush_workqueue(adapter->rx_workqueue); 506 destroy_workqueue(adapter->rx_workqueue); 507 adapter->rx_workqueue = NULL; 508 } 509 } 510 511 /* 512 * This function gets firmware and initializes it. 513 * 514 * The main initialization steps followed are - 515 * - Download the correct firmware to card 516 * - Issue the init commands to firmware 517 */ 518 static int _mwifiex_fw_dpc(const struct firmware *firmware, void *context) 519 { 520 int ret; 521 char fmt[64]; 522 struct mwifiex_adapter *adapter = context; 523 struct mwifiex_fw_image fw; 524 bool init_failed = false; 525 struct wireless_dev *wdev; 526 struct completion *fw_done = adapter->fw_done; 527 528 if (!firmware) { 529 mwifiex_dbg(adapter, ERROR, 530 "Failed to get firmware %s\n", adapter->fw_name); 531 goto err_dnld_fw; 532 } 533 534 memset(&fw, 0, sizeof(struct mwifiex_fw_image)); 535 adapter->firmware = firmware; 536 fw.fw_buf = (u8 *) adapter->firmware->data; 537 fw.fw_len = adapter->firmware->size; 538 539 if (adapter->if_ops.dnld_fw) { 540 ret = adapter->if_ops.dnld_fw(adapter, &fw); 541 } else { 542 ret = mwifiex_dnld_fw(adapter, &fw); 543 } 544 545 if (ret == -1) 546 goto err_dnld_fw; 547 548 mwifiex_dbg(adapter, MSG, "WLAN FW is active\n"); 549 550 if (cal_data_cfg) { 551 if ((request_firmware(&adapter->cal_data, cal_data_cfg, 552 adapter->dev)) < 0) 553 mwifiex_dbg(adapter, ERROR, 554 "Cal data request_firmware() failed\n"); 555 } 556 557 /* enable host interrupt after fw dnld is successful */ 558 if (adapter->if_ops.enable_int) { 559 if (adapter->if_ops.enable_int(adapter)) 560 goto err_dnld_fw; 561 } 562 563 adapter->init_wait_q_woken = false; 564 ret = mwifiex_init_fw(adapter); 565 if (ret == -1) { 566 goto err_init_fw; 567 } else if (!ret) { 568 adapter->hw_status = MWIFIEX_HW_STATUS_READY; 569 goto done; 570 } 571 /* Wait for mwifiex_init to complete */ 572 if (!adapter->mfg_mode) { 573 wait_event_interruptible(adapter->init_wait_q, 574 adapter->init_wait_q_woken); 575 if (adapter->hw_status != MWIFIEX_HW_STATUS_READY) 576 goto err_init_fw; 577 } 578 579 if (!adapter->wiphy) { 580 if (mwifiex_register_cfg80211(adapter)) { 581 mwifiex_dbg(adapter, ERROR, 582 "cannot register with cfg80211\n"); 583 goto err_init_fw; 584 } 585 } 586 587 if (mwifiex_init_channel_scan_gap(adapter)) { 588 mwifiex_dbg(adapter, ERROR, 589 "could not init channel stats table\n"); 590 goto err_init_chan_scan; 591 } 592 593 if (driver_mode) { 594 driver_mode &= MWIFIEX_DRIVER_MODE_BITMASK; 595 driver_mode |= MWIFIEX_DRIVER_MODE_STA; 596 } 597 598 rtnl_lock(); 599 /* Create station interface by default */ 600 wdev = mwifiex_add_virtual_intf(adapter->wiphy, "mlan%d", NET_NAME_ENUM, 601 NL80211_IFTYPE_STATION, NULL); 602 if (IS_ERR(wdev)) { 603 mwifiex_dbg(adapter, ERROR, 604 "cannot create default STA interface\n"); 605 rtnl_unlock(); 606 goto err_add_intf; 607 } 608 609 if (driver_mode & MWIFIEX_DRIVER_MODE_UAP) { 610 wdev = mwifiex_add_virtual_intf(adapter->wiphy, "uap%d", NET_NAME_ENUM, 611 NL80211_IFTYPE_AP, NULL); 612 if (IS_ERR(wdev)) { 613 mwifiex_dbg(adapter, ERROR, 614 "cannot create AP interface\n"); 615 rtnl_unlock(); 616 goto err_add_intf; 617 } 618 } 619 620 if (driver_mode & MWIFIEX_DRIVER_MODE_P2P) { 621 wdev = mwifiex_add_virtual_intf(adapter->wiphy, "p2p%d", NET_NAME_ENUM, 622 NL80211_IFTYPE_P2P_CLIENT, NULL); 623 if (IS_ERR(wdev)) { 624 mwifiex_dbg(adapter, ERROR, 625 "cannot create p2p client interface\n"); 626 rtnl_unlock(); 627 goto err_add_intf; 628 } 629 } 630 rtnl_unlock(); 631 632 mwifiex_drv_get_driver_version(adapter, fmt, sizeof(fmt) - 1); 633 mwifiex_dbg(adapter, MSG, "driver_version = %s\n", fmt); 634 adapter->is_up = true; 635 goto done; 636 637 err_add_intf: 638 vfree(adapter->chan_stats); 639 err_init_chan_scan: 640 wiphy_unregister(adapter->wiphy); 641 wiphy_free(adapter->wiphy); 642 err_init_fw: 643 if (adapter->if_ops.disable_int) 644 adapter->if_ops.disable_int(adapter); 645 err_dnld_fw: 646 mwifiex_dbg(adapter, ERROR, 647 "info: %s: unregister device\n", __func__); 648 if (adapter->if_ops.unregister_dev) 649 adapter->if_ops.unregister_dev(adapter); 650 651 set_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags); 652 mwifiex_terminate_workqueue(adapter); 653 654 if (adapter->hw_status == MWIFIEX_HW_STATUS_READY) { 655 pr_debug("info: %s: shutdown mwifiex\n", __func__); 656 mwifiex_shutdown_drv(adapter); 657 mwifiex_free_cmd_buffers(adapter); 658 } 659 660 init_failed = true; 661 done: 662 if (adapter->cal_data) { 663 release_firmware(adapter->cal_data); 664 adapter->cal_data = NULL; 665 } 666 if (adapter->firmware) { 667 release_firmware(adapter->firmware); 668 adapter->firmware = NULL; 669 } 670 if (init_failed) { 671 if (adapter->irq_wakeup >= 0) 672 device_init_wakeup(adapter->dev, false); 673 mwifiex_free_adapter(adapter); 674 } 675 /* Tell all current and future waiters we're finished */ 676 complete_all(fw_done); 677 678 return init_failed ? -EIO : 0; 679 } 680 681 static void mwifiex_fw_dpc(const struct firmware *firmware, void *context) 682 { 683 _mwifiex_fw_dpc(firmware, context); 684 } 685 686 /* 687 * This function gets the firmware and (if called asynchronously) kicks off the 688 * HW init when done. 689 */ 690 static int mwifiex_init_hw_fw(struct mwifiex_adapter *adapter, 691 bool req_fw_nowait) 692 { 693 int ret; 694 695 /* Override default firmware with manufacturing one if 696 * manufacturing mode is enabled 697 */ 698 if (mfg_mode) { 699 if (strlcpy(adapter->fw_name, MFG_FIRMWARE, 700 sizeof(adapter->fw_name)) >= 701 sizeof(adapter->fw_name)) { 702 pr_err("%s: fw_name too long!\n", __func__); 703 return -1; 704 } 705 } 706 707 if (req_fw_nowait) { 708 ret = request_firmware_nowait(THIS_MODULE, 1, adapter->fw_name, 709 adapter->dev, GFP_KERNEL, adapter, 710 mwifiex_fw_dpc); 711 } else { 712 ret = request_firmware(&adapter->firmware, 713 adapter->fw_name, 714 adapter->dev); 715 } 716 717 if (ret < 0) 718 mwifiex_dbg(adapter, ERROR, "request_firmware%s error %d\n", 719 req_fw_nowait ? "_nowait" : "", ret); 720 return ret; 721 } 722 723 /* 724 * CFG802.11 network device handler for open. 725 * 726 * Starts the data queue. 727 */ 728 static int 729 mwifiex_open(struct net_device *dev) 730 { 731 netif_carrier_off(dev); 732 733 return 0; 734 } 735 736 /* 737 * CFG802.11 network device handler for close. 738 */ 739 static int 740 mwifiex_close(struct net_device *dev) 741 { 742 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev); 743 744 if (priv->scan_request) { 745 struct cfg80211_scan_info info = { 746 .aborted = true, 747 }; 748 749 mwifiex_dbg(priv->adapter, INFO, 750 "aborting scan on ndo_stop\n"); 751 cfg80211_scan_done(priv->scan_request, &info); 752 priv->scan_request = NULL; 753 priv->scan_aborting = true; 754 } 755 756 if (priv->sched_scanning) { 757 mwifiex_dbg(priv->adapter, INFO, 758 "aborting bgscan on ndo_stop\n"); 759 mwifiex_stop_bg_scan(priv); 760 cfg80211_sched_scan_stopped(priv->wdev.wiphy, 0); 761 } 762 763 return 0; 764 } 765 766 static bool 767 mwifiex_bypass_tx_queue(struct mwifiex_private *priv, 768 struct sk_buff *skb) 769 { 770 struct ethhdr *eth_hdr = (struct ethhdr *)skb->data; 771 772 if (ntohs(eth_hdr->h_proto) == ETH_P_PAE || 773 mwifiex_is_skb_mgmt_frame(skb) || 774 (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA && 775 ISSUPP_TDLS_ENABLED(priv->adapter->fw_cap_info) && 776 (ntohs(eth_hdr->h_proto) == ETH_P_TDLS))) { 777 mwifiex_dbg(priv->adapter, DATA, 778 "bypass txqueue; eth type %#x, mgmt %d\n", 779 ntohs(eth_hdr->h_proto), 780 mwifiex_is_skb_mgmt_frame(skb)); 781 return true; 782 } 783 784 return false; 785 } 786 /* 787 * Add buffer into wmm tx queue and queue work to transmit it. 788 */ 789 int mwifiex_queue_tx_pkt(struct mwifiex_private *priv, struct sk_buff *skb) 790 { 791 struct netdev_queue *txq; 792 int index = mwifiex_1d_to_wmm_queue[skb->priority]; 793 794 if (atomic_inc_return(&priv->wmm_tx_pending[index]) >= MAX_TX_PENDING) { 795 txq = netdev_get_tx_queue(priv->netdev, index); 796 if (!netif_tx_queue_stopped(txq)) { 797 netif_tx_stop_queue(txq); 798 mwifiex_dbg(priv->adapter, DATA, 799 "stop queue: %d\n", index); 800 } 801 } 802 803 if (mwifiex_bypass_tx_queue(priv, skb)) { 804 atomic_inc(&priv->adapter->tx_pending); 805 atomic_inc(&priv->adapter->bypass_tx_pending); 806 mwifiex_wmm_add_buf_bypass_txqueue(priv, skb); 807 } else { 808 atomic_inc(&priv->adapter->tx_pending); 809 mwifiex_wmm_add_buf_txqueue(priv, skb); 810 } 811 812 mwifiex_queue_main_work(priv->adapter); 813 814 return 0; 815 } 816 817 struct sk_buff * 818 mwifiex_clone_skb_for_tx_status(struct mwifiex_private *priv, 819 struct sk_buff *skb, u8 flag, u64 *cookie) 820 { 821 struct sk_buff *orig_skb = skb; 822 struct mwifiex_txinfo *tx_info, *orig_tx_info; 823 824 skb = skb_clone(skb, GFP_ATOMIC); 825 if (skb) { 826 int id; 827 828 spin_lock_bh(&priv->ack_status_lock); 829 id = idr_alloc(&priv->ack_status_frames, orig_skb, 830 1, 0x10, GFP_ATOMIC); 831 spin_unlock_bh(&priv->ack_status_lock); 832 833 if (id >= 0) { 834 tx_info = MWIFIEX_SKB_TXCB(skb); 835 tx_info->ack_frame_id = id; 836 tx_info->flags |= flag; 837 orig_tx_info = MWIFIEX_SKB_TXCB(orig_skb); 838 orig_tx_info->ack_frame_id = id; 839 orig_tx_info->flags |= flag; 840 841 if (flag == MWIFIEX_BUF_FLAG_ACTION_TX_STATUS && cookie) 842 orig_tx_info->cookie = *cookie; 843 844 } else if (skb_shared(skb)) { 845 kfree_skb(orig_skb); 846 } else { 847 kfree_skb(skb); 848 skb = orig_skb; 849 } 850 } else { 851 /* couldn't clone -- lose tx status ... */ 852 skb = orig_skb; 853 } 854 855 return skb; 856 } 857 858 /* 859 * CFG802.11 network device handler for data transmission. 860 */ 861 static netdev_tx_t 862 mwifiex_hard_start_xmit(struct sk_buff *skb, struct net_device *dev) 863 { 864 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev); 865 struct sk_buff *new_skb; 866 struct mwifiex_txinfo *tx_info; 867 bool multicast; 868 869 mwifiex_dbg(priv->adapter, DATA, 870 "data: %lu BSS(%d-%d): Data <= kernel\n", 871 jiffies, priv->bss_type, priv->bss_num); 872 873 if (test_bit(MWIFIEX_SURPRISE_REMOVED, &priv->adapter->work_flags)) { 874 kfree_skb(skb); 875 priv->stats.tx_dropped++; 876 return 0; 877 } 878 if (!skb->len || (skb->len > ETH_FRAME_LEN)) { 879 mwifiex_dbg(priv->adapter, ERROR, 880 "Tx: bad skb len %d\n", skb->len); 881 kfree_skb(skb); 882 priv->stats.tx_dropped++; 883 return 0; 884 } 885 if (skb_headroom(skb) < MWIFIEX_MIN_DATA_HEADER_LEN) { 886 mwifiex_dbg(priv->adapter, DATA, 887 "data: Tx: insufficient skb headroom %d\n", 888 skb_headroom(skb)); 889 /* Insufficient skb headroom - allocate a new skb */ 890 new_skb = 891 skb_realloc_headroom(skb, MWIFIEX_MIN_DATA_HEADER_LEN); 892 if (unlikely(!new_skb)) { 893 mwifiex_dbg(priv->adapter, ERROR, 894 "Tx: cannot alloca new_skb\n"); 895 kfree_skb(skb); 896 priv->stats.tx_dropped++; 897 return 0; 898 } 899 kfree_skb(skb); 900 skb = new_skb; 901 mwifiex_dbg(priv->adapter, INFO, 902 "info: new skb headroomd %d\n", 903 skb_headroom(skb)); 904 } 905 906 tx_info = MWIFIEX_SKB_TXCB(skb); 907 memset(tx_info, 0, sizeof(*tx_info)); 908 tx_info->bss_num = priv->bss_num; 909 tx_info->bss_type = priv->bss_type; 910 tx_info->pkt_len = skb->len; 911 912 multicast = is_multicast_ether_addr(skb->data); 913 914 if (unlikely(!multicast && skb->sk && 915 skb_shinfo(skb)->tx_flags & SKBTX_WIFI_STATUS && 916 priv->adapter->fw_api_ver == MWIFIEX_FW_V15)) 917 skb = mwifiex_clone_skb_for_tx_status(priv, 918 skb, 919 MWIFIEX_BUF_FLAG_EAPOL_TX_STATUS, NULL); 920 921 /* Record the current time the packet was queued; used to 922 * determine the amount of time the packet was queued in 923 * the driver before it was sent to the firmware. 924 * The delay is then sent along with the packet to the 925 * firmware for aggregate delay calculation for stats and 926 * MSDU lifetime expiry. 927 */ 928 __net_timestamp(skb); 929 930 if (ISSUPP_TDLS_ENABLED(priv->adapter->fw_cap_info) && 931 priv->bss_type == MWIFIEX_BSS_TYPE_STA && 932 !ether_addr_equal_unaligned(priv->cfg_bssid, skb->data)) { 933 if (priv->adapter->auto_tdls && priv->check_tdls_tx) 934 mwifiex_tdls_check_tx(priv, skb); 935 } 936 937 mwifiex_queue_tx_pkt(priv, skb); 938 939 return 0; 940 } 941 942 int mwifiex_set_mac_address(struct mwifiex_private *priv, 943 struct net_device *dev, bool external, 944 u8 *new_mac) 945 { 946 int ret; 947 u64 mac_addr, old_mac_addr; 948 949 old_mac_addr = ether_addr_to_u64(priv->curr_addr); 950 951 if (external) { 952 mac_addr = ether_addr_to_u64(new_mac); 953 } else { 954 /* Internal mac address change */ 955 if (priv->bss_type == MWIFIEX_BSS_TYPE_ANY) 956 return -ENOTSUPP; 957 958 mac_addr = old_mac_addr; 959 960 if (priv->bss_type == MWIFIEX_BSS_TYPE_P2P) { 961 mac_addr |= BIT_ULL(MWIFIEX_MAC_LOCAL_ADMIN_BIT); 962 mac_addr += priv->bss_num; 963 } else if (priv->adapter->priv[0] != priv) { 964 /* Set mac address based on bss_type/bss_num */ 965 mac_addr ^= BIT_ULL(priv->bss_type + 8); 966 mac_addr += priv->bss_num; 967 } 968 } 969 970 u64_to_ether_addr(mac_addr, priv->curr_addr); 971 972 /* Send request to firmware */ 973 ret = mwifiex_send_cmd(priv, HostCmd_CMD_802_11_MAC_ADDRESS, 974 HostCmd_ACT_GEN_SET, 0, NULL, true); 975 976 if (ret) { 977 u64_to_ether_addr(old_mac_addr, priv->curr_addr); 978 mwifiex_dbg(priv->adapter, ERROR, 979 "set mac address failed: ret=%d\n", ret); 980 return ret; 981 } 982 983 ether_addr_copy(dev->dev_addr, priv->curr_addr); 984 return 0; 985 } 986 987 /* CFG802.11 network device handler for setting MAC address. 988 */ 989 static int 990 mwifiex_ndo_set_mac_address(struct net_device *dev, void *addr) 991 { 992 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev); 993 struct sockaddr *hw_addr = addr; 994 995 return mwifiex_set_mac_address(priv, dev, true, hw_addr->sa_data); 996 } 997 998 /* 999 * CFG802.11 network device handler for setting multicast list. 1000 */ 1001 static void mwifiex_set_multicast_list(struct net_device *dev) 1002 { 1003 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev); 1004 struct mwifiex_multicast_list mcast_list; 1005 1006 if (dev->flags & IFF_PROMISC) { 1007 mcast_list.mode = MWIFIEX_PROMISC_MODE; 1008 } else if (dev->flags & IFF_ALLMULTI || 1009 netdev_mc_count(dev) > MWIFIEX_MAX_MULTICAST_LIST_SIZE) { 1010 mcast_list.mode = MWIFIEX_ALL_MULTI_MODE; 1011 } else { 1012 mcast_list.mode = MWIFIEX_MULTICAST_MODE; 1013 mcast_list.num_multicast_addr = 1014 mwifiex_copy_mcast_addr(&mcast_list, dev); 1015 } 1016 mwifiex_request_set_multicast_list(priv, &mcast_list); 1017 } 1018 1019 /* 1020 * CFG802.11 network device handler for transmission timeout. 1021 */ 1022 static void 1023 mwifiex_tx_timeout(struct net_device *dev, unsigned int txqueue) 1024 { 1025 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev); 1026 1027 priv->num_tx_timeout++; 1028 priv->tx_timeout_cnt++; 1029 mwifiex_dbg(priv->adapter, ERROR, 1030 "%lu : Tx timeout(#%d), bss_type-num = %d-%d\n", 1031 jiffies, priv->tx_timeout_cnt, priv->bss_type, 1032 priv->bss_num); 1033 mwifiex_set_trans_start(dev); 1034 1035 if (priv->tx_timeout_cnt > TX_TIMEOUT_THRESHOLD && 1036 priv->adapter->if_ops.card_reset) { 1037 mwifiex_dbg(priv->adapter, ERROR, 1038 "tx_timeout_cnt exceeds threshold.\t" 1039 "Triggering card reset!\n"); 1040 priv->adapter->if_ops.card_reset(priv->adapter); 1041 } 1042 } 1043 1044 void mwifiex_multi_chan_resync(struct mwifiex_adapter *adapter) 1045 { 1046 struct usb_card_rec *card = adapter->card; 1047 struct mwifiex_private *priv; 1048 u16 tx_buf_size; 1049 int i, ret; 1050 1051 card->mc_resync_flag = true; 1052 for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) { 1053 if (atomic_read(&card->port[i].tx_data_urb_pending)) { 1054 mwifiex_dbg(adapter, WARN, "pending data urb in sys\n"); 1055 return; 1056 } 1057 } 1058 1059 card->mc_resync_flag = false; 1060 tx_buf_size = 0xffff; 1061 priv = mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY); 1062 ret = mwifiex_send_cmd(priv, HostCmd_CMD_RECONFIGURE_TX_BUFF, 1063 HostCmd_ACT_GEN_SET, 0, &tx_buf_size, false); 1064 if (ret) 1065 mwifiex_dbg(adapter, ERROR, 1066 "send reconfig tx buf size cmd err\n"); 1067 } 1068 EXPORT_SYMBOL_GPL(mwifiex_multi_chan_resync); 1069 1070 void mwifiex_upload_device_dump(struct mwifiex_adapter *adapter) 1071 { 1072 /* Dump all the memory data into single file, a userspace script will 1073 * be used to split all the memory data to multiple files 1074 */ 1075 mwifiex_dbg(adapter, MSG, 1076 "== mwifiex dump information to /sys/class/devcoredump start\n"); 1077 dev_coredumpv(adapter->dev, adapter->devdump_data, adapter->devdump_len, 1078 GFP_KERNEL); 1079 mwifiex_dbg(adapter, MSG, 1080 "== mwifiex dump information to /sys/class/devcoredump end\n"); 1081 1082 /* Device dump data will be freed in device coredump release function 1083 * after 5 min. Here reset adapter->devdump_data and ->devdump_len 1084 * to avoid it been accidentally reused. 1085 */ 1086 adapter->devdump_data = NULL; 1087 adapter->devdump_len = 0; 1088 } 1089 EXPORT_SYMBOL_GPL(mwifiex_upload_device_dump); 1090 1091 void mwifiex_drv_info_dump(struct mwifiex_adapter *adapter) 1092 { 1093 char *p; 1094 char drv_version[64]; 1095 struct usb_card_rec *cardp; 1096 struct sdio_mmc_card *sdio_card; 1097 struct mwifiex_private *priv; 1098 int i, idx; 1099 struct netdev_queue *txq; 1100 struct mwifiex_debug_info *debug_info; 1101 1102 mwifiex_dbg(adapter, MSG, "===mwifiex driverinfo dump start===\n"); 1103 1104 p = adapter->devdump_data; 1105 strcpy(p, "========Start dump driverinfo========\n"); 1106 p += strlen("========Start dump driverinfo========\n"); 1107 p += sprintf(p, "driver_name = " "\"mwifiex\"\n"); 1108 1109 mwifiex_drv_get_driver_version(adapter, drv_version, 1110 sizeof(drv_version) - 1); 1111 p += sprintf(p, "driver_version = %s\n", drv_version); 1112 1113 if (adapter->iface_type == MWIFIEX_USB) { 1114 cardp = (struct usb_card_rec *)adapter->card; 1115 p += sprintf(p, "tx_cmd_urb_pending = %d\n", 1116 atomic_read(&cardp->tx_cmd_urb_pending)); 1117 p += sprintf(p, "tx_data_urb_pending_port_0 = %d\n", 1118 atomic_read(&cardp->port[0].tx_data_urb_pending)); 1119 p += sprintf(p, "tx_data_urb_pending_port_1 = %d\n", 1120 atomic_read(&cardp->port[1].tx_data_urb_pending)); 1121 p += sprintf(p, "rx_cmd_urb_pending = %d\n", 1122 atomic_read(&cardp->rx_cmd_urb_pending)); 1123 p += sprintf(p, "rx_data_urb_pending = %d\n", 1124 atomic_read(&cardp->rx_data_urb_pending)); 1125 } 1126 1127 p += sprintf(p, "tx_pending = %d\n", 1128 atomic_read(&adapter->tx_pending)); 1129 p += sprintf(p, "rx_pending = %d\n", 1130 atomic_read(&adapter->rx_pending)); 1131 1132 if (adapter->iface_type == MWIFIEX_SDIO) { 1133 sdio_card = (struct sdio_mmc_card *)adapter->card; 1134 p += sprintf(p, "\nmp_rd_bitmap=0x%x curr_rd_port=0x%x\n", 1135 sdio_card->mp_rd_bitmap, sdio_card->curr_rd_port); 1136 p += sprintf(p, "mp_wr_bitmap=0x%x curr_wr_port=0x%x\n", 1137 sdio_card->mp_wr_bitmap, sdio_card->curr_wr_port); 1138 } 1139 1140 for (i = 0; i < adapter->priv_num; i++) { 1141 if (!adapter->priv[i] || !adapter->priv[i]->netdev) 1142 continue; 1143 priv = adapter->priv[i]; 1144 p += sprintf(p, "\n[interface : \"%s\"]\n", 1145 priv->netdev->name); 1146 p += sprintf(p, "wmm_tx_pending[0] = %d\n", 1147 atomic_read(&priv->wmm_tx_pending[0])); 1148 p += sprintf(p, "wmm_tx_pending[1] = %d\n", 1149 atomic_read(&priv->wmm_tx_pending[1])); 1150 p += sprintf(p, "wmm_tx_pending[2] = %d\n", 1151 atomic_read(&priv->wmm_tx_pending[2])); 1152 p += sprintf(p, "wmm_tx_pending[3] = %d\n", 1153 atomic_read(&priv->wmm_tx_pending[3])); 1154 p += sprintf(p, "media_state=\"%s\"\n", !priv->media_connected ? 1155 "Disconnected" : "Connected"); 1156 p += sprintf(p, "carrier %s\n", (netif_carrier_ok(priv->netdev) 1157 ? "on" : "off")); 1158 for (idx = 0; idx < priv->netdev->num_tx_queues; idx++) { 1159 txq = netdev_get_tx_queue(priv->netdev, idx); 1160 p += sprintf(p, "tx queue %d:%s ", idx, 1161 netif_tx_queue_stopped(txq) ? 1162 "stopped" : "started"); 1163 } 1164 p += sprintf(p, "\n%s: num_tx_timeout = %d\n", 1165 priv->netdev->name, priv->num_tx_timeout); 1166 } 1167 1168 if (adapter->iface_type == MWIFIEX_SDIO || 1169 adapter->iface_type == MWIFIEX_PCIE) { 1170 p += sprintf(p, "\n=== %s register dump===\n", 1171 adapter->iface_type == MWIFIEX_SDIO ? 1172 "SDIO" : "PCIE"); 1173 if (adapter->if_ops.reg_dump) 1174 p += adapter->if_ops.reg_dump(adapter, p); 1175 } 1176 p += sprintf(p, "\n=== more debug information\n"); 1177 debug_info = kzalloc(sizeof(*debug_info), GFP_KERNEL); 1178 if (debug_info) { 1179 for (i = 0; i < adapter->priv_num; i++) { 1180 if (!adapter->priv[i] || !adapter->priv[i]->netdev) 1181 continue; 1182 priv = adapter->priv[i]; 1183 mwifiex_get_debug_info(priv, debug_info); 1184 p += mwifiex_debug_info_to_buffer(priv, p, debug_info); 1185 break; 1186 } 1187 kfree(debug_info); 1188 } 1189 1190 strcpy(p, "\n========End dump========\n"); 1191 p += strlen("\n========End dump========\n"); 1192 mwifiex_dbg(adapter, MSG, "===mwifiex driverinfo dump end===\n"); 1193 adapter->devdump_len = p - (char *)adapter->devdump_data; 1194 } 1195 EXPORT_SYMBOL_GPL(mwifiex_drv_info_dump); 1196 1197 void mwifiex_prepare_fw_dump_info(struct mwifiex_adapter *adapter) 1198 { 1199 u8 idx; 1200 char *fw_dump_ptr; 1201 u32 dump_len = 0; 1202 1203 for (idx = 0; idx < adapter->num_mem_types; idx++) { 1204 struct memory_type_mapping *entry = 1205 &adapter->mem_type_mapping_tbl[idx]; 1206 1207 if (entry->mem_ptr) { 1208 dump_len += (strlen("========Start dump ") + 1209 strlen(entry->mem_name) + 1210 strlen("========\n") + 1211 (entry->mem_size + 1) + 1212 strlen("\n========End dump========\n")); 1213 } 1214 } 1215 1216 if (dump_len + 1 + adapter->devdump_len > MWIFIEX_FW_DUMP_SIZE) { 1217 /* Realloc in case buffer overflow */ 1218 fw_dump_ptr = vzalloc(dump_len + 1 + adapter->devdump_len); 1219 mwifiex_dbg(adapter, MSG, "Realloc device dump data.\n"); 1220 if (!fw_dump_ptr) { 1221 vfree(adapter->devdump_data); 1222 mwifiex_dbg(adapter, ERROR, 1223 "vzalloc devdump data failure!\n"); 1224 return; 1225 } 1226 1227 memmove(fw_dump_ptr, adapter->devdump_data, 1228 adapter->devdump_len); 1229 vfree(adapter->devdump_data); 1230 adapter->devdump_data = fw_dump_ptr; 1231 } 1232 1233 fw_dump_ptr = (char *)adapter->devdump_data + adapter->devdump_len; 1234 1235 for (idx = 0; idx < adapter->num_mem_types; idx++) { 1236 struct memory_type_mapping *entry = 1237 &adapter->mem_type_mapping_tbl[idx]; 1238 1239 if (entry->mem_ptr) { 1240 strcpy(fw_dump_ptr, "========Start dump "); 1241 fw_dump_ptr += strlen("========Start dump "); 1242 1243 strcpy(fw_dump_ptr, entry->mem_name); 1244 fw_dump_ptr += strlen(entry->mem_name); 1245 1246 strcpy(fw_dump_ptr, "========\n"); 1247 fw_dump_ptr += strlen("========\n"); 1248 1249 memcpy(fw_dump_ptr, entry->mem_ptr, entry->mem_size); 1250 fw_dump_ptr += entry->mem_size; 1251 1252 strcpy(fw_dump_ptr, "\n========End dump========\n"); 1253 fw_dump_ptr += strlen("\n========End dump========\n"); 1254 } 1255 } 1256 1257 adapter->devdump_len = fw_dump_ptr - (char *)adapter->devdump_data; 1258 1259 for (idx = 0; idx < adapter->num_mem_types; idx++) { 1260 struct memory_type_mapping *entry = 1261 &adapter->mem_type_mapping_tbl[idx]; 1262 1263 vfree(entry->mem_ptr); 1264 entry->mem_ptr = NULL; 1265 entry->mem_size = 0; 1266 } 1267 } 1268 EXPORT_SYMBOL_GPL(mwifiex_prepare_fw_dump_info); 1269 1270 /* 1271 * CFG802.11 network device handler for statistics retrieval. 1272 */ 1273 static struct net_device_stats *mwifiex_get_stats(struct net_device *dev) 1274 { 1275 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev); 1276 1277 return &priv->stats; 1278 } 1279 1280 static u16 1281 mwifiex_netdev_select_wmm_queue(struct net_device *dev, struct sk_buff *skb, 1282 struct net_device *sb_dev) 1283 { 1284 skb->priority = cfg80211_classify8021d(skb, NULL); 1285 return mwifiex_1d_to_wmm_queue[skb->priority]; 1286 } 1287 1288 /* Network device handlers */ 1289 static const struct net_device_ops mwifiex_netdev_ops = { 1290 .ndo_open = mwifiex_open, 1291 .ndo_stop = mwifiex_close, 1292 .ndo_start_xmit = mwifiex_hard_start_xmit, 1293 .ndo_set_mac_address = mwifiex_ndo_set_mac_address, 1294 .ndo_validate_addr = eth_validate_addr, 1295 .ndo_tx_timeout = mwifiex_tx_timeout, 1296 .ndo_get_stats = mwifiex_get_stats, 1297 .ndo_set_rx_mode = mwifiex_set_multicast_list, 1298 .ndo_select_queue = mwifiex_netdev_select_wmm_queue, 1299 }; 1300 1301 /* 1302 * This function initializes the private structure parameters. 1303 * 1304 * The following wait queues are initialized - 1305 * - IOCTL wait queue 1306 * - Command wait queue 1307 * - Statistics wait queue 1308 * 1309 * ...and the following default parameters are set - 1310 * - Current key index : Set to 0 1311 * - Rate index : Set to auto 1312 * - Media connected : Set to disconnected 1313 * - Adhoc link sensed : Set to false 1314 * - Nick name : Set to null 1315 * - Number of Tx timeout : Set to 0 1316 * - Device address : Set to current address 1317 * - Rx histogram statistc : Set to 0 1318 * 1319 * In addition, the CFG80211 work queue is also created. 1320 */ 1321 void mwifiex_init_priv_params(struct mwifiex_private *priv, 1322 struct net_device *dev) 1323 { 1324 dev->netdev_ops = &mwifiex_netdev_ops; 1325 dev->needs_free_netdev = true; 1326 /* Initialize private structure */ 1327 priv->current_key_index = 0; 1328 priv->media_connected = false; 1329 memset(priv->mgmt_ie, 0, 1330 sizeof(struct mwifiex_ie) * MAX_MGMT_IE_INDEX); 1331 priv->beacon_idx = MWIFIEX_AUTO_IDX_MASK; 1332 priv->proberesp_idx = MWIFIEX_AUTO_IDX_MASK; 1333 priv->assocresp_idx = MWIFIEX_AUTO_IDX_MASK; 1334 priv->gen_idx = MWIFIEX_AUTO_IDX_MASK; 1335 priv->num_tx_timeout = 0; 1336 if (is_valid_ether_addr(dev->dev_addr)) 1337 ether_addr_copy(priv->curr_addr, dev->dev_addr); 1338 else 1339 ether_addr_copy(priv->curr_addr, priv->adapter->perm_addr); 1340 1341 if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA || 1342 GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_UAP) { 1343 priv->hist_data = kmalloc(sizeof(*priv->hist_data), GFP_KERNEL); 1344 if (priv->hist_data) 1345 mwifiex_hist_data_reset(priv); 1346 } 1347 } 1348 1349 /* 1350 * This function check if command is pending. 1351 */ 1352 int is_command_pending(struct mwifiex_adapter *adapter) 1353 { 1354 int is_cmd_pend_q_empty; 1355 1356 spin_lock_bh(&adapter->cmd_pending_q_lock); 1357 is_cmd_pend_q_empty = list_empty(&adapter->cmd_pending_q); 1358 spin_unlock_bh(&adapter->cmd_pending_q_lock); 1359 1360 return !is_cmd_pend_q_empty; 1361 } 1362 1363 /* 1364 * This is the RX work queue function. 1365 * 1366 * It handles the RX operations. 1367 */ 1368 static void mwifiex_rx_work_queue(struct work_struct *work) 1369 { 1370 struct mwifiex_adapter *adapter = 1371 container_of(work, struct mwifiex_adapter, rx_work); 1372 1373 if (test_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags)) 1374 return; 1375 mwifiex_process_rx(adapter); 1376 } 1377 1378 /* 1379 * This is the main work queue function. 1380 * 1381 * It handles the main process, which in turn handles the complete 1382 * driver operations. 1383 */ 1384 static void mwifiex_main_work_queue(struct work_struct *work) 1385 { 1386 struct mwifiex_adapter *adapter = 1387 container_of(work, struct mwifiex_adapter, main_work); 1388 1389 if (test_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags)) 1390 return; 1391 mwifiex_main_process(adapter); 1392 } 1393 1394 /* Common teardown code used for both device removal and reset */ 1395 static void mwifiex_uninit_sw(struct mwifiex_adapter *adapter) 1396 { 1397 struct mwifiex_private *priv; 1398 int i; 1399 1400 /* We can no longer handle interrupts once we start doing the teardown 1401 * below. 1402 */ 1403 if (adapter->if_ops.disable_int) 1404 adapter->if_ops.disable_int(adapter); 1405 1406 set_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags); 1407 mwifiex_terminate_workqueue(adapter); 1408 adapter->int_status = 0; 1409 1410 /* Stop data */ 1411 for (i = 0; i < adapter->priv_num; i++) { 1412 priv = adapter->priv[i]; 1413 if (priv && priv->netdev) { 1414 mwifiex_stop_net_dev_queue(priv->netdev, adapter); 1415 if (netif_carrier_ok(priv->netdev)) 1416 netif_carrier_off(priv->netdev); 1417 netif_device_detach(priv->netdev); 1418 } 1419 } 1420 1421 mwifiex_dbg(adapter, CMD, "cmd: calling mwifiex_shutdown_drv...\n"); 1422 mwifiex_shutdown_drv(adapter); 1423 mwifiex_dbg(adapter, CMD, "cmd: mwifiex_shutdown_drv done\n"); 1424 1425 if (atomic_read(&adapter->rx_pending) || 1426 atomic_read(&adapter->tx_pending) || 1427 atomic_read(&adapter->cmd_pending)) { 1428 mwifiex_dbg(adapter, ERROR, 1429 "rx_pending=%d, tx_pending=%d,\t" 1430 "cmd_pending=%d\n", 1431 atomic_read(&adapter->rx_pending), 1432 atomic_read(&adapter->tx_pending), 1433 atomic_read(&adapter->cmd_pending)); 1434 } 1435 1436 for (i = 0; i < adapter->priv_num; i++) { 1437 priv = adapter->priv[i]; 1438 if (!priv) 1439 continue; 1440 rtnl_lock(); 1441 if (priv->netdev && 1442 priv->wdev.iftype != NL80211_IFTYPE_UNSPECIFIED) 1443 mwifiex_del_virtual_intf(adapter->wiphy, &priv->wdev); 1444 rtnl_unlock(); 1445 } 1446 1447 wiphy_unregister(adapter->wiphy); 1448 wiphy_free(adapter->wiphy); 1449 adapter->wiphy = NULL; 1450 1451 vfree(adapter->chan_stats); 1452 mwifiex_free_cmd_buffers(adapter); 1453 } 1454 1455 /* 1456 * This function gets called during PCIe function level reset. 1457 */ 1458 int mwifiex_shutdown_sw(struct mwifiex_adapter *adapter) 1459 { 1460 struct mwifiex_private *priv; 1461 1462 if (!adapter) 1463 return 0; 1464 1465 wait_for_completion(adapter->fw_done); 1466 /* Caller should ensure we aren't suspending while this happens */ 1467 reinit_completion(adapter->fw_done); 1468 1469 priv = mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY); 1470 mwifiex_deauthenticate(priv, NULL); 1471 1472 mwifiex_uninit_sw(adapter); 1473 adapter->is_up = false; 1474 1475 if (adapter->if_ops.down_dev) 1476 adapter->if_ops.down_dev(adapter); 1477 1478 return 0; 1479 } 1480 EXPORT_SYMBOL_GPL(mwifiex_shutdown_sw); 1481 1482 /* This function gets called during PCIe function level reset. Required 1483 * code is extracted from mwifiex_add_card() 1484 */ 1485 int 1486 mwifiex_reinit_sw(struct mwifiex_adapter *adapter) 1487 { 1488 int ret; 1489 1490 mwifiex_init_lock_list(adapter); 1491 if (adapter->if_ops.up_dev) 1492 adapter->if_ops.up_dev(adapter); 1493 1494 adapter->hw_status = MWIFIEX_HW_STATUS_INITIALIZING; 1495 clear_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags); 1496 init_waitqueue_head(&adapter->init_wait_q); 1497 clear_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags); 1498 adapter->hs_activated = false; 1499 clear_bit(MWIFIEX_IS_CMD_TIMEDOUT, &adapter->work_flags); 1500 init_waitqueue_head(&adapter->hs_activate_wait_q); 1501 init_waitqueue_head(&adapter->cmd_wait_q.wait); 1502 adapter->cmd_wait_q.status = 0; 1503 adapter->scan_wait_q_woken = false; 1504 1505 if ((num_possible_cpus() > 1) || adapter->iface_type == MWIFIEX_USB) 1506 adapter->rx_work_enabled = true; 1507 1508 adapter->workqueue = 1509 alloc_workqueue("MWIFIEX_WORK_QUEUE", 1510 WQ_HIGHPRI | WQ_MEM_RECLAIM | WQ_UNBOUND, 1); 1511 if (!adapter->workqueue) 1512 goto err_kmalloc; 1513 1514 INIT_WORK(&adapter->main_work, mwifiex_main_work_queue); 1515 1516 if (adapter->rx_work_enabled) { 1517 adapter->rx_workqueue = alloc_workqueue("MWIFIEX_RX_WORK_QUEUE", 1518 WQ_HIGHPRI | 1519 WQ_MEM_RECLAIM | 1520 WQ_UNBOUND, 1); 1521 if (!adapter->rx_workqueue) 1522 goto err_kmalloc; 1523 INIT_WORK(&adapter->rx_work, mwifiex_rx_work_queue); 1524 } 1525 1526 /* Register the device. Fill up the private data structure with 1527 * relevant information from the card. Some code extracted from 1528 * mwifiex_register_dev() 1529 */ 1530 mwifiex_dbg(adapter, INFO, "%s, mwifiex_init_hw_fw()...\n", __func__); 1531 1532 if (mwifiex_init_hw_fw(adapter, false)) { 1533 mwifiex_dbg(adapter, ERROR, 1534 "%s: firmware init failed\n", __func__); 1535 goto err_init_fw; 1536 } 1537 1538 /* _mwifiex_fw_dpc() does its own cleanup */ 1539 ret = _mwifiex_fw_dpc(adapter->firmware, adapter); 1540 if (ret) { 1541 pr_err("Failed to bring up adapter: %d\n", ret); 1542 return ret; 1543 } 1544 mwifiex_dbg(adapter, INFO, "%s, successful\n", __func__); 1545 1546 return 0; 1547 1548 err_init_fw: 1549 mwifiex_dbg(adapter, ERROR, "info: %s: unregister device\n", __func__); 1550 if (adapter->if_ops.unregister_dev) 1551 adapter->if_ops.unregister_dev(adapter); 1552 1553 err_kmalloc: 1554 set_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags); 1555 mwifiex_terminate_workqueue(adapter); 1556 if (adapter->hw_status == MWIFIEX_HW_STATUS_READY) { 1557 mwifiex_dbg(adapter, ERROR, 1558 "info: %s: shutdown mwifiex\n", __func__); 1559 mwifiex_shutdown_drv(adapter); 1560 mwifiex_free_cmd_buffers(adapter); 1561 } 1562 1563 complete_all(adapter->fw_done); 1564 mwifiex_dbg(adapter, INFO, "%s, error\n", __func__); 1565 1566 return -1; 1567 } 1568 EXPORT_SYMBOL_GPL(mwifiex_reinit_sw); 1569 1570 static irqreturn_t mwifiex_irq_wakeup_handler(int irq, void *priv) 1571 { 1572 struct mwifiex_adapter *adapter = priv; 1573 1574 dev_dbg(adapter->dev, "%s: wake by wifi", __func__); 1575 adapter->wake_by_wifi = true; 1576 disable_irq_nosync(irq); 1577 1578 /* Notify PM core we are wakeup source */ 1579 pm_wakeup_event(adapter->dev, 0); 1580 pm_system_wakeup(); 1581 1582 return IRQ_HANDLED; 1583 } 1584 1585 static void mwifiex_probe_of(struct mwifiex_adapter *adapter) 1586 { 1587 int ret; 1588 struct device *dev = adapter->dev; 1589 1590 if (!dev->of_node) 1591 goto err_exit; 1592 1593 adapter->dt_node = dev->of_node; 1594 adapter->irq_wakeup = irq_of_parse_and_map(adapter->dt_node, 0); 1595 if (!adapter->irq_wakeup) { 1596 dev_dbg(dev, "fail to parse irq_wakeup from device tree\n"); 1597 goto err_exit; 1598 } 1599 1600 ret = devm_request_irq(dev, adapter->irq_wakeup, 1601 mwifiex_irq_wakeup_handler, IRQF_TRIGGER_LOW, 1602 "wifi_wake", adapter); 1603 if (ret) { 1604 dev_err(dev, "Failed to request irq_wakeup %d (%d)\n", 1605 adapter->irq_wakeup, ret); 1606 goto err_exit; 1607 } 1608 1609 disable_irq(adapter->irq_wakeup); 1610 if (device_init_wakeup(dev, true)) { 1611 dev_err(dev, "fail to init wakeup for mwifiex\n"); 1612 goto err_exit; 1613 } 1614 return; 1615 1616 err_exit: 1617 adapter->irq_wakeup = -1; 1618 } 1619 1620 /* 1621 * This function adds the card. 1622 * 1623 * This function follows the following major steps to set up the device - 1624 * - Initialize software. This includes probing the card, registering 1625 * the interface operations table, and allocating/initializing the 1626 * adapter structure 1627 * - Set up the netlink socket 1628 * - Create and start the main work queue 1629 * - Register the device 1630 * - Initialize firmware and hardware 1631 * - Add logical interfaces 1632 */ 1633 int 1634 mwifiex_add_card(void *card, struct completion *fw_done, 1635 struct mwifiex_if_ops *if_ops, u8 iface_type, 1636 struct device *dev) 1637 { 1638 struct mwifiex_adapter *adapter; 1639 1640 if (mwifiex_register(card, dev, if_ops, (void **)&adapter)) { 1641 pr_err("%s: software init failed\n", __func__); 1642 goto err_init_sw; 1643 } 1644 1645 mwifiex_probe_of(adapter); 1646 1647 adapter->iface_type = iface_type; 1648 adapter->fw_done = fw_done; 1649 1650 adapter->hw_status = MWIFIEX_HW_STATUS_INITIALIZING; 1651 clear_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags); 1652 init_waitqueue_head(&adapter->init_wait_q); 1653 clear_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags); 1654 adapter->hs_activated = false; 1655 init_waitqueue_head(&adapter->hs_activate_wait_q); 1656 init_waitqueue_head(&adapter->cmd_wait_q.wait); 1657 adapter->cmd_wait_q.status = 0; 1658 adapter->scan_wait_q_woken = false; 1659 1660 if ((num_possible_cpus() > 1) || adapter->iface_type == MWIFIEX_USB) 1661 adapter->rx_work_enabled = true; 1662 1663 adapter->workqueue = 1664 alloc_workqueue("MWIFIEX_WORK_QUEUE", 1665 WQ_HIGHPRI | WQ_MEM_RECLAIM | WQ_UNBOUND, 1); 1666 if (!adapter->workqueue) 1667 goto err_kmalloc; 1668 1669 INIT_WORK(&adapter->main_work, mwifiex_main_work_queue); 1670 1671 if (adapter->rx_work_enabled) { 1672 adapter->rx_workqueue = alloc_workqueue("MWIFIEX_RX_WORK_QUEUE", 1673 WQ_HIGHPRI | 1674 WQ_MEM_RECLAIM | 1675 WQ_UNBOUND, 1); 1676 if (!adapter->rx_workqueue) 1677 goto err_kmalloc; 1678 1679 INIT_WORK(&adapter->rx_work, mwifiex_rx_work_queue); 1680 } 1681 1682 /* Register the device. Fill up the private data structure with relevant 1683 information from the card. */ 1684 if (adapter->if_ops.register_dev(adapter)) { 1685 pr_err("%s: failed to register mwifiex device\n", __func__); 1686 goto err_registerdev; 1687 } 1688 1689 if (mwifiex_init_hw_fw(adapter, true)) { 1690 pr_err("%s: firmware init failed\n", __func__); 1691 goto err_init_fw; 1692 } 1693 1694 return 0; 1695 1696 err_init_fw: 1697 pr_debug("info: %s: unregister device\n", __func__); 1698 if (adapter->if_ops.unregister_dev) 1699 adapter->if_ops.unregister_dev(adapter); 1700 err_registerdev: 1701 set_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags); 1702 mwifiex_terminate_workqueue(adapter); 1703 if (adapter->hw_status == MWIFIEX_HW_STATUS_READY) { 1704 pr_debug("info: %s: shutdown mwifiex\n", __func__); 1705 mwifiex_shutdown_drv(adapter); 1706 mwifiex_free_cmd_buffers(adapter); 1707 } 1708 err_kmalloc: 1709 if (adapter->irq_wakeup >= 0) 1710 device_init_wakeup(adapter->dev, false); 1711 mwifiex_free_adapter(adapter); 1712 1713 err_init_sw: 1714 1715 return -1; 1716 } 1717 EXPORT_SYMBOL_GPL(mwifiex_add_card); 1718 1719 /* 1720 * This function removes the card. 1721 * 1722 * This function follows the following major steps to remove the device - 1723 * - Stop data traffic 1724 * - Shutdown firmware 1725 * - Remove the logical interfaces 1726 * - Terminate the work queue 1727 * - Unregister the device 1728 * - Free the adapter structure 1729 */ 1730 int mwifiex_remove_card(struct mwifiex_adapter *adapter) 1731 { 1732 if (!adapter) 1733 return 0; 1734 1735 if (adapter->is_up) 1736 mwifiex_uninit_sw(adapter); 1737 1738 if (adapter->irq_wakeup >= 0) 1739 device_init_wakeup(adapter->dev, false); 1740 1741 /* Unregister device */ 1742 mwifiex_dbg(adapter, INFO, 1743 "info: unregister device\n"); 1744 if (adapter->if_ops.unregister_dev) 1745 adapter->if_ops.unregister_dev(adapter); 1746 /* Free adapter structure */ 1747 mwifiex_dbg(adapter, INFO, 1748 "info: free adapter\n"); 1749 mwifiex_free_adapter(adapter); 1750 1751 return 0; 1752 } 1753 EXPORT_SYMBOL_GPL(mwifiex_remove_card); 1754 1755 void _mwifiex_dbg(const struct mwifiex_adapter *adapter, int mask, 1756 const char *fmt, ...) 1757 { 1758 struct va_format vaf; 1759 va_list args; 1760 1761 if (!(adapter->debug_mask & mask)) 1762 return; 1763 1764 va_start(args, fmt); 1765 1766 vaf.fmt = fmt; 1767 vaf.va = &args; 1768 1769 if (adapter->dev) 1770 dev_info(adapter->dev, "%pV", &vaf); 1771 else 1772 pr_info("%pV", &vaf); 1773 1774 va_end(args); 1775 } 1776 EXPORT_SYMBOL_GPL(_mwifiex_dbg); 1777 1778 /* 1779 * This function initializes the module. 1780 * 1781 * The debug FS is also initialized if configured. 1782 */ 1783 static int 1784 mwifiex_init_module(void) 1785 { 1786 #ifdef CONFIG_DEBUG_FS 1787 mwifiex_debugfs_init(); 1788 #endif 1789 return 0; 1790 } 1791 1792 /* 1793 * This function cleans up the module. 1794 * 1795 * The debug FS is removed if available. 1796 */ 1797 static void 1798 mwifiex_cleanup_module(void) 1799 { 1800 #ifdef CONFIG_DEBUG_FS 1801 mwifiex_debugfs_remove(); 1802 #endif 1803 } 1804 1805 module_init(mwifiex_init_module); 1806 module_exit(mwifiex_cleanup_module); 1807 1808 MODULE_AUTHOR("Marvell International Ltd."); 1809 MODULE_DESCRIPTION("Marvell WiFi-Ex Driver version " VERSION); 1810 MODULE_VERSION(VERSION); 1811 MODULE_LICENSE("GPL v2"); 1812