drivers/net/wireless/microchip/wilc1000/netdev.c

   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         wilc_for_each_vif(wilc, vif) {
 100                 if (vif->iftype == WILC_STATION_MODE)
 101                         if (ether_addr_equal_unaligned(h->addr2, vif->bssid)) {
 102                                 ndev = vif->ndev;
 103                                 goto out;
 104                         }
 105                 if (vif->iftype == 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->iftype = 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         wilc_for_each_vif(wilc, vif) {
 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 void wilc_wake_tx_queues(struct wilc *wl)
 144 {
 145         int srcu_idx;
 146         struct wilc_vif *ifc;
 147
 148         srcu_idx = srcu_read_lock(&wl->srcu);
 149         wilc_for_each_vif(wl, ifc) {
 150                 if (ifc->mac_opened && netif_queue_stopped(ifc->ndev))
 151                         netif_wake_queue(ifc->ndev);
 152         }
 153         srcu_read_unlock(&wl->srcu, srcu_idx);
 154 }
 155
 156 static int wilc_txq_task(void *vp)
 157 {
 158         int ret;
 159         u32 txq_count;
 160         struct wilc *wl = vp;
 161
 162         complete(&wl->txq_thread_started);
 163         while (1) {
 164                 if (wait_for_completion_interruptible(&wl->txq_event))
 165                         continue;
 166                 if (wl->close) {
 167                         complete(&wl->txq_thread_started);
 168
 169                         while (!kthread_should_stop())
 170                                 schedule();
 171                         break;
 172                 }
 173                 do {
 174                         ret = wilc_wlan_handle_txq(wl, &txq_count);
 175                         if (txq_count < FLOW_CONTROL_LOWER_THRESHOLD) {
 176                                 wilc_wake_tx_queues(wl);
 177                         }
 178                         if (ret != WILC_VMM_ENTRY_FULL_RETRY)
 179                                 break;
 180                         /* Back off TX task from sending packets for some time.
 181                          * msleep_interruptible will allow RX task to run and
 182                          * free buffers. TX task will be in TASK_INTERRUPTIBLE
 183                          * state which will put the thread back to CPU running
 184                          * queue when it's signaled even if the timeout isn't
 185                          * elapsed. This gives faster chance for reserved SK
 186                          * buffers to be free.
 187                          */
 188                         msleep_interruptible(TX_BACKOFF_WEIGHT_MS);
 189                 } while (!wl->close);
 190         }
 191         return 0;
 192 }
 193
 194 static int wilc_wlan_get_firmware(struct net_device *dev)
 195 {
 196         struct wilc_vif *vif = netdev_priv(dev);
 197         struct wilc *wilc = vif->wilc;
 198         int chip_id;
 199         const struct firmware *wilc_fw;
 200         int ret;
 201
 202         chip_id = wilc_get_chipid(wilc, false);
 203
 204         netdev_info(dev, "ChipID [%x] loading firmware [%s]\n", chip_id,
 205                     WILC1000_FW(WILC1000_API_VER));
 206
 207         ret = request_firmware(&wilc_fw, WILC1000_FW(WILC1000_API_VER),
 208                                wilc->dev);
 209         if (ret != 0) {
 210                 netdev_err(dev, "%s - firmware not available\n",
 211                            WILC1000_FW(WILC1000_API_VER));
 212                 return -EINVAL;
 213         }
 214         wilc->firmware = wilc_fw;
 215
 216         return 0;
 217 }
 218
 219 static int wilc_start_firmware(struct net_device *dev)
 220 {
 221         struct wilc_vif *vif = netdev_priv(dev);
 222         struct wilc *wilc = vif->wilc;
 223         int ret = 0;
 224
 225         ret = wilc_wlan_start(wilc);
 226         if (ret)
 227                 return ret;
 228
 229         if (!wait_for_completion_timeout(&wilc->sync_event,
 230                                          msecs_to_jiffies(5000)))
 231                 return -ETIME;
 232
 233         return 0;
 234 }
 235
 236 static int wilc1000_firmware_download(struct net_device *dev)
 237 {
 238         struct wilc_vif *vif = netdev_priv(dev);
 239         struct wilc *wilc = vif->wilc;
 240         int ret = 0;
 241
 242         if (!wilc->firmware) {
 243                 netdev_err(dev, "Firmware buffer is NULL\n");
 244                 return -ENOBUFS;
 245         }
 246
 247         ret = wilc_wlan_firmware_download(wilc, wilc->firmware->data,
 248                                           wilc->firmware->size);
 249         if (ret)
 250                 return ret;
 251
 252         release_firmware(wilc->firmware);
 253         wilc->firmware = NULL;
 254
 255         netdev_dbg(dev, "Download Succeeded\n");
 256
 257         return 0;
 258 }
 259
 260 static int wilc_init_fw_config(struct net_device *dev, struct wilc_vif *vif)
 261 {
 262         struct wilc_priv *priv = &vif->priv;
 263         struct host_if_drv *hif_drv;
 264         u8 b;
 265         u16 hw;
 266         u32 w;
 267
 268         netdev_dbg(dev, "Start configuring Firmware\n");
 269         hif_drv = (struct host_if_drv *)priv->hif_drv;
 270         netdev_dbg(dev, "Host = %p\n", hif_drv);
 271
 272         w = vif->iftype;
 273         cpu_to_le32s(&w);
 274         if (!wilc_wlan_cfg_set(vif, 1, WID_SET_OPERATION_MODE, (u8 *)&w, 4,
 275                                0, 0))
 276                 goto fail;
 277
 278         b = WILC_FW_BSS_TYPE_INFRA;
 279         if (!wilc_wlan_cfg_set(vif, 0, WID_BSS_TYPE, &b, 1, 0, 0))
 280                 goto fail;
 281
 282         b = WILC_FW_TX_RATE_AUTO;
 283         if (!wilc_wlan_cfg_set(vif, 0, WID_CURRENT_TX_RATE, &b, 1, 0, 0))
 284                 goto fail;
 285
 286         b = WILC_FW_OPER_MODE_G_MIXED_11B_2;
 287         if (!wilc_wlan_cfg_set(vif, 0, WID_11G_OPERATING_MODE, &b, 1, 0, 0))
 288                 goto fail;
 289
 290         b = WILC_FW_PREAMBLE_AUTO;
 291         if (!wilc_wlan_cfg_set(vif, 0, WID_PREAMBLE, &b, 1, 0, 0))
 292                 goto fail;
 293
 294         b = WILC_FW_11N_PROT_AUTO;
 295         if (!wilc_wlan_cfg_set(vif, 0, WID_11N_PROT_MECH, &b, 1, 0, 0))
 296                 goto fail;
 297
 298         b = WILC_FW_ACTIVE_SCAN;
 299         if (!wilc_wlan_cfg_set(vif, 0, WID_SCAN_TYPE, &b, 1, 0, 0))
 300                 goto fail;
 301
 302         b = WILC_FW_SITE_SURVEY_OFF;
 303         if (!wilc_wlan_cfg_set(vif, 0, WID_SITE_SURVEY, &b, 1, 0, 0))
 304                 goto fail;
 305
 306         hw = 0xffff;
 307         cpu_to_le16s(&hw);
 308         if (!wilc_wlan_cfg_set(vif, 0, WID_RTS_THRESHOLD, (u8 *)&hw, 2, 0, 0))
 309                 goto fail;
 310
 311         hw = 2346;
 312         cpu_to_le16s(&hw);
 313         if (!wilc_wlan_cfg_set(vif, 0, WID_FRAG_THRESHOLD, (u8 *)&hw, 2, 0, 0))
 314                 goto fail;
 315
 316         b = 0;
 317         if (!wilc_wlan_cfg_set(vif, 0, WID_BCAST_SSID, &b, 1, 0, 0))
 318                 goto fail;
 319
 320         b = 1;
 321         if (!wilc_wlan_cfg_set(vif, 0, WID_QOS_ENABLE, &b, 1, 0, 0))
 322                 goto fail;
 323
 324         b = WILC_FW_NO_POWERSAVE;
 325         if (!wilc_wlan_cfg_set(vif, 0, WID_POWER_MANAGEMENT, &b, 1, 0, 0))
 326                 goto fail;
 327
 328         b = WILC_FW_SEC_NO;
 329         if (!wilc_wlan_cfg_set(vif, 0, WID_11I_MODE, &b, 1, 0, 0))
 330                 goto fail;
 331
 332         b = WILC_FW_AUTH_OPEN_SYSTEM;
 333         if (!wilc_wlan_cfg_set(vif, 0, WID_AUTH_TYPE, &b, 1, 0, 0))
 334                 goto fail;
 335
 336         b = 3;
 337         if (!wilc_wlan_cfg_set(vif, 0, WID_LISTEN_INTERVAL, &b, 1, 0, 0))
 338                 goto fail;
 339
 340         b = 3;
 341         if (!wilc_wlan_cfg_set(vif, 0, WID_DTIM_PERIOD, &b, 1, 0, 0))
 342                 goto fail;
 343
 344         b = WILC_FW_ACK_POLICY_NORMAL;
 345         if (!wilc_wlan_cfg_set(vif, 0, WID_ACK_POLICY, &b, 1, 0, 0))
 346                 goto fail;
 347
 348         b = 0;
 349         if (!wilc_wlan_cfg_set(vif, 0, WID_USER_CONTROL_ON_TX_POWER, &b, 1,
 350                                0, 0))
 351                 goto fail;
 352
 353         b = 48;
 354         if (!wilc_wlan_cfg_set(vif, 0, WID_TX_POWER_LEVEL_11A, &b, 1, 0, 0))
 355                 goto fail;
 356
 357         b = 28;
 358         if (!wilc_wlan_cfg_set(vif, 0, WID_TX_POWER_LEVEL_11B, &b, 1, 0, 0))
 359                 goto fail;
 360
 361         hw = 100;
 362         cpu_to_le16s(&hw);
 363         if (!wilc_wlan_cfg_set(vif, 0, WID_BEACON_INTERVAL, (u8 *)&hw, 2, 0, 0))
 364                 goto fail;
 365
 366         b = WILC_FW_REKEY_POLICY_DISABLE;
 367         if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_POLICY, &b, 1, 0, 0))
 368                 goto fail;
 369
 370         w = 84600;
 371         cpu_to_le32s(&w);
 372         if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_PERIOD, (u8 *)&w, 4, 0, 0))
 373                 goto fail;
 374
 375         w = 500;
 376         cpu_to_le32s(&w);
 377         if (!wilc_wlan_cfg_set(vif, 0, WID_REKEY_PACKET_COUNT, (u8 *)&w, 4, 0,
 378                                0))
 379                 goto fail;
 380
 381         b = 1;
 382         if (!wilc_wlan_cfg_set(vif, 0, WID_SHORT_SLOT_ALLOWED, &b, 1, 0,
 383                                0))
 384                 goto fail;
 385
 386         b = WILC_FW_ERP_PROT_SELF_CTS;
 387         if (!wilc_wlan_cfg_set(vif, 0, WID_11N_ERP_PROT_TYPE, &b, 1, 0, 0))
 388                 goto fail;
 389
 390         b = 1;
 391         if (!wilc_wlan_cfg_set(vif, 0, WID_11N_ENABLE, &b, 1, 0, 0))
 392                 goto fail;
 393
 394         b = WILC_FW_11N_OP_MODE_HT_MIXED;
 395         if (!wilc_wlan_cfg_set(vif, 0, WID_11N_OPERATING_MODE, &b, 1, 0, 0))
 396                 goto fail;
 397
 398         b = 1;
 399         if (!wilc_wlan_cfg_set(vif, 0, WID_11N_TXOP_PROT_DISABLE, &b, 1, 0, 0))
 400                 goto fail;
 401
 402         b = WILC_FW_OBBS_NONHT_DETECT_PROTECT_REPORT;
 403         if (!wilc_wlan_cfg_set(vif, 0, WID_11N_OBSS_NONHT_DETECTION, &b, 1,
 404                                0, 0))
 405                 goto fail;
 406
 407         b = WILC_FW_HT_PROT_RTS_CTS_NONHT;
 408         if (!wilc_wlan_cfg_set(vif, 0, WID_11N_HT_PROT_TYPE, &b, 1, 0, 0))
 409                 goto fail;
 410
 411         b = 0;
 412         if (!wilc_wlan_cfg_set(vif, 0, WID_11N_RIFS_PROT_ENABLE, &b, 1, 0,
 413                                0))
 414                 goto fail;
 415
 416         b = 7;
 417         if (!wilc_wlan_cfg_set(vif, 0, WID_11N_CURRENT_TX_MCS, &b, 1, 0, 0))
 418                 goto fail;
 419
 420         b = 1;
 421         if (!wilc_wlan_cfg_set(vif, 0, WID_11N_IMMEDIATE_BA_ENABLED, &b, 1,
 422                                1, 0))
 423                 goto fail;
 424
 425         return 0;
 426
 427 fail:
 428         return -EINVAL;
 429 }
 430
 431 static void wlan_deinitialize_threads(struct net_device *dev)
 432 {
 433         struct wilc_vif *vif = netdev_priv(dev);
 434         struct wilc *wl = vif->wilc;
 435
 436         wl->close = 1;
 437
 438         complete(&wl->txq_event);
 439
 440         if (wl->txq_thread) {
 441                 kthread_stop(wl->txq_thread);
 442                 wl->txq_thread = NULL;
 443         }
 444 }
 445
 446 static void wilc_wlan_deinitialize(struct net_device *dev)
 447 {
 448         struct wilc_vif *vif = netdev_priv(dev);
 449         struct wilc *wl = vif->wilc;
 450
 451         if (!wl) {
 452                 netdev_err(dev, "wl is NULL\n");
 453                 return;
 454         }
 455
 456         if (wl->initialized) {
 457                 netdev_info(dev, "Deinitializing wilc1000...\n");
 458
 459                 if (!wl->dev_irq_num &&
 460                     wl->hif_func->disable_interrupt) {
 461                         mutex_lock(&wl->hif_cs);
 462                         wl->hif_func->disable_interrupt(wl);
 463                         mutex_unlock(&wl->hif_cs);
 464                 }
 465                 complete(&wl->txq_event);
 466
 467                 wlan_deinitialize_threads(dev);
 468                 deinit_irq(dev);
 469
 470                 wilc_wlan_stop(wl, vif);
 471                 wilc_wlan_cleanup(dev);
 472
 473                 wl->initialized = false;
 474
 475                 netdev_dbg(dev, "wilc1000 deinitialization Done\n");
 476         } else {
 477                 netdev_dbg(dev, "wilc1000 is not initialized\n");
 478         }
 479 }
 480
 481 static int wlan_initialize_threads(struct net_device *dev)
 482 {
 483         struct wilc_vif *vif = netdev_priv(dev);
 484         struct wilc *wilc = vif->wilc;
 485
 486         wilc->txq_thread = kthread_run(wilc_txq_task, (void *)wilc,
 487                                        "%s-tx", dev->name);
 488         if (IS_ERR(wilc->txq_thread)) {
 489                 netdev_err(dev, "couldn't create TXQ thread\n");
 490                 wilc->close = 1;
 491                 return PTR_ERR(wilc->txq_thread);
 492         }
 493         wait_for_completion(&wilc->txq_thread_started);
 494
 495         return 0;
 496 }
 497
 498 static int wilc_wlan_initialize(struct net_device *dev, struct wilc_vif *vif)
 499 {
 500         int ret = 0;
 501         struct wilc *wl = vif->wilc;
 502
 503         if (!wl->initialized) {
 504                 wl->mac_status = WILC_MAC_STATUS_INIT;
 505                 wl->close = 0;
 506
 507                 ret = wilc_wlan_init(dev);
 508                 if (ret)
 509                         return ret;
 510
 511                 ret = wlan_initialize_threads(dev);
 512                 if (ret)
 513                         goto fail_wilc_wlan;
 514
 515                 if (wl->dev_irq_num && init_irq(dev)) {
 516                         ret = -EIO;
 517                         goto fail_threads;
 518                 }
 519
 520                 if (!wl->dev_irq_num &&
 521                     wl->hif_func->enable_interrupt &&
 522                     wl->hif_func->enable_interrupt(wl)) {
 523                         ret = -EIO;
 524                         goto fail_irq_init;
 525                 }
 526
 527                 ret = wilc_wlan_get_firmware(dev);
 528                 if (ret)
 529                         goto fail_irq_enable;
 530
 531                 ret = wilc1000_firmware_download(dev);
 532                 if (ret)
 533                         goto fail_irq_enable;
 534
 535                 ret = wilc_start_firmware(dev);
 536                 if (ret)
 537                         goto fail_irq_enable;
 538
 539                 if (wilc_wlan_cfg_get(vif, 1, WID_FIRMWARE_VERSION, 1, 0)) {
 540                         int size;
 541                         char firmware_ver[WILC_MAX_FW_VERSION_STR_SIZE];
 542
 543                         size = wilc_wlan_cfg_get_val(wl, WID_FIRMWARE_VERSION,
 544                                                      firmware_ver,
 545                                                      sizeof(firmware_ver));
 546                         firmware_ver[size] = '\0';
 547                         netdev_dbg(dev, "Firmware Ver = %s\n", firmware_ver);
 548                 }
 549
 550                 ret = wilc_init_fw_config(dev, vif);
 551                 if (ret) {
 552                         netdev_err(dev, "Failed to configure firmware\n");
 553                         goto fail_fw_start;
 554                 }
 555                 wl->initialized = true;
 556                 return 0;
 557
 558 fail_fw_start:
 559                 wilc_wlan_stop(wl, vif);
 560
 561 fail_irq_enable:
 562                 if (!wl->dev_irq_num &&
 563                     wl->hif_func->disable_interrupt)
 564                         wl->hif_func->disable_interrupt(wl);
 565 fail_irq_init:
 566                 if (wl->dev_irq_num)
 567                         deinit_irq(dev);
 568 fail_threads:
 569                 wlan_deinitialize_threads(dev);
 570 fail_wilc_wlan:
 571                 wilc_wlan_cleanup(dev);
 572                 netdev_err(dev, "WLAN initialization FAILED\n");
 573         } else {
 574                 netdev_dbg(dev, "wilc1000 already initialized\n");
 575         }
 576         return ret;
 577 }
 578
 579 static int mac_init_fn(struct net_device *ndev)
 580 {
 581         netif_start_queue(ndev);
 582         netif_stop_queue(ndev);
 583
 584         return 0;
 585 }
 586
 587 static int wilc_mac_open(struct net_device *ndev)
 588 {
 589         struct wilc_vif *vif = netdev_priv(ndev);
 590         struct wilc *wl = vif->wilc;
 591         int ret = 0;
 592         struct mgmt_frame_regs mgmt_regs = {};
 593
 594         if (!wl || !wl->dev) {
 595                 netdev_err(ndev, "device not ready\n");
 596                 return -ENODEV;
 597         }
 598
 599         netdev_dbg(ndev, "MAC OPEN[%p]\n", ndev);
 600
 601         ret = wilc_init_host_int(ndev);
 602         if (ret)
 603                 return ret;
 604
 605         ret = wilc_wlan_initialize(ndev, vif);
 606         if (ret) {
 607                 wilc_deinit_host_int(ndev);
 608                 return ret;
 609         }
 610
 611         netdev_dbg(ndev, "Mac address: %pM\n", ndev->dev_addr);
 612         ret = wilc_set_mac_address(vif, ndev->dev_addr);
 613         if (ret) {
 614                 netdev_err(ndev, "Failed to enforce MAC address in chip");
 615                 wilc_deinit_host_int(ndev);
 616                 if (!wl->open_ifcs)
 617                         wilc_wlan_deinitialize(ndev);
 618                 return ret;
 619         }
 620
 621         wilc_set_operation_mode(vif, wilc_get_vif_idx(vif), vif->iftype,
 622                                 vif->idx);
 623
 624         mgmt_regs.interface_stypes = vif->mgmt_reg_stypes;
 625         /* so we detect a change */
 626         vif->mgmt_reg_stypes = 0;
 627         wilc_update_mgmt_frame_registrations(vif->ndev->ieee80211_ptr->wiphy,
 628                                              vif->ndev->ieee80211_ptr,
 629                                              &mgmt_regs);
 630         netif_wake_queue(ndev);
 631         wl->open_ifcs++;
 632         vif->mac_opened = 1;
 633         return 0;
 634 }
 635
 636 static struct net_device_stats *mac_stats(struct net_device *dev)
 637 {
 638         struct wilc_vif *vif = netdev_priv(dev);
 639
 640         return &vif->netstats;
 641 }
 642
 643 static int wilc_set_mac_addr(struct net_device *dev, void *p)
 644 {
 645         int result;
 646         struct wilc_vif *vif = netdev_priv(dev);
 647         struct wilc *wilc = vif->wilc;
 648         struct sockaddr *addr = (struct sockaddr *)p;
 649         unsigned char mac_addr[ETH_ALEN];
 650         struct wilc_vif *tmp_vif;
 651         int srcu_idx;
 652
 653         if (!is_valid_ether_addr(addr->sa_data))
 654                 return -EADDRNOTAVAIL;
 655
 656         if (!vif->mac_opened) {
 657                 eth_commit_mac_addr_change(dev, p);
 658                 return 0;
 659         }
 660
 661         /* Verify MAC Address is not already in use: */
 662
 663         srcu_idx = srcu_read_lock(&wilc->srcu);
 664         wilc_for_each_vif(wilc, tmp_vif) {
 665                 wilc_get_mac_address(tmp_vif, mac_addr);
 666                 if (ether_addr_equal(addr->sa_data, mac_addr)) {
 667                         if (vif != tmp_vif) {
 668                                 srcu_read_unlock(&wilc->srcu, srcu_idx);
 669                                 return -EADDRNOTAVAIL;
 670                         }
 671                         srcu_read_unlock(&wilc->srcu, srcu_idx);
 672                         return 0;
 673                 }
 674         }
 675         srcu_read_unlock(&wilc->srcu, srcu_idx);
 676
 677         result = wilc_set_mac_address(vif, addr->sa_data);
 678         if (result)
 679                 return result;
 680
 681         eth_commit_mac_addr_change(dev, p);
 682         return result;
 683 }
 684
 685 static void wilc_set_multicast_list(struct net_device *dev)
 686 {
 687         struct netdev_hw_addr *ha;
 688         struct wilc_vif *vif = netdev_priv(dev);
 689         int i;
 690         u8 *mc_list;
 691         u8 *cur_mc;
 692
 693         if (dev->flags & IFF_PROMISC)
 694                 return;
 695
 696         if (dev->flags & IFF_ALLMULTI ||
 697             dev->mc.count > WILC_MULTICAST_TABLE_SIZE) {
 698                 wilc_setup_multicast_filter(vif, 0, 0, NULL);
 699                 return;
 700         }
 701
 702         if (dev->mc.count == 0) {
 703                 wilc_setup_multicast_filter(vif, 1, 0, NULL);
 704                 return;
 705         }
 706
 707         mc_list = kmalloc_array(dev->mc.count, ETH_ALEN, GFP_ATOMIC);
 708         if (!mc_list)
 709                 return;
 710
 711         cur_mc = mc_list;
 712         i = 0;
 713         netdev_for_each_mc_addr(ha, dev) {
 714                 memcpy(cur_mc, ha->addr, ETH_ALEN);
 715                 netdev_dbg(dev, "Entry[%d]: %pM\n", i, cur_mc);
 716                 i++;
 717                 cur_mc += ETH_ALEN;
 718         }
 719
 720         if (wilc_setup_multicast_filter(vif, 1, dev->mc.count, mc_list))
 721                 kfree(mc_list);
 722 }
 723
 724 static void wilc_tx_complete(void *priv, int status)
 725 {
 726         struct tx_complete_data *pv_data = priv;
 727
 728         dev_kfree_skb(pv_data->skb);
 729         kfree(pv_data);
 730 }
 731
 732 netdev_tx_t wilc_mac_xmit(struct sk_buff *skb, struct net_device *ndev)
 733 {
 734         struct wilc_vif *vif = netdev_priv(ndev);
 735         struct wilc *wilc = vif->wilc;
 736         struct tx_complete_data *tx_data = NULL;
 737         int queue_count;
 738
 739         if (skb->dev != ndev) {
 740                 netdev_err(ndev, "Packet not destined to this device\n");
 741                 dev_kfree_skb(skb);
 742                 return NETDEV_TX_OK;
 743         }
 744
 745         tx_data = kmalloc(sizeof(*tx_data), GFP_ATOMIC);
 746         if (!tx_data) {
 747                 dev_kfree_skb(skb);
 748                 netif_wake_queue(ndev);
 749                 return NETDEV_TX_OK;
 750         }
 751
 752         tx_data->buff = skb->data;
 753         tx_data->size = skb->len;
 754         tx_data->skb  = skb;
 755
 756         vif->netstats.tx_packets++;
 757         vif->netstats.tx_bytes += tx_data->size;
 758         queue_count = wilc_wlan_txq_add_net_pkt(ndev, tx_data,
 759                                                 tx_data->buff, tx_data->size,
 760                                                 wilc_tx_complete);
 761
 762         if (queue_count > FLOW_CONTROL_UPPER_THRESHOLD) {
 763                 int srcu_idx;
 764                 struct wilc_vif *vif;
 765
 766                 srcu_idx = srcu_read_lock(&wilc->srcu);
 767                 wilc_for_each_vif(wilc, vif) {
 768                         if (vif->mac_opened)
 769                                 netif_stop_queue(vif->ndev);
 770                 }
 771                 srcu_read_unlock(&wilc->srcu, srcu_idx);
 772         }
 773
 774         return NETDEV_TX_OK;
 775 }
 776
 777 static int wilc_mac_close(struct net_device *ndev)
 778 {
 779         struct wilc_vif *vif = netdev_priv(ndev);
 780         struct wilc *wl = vif->wilc;
 781
 782         netdev_dbg(ndev, "Mac close\n");
 783
 784         if (wl->open_ifcs > 0)
 785                 wl->open_ifcs--;
 786         else
 787                 return 0;
 788
 789         if (vif->ndev) {
 790                 netif_stop_queue(vif->ndev);
 791
 792                 wilc_handle_disconnect(vif);
 793                 wilc_deinit_host_int(vif->ndev);
 794         }
 795
 796         if (wl->open_ifcs == 0) {
 797                 netdev_dbg(ndev, "Deinitializing wilc1000\n");
 798                 wl->close = 1;
 799                 wilc_wlan_deinitialize(ndev);
 800         }
 801
 802         vif->mac_opened = 0;
 803
 804         return 0;
 805 }
 806
 807 void wilc_frmw_to_host(struct wilc *wilc, u8 *buff, u32 size,
 808                        u32 pkt_offset)
 809 {
 810         unsigned char *buff_to_send = NULL;
 811         struct net_device *wilc_netdev;
 812         unsigned int frame_len = 0;
 813         struct wilc_vif *vif;
 814         struct sk_buff *skb;
 815         int srcu_idx;
 816         int stats;
 817
 818         if (!wilc)
 819                 return;
 820
 821         srcu_idx = srcu_read_lock(&wilc->srcu);
 822         wilc_netdev = get_if_handler(wilc, buff);
 823         if (!wilc_netdev)
 824                 goto out;
 825
 826         buff += pkt_offset;
 827         vif = netdev_priv(wilc_netdev);
 828
 829         if (size > 0) {
 830                 frame_len = size;
 831                 buff_to_send = buff;
 832
 833                 skb = dev_alloc_skb(frame_len);
 834                 if (!skb)
 835                         goto out;
 836
 837                 skb->dev = wilc_netdev;
 838
 839                 skb_put_data(skb, buff_to_send, frame_len);
 840
 841                 skb->protocol = eth_type_trans(skb, wilc_netdev);
 842                 vif->netstats.rx_packets++;
 843                 vif->netstats.rx_bytes += frame_len;
 844                 skb->ip_summed = CHECKSUM_UNNECESSARY;
 845                 stats = netif_rx(skb);
 846                 netdev_dbg(wilc_netdev, "netif_rx ret value is: %d\n", stats);
 847         }
 848 out:
 849         srcu_read_unlock(&wilc->srcu, srcu_idx);
 850 }
 851
 852 void wilc_wfi_mgmt_rx(struct wilc *wilc, u8 *buff, u32 size, bool is_auth)
 853 {
 854         int srcu_idx;
 855         struct wilc_vif *vif;
 856
 857         srcu_idx = srcu_read_lock(&wilc->srcu);
 858         wilc_for_each_vif(wilc, vif) {
 859                 struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buff;
 860                 u16 type = le16_to_cpup((__le16 *)buff);
 861                 u32 type_bit = BIT(type >> 4);
 862                 u32 auth_bit = BIT(IEEE80211_STYPE_AUTH >> 4);
 863
 864                 if ((vif->mgmt_reg_stypes & auth_bit &&
 865                      ieee80211_is_auth(mgmt->frame_control)) &&
 866                     vif->iftype == WILC_STATION_MODE && is_auth) {
 867                         wilc_wfi_mgmt_frame_rx(vif, buff, size);
 868                         break;
 869                 }
 870
 871                 if (vif->priv.p2p_listen_state &&
 872                     vif->mgmt_reg_stypes & type_bit)
 873                         wilc_wfi_p2p_rx(vif, buff, size);
 874
 875                 if (vif->monitor_flag)
 876                         wilc_wfi_monitor_rx(wilc->monitor_dev, buff, size);
 877         }
 878         srcu_read_unlock(&wilc->srcu, srcu_idx);
 879 }
 880
 881 static const struct net_device_ops wilc_netdev_ops = {
 882         .ndo_init = mac_init_fn,
 883         .ndo_open = wilc_mac_open,
 884         .ndo_stop = wilc_mac_close,
 885         .ndo_set_mac_address = wilc_set_mac_addr,
 886         .ndo_start_xmit = wilc_mac_xmit,
 887         .ndo_get_stats = mac_stats,
 888         .ndo_set_rx_mode  = wilc_set_multicast_list,
 889 };
 890
 891 void wilc_netdev_cleanup(struct wilc *wilc)
 892 {
 893         struct wilc_vif *vif, *vif_tmp;
 894
 895         if (!wilc)
 896                 return;
 897
 898         if (wilc->firmware) {
 899                 release_firmware(wilc->firmware);
 900                 wilc->firmware = NULL;
 901         }
 902
 903         list_for_each_entry_safe(vif, vif_tmp, &wilc->vif_list, list) {
 904                 mutex_lock(&wilc->vif_mutex);
 905                 list_del_rcu(&vif->list);
 906                 wilc->vif_num--;
 907                 mutex_unlock(&wilc->vif_mutex);
 908                 synchronize_srcu(&wilc->srcu);
 909                 if (vif->ndev)
 910                         unregister_netdev(vif->ndev);
 911         }
 912
 913         wilc_wfi_deinit_mon_interface(wilc, false);
 914         destroy_workqueue(wilc->hif_workqueue);
 915
 916         wilc_wlan_cfg_deinit(wilc);
 917         wlan_deinit_locks(wilc);
 918         wiphy_unregister(wilc->wiphy);
 919         wiphy_free(wilc->wiphy);
 920 }
 921 EXPORT_SYMBOL_GPL(wilc_netdev_cleanup);
 922
 923 static u8 wilc_get_available_idx(struct wilc *wl)
 924 {
 925         int idx = 0;
 926         struct wilc_vif *vif;
 927         int srcu_idx;
 928
 929         srcu_idx = srcu_read_lock(&wl->srcu);
 930         wilc_for_each_vif(wl, vif) {
 931                 if (vif->idx == 0)
 932                         idx = 1;
 933                 else
 934                         idx = 0;
 935         }
 936         srcu_read_unlock(&wl->srcu, srcu_idx);
 937         return idx;
 938 }
 939
 940 struct wilc_vif *wilc_netdev_ifc_init(struct wilc *wl, const char *name,
 941                                       int vif_type, enum nl80211_iftype type,
 942                                       bool rtnl_locked)
 943 {
 944         u8 mac_address[ETH_ALEN];
 945         struct net_device *ndev;
 946         struct wilc_vif *vif;
 947         int ret;
 948
 949         ndev = alloc_etherdev(sizeof(*vif));
 950         if (!ndev)
 951                 return ERR_PTR(-ENOMEM);
 952
 953         vif = netdev_priv(ndev);
 954         ndev->ieee80211_ptr = &vif->priv.wdev;
 955         strcpy(ndev->name, name);
 956         vif->wilc = wl;
 957         vif->ndev = ndev;
 958         ndev->ml_priv = vif;
 959
 960         ndev->netdev_ops = &wilc_netdev_ops;
 961
 962         SET_NETDEV_DEV(ndev, wiphy_dev(wl->wiphy));
 963
 964         vif->priv.wdev.wiphy = wl->wiphy;
 965         vif->priv.wdev.netdev = ndev;
 966         vif->priv.wdev.iftype = type;
 967         vif->priv.dev = ndev;
 968
 969         ndev->needs_free_netdev = true;
 970         vif->iftype = vif_type;
 971         vif->idx = wilc_get_available_idx(wl);
 972         vif->mac_opened = 0;
 973
 974         memcpy(mac_address, wl->nv_mac_address, ETH_ALEN);
 975         /* WILC firmware uses locally administered MAC address for the
 976          * second virtual interface (bit 1 of first byte set), but
 977          * since it is possibly not loaded/running yet, reproduce this behavior
 978          * in the driver during interface creation.
 979          */
 980         if (vif->idx)
 981                 mac_address[0] |= 0x2;
 982
 983         eth_hw_addr_set(vif->ndev, mac_address);
 984
 985         mutex_lock(&wl->vif_mutex);
 986         list_add_tail_rcu(&vif->list, &wl->vif_list);
 987         wl->vif_num += 1;
 988         mutex_unlock(&wl->vif_mutex);
 989         synchronize_srcu(&wl->srcu);
 990
 991         if (rtnl_locked)
 992                 ret = cfg80211_register_netdevice(ndev);
 993         else
 994                 ret = register_netdev(ndev);
 995
 996         if (ret) {
 997                 ret = -EFAULT;
 998                 goto error_remove_vif;
 999         }
1000
1001         return vif;
1002
1003 error_remove_vif:
1004         mutex_lock(&wl->vif_mutex);
1005         list_del_rcu(&vif->list);
1006         wl->vif_num -= 1;
1007         mutex_unlock(&wl->vif_mutex);
1008         synchronize_srcu(&wl->srcu);
1009         free_netdev(ndev);
1010         return ERR_PTR(ret);
1011 }
1012 EXPORT_SYMBOL_GPL(wilc_netdev_ifc_init);
1013
1014 MODULE_DESCRIPTION("Atmel WILC1000 core wireless driver");
1015 MODULE_LICENSE("GPL");
1016 MODULE_FIRMWARE(WILC1000_FW(WILC1000_API_VER));