1 /* 2 * This file contains the major functions in WLAN 3 * driver. It includes init, exit, open, close and main 4 * thread etc.. 5 */ 6 7 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 8 9 #include <linux/module.h> 10 #include <linux/delay.h> 11 #include <linux/etherdevice.h> 12 #include <linux/hardirq.h> 13 #include <linux/netdevice.h> 14 #include <linux/if_arp.h> 15 #include <linux/kthread.h> 16 #include <linux/kfifo.h> 17 #include <linux/slab.h> 18 #include <net/cfg80211.h> 19 20 #include "host.h" 21 #include "decl.h" 22 #include "dev.h" 23 #include "cfg.h" 24 #include "debugfs.h" 25 #include "cmd.h" 26 #include "mesh.h" 27 28 #define DRIVER_RELEASE_VERSION "323.p0" 29 const char lbs_driver_version[] = "COMM-USB8388-" DRIVER_RELEASE_VERSION 30 #ifdef DEBUG 31 "-dbg" 32 #endif 33 ""; 34 35 36 /* Module parameters */ 37 unsigned int lbs_debug; 38 EXPORT_SYMBOL_GPL(lbs_debug); 39 module_param_named(libertas_debug, lbs_debug, int, 0644); 40 41 unsigned int lbs_disablemesh; 42 EXPORT_SYMBOL_GPL(lbs_disablemesh); 43 module_param_named(libertas_disablemesh, lbs_disablemesh, int, 0644); 44 45 46 /* 47 * This global structure is used to send the confirm_sleep command as 48 * fast as possible down to the firmware. 49 */ 50 struct cmd_confirm_sleep confirm_sleep; 51 52 53 /* 54 * the table to keep region code 55 */ 56 u16 lbs_region_code_to_index[MRVDRV_MAX_REGION_CODE] = 57 { 0x10, 0x20, 0x30, 0x31, 0x32, 0x40 }; 58 59 /* 60 * FW rate table. FW refers to rates by their index in this table, not by the 61 * rate value itself. Values of 0x00 are 62 * reserved positions. 63 */ 64 static u8 fw_data_rates[MAX_RATES] = 65 { 0x02, 0x04, 0x0B, 0x16, 0x00, 0x0C, 0x12, 66 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C, 0x00 67 }; 68 69 /** 70 * lbs_fw_index_to_data_rate - use index to get the data rate 71 * 72 * @idx: The index of data rate 73 * returns: data rate or 0 74 */ 75 u32 lbs_fw_index_to_data_rate(u8 idx) 76 { 77 if (idx >= sizeof(fw_data_rates)) 78 idx = 0; 79 return fw_data_rates[idx]; 80 } 81 82 /** 83 * lbs_data_rate_to_fw_index - use rate to get the index 84 * 85 * @rate: data rate 86 * returns: index or 0 87 */ 88 u8 lbs_data_rate_to_fw_index(u32 rate) 89 { 90 u8 i; 91 92 if (!rate) 93 return 0; 94 95 for (i = 0; i < sizeof(fw_data_rates); i++) { 96 if (rate == fw_data_rates[i]) 97 return i; 98 } 99 return 0; 100 } 101 102 int lbs_set_iface_type(struct lbs_private *priv, enum nl80211_iftype type) 103 { 104 int ret = 0; 105 106 switch (type) { 107 case NL80211_IFTYPE_MONITOR: 108 ret = lbs_set_monitor_mode(priv, 1); 109 break; 110 case NL80211_IFTYPE_STATION: 111 if (priv->wdev->iftype == NL80211_IFTYPE_MONITOR) 112 ret = lbs_set_monitor_mode(priv, 0); 113 if (!ret) 114 ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_BSS_TYPE, 1); 115 break; 116 case NL80211_IFTYPE_ADHOC: 117 if (priv->wdev->iftype == NL80211_IFTYPE_MONITOR) 118 ret = lbs_set_monitor_mode(priv, 0); 119 if (!ret) 120 ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_BSS_TYPE, 2); 121 break; 122 default: 123 ret = -ENOTSUPP; 124 } 125 return ret; 126 } 127 128 int lbs_start_iface(struct lbs_private *priv) 129 { 130 struct cmd_ds_802_11_mac_address cmd; 131 int ret; 132 133 if (priv->power_restore) { 134 ret = priv->power_restore(priv); 135 if (ret) 136 return ret; 137 } 138 139 cmd.hdr.size = cpu_to_le16(sizeof(cmd)); 140 cmd.action = cpu_to_le16(CMD_ACT_SET); 141 memcpy(cmd.macadd, priv->current_addr, ETH_ALEN); 142 143 ret = lbs_cmd_with_response(priv, CMD_802_11_MAC_ADDRESS, &cmd); 144 if (ret) { 145 lbs_deb_net("set MAC address failed\n"); 146 goto err; 147 } 148 149 ret = lbs_set_iface_type(priv, priv->wdev->iftype); 150 if (ret) { 151 lbs_deb_net("set iface type failed\n"); 152 goto err; 153 } 154 155 ret = lbs_set_11d_domain_info(priv); 156 if (ret) { 157 lbs_deb_net("set 11d domain info failed\n"); 158 goto err; 159 } 160 161 lbs_update_channel(priv); 162 163 priv->iface_running = true; 164 return 0; 165 166 err: 167 if (priv->power_save) 168 priv->power_save(priv); 169 return ret; 170 } 171 172 /** 173 * lbs_dev_open - open the ethX interface 174 * 175 * @dev: A pointer to &net_device structure 176 * returns: 0 or -EBUSY if monitor mode active 177 */ 178 static int lbs_dev_open(struct net_device *dev) 179 { 180 struct lbs_private *priv = dev->ml_priv; 181 int ret = 0; 182 183 lbs_deb_enter(LBS_DEB_NET); 184 if (!priv->iface_running) { 185 ret = lbs_start_iface(priv); 186 if (ret) 187 goto out; 188 } 189 190 spin_lock_irq(&priv->driver_lock); 191 192 netif_carrier_off(dev); 193 194 if (!priv->tx_pending_len) 195 netif_wake_queue(dev); 196 197 spin_unlock_irq(&priv->driver_lock); 198 199 out: 200 lbs_deb_leave_args(LBS_DEB_NET, "ret %d", ret); 201 return ret; 202 } 203 204 static bool lbs_command_queue_empty(struct lbs_private *priv) 205 { 206 unsigned long flags; 207 bool ret; 208 spin_lock_irqsave(&priv->driver_lock, flags); 209 ret = priv->cur_cmd == NULL && list_empty(&priv->cmdpendingq); 210 spin_unlock_irqrestore(&priv->driver_lock, flags); 211 return ret; 212 } 213 214 int lbs_stop_iface(struct lbs_private *priv) 215 { 216 unsigned long flags; 217 int ret = 0; 218 219 lbs_deb_enter(LBS_DEB_MAIN); 220 221 spin_lock_irqsave(&priv->driver_lock, flags); 222 priv->iface_running = false; 223 kfree_skb(priv->currenttxskb); 224 priv->currenttxskb = NULL; 225 priv->tx_pending_len = 0; 226 spin_unlock_irqrestore(&priv->driver_lock, flags); 227 228 cancel_work_sync(&priv->mcast_work); 229 del_timer_sync(&priv->tx_lockup_timer); 230 231 /* Disable command processing, and wait for all commands to complete */ 232 lbs_deb_main("waiting for commands to complete\n"); 233 wait_event(priv->waitq, lbs_command_queue_empty(priv)); 234 lbs_deb_main("all commands completed\n"); 235 236 if (priv->power_save) 237 ret = priv->power_save(priv); 238 239 lbs_deb_leave(LBS_DEB_MAIN); 240 return ret; 241 } 242 243 /** 244 * lbs_eth_stop - close the ethX interface 245 * 246 * @dev: A pointer to &net_device structure 247 * returns: 0 248 */ 249 static int lbs_eth_stop(struct net_device *dev) 250 { 251 struct lbs_private *priv = dev->ml_priv; 252 253 lbs_deb_enter(LBS_DEB_NET); 254 255 if (priv->connect_status == LBS_CONNECTED) 256 lbs_disconnect(priv, WLAN_REASON_DEAUTH_LEAVING); 257 258 spin_lock_irq(&priv->driver_lock); 259 netif_stop_queue(dev); 260 spin_unlock_irq(&priv->driver_lock); 261 262 lbs_update_mcast(priv); 263 cancel_delayed_work_sync(&priv->scan_work); 264 if (priv->scan_req) 265 lbs_scan_done(priv); 266 267 netif_carrier_off(priv->dev); 268 269 if (!lbs_iface_active(priv)) 270 lbs_stop_iface(priv); 271 272 lbs_deb_leave(LBS_DEB_NET); 273 return 0; 274 } 275 276 void lbs_host_to_card_done(struct lbs_private *priv) 277 { 278 unsigned long flags; 279 280 lbs_deb_enter(LBS_DEB_THREAD); 281 282 spin_lock_irqsave(&priv->driver_lock, flags); 283 del_timer(&priv->tx_lockup_timer); 284 285 priv->dnld_sent = DNLD_RES_RECEIVED; 286 287 /* Wake main thread if commands are pending */ 288 if (!priv->cur_cmd || priv->tx_pending_len > 0) { 289 if (!priv->wakeup_dev_required) 290 wake_up(&priv->waitq); 291 } 292 293 spin_unlock_irqrestore(&priv->driver_lock, flags); 294 lbs_deb_leave(LBS_DEB_THREAD); 295 } 296 EXPORT_SYMBOL_GPL(lbs_host_to_card_done); 297 298 int lbs_set_mac_address(struct net_device *dev, void *addr) 299 { 300 int ret = 0; 301 struct lbs_private *priv = dev->ml_priv; 302 struct sockaddr *phwaddr = addr; 303 304 lbs_deb_enter(LBS_DEB_NET); 305 306 /* 307 * Can only set MAC address when all interfaces are down, to be written 308 * to the hardware when one of them is brought up. 309 */ 310 if (lbs_iface_active(priv)) 311 return -EBUSY; 312 313 /* In case it was called from the mesh device */ 314 dev = priv->dev; 315 316 memcpy(priv->current_addr, phwaddr->sa_data, ETH_ALEN); 317 memcpy(dev->dev_addr, phwaddr->sa_data, ETH_ALEN); 318 if (priv->mesh_dev) 319 memcpy(priv->mesh_dev->dev_addr, phwaddr->sa_data, ETH_ALEN); 320 321 lbs_deb_leave_args(LBS_DEB_NET, "ret %d", ret); 322 return ret; 323 } 324 325 326 static inline int mac_in_list(unsigned char *list, int list_len, 327 unsigned char *mac) 328 { 329 while (list_len) { 330 if (!memcmp(list, mac, ETH_ALEN)) 331 return 1; 332 list += ETH_ALEN; 333 list_len--; 334 } 335 return 0; 336 } 337 338 339 static int lbs_add_mcast_addrs(struct cmd_ds_mac_multicast_adr *cmd, 340 struct net_device *dev, int nr_addrs) 341 { 342 int i = nr_addrs; 343 struct netdev_hw_addr *ha; 344 int cnt; 345 346 if ((dev->flags & (IFF_UP|IFF_MULTICAST)) != (IFF_UP|IFF_MULTICAST)) 347 return nr_addrs; 348 349 netif_addr_lock_bh(dev); 350 cnt = netdev_mc_count(dev); 351 netdev_for_each_mc_addr(ha, dev) { 352 if (mac_in_list(cmd->maclist, nr_addrs, ha->addr)) { 353 lbs_deb_net("mcast address %s:%pM skipped\n", dev->name, 354 ha->addr); 355 cnt--; 356 continue; 357 } 358 359 if (i == MRVDRV_MAX_MULTICAST_LIST_SIZE) 360 break; 361 memcpy(&cmd->maclist[6*i], ha->addr, ETH_ALEN); 362 lbs_deb_net("mcast address %s:%pM added to filter\n", dev->name, 363 ha->addr); 364 i++; 365 cnt--; 366 } 367 netif_addr_unlock_bh(dev); 368 if (cnt) 369 return -EOVERFLOW; 370 371 return i; 372 } 373 374 void lbs_update_mcast(struct lbs_private *priv) 375 { 376 struct cmd_ds_mac_multicast_adr mcast_cmd; 377 int dev_flags = 0; 378 int nr_addrs; 379 int old_mac_control = priv->mac_control; 380 381 lbs_deb_enter(LBS_DEB_NET); 382 383 if (netif_running(priv->dev)) 384 dev_flags |= priv->dev->flags; 385 if (priv->mesh_dev && netif_running(priv->mesh_dev)) 386 dev_flags |= priv->mesh_dev->flags; 387 388 if (dev_flags & IFF_PROMISC) { 389 priv->mac_control |= CMD_ACT_MAC_PROMISCUOUS_ENABLE; 390 priv->mac_control &= ~(CMD_ACT_MAC_ALL_MULTICAST_ENABLE | 391 CMD_ACT_MAC_MULTICAST_ENABLE); 392 goto out_set_mac_control; 393 } else if (dev_flags & IFF_ALLMULTI) { 394 do_allmulti: 395 priv->mac_control |= CMD_ACT_MAC_ALL_MULTICAST_ENABLE; 396 priv->mac_control &= ~(CMD_ACT_MAC_PROMISCUOUS_ENABLE | 397 CMD_ACT_MAC_MULTICAST_ENABLE); 398 goto out_set_mac_control; 399 } 400 401 /* Once for priv->dev, again for priv->mesh_dev if it exists */ 402 nr_addrs = lbs_add_mcast_addrs(&mcast_cmd, priv->dev, 0); 403 if (nr_addrs >= 0 && priv->mesh_dev) 404 nr_addrs = lbs_add_mcast_addrs(&mcast_cmd, priv->mesh_dev, nr_addrs); 405 if (nr_addrs < 0) 406 goto do_allmulti; 407 408 if (nr_addrs) { 409 int size = offsetof(struct cmd_ds_mac_multicast_adr, 410 maclist[6*nr_addrs]); 411 412 mcast_cmd.action = cpu_to_le16(CMD_ACT_SET); 413 mcast_cmd.hdr.size = cpu_to_le16(size); 414 mcast_cmd.nr_of_adrs = cpu_to_le16(nr_addrs); 415 416 lbs_cmd_async(priv, CMD_MAC_MULTICAST_ADR, &mcast_cmd.hdr, size); 417 418 priv->mac_control |= CMD_ACT_MAC_MULTICAST_ENABLE; 419 } else 420 priv->mac_control &= ~CMD_ACT_MAC_MULTICAST_ENABLE; 421 422 priv->mac_control &= ~(CMD_ACT_MAC_PROMISCUOUS_ENABLE | 423 CMD_ACT_MAC_ALL_MULTICAST_ENABLE); 424 out_set_mac_control: 425 if (priv->mac_control != old_mac_control) 426 lbs_set_mac_control(priv); 427 428 lbs_deb_leave(LBS_DEB_NET); 429 } 430 431 static void lbs_set_mcast_worker(struct work_struct *work) 432 { 433 struct lbs_private *priv = container_of(work, struct lbs_private, mcast_work); 434 lbs_update_mcast(priv); 435 } 436 437 void lbs_set_multicast_list(struct net_device *dev) 438 { 439 struct lbs_private *priv = dev->ml_priv; 440 441 schedule_work(&priv->mcast_work); 442 } 443 444 /** 445 * lbs_thread - handles the major jobs in the LBS driver. 446 * It handles all events generated by firmware, RX data received 447 * from firmware and TX data sent from kernel. 448 * 449 * @data: A pointer to &lbs_thread structure 450 * returns: 0 451 */ 452 static int lbs_thread(void *data) 453 { 454 struct net_device *dev = data; 455 struct lbs_private *priv = dev->ml_priv; 456 wait_queue_t wait; 457 458 lbs_deb_enter(LBS_DEB_THREAD); 459 460 init_waitqueue_entry(&wait, current); 461 462 for (;;) { 463 int shouldsleep; 464 u8 resp_idx; 465 466 lbs_deb_thread("1: currenttxskb %p, dnld_sent %d\n", 467 priv->currenttxskb, priv->dnld_sent); 468 469 add_wait_queue(&priv->waitq, &wait); 470 set_current_state(TASK_INTERRUPTIBLE); 471 spin_lock_irq(&priv->driver_lock); 472 473 if (kthread_should_stop()) 474 shouldsleep = 0; /* Bye */ 475 else if (priv->surpriseremoved) 476 shouldsleep = 1; /* We need to wait until we're _told_ to die */ 477 else if (priv->psstate == PS_STATE_SLEEP) 478 shouldsleep = 1; /* Sleep mode. Nothing we can do till it wakes */ 479 else if (priv->cmd_timed_out) 480 shouldsleep = 0; /* Command timed out. Recover */ 481 else if (!priv->fw_ready) 482 shouldsleep = 1; /* Firmware not ready. We're waiting for it */ 483 else if (priv->dnld_sent) 484 shouldsleep = 1; /* Something is en route to the device already */ 485 else if (priv->tx_pending_len > 0) 486 shouldsleep = 0; /* We've a packet to send */ 487 else if (priv->resp_len[priv->resp_idx]) 488 shouldsleep = 0; /* We have a command response */ 489 else if (priv->cur_cmd) 490 shouldsleep = 1; /* Can't send a command; one already running */ 491 else if (!list_empty(&priv->cmdpendingq) && 492 !(priv->wakeup_dev_required)) 493 shouldsleep = 0; /* We have a command to send */ 494 else if (kfifo_len(&priv->event_fifo)) 495 shouldsleep = 0; /* We have an event to process */ 496 else 497 shouldsleep = 1; /* No command */ 498 499 if (shouldsleep) { 500 lbs_deb_thread("sleeping, connect_status %d, " 501 "psmode %d, psstate %d\n", 502 priv->connect_status, 503 priv->psmode, priv->psstate); 504 spin_unlock_irq(&priv->driver_lock); 505 schedule(); 506 } else 507 spin_unlock_irq(&priv->driver_lock); 508 509 lbs_deb_thread("2: currenttxskb %p, dnld_send %d\n", 510 priv->currenttxskb, priv->dnld_sent); 511 512 set_current_state(TASK_RUNNING); 513 remove_wait_queue(&priv->waitq, &wait); 514 515 lbs_deb_thread("3: currenttxskb %p, dnld_sent %d\n", 516 priv->currenttxskb, priv->dnld_sent); 517 518 if (kthread_should_stop()) { 519 lbs_deb_thread("break from main thread\n"); 520 break; 521 } 522 523 if (priv->surpriseremoved) { 524 lbs_deb_thread("adapter removed; waiting to die...\n"); 525 continue; 526 } 527 528 lbs_deb_thread("4: currenttxskb %p, dnld_sent %d\n", 529 priv->currenttxskb, priv->dnld_sent); 530 531 /* Process any pending command response */ 532 spin_lock_irq(&priv->driver_lock); 533 resp_idx = priv->resp_idx; 534 if (priv->resp_len[resp_idx]) { 535 spin_unlock_irq(&priv->driver_lock); 536 lbs_process_command_response(priv, 537 priv->resp_buf[resp_idx], 538 priv->resp_len[resp_idx]); 539 spin_lock_irq(&priv->driver_lock); 540 priv->resp_len[resp_idx] = 0; 541 } 542 spin_unlock_irq(&priv->driver_lock); 543 544 /* Process hardware events, e.g. card removed, link lost */ 545 spin_lock_irq(&priv->driver_lock); 546 while (kfifo_len(&priv->event_fifo)) { 547 u32 event; 548 549 if (kfifo_out(&priv->event_fifo, 550 (unsigned char *) &event, sizeof(event)) != 551 sizeof(event)) 552 break; 553 spin_unlock_irq(&priv->driver_lock); 554 lbs_process_event(priv, event); 555 spin_lock_irq(&priv->driver_lock); 556 } 557 spin_unlock_irq(&priv->driver_lock); 558 559 if (priv->wakeup_dev_required) { 560 lbs_deb_thread("Waking up device...\n"); 561 /* Wake up device */ 562 if (priv->exit_deep_sleep(priv)) 563 lbs_deb_thread("Wakeup device failed\n"); 564 continue; 565 } 566 567 /* command timeout stuff */ 568 if (priv->cmd_timed_out && priv->cur_cmd) { 569 struct cmd_ctrl_node *cmdnode = priv->cur_cmd; 570 571 netdev_info(dev, "Timeout submitting command 0x%04x\n", 572 le16_to_cpu(cmdnode->cmdbuf->command)); 573 lbs_complete_command(priv, cmdnode, -ETIMEDOUT); 574 575 /* Reset card, but only when it isn't in the process 576 * of being shutdown anyway. */ 577 if (!dev->dismantle && priv->reset_card) 578 priv->reset_card(priv); 579 } 580 priv->cmd_timed_out = 0; 581 582 if (!priv->fw_ready) 583 continue; 584 585 /* Check if we need to confirm Sleep Request received previously */ 586 if (priv->psstate == PS_STATE_PRE_SLEEP && 587 !priv->dnld_sent && !priv->cur_cmd) { 588 if (priv->connect_status == LBS_CONNECTED) { 589 lbs_deb_thread("pre-sleep, currenttxskb %p, " 590 "dnld_sent %d, cur_cmd %p\n", 591 priv->currenttxskb, priv->dnld_sent, 592 priv->cur_cmd); 593 594 lbs_ps_confirm_sleep(priv); 595 } else { 596 /* workaround for firmware sending 597 * deauth/linkloss event immediately 598 * after sleep request; remove this 599 * after firmware fixes it 600 */ 601 priv->psstate = PS_STATE_AWAKE; 602 netdev_alert(dev, 603 "ignore PS_SleepConfirm in non-connected state\n"); 604 } 605 } 606 607 /* The PS state is changed during processing of Sleep Request 608 * event above 609 */ 610 if ((priv->psstate == PS_STATE_SLEEP) || 611 (priv->psstate == PS_STATE_PRE_SLEEP)) 612 continue; 613 614 if (priv->is_deep_sleep) 615 continue; 616 617 /* Execute the next command */ 618 if (!priv->dnld_sent && !priv->cur_cmd) 619 lbs_execute_next_command(priv); 620 621 spin_lock_irq(&priv->driver_lock); 622 if (!priv->dnld_sent && priv->tx_pending_len > 0) { 623 int ret = priv->hw_host_to_card(priv, MVMS_DAT, 624 priv->tx_pending_buf, 625 priv->tx_pending_len); 626 if (ret) { 627 lbs_deb_tx("host_to_card failed %d\n", ret); 628 priv->dnld_sent = DNLD_RES_RECEIVED; 629 } else { 630 mod_timer(&priv->tx_lockup_timer, 631 jiffies + (HZ * 5)); 632 } 633 priv->tx_pending_len = 0; 634 if (!priv->currenttxskb) { 635 /* We can wake the queues immediately if we aren't 636 waiting for TX feedback */ 637 if (priv->connect_status == LBS_CONNECTED) 638 netif_wake_queue(priv->dev); 639 if (priv->mesh_dev && 640 netif_running(priv->mesh_dev)) 641 netif_wake_queue(priv->mesh_dev); 642 } 643 } 644 spin_unlock_irq(&priv->driver_lock); 645 } 646 647 del_timer(&priv->command_timer); 648 del_timer(&priv->tx_lockup_timer); 649 del_timer(&priv->auto_deepsleep_timer); 650 651 lbs_deb_leave(LBS_DEB_THREAD); 652 return 0; 653 } 654 655 /** 656 * lbs_setup_firmware - gets the HW spec from the firmware and sets 657 * some basic parameters 658 * 659 * @priv: A pointer to &struct lbs_private structure 660 * returns: 0 or -1 661 */ 662 static int lbs_setup_firmware(struct lbs_private *priv) 663 { 664 int ret = -1; 665 s16 curlevel = 0, minlevel = 0, maxlevel = 0; 666 667 lbs_deb_enter(LBS_DEB_FW); 668 669 /* Read MAC address from firmware */ 670 eth_broadcast_addr(priv->current_addr); 671 ret = lbs_update_hw_spec(priv); 672 if (ret) 673 goto done; 674 675 /* Read power levels if available */ 676 ret = lbs_get_tx_power(priv, &curlevel, &minlevel, &maxlevel); 677 if (ret == 0) { 678 priv->txpower_cur = curlevel; 679 priv->txpower_min = minlevel; 680 priv->txpower_max = maxlevel; 681 } 682 683 /* Send cmd to FW to enable 11D function */ 684 ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_11D_ENABLE, 1); 685 if (ret) 686 goto done; 687 688 ret = lbs_set_mac_control_sync(priv); 689 done: 690 lbs_deb_leave_args(LBS_DEB_FW, "ret %d", ret); 691 return ret; 692 } 693 694 int lbs_suspend(struct lbs_private *priv) 695 { 696 int ret; 697 698 lbs_deb_enter(LBS_DEB_FW); 699 700 if (priv->is_deep_sleep) { 701 ret = lbs_set_deep_sleep(priv, 0); 702 if (ret) { 703 netdev_err(priv->dev, 704 "deep sleep cancellation failed: %d\n", ret); 705 return ret; 706 } 707 priv->deep_sleep_required = 1; 708 } 709 710 ret = lbs_set_host_sleep(priv, 1); 711 712 netif_device_detach(priv->dev); 713 if (priv->mesh_dev) 714 netif_device_detach(priv->mesh_dev); 715 716 lbs_deb_leave_args(LBS_DEB_FW, "ret %d", ret); 717 return ret; 718 } 719 EXPORT_SYMBOL_GPL(lbs_suspend); 720 721 int lbs_resume(struct lbs_private *priv) 722 { 723 int ret; 724 725 lbs_deb_enter(LBS_DEB_FW); 726 727 ret = lbs_set_host_sleep(priv, 0); 728 729 netif_device_attach(priv->dev); 730 if (priv->mesh_dev) 731 netif_device_attach(priv->mesh_dev); 732 733 if (priv->deep_sleep_required) { 734 priv->deep_sleep_required = 0; 735 ret = lbs_set_deep_sleep(priv, 1); 736 if (ret) 737 netdev_err(priv->dev, 738 "deep sleep activation failed: %d\n", ret); 739 } 740 741 if (priv->setup_fw_on_resume) 742 ret = lbs_setup_firmware(priv); 743 744 lbs_deb_leave_args(LBS_DEB_FW, "ret %d", ret); 745 return ret; 746 } 747 EXPORT_SYMBOL_GPL(lbs_resume); 748 749 /** 750 * lbs_cmd_timeout_handler - handles the timeout of command sending. 751 * It will re-send the same command again. 752 * 753 * @data: &struct lbs_private pointer 754 */ 755 static void lbs_cmd_timeout_handler(unsigned long data) 756 { 757 struct lbs_private *priv = (struct lbs_private *)data; 758 unsigned long flags; 759 760 lbs_deb_enter(LBS_DEB_CMD); 761 spin_lock_irqsave(&priv->driver_lock, flags); 762 763 if (!priv->cur_cmd) 764 goto out; 765 766 netdev_info(priv->dev, "command 0x%04x timed out\n", 767 le16_to_cpu(priv->cur_cmd->cmdbuf->command)); 768 769 priv->cmd_timed_out = 1; 770 771 /* 772 * If the device didn't even acknowledge the command, reset the state 773 * so that we don't block all future commands due to this one timeout. 774 */ 775 if (priv->dnld_sent == DNLD_CMD_SENT) 776 priv->dnld_sent = DNLD_RES_RECEIVED; 777 778 wake_up(&priv->waitq); 779 out: 780 spin_unlock_irqrestore(&priv->driver_lock, flags); 781 lbs_deb_leave(LBS_DEB_CMD); 782 } 783 784 /** 785 * lbs_tx_lockup_handler - handles the timeout of the passing of TX frames 786 * to the hardware. This is known to frequently happen with SD8686 when 787 * waking up after a Wake-on-WLAN-triggered resume. 788 * 789 * @data: &struct lbs_private pointer 790 */ 791 static void lbs_tx_lockup_handler(unsigned long data) 792 { 793 struct lbs_private *priv = (struct lbs_private *)data; 794 unsigned long flags; 795 796 lbs_deb_enter(LBS_DEB_TX); 797 spin_lock_irqsave(&priv->driver_lock, flags); 798 799 netdev_info(priv->dev, "TX lockup detected\n"); 800 if (priv->reset_card) 801 priv->reset_card(priv); 802 803 priv->dnld_sent = DNLD_RES_RECEIVED; 804 wake_up_interruptible(&priv->waitq); 805 806 spin_unlock_irqrestore(&priv->driver_lock, flags); 807 lbs_deb_leave(LBS_DEB_TX); 808 } 809 810 /** 811 * auto_deepsleep_timer_fn - put the device back to deep sleep mode when 812 * timer expires and no activity (command, event, data etc.) is detected. 813 * @data: &struct lbs_private pointer 814 * returns: N/A 815 */ 816 static void auto_deepsleep_timer_fn(unsigned long data) 817 { 818 struct lbs_private *priv = (struct lbs_private *)data; 819 820 lbs_deb_enter(LBS_DEB_CMD); 821 822 if (priv->is_activity_detected) { 823 priv->is_activity_detected = 0; 824 } else { 825 if (priv->is_auto_deep_sleep_enabled && 826 (!priv->wakeup_dev_required) && 827 (priv->connect_status != LBS_CONNECTED)) { 828 struct cmd_header cmd; 829 830 lbs_deb_main("Entering auto deep sleep mode...\n"); 831 memset(&cmd, 0, sizeof(cmd)); 832 cmd.size = cpu_to_le16(sizeof(cmd)); 833 lbs_cmd_async(priv, CMD_802_11_DEEP_SLEEP, &cmd, 834 sizeof(cmd)); 835 } 836 } 837 mod_timer(&priv->auto_deepsleep_timer , jiffies + 838 (priv->auto_deep_sleep_timeout * HZ)/1000); 839 lbs_deb_leave(LBS_DEB_CMD); 840 } 841 842 int lbs_enter_auto_deep_sleep(struct lbs_private *priv) 843 { 844 lbs_deb_enter(LBS_DEB_SDIO); 845 846 priv->is_auto_deep_sleep_enabled = 1; 847 if (priv->is_deep_sleep) 848 priv->wakeup_dev_required = 1; 849 mod_timer(&priv->auto_deepsleep_timer , 850 jiffies + (priv->auto_deep_sleep_timeout * HZ)/1000); 851 852 lbs_deb_leave(LBS_DEB_SDIO); 853 return 0; 854 } 855 856 int lbs_exit_auto_deep_sleep(struct lbs_private *priv) 857 { 858 lbs_deb_enter(LBS_DEB_SDIO); 859 860 priv->is_auto_deep_sleep_enabled = 0; 861 priv->auto_deep_sleep_timeout = 0; 862 del_timer(&priv->auto_deepsleep_timer); 863 864 lbs_deb_leave(LBS_DEB_SDIO); 865 return 0; 866 } 867 868 static int lbs_init_adapter(struct lbs_private *priv) 869 { 870 int ret; 871 872 lbs_deb_enter(LBS_DEB_MAIN); 873 874 eth_broadcast_addr(priv->current_addr); 875 876 priv->connect_status = LBS_DISCONNECTED; 877 priv->channel = DEFAULT_AD_HOC_CHANNEL; 878 priv->mac_control = CMD_ACT_MAC_RX_ON | CMD_ACT_MAC_TX_ON; 879 priv->radio_on = 1; 880 priv->psmode = LBS802_11POWERMODECAM; 881 priv->psstate = PS_STATE_FULL_POWER; 882 priv->is_deep_sleep = 0; 883 priv->is_auto_deep_sleep_enabled = 0; 884 priv->deep_sleep_required = 0; 885 priv->wakeup_dev_required = 0; 886 init_waitqueue_head(&priv->ds_awake_q); 887 init_waitqueue_head(&priv->scan_q); 888 priv->authtype_auto = 1; 889 priv->is_host_sleep_configured = 0; 890 priv->is_host_sleep_activated = 0; 891 init_waitqueue_head(&priv->host_sleep_q); 892 init_waitqueue_head(&priv->fw_waitq); 893 mutex_init(&priv->lock); 894 895 setup_timer(&priv->command_timer, lbs_cmd_timeout_handler, 896 (unsigned long)priv); 897 setup_timer(&priv->tx_lockup_timer, lbs_tx_lockup_handler, 898 (unsigned long)priv); 899 setup_timer(&priv->auto_deepsleep_timer, auto_deepsleep_timer_fn, 900 (unsigned long)priv); 901 902 INIT_LIST_HEAD(&priv->cmdfreeq); 903 INIT_LIST_HEAD(&priv->cmdpendingq); 904 905 spin_lock_init(&priv->driver_lock); 906 907 /* Allocate the command buffers */ 908 if (lbs_allocate_cmd_buffer(priv)) { 909 pr_err("Out of memory allocating command buffers\n"); 910 ret = -ENOMEM; 911 goto out; 912 } 913 priv->resp_idx = 0; 914 priv->resp_len[0] = priv->resp_len[1] = 0; 915 916 /* Create the event FIFO */ 917 ret = kfifo_alloc(&priv->event_fifo, sizeof(u32) * 16, GFP_KERNEL); 918 if (ret) { 919 pr_err("Out of memory allocating event FIFO buffer\n"); 920 goto out; 921 } 922 923 out: 924 lbs_deb_leave_args(LBS_DEB_MAIN, "ret %d", ret); 925 926 return ret; 927 } 928 929 static void lbs_free_adapter(struct lbs_private *priv) 930 { 931 lbs_deb_enter(LBS_DEB_MAIN); 932 933 lbs_free_cmd_buffer(priv); 934 kfifo_free(&priv->event_fifo); 935 del_timer(&priv->command_timer); 936 del_timer(&priv->tx_lockup_timer); 937 del_timer(&priv->auto_deepsleep_timer); 938 939 lbs_deb_leave(LBS_DEB_MAIN); 940 } 941 942 static const struct net_device_ops lbs_netdev_ops = { 943 .ndo_open = lbs_dev_open, 944 .ndo_stop = lbs_eth_stop, 945 .ndo_start_xmit = lbs_hard_start_xmit, 946 .ndo_set_mac_address = lbs_set_mac_address, 947 .ndo_set_rx_mode = lbs_set_multicast_list, 948 .ndo_validate_addr = eth_validate_addr, 949 }; 950 951 /** 952 * lbs_add_card - adds the card. It will probe the 953 * card, allocate the lbs_priv and initialize the device. 954 * 955 * @card: A pointer to card 956 * @dmdev: A pointer to &struct device 957 * returns: A pointer to &struct lbs_private structure 958 */ 959 struct lbs_private *lbs_add_card(void *card, struct device *dmdev) 960 { 961 struct net_device *dev; 962 struct wireless_dev *wdev; 963 struct lbs_private *priv = NULL; 964 965 lbs_deb_enter(LBS_DEB_MAIN); 966 967 /* Allocate an Ethernet device and register it */ 968 wdev = lbs_cfg_alloc(dmdev); 969 if (IS_ERR(wdev)) { 970 pr_err("cfg80211 init failed\n"); 971 goto done; 972 } 973 974 wdev->iftype = NL80211_IFTYPE_STATION; 975 priv = wdev_priv(wdev); 976 priv->wdev = wdev; 977 978 if (lbs_init_adapter(priv)) { 979 pr_err("failed to initialize adapter structure\n"); 980 goto err_wdev; 981 } 982 983 dev = alloc_netdev(0, "wlan%d", NET_NAME_UNKNOWN, ether_setup); 984 if (!dev) { 985 dev_err(dmdev, "no memory for network device instance\n"); 986 goto err_adapter; 987 } 988 989 dev->ieee80211_ptr = wdev; 990 dev->ml_priv = priv; 991 SET_NETDEV_DEV(dev, dmdev); 992 wdev->netdev = dev; 993 priv->dev = dev; 994 995 dev->netdev_ops = &lbs_netdev_ops; 996 dev->watchdog_timeo = 5 * HZ; 997 dev->ethtool_ops = &lbs_ethtool_ops; 998 dev->flags |= IFF_BROADCAST | IFF_MULTICAST; 999 1000 priv->card = card; 1001 1002 strcpy(dev->name, "wlan%d"); 1003 1004 lbs_deb_thread("Starting main thread...\n"); 1005 init_waitqueue_head(&priv->waitq); 1006 priv->main_thread = kthread_run(lbs_thread, dev, "lbs_main"); 1007 if (IS_ERR(priv->main_thread)) { 1008 lbs_deb_thread("Error creating main thread.\n"); 1009 goto err_ndev; 1010 } 1011 1012 priv->work_thread = create_singlethread_workqueue("lbs_worker"); 1013 INIT_WORK(&priv->mcast_work, lbs_set_mcast_worker); 1014 1015 priv->wol_criteria = EHS_REMOVE_WAKEUP; 1016 priv->wol_gpio = 0xff; 1017 priv->wol_gap = 20; 1018 priv->ehs_remove_supported = true; 1019 1020 goto done; 1021 1022 err_ndev: 1023 free_netdev(dev); 1024 1025 err_adapter: 1026 lbs_free_adapter(priv); 1027 1028 err_wdev: 1029 lbs_cfg_free(priv); 1030 1031 priv = NULL; 1032 1033 done: 1034 lbs_deb_leave_args(LBS_DEB_MAIN, "priv %p", priv); 1035 return priv; 1036 } 1037 EXPORT_SYMBOL_GPL(lbs_add_card); 1038 1039 1040 void lbs_remove_card(struct lbs_private *priv) 1041 { 1042 struct net_device *dev = priv->dev; 1043 1044 lbs_deb_enter(LBS_DEB_MAIN); 1045 1046 lbs_remove_mesh(priv); 1047 1048 if (priv->wiphy_registered) 1049 lbs_scan_deinit(priv); 1050 1051 lbs_wait_for_firmware_load(priv); 1052 1053 /* worker thread destruction blocks on the in-flight command which 1054 * should have been cleared already in lbs_stop_card(). 1055 */ 1056 lbs_deb_main("destroying worker thread\n"); 1057 destroy_workqueue(priv->work_thread); 1058 lbs_deb_main("done destroying worker thread\n"); 1059 1060 if (priv->psmode == LBS802_11POWERMODEMAX_PSP) { 1061 priv->psmode = LBS802_11POWERMODECAM; 1062 /* no need to wakeup if already woken up, 1063 * on suspend, this exit ps command is not processed 1064 * the driver hangs 1065 */ 1066 if (priv->psstate != PS_STATE_FULL_POWER) 1067 lbs_set_ps_mode(priv, PS_MODE_ACTION_EXIT_PS, true); 1068 } 1069 1070 if (priv->is_deep_sleep) { 1071 priv->is_deep_sleep = 0; 1072 wake_up_interruptible(&priv->ds_awake_q); 1073 } 1074 1075 priv->is_host_sleep_configured = 0; 1076 priv->is_host_sleep_activated = 0; 1077 wake_up_interruptible(&priv->host_sleep_q); 1078 1079 /* Stop the thread servicing the interrupts */ 1080 priv->surpriseremoved = 1; 1081 kthread_stop(priv->main_thread); 1082 1083 lbs_free_adapter(priv); 1084 lbs_cfg_free(priv); 1085 free_netdev(dev); 1086 1087 lbs_deb_leave(LBS_DEB_MAIN); 1088 } 1089 EXPORT_SYMBOL_GPL(lbs_remove_card); 1090 1091 1092 int lbs_rtap_supported(struct lbs_private *priv) 1093 { 1094 if (MRVL_FW_MAJOR_REV(priv->fwrelease) == MRVL_FW_V5) 1095 return 1; 1096 1097 /* newer firmware use a capability mask */ 1098 return ((MRVL_FW_MAJOR_REV(priv->fwrelease) >= MRVL_FW_V10) && 1099 (priv->fwcapinfo & MESH_CAPINFO_ENABLE_MASK)); 1100 } 1101 1102 1103 int lbs_start_card(struct lbs_private *priv) 1104 { 1105 struct net_device *dev = priv->dev; 1106 int ret = -1; 1107 1108 lbs_deb_enter(LBS_DEB_MAIN); 1109 1110 /* poke the firmware */ 1111 ret = lbs_setup_firmware(priv); 1112 if (ret) 1113 goto done; 1114 1115 if (!lbs_disablemesh) 1116 lbs_init_mesh(priv); 1117 else 1118 pr_info("%s: mesh disabled\n", dev->name); 1119 1120 ret = lbs_cfg_register(priv); 1121 if (ret) { 1122 pr_err("cannot register device\n"); 1123 goto done; 1124 } 1125 1126 if (lbs_mesh_activated(priv)) 1127 lbs_start_mesh(priv); 1128 1129 lbs_debugfs_init_one(priv, dev); 1130 1131 netdev_info(dev, "Marvell WLAN 802.11 adapter\n"); 1132 1133 ret = 0; 1134 1135 done: 1136 lbs_deb_leave_args(LBS_DEB_MAIN, "ret %d", ret); 1137 return ret; 1138 } 1139 EXPORT_SYMBOL_GPL(lbs_start_card); 1140 1141 1142 void lbs_stop_card(struct lbs_private *priv) 1143 { 1144 struct net_device *dev; 1145 1146 lbs_deb_enter(LBS_DEB_MAIN); 1147 1148 if (!priv) 1149 goto out; 1150 dev = priv->dev; 1151 1152 /* If the netdev isn't registered, it means that lbs_start_card() was 1153 * never called so we have nothing to do here. */ 1154 if (dev->reg_state != NETREG_REGISTERED) 1155 goto out; 1156 1157 netif_stop_queue(dev); 1158 netif_carrier_off(dev); 1159 1160 lbs_debugfs_remove_one(priv); 1161 lbs_deinit_mesh(priv); 1162 unregister_netdev(dev); 1163 1164 out: 1165 lbs_deb_leave(LBS_DEB_MAIN); 1166 } 1167 EXPORT_SYMBOL_GPL(lbs_stop_card); 1168 1169 1170 void lbs_queue_event(struct lbs_private *priv, u32 event) 1171 { 1172 unsigned long flags; 1173 1174 lbs_deb_enter(LBS_DEB_THREAD); 1175 spin_lock_irqsave(&priv->driver_lock, flags); 1176 1177 if (priv->psstate == PS_STATE_SLEEP) 1178 priv->psstate = PS_STATE_AWAKE; 1179 1180 kfifo_in(&priv->event_fifo, (unsigned char *) &event, sizeof(u32)); 1181 1182 wake_up(&priv->waitq); 1183 1184 spin_unlock_irqrestore(&priv->driver_lock, flags); 1185 lbs_deb_leave(LBS_DEB_THREAD); 1186 } 1187 EXPORT_SYMBOL_GPL(lbs_queue_event); 1188 1189 void lbs_notify_command_response(struct lbs_private *priv, u8 resp_idx) 1190 { 1191 lbs_deb_enter(LBS_DEB_THREAD); 1192 1193 if (priv->psstate == PS_STATE_SLEEP) 1194 priv->psstate = PS_STATE_AWAKE; 1195 1196 /* Swap buffers by flipping the response index */ 1197 BUG_ON(resp_idx > 1); 1198 priv->resp_idx = resp_idx; 1199 1200 wake_up(&priv->waitq); 1201 1202 lbs_deb_leave(LBS_DEB_THREAD); 1203 } 1204 EXPORT_SYMBOL_GPL(lbs_notify_command_response); 1205 1206 static int __init lbs_init_module(void) 1207 { 1208 lbs_deb_enter(LBS_DEB_MAIN); 1209 memset(&confirm_sleep, 0, sizeof(confirm_sleep)); 1210 confirm_sleep.hdr.command = cpu_to_le16(CMD_802_11_PS_MODE); 1211 confirm_sleep.hdr.size = cpu_to_le16(sizeof(confirm_sleep)); 1212 confirm_sleep.action = cpu_to_le16(PS_MODE_ACTION_SLEEP_CONFIRMED); 1213 lbs_debugfs_init(); 1214 lbs_deb_leave(LBS_DEB_MAIN); 1215 return 0; 1216 } 1217 1218 static void __exit lbs_exit_module(void) 1219 { 1220 lbs_deb_enter(LBS_DEB_MAIN); 1221 lbs_debugfs_remove(); 1222 lbs_deb_leave(LBS_DEB_MAIN); 1223 } 1224 1225 module_init(lbs_init_module); 1226 module_exit(lbs_exit_module); 1227 1228 MODULE_DESCRIPTION("Libertas WLAN Driver Library"); 1229 MODULE_AUTHOR("Marvell International Ltd."); 1230 MODULE_LICENSE("GPL"); 1231