drivers/net/wireless/ath9k/virtual.c

   1 /*
   2  * Copyright (c) 2008-2009 Atheros Communications Inc.
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include "ath9k.h"
  18
  19 struct ath9k_vif_iter_data {
  20         int count;
  21         u8 *addr;
  22 };
  23
  24 static void ath9k_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
  25 {
  26         struct ath9k_vif_iter_data *iter_data = data;
  27         u8 *nbuf;
  28
  29         nbuf = krealloc(iter_data->addr, (iter_data->count + 1) * ETH_ALEN,
  30                         GFP_ATOMIC);
  31         if (nbuf == NULL)
  32                 return;
  33
  34         memcpy(nbuf + iter_data->count * ETH_ALEN, mac, ETH_ALEN);
  35         iter_data->addr = nbuf;
  36         iter_data->count++;
  37 }
  38
  39 void ath9k_set_bssid_mask(struct ieee80211_hw *hw)
  40 {
  41         struct ath_wiphy *aphy = hw->priv;
  42         struct ath_softc *sc = aphy->sc;
  43         struct ath9k_vif_iter_data iter_data;
  44         int i, j;
  45         u8 mask[ETH_ALEN];
  46
  47         /*
  48          * Add primary MAC address even if it is not in active use since it
  49          * will be configured to the hardware as the starting point and the
  50          * BSSID mask will need to be changed if another address is active.
  51          */
  52         iter_data.addr = kmalloc(ETH_ALEN, GFP_ATOMIC);
  53         if (iter_data.addr) {
  54                 memcpy(iter_data.addr, sc->sc_ah->macaddr, ETH_ALEN);
  55                 iter_data.count = 1;
  56         } else
  57                 iter_data.count = 0;
  58
  59         /* Get list of all active MAC addresses */
  60         spin_lock_bh(&sc->wiphy_lock);
  61         ieee80211_iterate_active_interfaces_atomic(sc->hw, ath9k_vif_iter,
  62                                                    &iter_data);
  63         for (i = 0; i < sc->num_sec_wiphy; i++) {
  64                 if (sc->sec_wiphy[i] == NULL)
  65                         continue;
  66                 ieee80211_iterate_active_interfaces_atomic(
  67                         sc->sec_wiphy[i]->hw, ath9k_vif_iter, &iter_data);
  68         }
  69         spin_unlock_bh(&sc->wiphy_lock);
  70
  71         /* Generate an address mask to cover all active addresses */
  72         memset(mask, 0, ETH_ALEN);
  73         for (i = 0; i < iter_data.count; i++) {
  74                 u8 *a1 = iter_data.addr + i * ETH_ALEN;
  75                 for (j = i + 1; j < iter_data.count; j++) {
  76                         u8 *a2 = iter_data.addr + j * ETH_ALEN;
  77                         mask[0] |= a1[0] ^ a2[0];
  78                         mask[1] |= a1[1] ^ a2[1];
  79                         mask[2] |= a1[2] ^ a2[2];
  80                         mask[3] |= a1[3] ^ a2[3];
  81                         mask[4] |= a1[4] ^ a2[4];
  82                         mask[5] |= a1[5] ^ a2[5];
  83                 }
  84         }
  85
  86         kfree(iter_data.addr);
  87
  88         /* Invert the mask and configure hardware */
  89         sc->bssidmask[0] = ~mask[0];
  90         sc->bssidmask[1] = ~mask[1];
  91         sc->bssidmask[2] = ~mask[2];
  92         sc->bssidmask[3] = ~mask[3];
  93         sc->bssidmask[4] = ~mask[4];
  94         sc->bssidmask[5] = ~mask[5];
  95
  96         ath9k_hw_setbssidmask(sc);
  97 }
  98
  99 int ath9k_wiphy_add(struct ath_softc *sc)
 100 {
 101         int i, error;
 102         struct ath_wiphy *aphy;
 103         struct ieee80211_hw *hw;
 104         u8 addr[ETH_ALEN];
 105
 106         hw = ieee80211_alloc_hw(sizeof(struct ath_wiphy), &ath9k_ops);
 107         if (hw == NULL)
 108                 return -ENOMEM;
 109
 110         spin_lock_bh(&sc->wiphy_lock);
 111         for (i = 0; i < sc->num_sec_wiphy; i++) {
 112                 if (sc->sec_wiphy[i] == NULL)
 113                         break;
 114         }
 115
 116         if (i == sc->num_sec_wiphy) {
 117                 /* No empty slot available; increase array length */
 118                 struct ath_wiphy **n;
 119                 n = krealloc(sc->sec_wiphy,
 120                              (sc->num_sec_wiphy + 1) *
 121                              sizeof(struct ath_wiphy *),
 122                              GFP_ATOMIC);
 123                 if (n == NULL) {
 124                         spin_unlock_bh(&sc->wiphy_lock);
 125                         ieee80211_free_hw(hw);
 126                         return -ENOMEM;
 127                 }
 128                 n[i] = NULL;
 129                 sc->sec_wiphy = n;
 130                 sc->num_sec_wiphy++;
 131         }
 132
 133         SET_IEEE80211_DEV(hw, sc->dev);
 134
 135         aphy = hw->priv;
 136         aphy->sc = sc;
 137         aphy->hw = hw;
 138         sc->sec_wiphy[i] = aphy;
 139         spin_unlock_bh(&sc->wiphy_lock);
 140
 141         memcpy(addr, sc->sc_ah->macaddr, ETH_ALEN);
 142         addr[0] |= 0x02; /* Locally managed address */
 143         /*
 144          * XOR virtual wiphy index into the least significant bits to generate
 145          * a different MAC address for each virtual wiphy.
 146          */
 147         addr[5] ^= i & 0xff;
 148         addr[4] ^= (i & 0xff00) >> 8;
 149         addr[3] ^= (i & 0xff0000) >> 16;
 150
 151         SET_IEEE80211_PERM_ADDR(hw, addr);
 152
 153         ath_set_hw_capab(sc, hw);
 154
 155         error = ieee80211_register_hw(hw);
 156
 157         if (error == 0) {
 158                 /* Make sure wiphy scheduler is started (if enabled) */
 159                 ath9k_wiphy_set_scheduler(sc, sc->wiphy_scheduler_int);
 160         }
 161
 162         return error;
 163 }
 164
 165 int ath9k_wiphy_del(struct ath_wiphy *aphy)
 166 {
 167         struct ath_softc *sc = aphy->sc;
 168         int i;
 169
 170         spin_lock_bh(&sc->wiphy_lock);
 171         for (i = 0; i < sc->num_sec_wiphy; i++) {
 172                 if (aphy == sc->sec_wiphy[i]) {
 173                         sc->sec_wiphy[i] = NULL;
 174                         spin_unlock_bh(&sc->wiphy_lock);
 175                         ieee80211_unregister_hw(aphy->hw);
 176                         ieee80211_free_hw(aphy->hw);
 177                         return 0;
 178                 }
 179         }
 180         spin_unlock_bh(&sc->wiphy_lock);
 181         return -ENOENT;
 182 }
 183
 184 static int ath9k_send_nullfunc(struct ath_wiphy *aphy,
 185                                struct ieee80211_vif *vif, const u8 *bssid,
 186                                int ps)
 187 {
 188         struct ath_softc *sc = aphy->sc;
 189         struct ath_tx_control txctl;
 190         struct sk_buff *skb;
 191         struct ieee80211_hdr *hdr;
 192         __le16 fc;
 193         struct ieee80211_tx_info *info;
 194
 195         skb = dev_alloc_skb(24);
 196         if (skb == NULL)
 197                 return -ENOMEM;
 198         hdr = (struct ieee80211_hdr *) skb_put(skb, 24);
 199         memset(hdr, 0, 24);
 200         fc = cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_NULLFUNC |
 201                          IEEE80211_FCTL_TODS);
 202         if (ps)
 203                 fc |= cpu_to_le16(IEEE80211_FCTL_PM);
 204         hdr->frame_control = fc;
 205         memcpy(hdr->addr1, bssid, ETH_ALEN);
 206         memcpy(hdr->addr2, aphy->hw->wiphy->perm_addr, ETH_ALEN);
 207         memcpy(hdr->addr3, bssid, ETH_ALEN);
 208
 209         info = IEEE80211_SKB_CB(skb);
 210         memset(info, 0, sizeof(*info));
 211         info->flags = IEEE80211_TX_CTL_REQ_TX_STATUS;
 212         info->control.vif = vif;
 213         info->control.rates[0].idx = 0;
 214         info->control.rates[0].count = 4;
 215         info->control.rates[1].idx = -1;
 216
 217         memset(&txctl, 0, sizeof(struct ath_tx_control));
 218         txctl.txq = &sc->tx.txq[sc->tx.hwq_map[ATH9K_WME_AC_VO]];
 219         txctl.frame_type = ps ? ATH9K_INT_PAUSE : ATH9K_INT_UNPAUSE;
 220
 221         if (ath_tx_start(aphy->hw, skb, &txctl) != 0)
 222                 goto exit;
 223
 224         return 0;
 225 exit:
 226         dev_kfree_skb_any(skb);
 227         return -1;
 228 }
 229
 230 static bool __ath9k_wiphy_pausing(struct ath_softc *sc)
 231 {
 232         int i;
 233         if (sc->pri_wiphy->state == ATH_WIPHY_PAUSING)
 234                 return true;
 235         for (i = 0; i < sc->num_sec_wiphy; i++) {
 236                 if (sc->sec_wiphy[i] &&
 237                     sc->sec_wiphy[i]->state == ATH_WIPHY_PAUSING)
 238                         return true;
 239         }
 240         return false;
 241 }
 242
 243 static bool ath9k_wiphy_pausing(struct ath_softc *sc)
 244 {
 245         bool ret;
 246         spin_lock_bh(&sc->wiphy_lock);
 247         ret = __ath9k_wiphy_pausing(sc);
 248         spin_unlock_bh(&sc->wiphy_lock);
 249         return ret;
 250 }
 251
 252 static bool __ath9k_wiphy_scanning(struct ath_softc *sc)
 253 {
 254         int i;
 255         if (sc->pri_wiphy->state == ATH_WIPHY_SCAN)
 256                 return true;
 257         for (i = 0; i < sc->num_sec_wiphy; i++) {
 258                 if (sc->sec_wiphy[i] &&
 259                     sc->sec_wiphy[i]->state == ATH_WIPHY_SCAN)
 260                         return true;
 261         }
 262         return false;
 263 }
 264
 265 bool ath9k_wiphy_scanning(struct ath_softc *sc)
 266 {
 267         bool ret;
 268         spin_lock_bh(&sc->wiphy_lock);
 269         ret = __ath9k_wiphy_scanning(sc);
 270         spin_unlock_bh(&sc->wiphy_lock);
 271         return ret;
 272 }
 273
 274 static int __ath9k_wiphy_unpause(struct ath_wiphy *aphy);
 275
 276 /* caller must hold wiphy_lock */
 277 static void __ath9k_wiphy_unpause_ch(struct ath_wiphy *aphy)
 278 {
 279         if (aphy == NULL)
 280                 return;
 281         if (aphy->chan_idx != aphy->sc->chan_idx)
 282                 return; /* wiphy not on the selected channel */
 283         __ath9k_wiphy_unpause(aphy);
 284 }
 285
 286 static void ath9k_wiphy_unpause_channel(struct ath_softc *sc)
 287 {
 288         int i;
 289         spin_lock_bh(&sc->wiphy_lock);
 290         __ath9k_wiphy_unpause_ch(sc->pri_wiphy);
 291         for (i = 0; i < sc->num_sec_wiphy; i++)
 292                 __ath9k_wiphy_unpause_ch(sc->sec_wiphy[i]);
 293         spin_unlock_bh(&sc->wiphy_lock);
 294 }
 295
 296 void ath9k_wiphy_chan_work(struct work_struct *work)
 297 {
 298         struct ath_softc *sc = container_of(work, struct ath_softc, chan_work);
 299         struct ath_wiphy *aphy = sc->next_wiphy;
 300
 301         if (aphy == NULL)
 302                 return;
 303
 304         /*
 305          * All pending interfaces paused; ready to change
 306          * channels.
 307          */
 308
 309         /* Change channels */
 310         mutex_lock(&sc->mutex);
 311         /* XXX: remove me eventually */
 312         ath9k_update_ichannel(sc, aphy->hw,
 313                               &sc->sc_ah->channels[sc->chan_idx]);
 314         ath_update_chainmask(sc, sc->chan_is_ht);
 315         if (ath_set_channel(sc, aphy->hw,
 316                             &sc->sc_ah->channels[sc->chan_idx]) < 0) {
 317                 printk(KERN_DEBUG "ath9k: Failed to set channel for new "
 318                        "virtual wiphy\n");
 319                 mutex_unlock(&sc->mutex);
 320                 return;
 321         }
 322         mutex_unlock(&sc->mutex);
 323
 324         ath9k_wiphy_unpause_channel(sc);
 325 }
 326
 327 /*
 328  * ath9k version of ieee80211_tx_status() for TX frames that are generated
 329  * internally in the driver.
 330  */
 331 void ath9k_tx_status(struct ieee80211_hw *hw, struct sk_buff *skb)
 332 {
 333         struct ath_wiphy *aphy = hw->priv;
 334         struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
 335         struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
 336         struct ath_tx_info_priv *tx_info_priv = ATH_TX_INFO_PRIV(tx_info);
 337
 338         if (tx_info_priv && tx_info_priv->frame_type == ATH9K_INT_PAUSE &&
 339             aphy->state == ATH_WIPHY_PAUSING) {
 340                 if (!(info->flags & IEEE80211_TX_STAT_ACK)) {
 341                         printk(KERN_DEBUG "ath9k: %s: no ACK for pause "
 342                                "frame\n", wiphy_name(hw->wiphy));
 343                         /*
 344                          * The AP did not reply; ignore this to allow us to
 345                          * continue.
 346                          */
 347                 }
 348                 aphy->state = ATH_WIPHY_PAUSED;
 349                 if (!ath9k_wiphy_pausing(aphy->sc)) {
 350                         /*
 351                          * Drop from tasklet to work to allow mutex for channel
 352                          * change.
 353                          */
 354                         queue_work(aphy->sc->hw->workqueue,
 355                                    &aphy->sc->chan_work);
 356                 }
 357         }
 358
 359         kfree(tx_info_priv);
 360         tx_info->rate_driver_data[0] = NULL;
 361
 362         dev_kfree_skb(skb);
 363 }
 364
 365 static void ath9k_mark_paused(struct ath_wiphy *aphy)
 366 {
 367         struct ath_softc *sc = aphy->sc;
 368         aphy->state = ATH_WIPHY_PAUSED;
 369         if (!__ath9k_wiphy_pausing(sc))
 370                 queue_work(sc->hw->workqueue, &sc->chan_work);
 371 }
 372
 373 static void ath9k_pause_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
 374 {
 375         struct ath_wiphy *aphy = data;
 376         struct ath_vif *avp = (void *) vif->drv_priv;
 377
 378         switch (vif->type) {
 379         case NL80211_IFTYPE_STATION:
 380                 if (!vif->bss_conf.assoc) {
 381                         ath9k_mark_paused(aphy);
 382                         break;
 383                 }
 384                 /* TODO: could avoid this if already in PS mode */
 385                 if (ath9k_send_nullfunc(aphy, vif, avp->bssid, 1)) {
 386                         printk(KERN_DEBUG "%s: failed to send PS nullfunc\n",
 387                                __func__);
 388                         ath9k_mark_paused(aphy);
 389                 }
 390                 break;
 391         case NL80211_IFTYPE_AP:
 392                 /* Beacon transmission is paused by aphy->state change */
 393                 ath9k_mark_paused(aphy);
 394                 break;
 395         default:
 396                 break;
 397         }
 398 }
 399
 400 /* caller must hold wiphy_lock */
 401 static int __ath9k_wiphy_pause(struct ath_wiphy *aphy)
 402 {
 403         ieee80211_stop_queues(aphy->hw);
 404         aphy->state = ATH_WIPHY_PAUSING;
 405         /*
 406          * TODO: handle PAUSING->PAUSED for the case where there are multiple
 407          * active vifs (now we do it on the first vif getting ready; should be
 408          * on the last)
 409          */
 410         ieee80211_iterate_active_interfaces_atomic(aphy->hw, ath9k_pause_iter,
 411                                                    aphy);
 412         return 0;
 413 }
 414
 415 int ath9k_wiphy_pause(struct ath_wiphy *aphy)
 416 {
 417         int ret;
 418         spin_lock_bh(&aphy->sc->wiphy_lock);
 419         ret = __ath9k_wiphy_pause(aphy);
 420         spin_unlock_bh(&aphy->sc->wiphy_lock);
 421         return ret;
 422 }
 423
 424 static void ath9k_unpause_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
 425 {
 426         struct ath_wiphy *aphy = data;
 427         struct ath_vif *avp = (void *) vif->drv_priv;
 428
 429         switch (vif->type) {
 430         case NL80211_IFTYPE_STATION:
 431                 if (!vif->bss_conf.assoc)
 432                         break;
 433                 ath9k_send_nullfunc(aphy, vif, avp->bssid, 0);
 434                 break;
 435         case NL80211_IFTYPE_AP:
 436                 /* Beacon transmission is re-enabled by aphy->state change */
 437                 break;
 438         default:
 439                 break;
 440         }
 441 }
 442
 443 /* caller must hold wiphy_lock */
 444 static int __ath9k_wiphy_unpause(struct ath_wiphy *aphy)
 445 {
 446         ieee80211_iterate_active_interfaces_atomic(aphy->hw,
 447                                                    ath9k_unpause_iter, aphy);
 448         aphy->state = ATH_WIPHY_ACTIVE;
 449         ieee80211_wake_queues(aphy->hw);
 450         return 0;
 451 }
 452
 453 int ath9k_wiphy_unpause(struct ath_wiphy *aphy)
 454 {
 455         int ret;
 456         spin_lock_bh(&aphy->sc->wiphy_lock);
 457         ret = __ath9k_wiphy_unpause(aphy);
 458         spin_unlock_bh(&aphy->sc->wiphy_lock);
 459         return ret;
 460 }
 461
 462 static void __ath9k_wiphy_mark_all_paused(struct ath_softc *sc)
 463 {
 464         int i;
 465         if (sc->pri_wiphy->state != ATH_WIPHY_INACTIVE)
 466                 sc->pri_wiphy->state = ATH_WIPHY_PAUSED;
 467         for (i = 0; i < sc->num_sec_wiphy; i++) {
 468                 if (sc->sec_wiphy[i] &&
 469                     sc->sec_wiphy[i]->state != ATH_WIPHY_INACTIVE)
 470                         sc->sec_wiphy[i]->state = ATH_WIPHY_PAUSED;
 471         }
 472 }
 473
 474 /* caller must hold wiphy_lock */
 475 static void __ath9k_wiphy_pause_all(struct ath_softc *sc)
 476 {
 477         int i;
 478         if (sc->pri_wiphy->state == ATH_WIPHY_ACTIVE)
 479                 __ath9k_wiphy_pause(sc->pri_wiphy);
 480         for (i = 0; i < sc->num_sec_wiphy; i++) {
 481                 if (sc->sec_wiphy[i] &&
 482                     sc->sec_wiphy[i]->state == ATH_WIPHY_ACTIVE)
 483                         __ath9k_wiphy_pause(sc->sec_wiphy[i]);
 484         }
 485 }
 486
 487 int ath9k_wiphy_select(struct ath_wiphy *aphy)
 488 {
 489         struct ath_softc *sc = aphy->sc;
 490         bool now;
 491
 492         spin_lock_bh(&sc->wiphy_lock);
 493         if (__ath9k_wiphy_scanning(sc)) {
 494                 /*
 495                  * For now, we are using mac80211 sw scan and it expects to
 496                  * have full control over channel changes, so avoid wiphy
 497                  * scheduling during a scan. This could be optimized if the
 498                  * scanning control were moved into the driver.
 499                  */
 500                 spin_unlock_bh(&sc->wiphy_lock);
 501                 return -EBUSY;
 502         }
 503         if (__ath9k_wiphy_pausing(sc)) {
 504                 if (sc->wiphy_select_failures == 0)
 505                         sc->wiphy_select_first_fail = jiffies;
 506                 sc->wiphy_select_failures++;
 507                 if (time_after(jiffies, sc->wiphy_select_first_fail + HZ / 2))
 508                 {
 509                         printk(KERN_DEBUG "ath9k: Previous wiphy select timed "
 510                                "out; disable/enable hw to recover\n");
 511                         __ath9k_wiphy_mark_all_paused(sc);
 512                         /*
 513                          * TODO: this workaround to fix hardware is unlikely to
 514                          * be specific to virtual wiphy changes. It can happen
 515                          * on normal channel change, too, and as such, this
 516                          * should really be made more generic. For example,
 517                          * tricker radio disable/enable on GTT interrupt burst
 518                          * (say, 10 GTT interrupts received without any TX
 519                          * frame being completed)
 520                          */
 521                         spin_unlock_bh(&sc->wiphy_lock);
 522                         ath_radio_disable(sc);
 523                         ath_radio_enable(sc);
 524                         queue_work(aphy->sc->hw->workqueue,
 525                                    &aphy->sc->chan_work);
 526                         return -EBUSY; /* previous select still in progress */
 527                 }
 528                 spin_unlock_bh(&sc->wiphy_lock);
 529                 return -EBUSY; /* previous select still in progress */
 530         }
 531         sc->wiphy_select_failures = 0;
 532
 533         /* Store the new channel */
 534         sc->chan_idx = aphy->chan_idx;
 535         sc->chan_is_ht = aphy->chan_is_ht;
 536         sc->next_wiphy = aphy;
 537
 538         __ath9k_wiphy_pause_all(sc);
 539         now = !__ath9k_wiphy_pausing(aphy->sc);
 540         spin_unlock_bh(&sc->wiphy_lock);
 541
 542         if (now) {
 543                 /* Ready to request channel change immediately */
 544                 queue_work(aphy->sc->hw->workqueue, &aphy->sc->chan_work);
 545         }
 546
 547         /*
 548          * wiphys will be unpaused in ath9k_tx_status() once channel has been
 549          * changed if any wiphy needs time to become paused.
 550          */
 551
 552         return 0;
 553 }
 554
 555 bool ath9k_wiphy_started(struct ath_softc *sc)
 556 {
 557         int i;
 558         spin_lock_bh(&sc->wiphy_lock);
 559         if (sc->pri_wiphy->state != ATH_WIPHY_INACTIVE) {
 560                 spin_unlock_bh(&sc->wiphy_lock);
 561                 return true;
 562         }
 563         for (i = 0; i < sc->num_sec_wiphy; i++) {
 564                 if (sc->sec_wiphy[i] &&
 565                     sc->sec_wiphy[i]->state != ATH_WIPHY_INACTIVE) {
 566                         spin_unlock_bh(&sc->wiphy_lock);
 567                         return true;
 568                 }
 569         }
 570         spin_unlock_bh(&sc->wiphy_lock);
 571         return false;
 572 }
 573
 574 static void ath9k_wiphy_pause_chan(struct ath_wiphy *aphy,
 575                                    struct ath_wiphy *selected)
 576 {
 577         if (selected->state == ATH_WIPHY_SCAN) {
 578                 if (aphy == selected)
 579                         return;
 580                 /*
 581                  * Pause all other wiphys for the duration of the scan even if
 582                  * they are on the current channel now.
 583                  */
 584         } else if (aphy->chan_idx == selected->chan_idx)
 585                 return;
 586         aphy->state = ATH_WIPHY_PAUSED;
 587         ieee80211_stop_queues(aphy->hw);
 588 }
 589
 590 void ath9k_wiphy_pause_all_forced(struct ath_softc *sc,
 591                                   struct ath_wiphy *selected)
 592 {
 593         int i;
 594         spin_lock_bh(&sc->wiphy_lock);
 595         if (sc->pri_wiphy->state == ATH_WIPHY_ACTIVE)
 596                 ath9k_wiphy_pause_chan(sc->pri_wiphy, selected);
 597         for (i = 0; i < sc->num_sec_wiphy; i++) {
 598                 if (sc->sec_wiphy[i] &&
 599                     sc->sec_wiphy[i]->state == ATH_WIPHY_ACTIVE)
 600                         ath9k_wiphy_pause_chan(sc->sec_wiphy[i], selected);
 601         }
 602         spin_unlock_bh(&sc->wiphy_lock);
 603 }
 604
 605 void ath9k_wiphy_work(struct work_struct *work)
 606 {
 607         struct ath_softc *sc = container_of(work, struct ath_softc,
 608                                             wiphy_work.work);
 609         struct ath_wiphy *aphy = NULL;
 610         bool first = true;
 611
 612         spin_lock_bh(&sc->wiphy_lock);
 613
 614         if (sc->wiphy_scheduler_int == 0) {
 615                 /* wiphy scheduler is disabled */
 616                 spin_unlock_bh(&sc->wiphy_lock);
 617                 return;
 618         }
 619
 620 try_again:
 621         sc->wiphy_scheduler_index++;
 622         while (sc->wiphy_scheduler_index <= sc->num_sec_wiphy) {
 623                 aphy = sc->sec_wiphy[sc->wiphy_scheduler_index - 1];
 624                 if (aphy && aphy->state != ATH_WIPHY_INACTIVE)
 625                         break;
 626
 627                 sc->wiphy_scheduler_index++;
 628                 aphy = NULL;
 629         }
 630         if (aphy == NULL) {
 631                 sc->wiphy_scheduler_index = 0;
 632                 if (sc->pri_wiphy->state == ATH_WIPHY_INACTIVE) {
 633                         if (first) {
 634                                 first = false;
 635                                 goto try_again;
 636                         }
 637                         /* No wiphy is ready to be scheduled */
 638                 } else
 639                         aphy = sc->pri_wiphy;
 640         }
 641
 642         spin_unlock_bh(&sc->wiphy_lock);
 643
 644         if (aphy &&
 645             aphy->state != ATH_WIPHY_ACTIVE && aphy->state != ATH_WIPHY_SCAN &&
 646             ath9k_wiphy_select(aphy)) {
 647                 printk(KERN_DEBUG "ath9k: Failed to schedule virtual wiphy "
 648                        "change\n");
 649         }
 650
 651         queue_delayed_work(sc->hw->workqueue, &sc->wiphy_work,
 652                            sc->wiphy_scheduler_int);
 653 }
 654
 655 void ath9k_wiphy_set_scheduler(struct ath_softc *sc, unsigned int msec_int)
 656 {
 657         cancel_delayed_work_sync(&sc->wiphy_work);
 658         sc->wiphy_scheduler_int = msecs_to_jiffies(msec_int);
 659         if (sc->wiphy_scheduler_int)
 660                 queue_delayed_work(sc->hw->workqueue, &sc->wiphy_work,
 661                                    sc->wiphy_scheduler_int);
 662 }