1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (c) 2012 - 2018 Microchip Technology Inc., and its subsidiaries. 4 * All rights reserved. 5 */ 6 7 #include <linux/irq.h> 8 #include <linux/kthread.h> 9 #include <linux/firmware.h> 10 #include <linux/netdevice.h> 11 #include <linux/inetdevice.h> 12 13 #include "cfg80211.h" 14 #include "wlan_cfg.h" 15 16 #define WILC_MULTICAST_TABLE_SIZE 8 17 #define WILC_MAX_FW_VERSION_STR_SIZE 50 18 19 /* latest API version supported */ 20 #define WILC1000_API_VER 1 21 22 #define WILC1000_FW_PREFIX "atmel/wilc1000_wifi_firmware-" 23 #define __WILC1000_FW(api) WILC1000_FW_PREFIX #api ".bin" 24 #define WILC1000_FW(api) __WILC1000_FW(api) 25 26 static irqreturn_t isr_uh_routine(int irq, void *user_data) 27 { 28 struct wilc *wilc = user_data; 29 30 if (wilc->close) { 31 pr_err("Can't handle UH interrupt\n"); 32 return IRQ_HANDLED; 33 } 34 return IRQ_WAKE_THREAD; 35 } 36 37 static irqreturn_t isr_bh_routine(int irq, void *userdata) 38 { 39 struct wilc *wilc = userdata; 40 41 if (wilc->close) { 42 pr_err("Can't handle BH interrupt\n"); 43 return IRQ_HANDLED; 44 } 45 46 wilc_handle_isr(wilc); 47 48 return IRQ_HANDLED; 49 } 50 51 static int init_irq(struct net_device *dev) 52 { 53 struct wilc_vif *vif = netdev_priv(dev); 54 struct wilc *wl = vif->wilc; 55 int ret; 56 57 ret = request_threaded_irq(wl->dev_irq_num, isr_uh_routine, 58 isr_bh_routine, 59 IRQF_TRIGGER_FALLING | IRQF_ONESHOT, 60 dev->name, wl); 61 if (ret) { 62 netdev_err(dev, "Failed to request IRQ [%d]\n", ret); 63 return ret; 64 } 65 netdev_dbg(dev, "IRQ request succeeded IRQ-NUM= %d\n", wl->dev_irq_num); 66 67 return 0; 68 } 69 70 static void deinit_irq(struct net_device *dev) 71 { 72 struct wilc_vif *vif = netdev_priv(dev); 73 struct wilc *wilc = vif->wilc; 74 75 /* Deinitialize IRQ */ 76 if (wilc->dev_irq_num) 77 free_irq(wilc->dev_irq_num, wilc); 78 } 79 80 void wilc_mac_indicate(struct wilc *wilc) 81 { 82 s8 status; 83 84 wilc_wlan_cfg_get_val(wilc, WID_STATUS, &status, 1); 85 if (wilc->mac_status == WILC_MAC_STATUS_INIT) { 86 wilc->mac_status = status; 87 complete(&wilc->sync_event); 88 } else { 89 wilc->mac_status = status; 90 } 91 } 92 93 static struct net_device *get_if_handler(struct wilc *wilc, u8 *mac_header) 94 { 95 struct net_device *ndev = NULL; 96 struct wilc_vif *vif; 97 struct ieee80211_hdr *h = (struct ieee80211_hdr *)mac_header; 98 99 list_for_each_entry_rcu(vif, &wilc->vif_list, list) { 100 if (vif->mode == WILC_STATION_MODE) 101 if (ether_addr_equal_unaligned(h->addr2, vif->bssid)) { 102 ndev = vif->ndev; 103 goto out; 104 } 105 if (vif->mode == WILC_AP_MODE) 106 if (ether_addr_equal_unaligned(h->addr1, vif->bssid)) { 107 ndev = vif->ndev; 108 goto out; 109 } 110 } 111 out: 112 return ndev; 113 } 114 115 void wilc_wlan_set_bssid(struct net_device *wilc_netdev, const u8 *bssid, 116 u8 mode) 117 { 118 struct wilc_vif *vif = netdev_priv(wilc_netdev); 119 120 if (bssid) 121 ether_addr_copy(vif->bssid, bssid); 122 else 123 eth_zero_addr(vif->bssid); 124 125 vif->mode = mode; 126 } 127 128 int wilc_wlan_get_num_conn_ifcs(struct wilc *wilc) 129 { 130 int srcu_idx; 131 u8 ret_val = 0; 132 struct wilc_vif *vif; 133 134 srcu_idx = srcu_read_lock(&wilc->srcu); 135 list_for_each_entry_rcu(vif, &wilc->vif_list, list) { 136 if (!is_zero_ether_addr(vif->bssid)) 137 ret_val++; 138 } 139 srcu_read_unlock(&wilc->srcu, srcu_idx); 140 return ret_val; 141 } 142 143 static int wilc_txq_task(void *vp) 144 { 145 int ret; 146 u32 txq_count; 147 struct wilc *wl = vp; 148 149 complete(&wl->txq_thread_started); 150 while (1) { 151 wait_for_completion(&wl->txq_event); 152 153 if (wl->close) { 154 complete(&wl->txq_thread_started); 155 156 while (!kthread_should_stop()) 157 schedule(); 158 break; 159 } 160 do { 161 ret = wilc_wlan_handle_txq(wl, &txq_count); 162 if (txq_count < FLOW_CONTROL_LOWER_THRESHOLD) { 163 int srcu_idx; 164 struct wilc_vif *ifc; 165 166 srcu_idx = srcu_read_lock(&wl->srcu); 167 list_for_each_entry_rcu(ifc, &wl->vif_list, 168 list) { 169 if (ifc->mac_opened && ifc->ndev) 170 netif_wake_queue(ifc->ndev); 171 } 172 srcu_read_unlock(&wl->srcu, srcu_idx); 173 } 174 } while (ret == WILC_VMM_ENTRY_FULL_RETRY && !wl->close); 175 } 176 return 0; 177 } 178 179 static int wilc_wlan_get_firmware(struct net_device *dev) 180 { 181 struct wilc_vif *vif = netdev_priv(dev); 182 struct wilc *wilc = vif->wilc; 183 int chip_id; 184 const struct firmware *wilc_fw; 185 int ret; 186 187 chip_id = wilc_get_chipid(wilc, false); 188 189 netdev_info(dev, "ChipID [%x] loading firmware [%s]\n", chip_id, 190 WILC1000_FW(WILC1000_API_VER)); 191 192 ret = request_firmware(&wilc_fw, WILC1000_FW(WILC1000_API_VER), 193 wilc->dev); 194 if (ret != 0) { 195 netdev_err(dev, "%s - firmware not available\n", 196 WILC1000_FW(WILC1000_API_VER)); 197 return -EINVAL; 198 } 199 wilc->firmware = wilc_fw; 200 201 return 0; 202 } 203 204 static int wilc_start_firmware(struct net_device *dev) 205 { 206 struct wilc_vif *vif = netdev_priv(dev); 207 struct wilc *wilc = vif->wilc; 208 int ret = 0; 209 210 ret = wilc_wlan_start(wilc); 211 if (ret) 212 return ret; 213 214 if (!wait_for_completion_timeout(&wilc->sync_event, 215 msecs_to_jiffies(5000))) 216 return -ETIME; 217 218 return 0; 219 } 220 221 static int wilc1000_firmware_download(struct net_device *dev) 222 { 223 struct wilc_vif *vif = netdev_priv(dev); 224 struct wilc *wilc = vif->wilc; 225 int ret = 0; 226 227 if (!wilc->firmware) { 228 netdev_err(dev, "Firmware buffer is NULL\n"); 229 return -ENOBUFS; 230 } 231 232 ret = wilc_wlan_firmware_download(wilc, wilc->firmware->data, 233 wilc->firmware->size); 234 if (ret) 235 return ret; 236 237 release_firmware(wilc->firmware); 238 wilc->firmware = NULL; 239 240 netdev_dbg(dev, "Download Succeeded\n"); 241 242 return 0; 243 } 244 245 static int wilc_init_fw_config(struct net_device *dev, struct wilc_vif *vif) 246 { 247 struct wilc_priv *priv = &vif->priv; 248 struct host_if_drv *hif_drv; 249 u8 b; 250 u16 hw; 251 u32 w; 252 253 netdev_dbg(dev, "Start configuring Firmware\n"); 254 hif_drv = (struct host_if_drv *)priv->hif_drv; 255 netdev_dbg(dev, "Host = %p\n", hif_drv); 256 257 w = vif->iftype; 258 cpu_to_le32s(&w); 259 if (!wilc_wlan_cfg_set(vif, 1, WID_SET_OPERATION_MODE, (u8 *)&w, 4, 260 0, 0)) 261 goto fail; 262 263 b = WILC_FW_BSS_TYPE_INFRA; 264 if (!wilc_wlan_cfg_set(vif, 0, WID_BSS_TYPE, &b, 1, 0, 0)) 265 goto fail; 266 267 b = WILC_FW_TX_RATE_AUTO; 268 if (!wilc_wlan_cfg_set(vif, 0, WID_CURRENT_TX_RATE, &b, 1, 0, 0)) 269 goto fail; 270 271 b = WILC_FW_OPER_MODE_G_MIXED_11B_2; 272 if (!wilc_wlan_cfg_set(vif, 0, WID_11G_OPERATING_MODE, &b, 1, 0, 0)) 273 goto fail; 274 275 b = WILC_FW_PREAMBLE_SHORT; 276 if (!wilc_wlan_cfg_set(vif, 0, WID_PREAMBLE, &b, 1, 0, 0)) 277 goto fail; 278 279 b = WILC_FW_11N_PROT_AUTO; 280 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_PROT_MECH, &b, 1, 0, 0)) 281 goto fail; 282 283 b = WILC_FW_ACTIVE_SCAN; 284 if (!wilc_wlan_cfg_set(vif, 0, WID_SCAN_TYPE, &b, 1, 0, 0)) 285 goto fail; 286 287 b = WILC_FW_SITE_SURVEY_OFF; 288 if (!wilc_wlan_cfg_set(vif, 0, WID_SITE_SURVEY, &b, 1, 0, 0)) 289 goto fail; 290 291 hw = 0xffff; 292 cpu_to_le16s(&hw); 293 if (!wilc_wlan_cfg_set(vif, 0, WID_RTS_THRESHOLD, (u8 *)&hw, 2, 0, 0)) 294 goto fail; 295 296 hw = 2346; 297 cpu_to_le16s(&hw); 298 if (!wilc_wlan_cfg_set(vif, 0, WID_FRAG_THRESHOLD, (u8 *)&hw, 2, 0, 0)) 299 goto fail; 300 301 b = 0; 302 if (!wilc_wlan_cfg_set(vif, 0, WID_BCAST_SSID, &b, 1, 0, 0)) 303 goto fail; 304 305 b = 1; 306 if (!wilc_wlan_cfg_set(vif, 0, WID_QOS_ENABLE, &b, 1, 0, 0)) 307 goto fail; 308 309 b = WILC_FW_NO_POWERSAVE; 310 if (!wilc_wlan_cfg_set(vif, 0, WID_POWER_MANAGEMENT, &b, 1, 0, 0)) 311 goto fail; 312 313 b = WILC_FW_SEC_NO; 314 if (!wilc_wlan_cfg_set(vif, 0, WID_11I_MODE, &b, 1, 0, 0)) 315 goto fail; 316 317 b = WILC_FW_AUTH_OPEN_SYSTEM; 318 if (!wilc_wlan_cfg_set(vif, 0, WID_AUTH_TYPE, &b, 1, 0, 0)) 319 goto fail; 320 321 b = 3; 322 if (!wilc_wlan_cfg_set(vif, 0, WID_LISTEN_INTERVAL, &b, 1, 0, 0)) 323 goto fail; 324 325 b = 3; 326 if (!wilc_wlan_cfg_set(vif, 0, WID_DTIM_PERIOD, &b, 1, 0, 0)) 327 goto fail; 328 329 b = WILC_FW_ACK_POLICY_NORMAL; 330 if (!wilc_wlan_cfg_set(vif, 0, WID_ACK_POLICY, &b, 1, 0, 0)) 331 goto fail; 332 333 b = 0; 334 if (!wilc_wlan_cfg_set(vif, 0, WID_USER_CONTROL_ON_TX_POWER, &b, 1, 335 0, 0)) 336 goto fail; 337 338 b = 48; 339 if (!wilc_wlan_cfg_set(vif, 0, WID_TX_POWER_LEVEL_11A, &b, 1, 0, 0)) 340 goto fail; 341 342 b = 28; 343 if (!wilc_wlan_cfg_set(vif, 0, WID_TX_POWER_LEVEL_11B, &b, 1, 0, 0)) 344 goto fail; 345 346 hw = 100; 347 cpu_to_le16s(&hw); 348 if (!wilc_wlan_cfg_set(vif, 0, WID_BEACON_INTERVAL, (u8 *)&hw, 2, 0, 0)) 349 goto fail; 350 351 b = WILC_FW_REKEY_POLICY_DISABLE; 352 if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_POLICY, &b, 1, 0, 0)) 353 goto fail; 354 355 w = 84600; 356 cpu_to_le32s(&w); 357 if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_PERIOD, (u8 *)&w, 4, 0, 0)) 358 goto fail; 359 360 w = 500; 361 cpu_to_le32s(&w); 362 if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_PACKET_COUNT, (u8 *)&w, 4, 0, 363 0)) 364 goto fail; 365 366 b = 1; 367 if (!wilc_wlan_cfg_set(vif, 0, WID_SHORT_SLOT_ALLOWED, &b, 1, 0, 368 0)) 369 goto fail; 370 371 b = WILC_FW_ERP_PROT_SELF_CTS; 372 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_ERP_PROT_TYPE, &b, 1, 0, 0)) 373 goto fail; 374 375 b = 1; 376 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_ENABLE, &b, 1, 0, 0)) 377 goto fail; 378 379 b = WILC_FW_11N_OP_MODE_HT_MIXED; 380 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_OPERATING_MODE, &b, 1, 0, 0)) 381 goto fail; 382 383 b = 1; 384 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_TXOP_PROT_DISABLE, &b, 1, 0, 0)) 385 goto fail; 386 387 b = WILC_FW_OBBS_NONHT_DETECT_PROTECT_REPORT; 388 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_OBSS_NONHT_DETECTION, &b, 1, 389 0, 0)) 390 goto fail; 391 392 b = WILC_FW_HT_PROT_RTS_CTS_NONHT; 393 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_HT_PROT_TYPE, &b, 1, 0, 0)) 394 goto fail; 395 396 b = 0; 397 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_RIFS_PROT_ENABLE, &b, 1, 0, 398 0)) 399 goto fail; 400 401 b = 7; 402 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_CURRENT_TX_MCS, &b, 1, 0, 0)) 403 goto fail; 404 405 b = 1; 406 if (!wilc_wlan_cfg_set(vif, 0, WID_11N_IMMEDIATE_BA_ENABLED, &b, 1, 407 1, 1)) 408 goto fail; 409 410 return 0; 411 412 fail: 413 return -EINVAL; 414 } 415 416 static void wlan_deinitialize_threads(struct net_device *dev) 417 { 418 struct wilc_vif *vif = netdev_priv(dev); 419 struct wilc *wl = vif->wilc; 420 421 wl->close = 1; 422 423 complete(&wl->txq_event); 424 425 if (wl->txq_thread) { 426 kthread_stop(wl->txq_thread); 427 wl->txq_thread = NULL; 428 } 429 } 430 431 static void wilc_wlan_deinitialize(struct net_device *dev) 432 { 433 struct wilc_vif *vif = netdev_priv(dev); 434 struct wilc *wl = vif->wilc; 435 436 if (!wl) { 437 netdev_err(dev, "wl is NULL\n"); 438 return; 439 } 440 441 if (wl->initialized) { 442 netdev_info(dev, "Deinitializing wilc1000...\n"); 443 444 if (!wl->dev_irq_num && 445 wl->hif_func->disable_interrupt) { 446 mutex_lock(&wl->hif_cs); 447 wl->hif_func->disable_interrupt(wl); 448 mutex_unlock(&wl->hif_cs); 449 } 450 complete(&wl->txq_event); 451 452 wlan_deinitialize_threads(dev); 453 deinit_irq(dev); 454 455 wilc_wlan_stop(wl, vif); 456 wilc_wlan_cleanup(dev); 457 458 wl->initialized = false; 459 460 netdev_dbg(dev, "wilc1000 deinitialization Done\n"); 461 } else { 462 netdev_dbg(dev, "wilc1000 is not initialized\n"); 463 } 464 } 465 466 static int wlan_initialize_threads(struct net_device *dev) 467 { 468 struct wilc_vif *vif = netdev_priv(dev); 469 struct wilc *wilc = vif->wilc; 470 471 wilc->txq_thread = kthread_run(wilc_txq_task, (void *)wilc, 472 "%s-tx", dev->name); 473 if (IS_ERR(wilc->txq_thread)) { 474 netdev_err(dev, "couldn't create TXQ thread\n"); 475 wilc->close = 0; 476 return PTR_ERR(wilc->txq_thread); 477 } 478 wait_for_completion(&wilc->txq_thread_started); 479 480 return 0; 481 } 482 483 static int wilc_wlan_initialize(struct net_device *dev, struct wilc_vif *vif) 484 { 485 int ret = 0; 486 struct wilc *wl = vif->wilc; 487 488 if (!wl->initialized) { 489 wl->mac_status = WILC_MAC_STATUS_INIT; 490 wl->close = 0; 491 492 ret = wilc_wlan_init(dev); 493 if (ret) 494 return ret; 495 496 ret = wlan_initialize_threads(dev); 497 if (ret) 498 goto fail_wilc_wlan; 499 500 if (wl->dev_irq_num && init_irq(dev)) { 501 ret = -EIO; 502 goto fail_threads; 503 } 504 505 if (!wl->dev_irq_num && 506 wl->hif_func->enable_interrupt && 507 wl->hif_func->enable_interrupt(wl)) { 508 ret = -EIO; 509 goto fail_irq_init; 510 } 511 512 ret = wilc_wlan_get_firmware(dev); 513 if (ret) 514 goto fail_irq_enable; 515 516 ret = wilc1000_firmware_download(dev); 517 if (ret) 518 goto fail_irq_enable; 519 520 ret = wilc_start_firmware(dev); 521 if (ret) 522 goto fail_irq_enable; 523 524 if (wilc_wlan_cfg_get(vif, 1, WID_FIRMWARE_VERSION, 1, 0)) { 525 int size; 526 char firmware_ver[WILC_MAX_FW_VERSION_STR_SIZE]; 527 528 size = wilc_wlan_cfg_get_val(wl, WID_FIRMWARE_VERSION, 529 firmware_ver, 530 sizeof(firmware_ver)); 531 firmware_ver[size] = '\0'; 532 netdev_dbg(dev, "Firmware Ver = %s\n", firmware_ver); 533 } 534 535 ret = wilc_init_fw_config(dev, vif); 536 if (ret) { 537 netdev_err(dev, "Failed to configure firmware\n"); 538 goto fail_fw_start; 539 } 540 wl->initialized = true; 541 return 0; 542 543 fail_fw_start: 544 wilc_wlan_stop(wl, vif); 545 546 fail_irq_enable: 547 if (!wl->dev_irq_num && 548 wl->hif_func->disable_interrupt) 549 wl->hif_func->disable_interrupt(wl); 550 fail_irq_init: 551 if (wl->dev_irq_num) 552 deinit_irq(dev); 553 fail_threads: 554 wlan_deinitialize_threads(dev); 555 fail_wilc_wlan: 556 wilc_wlan_cleanup(dev); 557 netdev_err(dev, "WLAN initialization FAILED\n"); 558 } else { 559 netdev_dbg(dev, "wilc1000 already initialized\n"); 560 } 561 return ret; 562 } 563 564 static int mac_init_fn(struct net_device *ndev) 565 { 566 netif_start_queue(ndev); 567 netif_stop_queue(ndev); 568 569 return 0; 570 } 571 572 static int wilc_mac_open(struct net_device *ndev) 573 { 574 struct wilc_vif *vif = netdev_priv(ndev); 575 struct wilc *wl = vif->wilc; 576 int ret = 0; 577 struct mgmt_frame_regs mgmt_regs = {}; 578 u8 addr[ETH_ALEN] __aligned(2); 579 580 if (!wl || !wl->dev) { 581 netdev_err(ndev, "device not ready\n"); 582 return -ENODEV; 583 } 584 585 netdev_dbg(ndev, "MAC OPEN[%p]\n", ndev); 586 587 ret = wilc_init_host_int(ndev); 588 if (ret) 589 return ret; 590 591 ret = wilc_wlan_initialize(ndev, vif); 592 if (ret) { 593 wilc_deinit_host_int(ndev); 594 return ret; 595 } 596 597 wilc_set_operation_mode(vif, wilc_get_vif_idx(vif), vif->iftype, 598 vif->idx); 599 600 if (is_valid_ether_addr(ndev->dev_addr)) { 601 ether_addr_copy(addr, ndev->dev_addr); 602 wilc_set_mac_address(vif, addr); 603 } else { 604 wilc_get_mac_address(vif, addr); 605 eth_hw_addr_set(ndev, addr); 606 } 607 netdev_dbg(ndev, "Mac address: %pM\n", ndev->dev_addr); 608 609 if (!is_valid_ether_addr(ndev->dev_addr)) { 610 netdev_err(ndev, "Wrong MAC address\n"); 611 wilc_deinit_host_int(ndev); 612 wilc_wlan_deinitialize(ndev); 613 return -EINVAL; 614 } 615 616 mgmt_regs.interface_stypes = vif->mgmt_reg_stypes; 617 /* so we detect a change */ 618 vif->mgmt_reg_stypes = 0; 619 wilc_update_mgmt_frame_registrations(vif->ndev->ieee80211_ptr->wiphy, 620 vif->ndev->ieee80211_ptr, 621 &mgmt_regs); 622 netif_wake_queue(ndev); 623 wl->open_ifcs++; 624 vif->mac_opened = 1; 625 return 0; 626 } 627 628 static struct net_device_stats *mac_stats(struct net_device *dev) 629 { 630 struct wilc_vif *vif = netdev_priv(dev); 631 632 return &vif->netstats; 633 } 634 635 static int wilc_set_mac_addr(struct net_device *dev, void *p) 636 { 637 int result; 638 struct wilc_vif *vif = netdev_priv(dev); 639 struct wilc *wilc = vif->wilc; 640 struct sockaddr *addr = (struct sockaddr *)p; 641 unsigned char mac_addr[ETH_ALEN]; 642 struct wilc_vif *tmp_vif; 643 int srcu_idx; 644 645 if (!is_valid_ether_addr(addr->sa_data)) 646 return -EADDRNOTAVAIL; 647 648 if (!vif->mac_opened) { 649 eth_commit_mac_addr_change(dev, p); 650 return 0; 651 } 652 653 /* Verify MAC Address is not already in use: */ 654 655 srcu_idx = srcu_read_lock(&wilc->srcu); 656 list_for_each_entry_rcu(tmp_vif, &wilc->vif_list, list) { 657 wilc_get_mac_address(tmp_vif, mac_addr); 658 if (ether_addr_equal(addr->sa_data, mac_addr)) { 659 if (vif != tmp_vif) { 660 srcu_read_unlock(&wilc->srcu, srcu_idx); 661 return -EADDRNOTAVAIL; 662 } 663 srcu_read_unlock(&wilc->srcu, srcu_idx); 664 return 0; 665 } 666 } 667 srcu_read_unlock(&wilc->srcu, srcu_idx); 668 669 result = wilc_set_mac_address(vif, (u8 *)addr->sa_data); 670 if (result) 671 return result; 672 673 eth_commit_mac_addr_change(dev, p); 674 return result; 675 } 676 677 static void wilc_set_multicast_list(struct net_device *dev) 678 { 679 struct netdev_hw_addr *ha; 680 struct wilc_vif *vif = netdev_priv(dev); 681 int i; 682 u8 *mc_list; 683 u8 *cur_mc; 684 685 if (dev->flags & IFF_PROMISC) 686 return; 687 688 if (dev->flags & IFF_ALLMULTI || 689 dev->mc.count > WILC_MULTICAST_TABLE_SIZE) { 690 wilc_setup_multicast_filter(vif, 0, 0, NULL); 691 return; 692 } 693 694 if (dev->mc.count == 0) { 695 wilc_setup_multicast_filter(vif, 1, 0, NULL); 696 return; 697 } 698 699 mc_list = kmalloc_array(dev->mc.count, ETH_ALEN, GFP_ATOMIC); 700 if (!mc_list) 701 return; 702 703 cur_mc = mc_list; 704 i = 0; 705 netdev_for_each_mc_addr(ha, dev) { 706 memcpy(cur_mc, ha->addr, ETH_ALEN); 707 netdev_dbg(dev, "Entry[%d]: %pM\n", i, cur_mc); 708 i++; 709 cur_mc += ETH_ALEN; 710 } 711 712 if (wilc_setup_multicast_filter(vif, 1, dev->mc.count, mc_list)) 713 kfree(mc_list); 714 } 715 716 static void wilc_tx_complete(void *priv, int status) 717 { 718 struct tx_complete_data *pv_data = priv; 719 720 dev_kfree_skb(pv_data->skb); 721 kfree(pv_data); 722 } 723 724 netdev_tx_t wilc_mac_xmit(struct sk_buff *skb, struct net_device *ndev) 725 { 726 struct wilc_vif *vif = netdev_priv(ndev); 727 struct wilc *wilc = vif->wilc; 728 struct tx_complete_data *tx_data = NULL; 729 int queue_count; 730 731 if (skb->dev != ndev) { 732 netdev_err(ndev, "Packet not destined to this device\n"); 733 return NETDEV_TX_OK; 734 } 735 736 tx_data = kmalloc(sizeof(*tx_data), GFP_ATOMIC); 737 if (!tx_data) { 738 dev_kfree_skb(skb); 739 netif_wake_queue(ndev); 740 return NETDEV_TX_OK; 741 } 742 743 tx_data->buff = skb->data; 744 tx_data->size = skb->len; 745 tx_data->skb = skb; 746 747 vif->netstats.tx_packets++; 748 vif->netstats.tx_bytes += tx_data->size; 749 queue_count = wilc_wlan_txq_add_net_pkt(ndev, tx_data, 750 tx_data->buff, tx_data->size, 751 wilc_tx_complete); 752 753 if (queue_count > FLOW_CONTROL_UPPER_THRESHOLD) { 754 int srcu_idx; 755 struct wilc_vif *vif; 756 757 srcu_idx = srcu_read_lock(&wilc->srcu); 758 list_for_each_entry_rcu(vif, &wilc->vif_list, list) { 759 if (vif->mac_opened) 760 netif_stop_queue(vif->ndev); 761 } 762 srcu_read_unlock(&wilc->srcu, srcu_idx); 763 } 764 765 return NETDEV_TX_OK; 766 } 767 768 static int wilc_mac_close(struct net_device *ndev) 769 { 770 struct wilc_vif *vif = netdev_priv(ndev); 771 struct wilc *wl = vif->wilc; 772 773 netdev_dbg(ndev, "Mac close\n"); 774 775 if (wl->open_ifcs > 0) 776 wl->open_ifcs--; 777 else 778 return 0; 779 780 if (vif->ndev) { 781 netif_stop_queue(vif->ndev); 782 783 wilc_deinit_host_int(vif->ndev); 784 } 785 786 if (wl->open_ifcs == 0) { 787 netdev_dbg(ndev, "Deinitializing wilc1000\n"); 788 wl->close = 1; 789 wilc_wlan_deinitialize(ndev); 790 } 791 792 vif->mac_opened = 0; 793 794 return 0; 795 } 796 797 void wilc_frmw_to_host(struct wilc *wilc, u8 *buff, u32 size, 798 u32 pkt_offset) 799 { 800 unsigned int frame_len = 0; 801 int stats; 802 unsigned char *buff_to_send = NULL; 803 struct sk_buff *skb; 804 struct net_device *wilc_netdev; 805 struct wilc_vif *vif; 806 807 if (!wilc) 808 return; 809 810 wilc_netdev = get_if_handler(wilc, buff); 811 if (!wilc_netdev) 812 return; 813 814 buff += pkt_offset; 815 vif = netdev_priv(wilc_netdev); 816 817 if (size > 0) { 818 frame_len = size; 819 buff_to_send = buff; 820 821 skb = dev_alloc_skb(frame_len); 822 if (!skb) 823 return; 824 825 skb->dev = wilc_netdev; 826 827 skb_put_data(skb, buff_to_send, frame_len); 828 829 skb->protocol = eth_type_trans(skb, wilc_netdev); 830 vif->netstats.rx_packets++; 831 vif->netstats.rx_bytes += frame_len; 832 skb->ip_summed = CHECKSUM_UNNECESSARY; 833 stats = netif_rx(skb); 834 netdev_dbg(wilc_netdev, "netif_rx ret value is: %d\n", stats); 835 } 836 } 837 838 void wilc_wfi_mgmt_rx(struct wilc *wilc, u8 *buff, u32 size) 839 { 840 int srcu_idx; 841 struct wilc_vif *vif; 842 843 srcu_idx = srcu_read_lock(&wilc->srcu); 844 list_for_each_entry_rcu(vif, &wilc->vif_list, list) { 845 u16 type = le16_to_cpup((__le16 *)buff); 846 u32 type_bit = BIT(type >> 4); 847 848 if (vif->priv.p2p_listen_state && 849 vif->mgmt_reg_stypes & type_bit) 850 wilc_wfi_p2p_rx(vif, buff, size); 851 852 if (vif->monitor_flag) 853 wilc_wfi_monitor_rx(wilc->monitor_dev, buff, size); 854 } 855 srcu_read_unlock(&wilc->srcu, srcu_idx); 856 } 857 858 static const struct net_device_ops wilc_netdev_ops = { 859 .ndo_init = mac_init_fn, 860 .ndo_open = wilc_mac_open, 861 .ndo_stop = wilc_mac_close, 862 .ndo_set_mac_address = wilc_set_mac_addr, 863 .ndo_start_xmit = wilc_mac_xmit, 864 .ndo_get_stats = mac_stats, 865 .ndo_set_rx_mode = wilc_set_multicast_list, 866 }; 867 868 void wilc_netdev_cleanup(struct wilc *wilc) 869 { 870 struct wilc_vif *vif; 871 int srcu_idx, ifc_cnt = 0; 872 873 if (!wilc) 874 return; 875 876 if (wilc->firmware) { 877 release_firmware(wilc->firmware); 878 wilc->firmware = NULL; 879 } 880 881 srcu_idx = srcu_read_lock(&wilc->srcu); 882 list_for_each_entry_rcu(vif, &wilc->vif_list, list) { 883 if (vif->ndev) 884 unregister_netdev(vif->ndev); 885 } 886 srcu_read_unlock(&wilc->srcu, srcu_idx); 887 888 wilc_wfi_deinit_mon_interface(wilc, false); 889 destroy_workqueue(wilc->hif_workqueue); 890 891 while (ifc_cnt < WILC_NUM_CONCURRENT_IFC) { 892 mutex_lock(&wilc->vif_mutex); 893 if (wilc->vif_num <= 0) { 894 mutex_unlock(&wilc->vif_mutex); 895 break; 896 } 897 vif = wilc_get_wl_to_vif(wilc); 898 if (!IS_ERR(vif)) 899 list_del_rcu(&vif->list); 900 901 wilc->vif_num--; 902 mutex_unlock(&wilc->vif_mutex); 903 synchronize_srcu(&wilc->srcu); 904 ifc_cnt++; 905 } 906 907 wilc_wlan_cfg_deinit(wilc); 908 wlan_deinit_locks(wilc); 909 wiphy_unregister(wilc->wiphy); 910 wiphy_free(wilc->wiphy); 911 } 912 EXPORT_SYMBOL_GPL(wilc_netdev_cleanup); 913 914 static u8 wilc_get_available_idx(struct wilc *wl) 915 { 916 int idx = 0; 917 struct wilc_vif *vif; 918 int srcu_idx; 919 920 srcu_idx = srcu_read_lock(&wl->srcu); 921 list_for_each_entry_rcu(vif, &wl->vif_list, list) { 922 if (vif->idx == 0) 923 idx = 1; 924 else 925 idx = 0; 926 } 927 srcu_read_unlock(&wl->srcu, srcu_idx); 928 return idx; 929 } 930 931 struct wilc_vif *wilc_netdev_ifc_init(struct wilc *wl, const char *name, 932 int vif_type, enum nl80211_iftype type, 933 bool rtnl_locked) 934 { 935 struct net_device *ndev; 936 struct wilc_vif *vif; 937 int ret; 938 939 ndev = alloc_etherdev(sizeof(*vif)); 940 if (!ndev) 941 return ERR_PTR(-ENOMEM); 942 943 vif = netdev_priv(ndev); 944 ndev->ieee80211_ptr = &vif->priv.wdev; 945 strcpy(ndev->name, name); 946 vif->wilc = wl; 947 vif->ndev = ndev; 948 ndev->ml_priv = vif; 949 950 ndev->netdev_ops = &wilc_netdev_ops; 951 952 SET_NETDEV_DEV(ndev, wiphy_dev(wl->wiphy)); 953 954 vif->priv.wdev.wiphy = wl->wiphy; 955 vif->priv.wdev.netdev = ndev; 956 vif->priv.wdev.iftype = type; 957 vif->priv.dev = ndev; 958 959 if (rtnl_locked) 960 ret = cfg80211_register_netdevice(ndev); 961 else 962 ret = register_netdev(ndev); 963 964 if (ret) { 965 ret = -EFAULT; 966 goto error; 967 } 968 969 wl->hif_workqueue = alloc_ordered_workqueue("%s-wq", WQ_MEM_RECLAIM, 970 ndev->name); 971 if (!wl->hif_workqueue) { 972 ret = -ENOMEM; 973 goto error; 974 } 975 976 ndev->needs_free_netdev = true; 977 vif->iftype = vif_type; 978 vif->idx = wilc_get_available_idx(wl); 979 vif->mac_opened = 0; 980 mutex_lock(&wl->vif_mutex); 981 list_add_tail_rcu(&vif->list, &wl->vif_list); 982 wl->vif_num += 1; 983 mutex_unlock(&wl->vif_mutex); 984 synchronize_srcu(&wl->srcu); 985 986 return vif; 987 988 error: 989 free_netdev(ndev); 990 return ERR_PTR(ret); 991 } 992 993 MODULE_LICENSE("GPL"); 994 MODULE_FIRMWARE(WILC1000_FW(WILC1000_API_VER)); 995