drivers/net/wireless/ath/ath9k/virtual.c - kernel/msm-4.19 - Gitiles

 /*
  * Copyright (c) 2008-2009 Atheros Communications Inc.
  *
  * Permission to use, copy, modify, and/or distribute this software for any
  * purpose with or without fee is hereby granted, provided that the above
  * copyright notice and this permission notice appear in all copies.
  *
  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  */

 #include "ath9k.h"

 struct ath9k_vif_iter_data {
 	int count;
 	u8 *addr;
 };

 static void ath9k_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
 {
 	struct ath9k_vif_iter_data *iter_data = data;
 	u8 *nbuf;

 	nbuf = krealloc(iter_data->addr, (iter_data->count + 1) * ETH_ALEN,
 			GFP_ATOMIC);
 	if (nbuf == NULL)
 		return;

 	memcpy(nbuf + iter_data->count * ETH_ALEN, mac, ETH_ALEN);
 	iter_data->addr = nbuf;
 	iter_data->count++;
 }

 void ath9k_set_bssid_mask(struct ieee80211_hw *hw)
 {
 	struct ath_wiphy *aphy = hw->priv;
 	struct ath_softc *sc = aphy->sc;
 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 	struct ath9k_vif_iter_data iter_data;
 	int i, j;
 	u8 mask[ETH_ALEN];

 	/*
 	 * Add primary MAC address even if it is not in active use since it
 	 * will be configured to the hardware as the starting point and the
 	 * BSSID mask will need to be changed if another address is active.
 	 */
 	iter_data.addr = kmalloc(ETH_ALEN, GFP_ATOMIC);
 	if (iter_data.addr) {
 		memcpy(iter_data.addr, common->macaddr, ETH_ALEN);
 		iter_data.count = 1;
 	} else
 		iter_data.count = 0;

 	/* Get list of all active MAC addresses */
 	spin_lock_bh(&sc->wiphy_lock);
 	ieee80211_iterate_active_interfaces_atomic(sc->hw, ath9k_vif_iter,
 						   &iter_data);
 	for (i = 0; i < sc->num_sec_wiphy; i++) {
 		if (sc->sec_wiphy[i] == NULL)
 			continue;
 		ieee80211_iterate_active_interfaces_atomic(
 			sc->sec_wiphy[i]->hw, ath9k_vif_iter, &iter_data);
 	}
 	spin_unlock_bh(&sc->wiphy_lock);

 	/* Generate an address mask to cover all active addresses */
 	memset(mask, 0, ETH_ALEN);
 	for (i = 0; i < iter_data.count; i++) {
 		u8 *a1 = iter_data.addr + i * ETH_ALEN;
 		for (j = i + 1; j < iter_data.count; j++) {
 			u8 *a2 = iter_data.addr + j * ETH_ALEN;
 			mask[0] |= a1[0] ^ a2[0];
 			mask[1] |= a1[1] ^ a2[1];
 			mask[2] |= a1[2] ^ a2[2];
 			mask[3] |= a1[3] ^ a2[3];
 			mask[4] |= a1[4] ^ a2[4];
 			mask[5] |= a1[5] ^ a2[5];
 		}
 	}

 	kfree(iter_data.addr);

 	/* Invert the mask and configure hardware */
 	common->bssidmask[0] = ~mask[0];
 	common->bssidmask[1] = ~mask[1];
 	common->bssidmask[2] = ~mask[2];
 	common->bssidmask[3] = ~mask[3];
 	common->bssidmask[4] = ~mask[4];
 	common->bssidmask[5] = ~mask[5];

 	ath_hw_setbssidmask(common);
 }

 int ath9k_wiphy_add(struct ath_softc *sc)
 {
 	int i, error;
 	struct ath_wiphy *aphy;
 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 	struct ieee80211_hw *hw;
 	u8 addr[ETH_ALEN];

 	hw = ieee80211_alloc_hw(sizeof(struct ath_wiphy), &ath9k_ops);
 	if (hw == NULL)
 		return -ENOMEM;

 	spin_lock_bh(&sc->wiphy_lock);
 	for (i = 0; i < sc->num_sec_wiphy; i++) {
 		if (sc->sec_wiphy[i] == NULL)
 			break;
 	}

 	if (i == sc->num_sec_wiphy) {
 		/* No empty slot available; increase array length */
 		struct ath_wiphy **n;
 		n = krealloc(sc->sec_wiphy,
 			     (sc->num_sec_wiphy + 1) *
 			     sizeof(struct ath_wiphy *),
 			     GFP_ATOMIC);
 		if (n == NULL) {
 			spin_unlock_bh(&sc->wiphy_lock);
 			ieee80211_free_hw(hw);
 			return -ENOMEM;
 		}
 		n[i] = NULL;
 		sc->sec_wiphy = n;
 		sc->num_sec_wiphy++;
 	}

 	SET_IEEE80211_DEV(hw, sc->dev);

 	aphy = hw->priv;
 	aphy->sc = sc;
 	aphy->hw = hw;
 	sc->sec_wiphy[i] = aphy;
 	spin_unlock_bh(&sc->wiphy_lock);

 	memcpy(addr, common->macaddr, ETH_ALEN);
 	addr[0] |= 0x02; /* Locally managed address */
 	/*
 	 * XOR virtual wiphy index into the least significant bits to generate
 	 * a different MAC address for each virtual wiphy.
 	 */
 	addr[5] ^= i & 0xff;
 	addr[4] ^= (i & 0xff00) >> 8;
 	addr[3] ^= (i & 0xff0000) >> 16;

 	SET_IEEE80211_PERM_ADDR(hw, addr);

 	ath_set_hw_capab(sc, hw);

 	error = ieee80211_register_hw(hw);

 	if (error == 0) {
 		/* Make sure wiphy scheduler is started (if enabled) */
 		ath9k_wiphy_set_scheduler(sc, sc->wiphy_scheduler_int);
 	}

 	return error;
 }

 int ath9k_wiphy_del(struct ath_wiphy *aphy)
 {
 	struct ath_softc *sc = aphy->sc;
 	int i;

 	spin_lock_bh(&sc->wiphy_lock);
 	for (i = 0; i < sc->num_sec_wiphy; i++) {
 		if (aphy == sc->sec_wiphy[i]) {
 			sc->sec_wiphy[i] = NULL;
 			spin_unlock_bh(&sc->wiphy_lock);
 			ieee80211_unregister_hw(aphy->hw);
 			ieee80211_free_hw(aphy->hw);
 			return 0;
 		}
 	}
 	spin_unlock_bh(&sc->wiphy_lock);
 	return -ENOENT;
 }

 static int ath9k_send_nullfunc(struct ath_wiphy *aphy,
 			       struct ieee80211_vif *vif, const u8 *bssid,
 			       int ps)
 {
 	struct ath_softc *sc = aphy->sc;
 	struct ath_tx_control txctl;
 	struct sk_buff *skb;
 	struct ieee80211_hdr *hdr;
 	__le16 fc;
 	struct ieee80211_tx_info *info;

 	skb = dev_alloc_skb(24);
 	if (skb == NULL)
 		return -ENOMEM;
 	hdr = (struct ieee80211_hdr *) skb_put(skb, 24);
 	memset(hdr, 0, 24);
 	fc = cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_NULLFUNC |
 			 IEEE80211_FCTL_TODS);
 	if (ps)
 		fc |= cpu_to_le16(IEEE80211_FCTL_PM);
 	hdr->frame_control = fc;
 	memcpy(hdr->addr1, bssid, ETH_ALEN);
 	memcpy(hdr->addr2, aphy->hw->wiphy->perm_addr, ETH_ALEN);
 	memcpy(hdr->addr3, bssid, ETH_ALEN);

 	info = IEEE80211_SKB_CB(skb);
 	memset(info, 0, sizeof(*info));
 	info->flags = IEEE80211_TX_CTL_REQ_TX_STATUS;
 	info->control.vif = vif;
 	info->control.rates[0].idx = 0;
 	info->control.rates[0].count = 4;
 	info->control.rates[1].idx = -1;

 	memset(&txctl, 0, sizeof(struct ath_tx_control));
 	txctl.txq = &sc->tx.txq[sc->tx.hwq_map[ATH9K_WME_AC_VO]];
 	txctl.frame_type = ps ? ATH9K_INT_PAUSE : ATH9K_INT_UNPAUSE;

 	if (ath_tx_start(aphy->hw, skb, &txctl) != 0)
 		goto exit;

 	return 0;
 exit:
 	dev_kfree_skb_any(skb);
 	return -1;
 }

 static bool __ath9k_wiphy_pausing(struct ath_softc *sc)
 {
 	int i;
 	if (sc->pri_wiphy->state == ATH_WIPHY_PAUSING)
 		return true;
 	for (i = 0; i < sc->num_sec_wiphy; i++) {
 		if (sc->sec_wiphy[i] &&
 		    sc->sec_wiphy[i]->state == ATH_WIPHY_PAUSING)
 			return true;
 	}
 	return false;
 }

 static bool ath9k_wiphy_pausing(struct ath_softc *sc)
 {
 	bool ret;
 	spin_lock_bh(&sc->wiphy_lock);
 	ret = __ath9k_wiphy_pausing(sc);
 	spin_unlock_bh(&sc->wiphy_lock);
 	return ret;
 }

 static bool __ath9k_wiphy_scanning(struct ath_softc *sc)
 {
 	int i;
 	if (sc->pri_wiphy->state == ATH_WIPHY_SCAN)
 		return true;
 	for (i = 0; i < sc->num_sec_wiphy; i++) {
 		if (sc->sec_wiphy[i] &&
 		    sc->sec_wiphy[i]->state == ATH_WIPHY_SCAN)
 			return true;
 	}
 	return false;
 }

 bool ath9k_wiphy_scanning(struct ath_softc *sc)
 {
 	bool ret;
 	spin_lock_bh(&sc->wiphy_lock);
 	ret = __ath9k_wiphy_scanning(sc);
 	spin_unlock_bh(&sc->wiphy_lock);
 	return ret;
 }

 static int __ath9k_wiphy_unpause(struct ath_wiphy *aphy);

 /* caller must hold wiphy_lock */
 static void __ath9k_wiphy_unpause_ch(struct ath_wiphy *aphy)
 {
 	if (aphy == NULL)
 		return;
 	if (aphy->chan_idx != aphy->sc->chan_idx)
 		return; /* wiphy not on the selected channel */
 	__ath9k_wiphy_unpause(aphy);
 }

 static void ath9k_wiphy_unpause_channel(struct ath_softc *sc)
 {
 	int i;
 	spin_lock_bh(&sc->wiphy_lock);
 	__ath9k_wiphy_unpause_ch(sc->pri_wiphy);
 	for (i = 0; i < sc->num_sec_wiphy; i++)
 		__ath9k_wiphy_unpause_ch(sc->sec_wiphy[i]);
 	spin_unlock_bh(&sc->wiphy_lock);
 }

 void ath9k_wiphy_chan_work(struct work_struct *work)
 {
 	struct ath_softc *sc = container_of(work, struct ath_softc, chan_work);
 	struct ath_wiphy *aphy = sc->next_wiphy;

 	if (aphy == NULL)
 		return;

 	/*
 	 * All pending interfaces paused; ready to change
 	 * channels.
 	 */

 	/* Change channels */
 	mutex_lock(&sc->mutex);
 	/* XXX: remove me eventually */
 	ath9k_update_ichannel(sc, aphy->hw,
 			      &sc->sc_ah->channels[sc->chan_idx]);
 	ath_update_chainmask(sc, sc->chan_is_ht);
 	if (ath_set_channel(sc, aphy->hw,
 			    &sc->sc_ah->channels[sc->chan_idx]) < 0) {
 		printk(KERN_DEBUG "ath9k: Failed to set channel for new "
 		       "virtual wiphy\n");
 		mutex_unlock(&sc->mutex);
 		return;
 	}
 	mutex_unlock(&sc->mutex);

 	ath9k_wiphy_unpause_channel(sc);
 }

 /*
  * ath9k version of ieee80211_tx_status() for TX frames that are generated
  * internally in the driver.
  */
 void ath9k_tx_status(struct ieee80211_hw *hw, struct sk_buff *skb)
 {
 	struct ath_wiphy *aphy = hw->priv;
 	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
 	struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
 	struct ath_tx_info_priv *tx_info_priv = ATH_TX_INFO_PRIV(tx_info);

 	if (tx_info_priv && tx_info_priv->frame_type == ATH9K_INT_PAUSE &&
 	    aphy->state == ATH_WIPHY_PAUSING) {
 		if (!(info->flags & IEEE80211_TX_STAT_ACK)) {
 			printk(KERN_DEBUG "ath9k: %s: no ACK for pause "
 			       "frame\n", wiphy_name(hw->wiphy));
 			/*
 			 * The AP did not reply; ignore this to allow us to
 			 * continue.
 			 */
 		}
 		aphy->state = ATH_WIPHY_PAUSED;
 		if (!ath9k_wiphy_pausing(aphy->sc)) {
 			/*
 			 * Drop from tasklet to work to allow mutex for channel
 			 * change.
 			 */
 			ieee80211_queue_work(aphy->sc->hw,
 				   &aphy->sc->chan_work);
 		}
 	}

 	kfree(tx_info_priv);
 	tx_info->rate_driver_data[0] = NULL;

 	dev_kfree_skb(skb);
 }

 static void ath9k_mark_paused(struct ath_wiphy *aphy)
 {
 	struct ath_softc *sc = aphy->sc;
 	aphy->state = ATH_WIPHY_PAUSED;
 	if (!__ath9k_wiphy_pausing(sc))
 		ieee80211_queue_work(sc->hw, &sc->chan_work);
 }

 static void ath9k_pause_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
 {
 	struct ath_wiphy *aphy = data;
 	struct ath_vif *avp = (void *) vif->drv_priv;

 	switch (vif->type) {
 	case NL80211_IFTYPE_STATION:
 		if (!vif->bss_conf.assoc) {
 			ath9k_mark_paused(aphy);
 			break;
 		}
 		/* TODO: could avoid this if already in PS mode */
 		if (ath9k_send_nullfunc(aphy, vif, avp->bssid, 1)) {
 			printk(KERN_DEBUG "%s: failed to send PS nullfunc\n",
 			       __func__);
 			ath9k_mark_paused(aphy);
 		}
 		break;
 	case NL80211_IFTYPE_AP:
 		/* Beacon transmission is paused by aphy->state change */
 		ath9k_mark_paused(aphy);
 		break;
 	default:
 		break;
 	}
 }

 /* caller must hold wiphy_lock */
 static int __ath9k_wiphy_pause(struct ath_wiphy *aphy)
 {
 	ieee80211_stop_queues(aphy->hw);
 	aphy->state = ATH_WIPHY_PAUSING;
 	/*
 	 * TODO: handle PAUSING->PAUSED for the case where there are multiple
 	 * active vifs (now we do it on the first vif getting ready; should be
 	 * on the last)
 	 */
 	ieee80211_iterate_active_interfaces_atomic(aphy->hw, ath9k_pause_iter,
 						   aphy);
 	return 0;
 }

 int ath9k_wiphy_pause(struct ath_wiphy *aphy)
 {
 	int ret;
 	spin_lock_bh(&aphy->sc->wiphy_lock);
 	ret = __ath9k_wiphy_pause(aphy);
 	spin_unlock_bh(&aphy->sc->wiphy_lock);
 	return ret;
 }

 static void ath9k_unpause_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
 {
 	struct ath_wiphy *aphy = data;
 	struct ath_vif *avp = (void *) vif->drv_priv;

 	switch (vif->type) {
 	case NL80211_IFTYPE_STATION:
 		if (!vif->bss_conf.assoc)
 			break;
 		ath9k_send_nullfunc(aphy, vif, avp->bssid, 0);
 		break;
 	case NL80211_IFTYPE_AP:
 		/* Beacon transmission is re-enabled by aphy->state change */
 		break;
 	default:
 		break;
 	}
 }

 /* caller must hold wiphy_lock */
 static int __ath9k_wiphy_unpause(struct ath_wiphy *aphy)
 {
 	ieee80211_iterate_active_interfaces_atomic(aphy->hw,
 						   ath9k_unpause_iter, aphy);
 	aphy->state = ATH_WIPHY_ACTIVE;
 	ieee80211_wake_queues(aphy->hw);
 	return 0;
 }

 int ath9k_wiphy_unpause(struct ath_wiphy *aphy)
 {
 	int ret;
 	spin_lock_bh(&aphy->sc->wiphy_lock);
 	ret = __ath9k_wiphy_unpause(aphy);
 	spin_unlock_bh(&aphy->sc->wiphy_lock);
 	return ret;
 }

 static void __ath9k_wiphy_mark_all_paused(struct ath_softc *sc)
 {
 	int i;
 	if (sc->pri_wiphy->state != ATH_WIPHY_INACTIVE)
 		sc->pri_wiphy->state = ATH_WIPHY_PAUSED;
 	for (i = 0; i < sc->num_sec_wiphy; i++) {
 		if (sc->sec_wiphy[i] &&
 		    sc->sec_wiphy[i]->state != ATH_WIPHY_INACTIVE)
 			sc->sec_wiphy[i]->state = ATH_WIPHY_PAUSED;
 	}
 }

 /* caller must hold wiphy_lock */
 static void __ath9k_wiphy_pause_all(struct ath_softc *sc)
 {
 	int i;
 	if (sc->pri_wiphy->state == ATH_WIPHY_ACTIVE)
 		__ath9k_wiphy_pause(sc->pri_wiphy);
 	for (i = 0; i < sc->num_sec_wiphy; i++) {
 		if (sc->sec_wiphy[i] &&
 		    sc->sec_wiphy[i]->state == ATH_WIPHY_ACTIVE)
 			__ath9k_wiphy_pause(sc->sec_wiphy[i]);
 	}
 }

 int ath9k_wiphy_select(struct ath_wiphy *aphy)
 {
 	struct ath_softc *sc = aphy->sc;
 	bool now;

 	spin_lock_bh(&sc->wiphy_lock);
 	if (__ath9k_wiphy_scanning(sc)) {
 		/*
 		 * For now, we are using mac80211 sw scan and it expects to
 		 * have full control over channel changes, so avoid wiphy
 		 * scheduling during a scan. This could be optimized if the
 		 * scanning control were moved into the driver.
 		 */
 		spin_unlock_bh(&sc->wiphy_lock);
 		return -EBUSY;
 	}
 	if (__ath9k_wiphy_pausing(sc)) {
 		if (sc->wiphy_select_failures == 0)
 			sc->wiphy_select_first_fail = jiffies;
 		sc->wiphy_select_failures++;
 		if (time_after(jiffies, sc->wiphy_select_first_fail + HZ / 2))
 		{
 			printk(KERN_DEBUG "ath9k: Previous wiphy select timed "
 			       "out; disable/enable hw to recover\n");
 			__ath9k_wiphy_mark_all_paused(sc);
 			/*
 			 * TODO: this workaround to fix hardware is unlikely to
 			 * be specific to virtual wiphy changes. It can happen
 			 * on normal channel change, too, and as such, this
 			 * should really be made more generic. For example,
 			 * tricker radio disable/enable on GTT interrupt burst
 			 * (say, 10 GTT interrupts received without any TX
 			 * frame being completed)
 			 */
 			spin_unlock_bh(&sc->wiphy_lock);
 			ath_radio_disable(sc);
 			ath_radio_enable(sc);
 			ieee80211_queue_work(aphy->sc->hw,
 				   &aphy->sc->chan_work);
 			return -EBUSY; /* previous select still in progress */
 		}
 		spin_unlock_bh(&sc->wiphy_lock);
 		return -EBUSY; /* previous select still in progress */
 	}
 	sc->wiphy_select_failures = 0;

 	/* Store the new channel */
 	sc->chan_idx = aphy->chan_idx;
 	sc->chan_is_ht = aphy->chan_is_ht;
 	sc->next_wiphy = aphy;

 	__ath9k_wiphy_pause_all(sc);
 	now = !__ath9k_wiphy_pausing(aphy->sc);
 	spin_unlock_bh(&sc->wiphy_lock);

 	if (now) {
 		/* Ready to request channel change immediately */
 		ieee80211_queue_work(aphy->sc->hw, &aphy->sc->chan_work);
 	}

 	/*
 	 * wiphys will be unpaused in ath9k_tx_status() once channel has been
 	 * changed if any wiphy needs time to become paused.
 	 */

 	return 0;
 }

 bool ath9k_wiphy_started(struct ath_softc *sc)
 {
 	int i;
 	spin_lock_bh(&sc->wiphy_lock);
 	if (sc->pri_wiphy->state != ATH_WIPHY_INACTIVE) {
 		spin_unlock_bh(&sc->wiphy_lock);
 		return true;
 	}
 	for (i = 0; i < sc->num_sec_wiphy; i++) {
 		if (sc->sec_wiphy[i] &&
 		    sc->sec_wiphy[i]->state != ATH_WIPHY_INACTIVE) {
 			spin_unlock_bh(&sc->wiphy_lock);
 			return true;
 		}
 	}
 	spin_unlock_bh(&sc->wiphy_lock);
 	return false;
 }

 static void ath9k_wiphy_pause_chan(struct ath_wiphy *aphy,
 				   struct ath_wiphy *selected)
 {
 	if (selected->state == ATH_WIPHY_SCAN) {
 		if (aphy == selected)
 			return;
 		/*
 		 * Pause all other wiphys for the duration of the scan even if
 		 * they are on the current channel now.
 		 */
 	} else if (aphy->chan_idx == selected->chan_idx)
 		return;
 	aphy->state = ATH_WIPHY_PAUSED;
 	ieee80211_stop_queues(aphy->hw);
 }

 void ath9k_wiphy_pause_all_forced(struct ath_softc *sc,
 				  struct ath_wiphy *selected)
 {
 	int i;
 	spin_lock_bh(&sc->wiphy_lock);
 	if (sc->pri_wiphy->state == ATH_WIPHY_ACTIVE)
 		ath9k_wiphy_pause_chan(sc->pri_wiphy, selected);
 	for (i = 0; i < sc->num_sec_wiphy; i++) {
 		if (sc->sec_wiphy[i] &&
 		    sc->sec_wiphy[i]->state == ATH_WIPHY_ACTIVE)
 			ath9k_wiphy_pause_chan(sc->sec_wiphy[i], selected);
 	}
 	spin_unlock_bh(&sc->wiphy_lock);
 }

 void ath9k_wiphy_work(struct work_struct *work)
 {
 	struct ath_softc *sc = container_of(work, struct ath_softc,
 					    wiphy_work.work);
 	struct ath_wiphy *aphy = NULL;
 	bool first = true;

 	spin_lock_bh(&sc->wiphy_lock);

 	if (sc->wiphy_scheduler_int == 0) {
 		/* wiphy scheduler is disabled */
 		spin_unlock_bh(&sc->wiphy_lock);
 		return;
 	}

 try_again:
 	sc->wiphy_scheduler_index++;
 	while (sc->wiphy_scheduler_index <= sc->num_sec_wiphy) {
 		aphy = sc->sec_wiphy[sc->wiphy_scheduler_index - 1];
 		if (aphy && aphy->state != ATH_WIPHY_INACTIVE)
 			break;

 		sc->wiphy_scheduler_index++;
 		aphy = NULL;
 	}
 	if (aphy == NULL) {
 		sc->wiphy_scheduler_index = 0;
 		if (sc->pri_wiphy->state == ATH_WIPHY_INACTIVE) {
 			if (first) {
 				first = false;
 				goto try_again;
 			}
 			/* No wiphy is ready to be scheduled */
 		} else
 			aphy = sc->pri_wiphy;
 	}

 	spin_unlock_bh(&sc->wiphy_lock);

 	if (aphy &&
 	    aphy->state != ATH_WIPHY_ACTIVE && aphy->state != ATH_WIPHY_SCAN &&
 	    ath9k_wiphy_select(aphy)) {
 		printk(KERN_DEBUG "ath9k: Failed to schedule virtual wiphy "
 		       "change\n");
 	}

 	ieee80211_queue_delayed_work(sc->hw,
 				     &sc->wiphy_work,
 				     sc->wiphy_scheduler_int);
 }

 void ath9k_wiphy_set_scheduler(struct ath_softc *sc, unsigned int msec_int)
 {
 	cancel_delayed_work_sync(&sc->wiphy_work);
 	sc->wiphy_scheduler_int = msecs_to_jiffies(msec_int);
 	if (sc->wiphy_scheduler_int)
 		ieee80211_queue_delayed_work(sc->hw, &sc->wiphy_work,
 					     sc->wiphy_scheduler_int);
 }

 /* caller must hold wiphy_lock */
 bool ath9k_all_wiphys_idle(struct ath_softc *sc)
 {
 	unsigned int i;
 	if (sc->pri_wiphy->state != ATH_WIPHY_INACTIVE) {
 		return false;
 	}
 	for (i = 0; i < sc->num_sec_wiphy; i++) {
 		struct ath_wiphy *aphy = sc->sec_wiphy[i];
 		if (!aphy)
 			continue;
 		if (aphy->state != ATH_WIPHY_INACTIVE)
 			return false;
 	}
 	return true;
 }
	/*
	* Copyright (c) 2008-2009 Atheros Communications Inc.
	*
	* Permission to use, copy, modify, and/or distribute this software for any
	* purpose with or without fee is hereby granted, provided that the above
	* copyright notice and this permission notice appear in all copies.
	*
	* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
	* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
	* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
	* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
	* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
	* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
	* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
	*/

	#include "ath9k.h"

	struct ath9k_vif_iter_data {
	int count;
	u8 *addr;
	};

	static void ath9k_vif_iter(void data, u8 mac, struct ieee80211_vif *vif)
	{
	struct ath9k_vif_iter_data *iter_data = data;
	u8 *nbuf;

	nbuf = krealloc(iter_data->addr, (iter_data->count + 1) * ETH_ALEN,
	GFP_ATOMIC);
	if (nbuf == NULL)
	return;

	memcpy(nbuf + iter_data->count * ETH_ALEN, mac, ETH_ALEN);
	iter_data->addr = nbuf;
	iter_data->count++;
	}

	void ath9k_set_bssid_mask(struct ieee80211_hw *hw)
	{
	struct ath_wiphy *aphy = hw->priv;
	struct ath_softc *sc = aphy->sc;
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
	struct ath9k_vif_iter_data iter_data;
	int i, j;
	u8 mask[ETH_ALEN];

	/*
	* Add primary MAC address even if it is not in active use since it
	* will be configured to the hardware as the starting point and the
	* BSSID mask will need to be changed if another address is active.
	*/
	iter_data.addr = kmalloc(ETH_ALEN, GFP_ATOMIC);
	if (iter_data.addr) {
	memcpy(iter_data.addr, common->macaddr, ETH_ALEN);
	iter_data.count = 1;
	} else
	iter_data.count = 0;

	/* Get list of all active MAC addresses */
	spin_lock_bh(&sc->wiphy_lock);
	ieee80211_iterate_active_interfaces_atomic(sc->hw, ath9k_vif_iter,
	&iter_data);
	for (i = 0; i < sc->num_sec_wiphy; i++) {
	if (sc->sec_wiphy[i] == NULL)
	continue;
	ieee80211_iterate_active_interfaces_atomic(
	sc->sec_wiphy[i]->hw, ath9k_vif_iter, &iter_data);
	}
	spin_unlock_bh(&sc->wiphy_lock);

	/* Generate an address mask to cover all active addresses */
	memset(mask, 0, ETH_ALEN);
	for (i = 0; i < iter_data.count; i++) {
	u8 a1 = iter_data.addr + i ETH_ALEN;
	for (j = i + 1; j < iter_data.count; j++) {
	u8 a2 = iter_data.addr + j ETH_ALEN;
	mask[0] \|= a1[0] ^ a2[0];
	mask[1] \|= a1[1] ^ a2[1];
	mask[2] \|= a1[2] ^ a2[2];
	mask[3] \|= a1[3] ^ a2[3];
	mask[4] \|= a1[4] ^ a2[4];
	mask[5] \|= a1[5] ^ a2[5];
	}
	}

	kfree(iter_data.addr);

	/* Invert the mask and configure hardware */
	common->bssidmask[0] = ~mask[0];
	common->bssidmask[1] = ~mask[1];
	common->bssidmask[2] = ~mask[2];
	common->bssidmask[3] = ~mask[3];
	common->bssidmask[4] = ~mask[4];
	common->bssidmask[5] = ~mask[5];

	ath_hw_setbssidmask(common);
	}

	int ath9k_wiphy_add(struct ath_softc *sc)
	{
	int i, error;
	struct ath_wiphy *aphy;
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
	struct ieee80211_hw *hw;
	u8 addr[ETH_ALEN];

	hw = ieee80211_alloc_hw(sizeof(struct ath_wiphy), &ath9k_ops);
	if (hw == NULL)
	return -ENOMEM;

	spin_lock_bh(&sc->wiphy_lock);
	for (i = 0; i < sc->num_sec_wiphy; i++) {
	if (sc->sec_wiphy[i] == NULL)
	break;
	}

	if (i == sc->num_sec_wiphy) {
	/* No empty slot available; increase array length */
	struct ath_wiphy **n;
	n = krealloc(sc->sec_wiphy,
	(sc->num_sec_wiphy + 1) *
	sizeof(struct ath_wiphy *),
	GFP_ATOMIC);
	if (n == NULL) {
	spin_unlock_bh(&sc->wiphy_lock);
	ieee80211_free_hw(hw);
	return -ENOMEM;
	}
	n[i] = NULL;
	sc->sec_wiphy = n;
	sc->num_sec_wiphy++;
	}

	SET_IEEE80211_DEV(hw, sc->dev);

	aphy = hw->priv;
	aphy->sc = sc;
	aphy->hw = hw;
	sc->sec_wiphy[i] = aphy;
	spin_unlock_bh(&sc->wiphy_lock);

	memcpy(addr, common->macaddr, ETH_ALEN);
	addr[0] \|= 0x02; /* Locally managed address */
	/*
	* XOR virtual wiphy index into the least significant bits to generate
	* a different MAC address for each virtual wiphy.
	*/
	addr[5] ^= i & 0xff;
	addr[4] ^= (i & 0xff00) >> 8;
	addr[3] ^= (i & 0xff0000) >> 16;

	SET_IEEE80211_PERM_ADDR(hw, addr);

	ath_set_hw_capab(sc, hw);

	error = ieee80211_register_hw(hw);

	if (error == 0) {
	/* Make sure wiphy scheduler is started (if enabled) */
	ath9k_wiphy_set_scheduler(sc, sc->wiphy_scheduler_int);
	}

	return error;
	}

	int ath9k_wiphy_del(struct ath_wiphy *aphy)
	{
	struct ath_softc *sc = aphy->sc;
	int i;

	spin_lock_bh(&sc->wiphy_lock);
	for (i = 0; i < sc->num_sec_wiphy; i++) {
	if (aphy == sc->sec_wiphy[i]) {
	sc->sec_wiphy[i] = NULL;
	spin_unlock_bh(&sc->wiphy_lock);
	ieee80211_unregister_hw(aphy->hw);
	ieee80211_free_hw(aphy->hw);
	return 0;
	}
	}
	spin_unlock_bh(&sc->wiphy_lock);
	return -ENOENT;
	}

	static int ath9k_send_nullfunc(struct ath_wiphy *aphy,
	struct ieee80211_vif vif, const u8 bssid,
	int ps)
	{
	struct ath_softc *sc = aphy->sc;
	struct ath_tx_control txctl;
	struct sk_buff *skb;
	struct ieee80211_hdr *hdr;
	__le16 fc;
	struct ieee80211_tx_info *info;

	skb = dev_alloc_skb(24);
	if (skb == NULL)
	return -ENOMEM;
	hdr = (struct ieee80211_hdr *) skb_put(skb, 24);
	memset(hdr, 0, 24);
	fc = cpu_to_le16(IEEE80211_FTYPE_DATA \| IEEE80211_STYPE_NULLFUNC \|
	IEEE80211_FCTL_TODS);
	if (ps)
	fc \|= cpu_to_le16(IEEE80211_FCTL_PM);
	hdr->frame_control = fc;
	memcpy(hdr->addr1, bssid, ETH_ALEN);
	memcpy(hdr->addr2, aphy->hw->wiphy->perm_addr, ETH_ALEN);
	memcpy(hdr->addr3, bssid, ETH_ALEN);

	info = IEEE80211_SKB_CB(skb);
	memset(info, 0, sizeof(*info));
	info->flags = IEEE80211_TX_CTL_REQ_TX_STATUS;
	info->control.vif = vif;
	info->control.rates[0].idx = 0;
	info->control.rates[0].count = 4;
	info->control.rates[1].idx = -1;

	memset(&txctl, 0, sizeof(struct ath_tx_control));
	txctl.txq = &sc->tx.txq[sc->tx.hwq_map[ATH9K_WME_AC_VO]];
	txctl.frame_type = ps ? ATH9K_INT_PAUSE : ATH9K_INT_UNPAUSE;

	if (ath_tx_start(aphy->hw, skb, &txctl) != 0)
	goto exit;

	return 0;
	exit:
	dev_kfree_skb_any(skb);
	return -1;
	}

	static bool __ath9k_wiphy_pausing(struct ath_softc *sc)
	{
	int i;
	if (sc->pri_wiphy->state == ATH_WIPHY_PAUSING)
	return true;
	for (i = 0; i < sc->num_sec_wiphy; i++) {
	if (sc->sec_wiphy[i] &&
	sc->sec_wiphy[i]->state == ATH_WIPHY_PAUSING)
	return true;
	}
	return false;
	}

	static bool ath9k_wiphy_pausing(struct ath_softc *sc)
	{
	bool ret;
	spin_lock_bh(&sc->wiphy_lock);
	ret = __ath9k_wiphy_pausing(sc);
	spin_unlock_bh(&sc->wiphy_lock);
	return ret;
	}

	static bool __ath9k_wiphy_scanning(struct ath_softc *sc)
	{
	int i;
	if (sc->pri_wiphy->state == ATH_WIPHY_SCAN)
	return true;
	for (i = 0; i < sc->num_sec_wiphy; i++) {
	if (sc->sec_wiphy[i] &&
	sc->sec_wiphy[i]->state == ATH_WIPHY_SCAN)
	return true;
	}
	return false;
	}

	bool ath9k_wiphy_scanning(struct ath_softc *sc)
	{
	bool ret;
	spin_lock_bh(&sc->wiphy_lock);
	ret = __ath9k_wiphy_scanning(sc);
	spin_unlock_bh(&sc->wiphy_lock);
	return ret;
	}

	static int __ath9k_wiphy_unpause(struct ath_wiphy *aphy);

	/* caller must hold wiphy_lock */
	static void __ath9k_wiphy_unpause_ch(struct ath_wiphy *aphy)
	{
	if (aphy == NULL)
	return;
	if (aphy->chan_idx != aphy->sc->chan_idx)
	return; /* wiphy not on the selected channel */
	__ath9k_wiphy_unpause(aphy);
	}

	static void ath9k_wiphy_unpause_channel(struct ath_softc *sc)
	{
	int i;
	spin_lock_bh(&sc->wiphy_lock);
	__ath9k_wiphy_unpause_ch(sc->pri_wiphy);
	for (i = 0; i < sc->num_sec_wiphy; i++)
	__ath9k_wiphy_unpause_ch(sc->sec_wiphy[i]);
	spin_unlock_bh(&sc->wiphy_lock);
	}

	void ath9k_wiphy_chan_work(struct work_struct *work)
	{
	struct ath_softc *sc = container_of(work, struct ath_softc, chan_work);
	struct ath_wiphy *aphy = sc->next_wiphy;

	if (aphy == NULL)
	return;

	/*
	* All pending interfaces paused; ready to change
	* channels.
	*/

	/* Change channels */
	mutex_lock(&sc->mutex);
	/* XXX: remove me eventually */
	ath9k_update_ichannel(sc, aphy->hw,
	&sc->sc_ah->channels[sc->chan_idx]);
	ath_update_chainmask(sc, sc->chan_is_ht);
	if (ath_set_channel(sc, aphy->hw,
	&sc->sc_ah->channels[sc->chan_idx]) < 0) {
	printk(KERN_DEBUG "ath9k: Failed to set channel for new "
	"virtual wiphy\n");
	mutex_unlock(&sc->mutex);
	return;
	}
	mutex_unlock(&sc->mutex);

	ath9k_wiphy_unpause_channel(sc);
	}

	/*
	* ath9k version of ieee80211_tx_status() for TX frames that are generated
	* internally in the driver.
	*/
	void ath9k_tx_status(struct ieee80211_hw hw, struct sk_buff skb)
	{
	struct ath_wiphy *aphy = hw->priv;
	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
	struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
	struct ath_tx_info_priv *tx_info_priv = ATH_TX_INFO_PRIV(tx_info);

	if (tx_info_priv && tx_info_priv->frame_type == ATH9K_INT_PAUSE &&
	aphy->state == ATH_WIPHY_PAUSING) {
	if (!(info->flags & IEEE80211_TX_STAT_ACK)) {
	printk(KERN_DEBUG "ath9k: %s: no ACK for pause "
	"frame\n", wiphy_name(hw->wiphy));
	/*
	* The AP did not reply; ignore this to allow us to
	* continue.
	*/
	}
	aphy->state = ATH_WIPHY_PAUSED;
	if (!ath9k_wiphy_pausing(aphy->sc)) {
	/*
	* Drop from tasklet to work to allow mutex for channel
	* change.
	*/
	ieee80211_queue_work(aphy->sc->hw,
	&aphy->sc->chan_work);
	}
	}

	kfree(tx_info_priv);
	tx_info->rate_driver_data[0] = NULL;

	dev_kfree_skb(skb);
	}

	static void ath9k_mark_paused(struct ath_wiphy *aphy)
	{
	struct ath_softc *sc = aphy->sc;
	aphy->state = ATH_WIPHY_PAUSED;
	if (!__ath9k_wiphy_pausing(sc))
	ieee80211_queue_work(sc->hw, &sc->chan_work);
	}

	static void ath9k_pause_iter(void data, u8 mac, struct ieee80211_vif *vif)
	{
	struct ath_wiphy *aphy = data;
	struct ath_vif avp = (void ) vif->drv_priv;

	switch (vif->type) {
	case NL80211_IFTYPE_STATION:
	if (!vif->bss_conf.assoc) {
	ath9k_mark_paused(aphy);
	break;
	}
	/* TODO: could avoid this if already in PS mode */
	if (ath9k_send_nullfunc(aphy, vif, avp->bssid, 1)) {
	printk(KERN_DEBUG "%s: failed to send PS nullfunc\n",
	__func__);
	ath9k_mark_paused(aphy);
	}
	break;
	case NL80211_IFTYPE_AP:
	/* Beacon transmission is paused by aphy->state change */
	ath9k_mark_paused(aphy);
	break;
	default:
	break;
	}
	}

	/* caller must hold wiphy_lock */
	static int __ath9k_wiphy_pause(struct ath_wiphy *aphy)
	{
	ieee80211_stop_queues(aphy->hw);
	aphy->state = ATH_WIPHY_PAUSING;
	/*
	* TODO: handle PAUSING->PAUSED for the case where there are multiple
	* active vifs (now we do it on the first vif getting ready; should be
	* on the last)
	*/
	ieee80211_iterate_active_interfaces_atomic(aphy->hw, ath9k_pause_iter,
	aphy);
	return 0;
	}

	int ath9k_wiphy_pause(struct ath_wiphy *aphy)
	{
	int ret;
	spin_lock_bh(&aphy->sc->wiphy_lock);
	ret = __ath9k_wiphy_pause(aphy);
	spin_unlock_bh(&aphy->sc->wiphy_lock);
	return ret;
	}

	static void ath9k_unpause_iter(void data, u8 mac, struct ieee80211_vif *vif)
	{
	struct ath_wiphy *aphy = data;
	struct ath_vif avp = (void ) vif->drv_priv;

	switch (vif->type) {
	case NL80211_IFTYPE_STATION:
	if (!vif->bss_conf.assoc)
	break;
	ath9k_send_nullfunc(aphy, vif, avp->bssid, 0);
	break;
	case NL80211_IFTYPE_AP:
	/* Beacon transmission is re-enabled by aphy->state change */
	break;
	default:
	break;
	}
	}

	/* caller must hold wiphy_lock */
	static int __ath9k_wiphy_unpause(struct ath_wiphy *aphy)
	{
	ieee80211_iterate_active_interfaces_atomic(aphy->hw,
	ath9k_unpause_iter, aphy);
	aphy->state = ATH_WIPHY_ACTIVE;
	ieee80211_wake_queues(aphy->hw);
	return 0;
	}

	int ath9k_wiphy_unpause(struct ath_wiphy *aphy)
	{
	int ret;
	spin_lock_bh(&aphy->sc->wiphy_lock);
	ret = __ath9k_wiphy_unpause(aphy);
	spin_unlock_bh(&aphy->sc->wiphy_lock);
	return ret;
	}

	static void __ath9k_wiphy_mark_all_paused(struct ath_softc *sc)
	{
	int i;
	if (sc->pri_wiphy->state != ATH_WIPHY_INACTIVE)
	sc->pri_wiphy->state = ATH_WIPHY_PAUSED;
	for (i = 0; i < sc->num_sec_wiphy; i++) {
	if (sc->sec_wiphy[i] &&
	sc->sec_wiphy[i]->state != ATH_WIPHY_INACTIVE)
	sc->sec_wiphy[i]->state = ATH_WIPHY_PAUSED;
	}
	}

	/* caller must hold wiphy_lock */
	static void __ath9k_wiphy_pause_all(struct ath_softc *sc)
	{
	int i;
	if (sc->pri_wiphy->state == ATH_WIPHY_ACTIVE)
	__ath9k_wiphy_pause(sc->pri_wiphy);
	for (i = 0; i < sc->num_sec_wiphy; i++) {
	if (sc->sec_wiphy[i] &&
	sc->sec_wiphy[i]->state == ATH_WIPHY_ACTIVE)
	__ath9k_wiphy_pause(sc->sec_wiphy[i]);
	}
	}

	int ath9k_wiphy_select(struct ath_wiphy *aphy)
	{
	struct ath_softc *sc = aphy->sc;
	bool now;

	spin_lock_bh(&sc->wiphy_lock);
	if (__ath9k_wiphy_scanning(sc)) {
	/*
	* For now, we are using mac80211 sw scan and it expects to
	* have full control over channel changes, so avoid wiphy
	* scheduling during a scan. This could be optimized if the
	* scanning control were moved into the driver.
	*/
	spin_unlock_bh(&sc->wiphy_lock);
	return -EBUSY;
	}
	if (__ath9k_wiphy_pausing(sc)) {
	if (sc->wiphy_select_failures == 0)
	sc->wiphy_select_first_fail = jiffies;
	sc->wiphy_select_failures++;
	if (time_after(jiffies, sc->wiphy_select_first_fail + HZ / 2))
	{
	printk(KERN_DEBUG "ath9k: Previous wiphy select timed "
	"out; disable/enable hw to recover\n");
	__ath9k_wiphy_mark_all_paused(sc);
	/*
	* TODO: this workaround to fix hardware is unlikely to
	* be specific to virtual wiphy changes. It can happen
	* on normal channel change, too, and as such, this
	* should really be made more generic. For example,
	* tricker radio disable/enable on GTT interrupt burst
	* (say, 10 GTT interrupts received without any TX
	* frame being completed)
	*/
	spin_unlock_bh(&sc->wiphy_lock);
	ath_radio_disable(sc);
	ath_radio_enable(sc);
	ieee80211_queue_work(aphy->sc->hw,
	&aphy->sc->chan_work);
	return -EBUSY; /* previous select still in progress */
	}
	spin_unlock_bh(&sc->wiphy_lock);
	return -EBUSY; /* previous select still in progress */
	}
	sc->wiphy_select_failures = 0;

	/* Store the new channel */
	sc->chan_idx = aphy->chan_idx;
	sc->chan_is_ht = aphy->chan_is_ht;
	sc->next_wiphy = aphy;

	__ath9k_wiphy_pause_all(sc);
	now = !__ath9k_wiphy_pausing(aphy->sc);
	spin_unlock_bh(&sc->wiphy_lock);

	if (now) {
	/* Ready to request channel change immediately */
	ieee80211_queue_work(aphy->sc->hw, &aphy->sc->chan_work);
	}

	/*
	* wiphys will be unpaused in ath9k_tx_status() once channel has been
	* changed if any wiphy needs time to become paused.
	*/

	return 0;
	}

	bool ath9k_wiphy_started(struct ath_softc *sc)
	{
	int i;
	spin_lock_bh(&sc->wiphy_lock);
	if (sc->pri_wiphy->state != ATH_WIPHY_INACTIVE) {
	spin_unlock_bh(&sc->wiphy_lock);
	return true;
	}
	for (i = 0; i < sc->num_sec_wiphy; i++) {
	if (sc->sec_wiphy[i] &&
	sc->sec_wiphy[i]->state != ATH_WIPHY_INACTIVE) {
	spin_unlock_bh(&sc->wiphy_lock);
	return true;
	}
	}
	spin_unlock_bh(&sc->wiphy_lock);
	return false;
	}

	static void ath9k_wiphy_pause_chan(struct ath_wiphy *aphy,
	struct ath_wiphy *selected)
	{
	if (selected->state == ATH_WIPHY_SCAN) {
	if (aphy == selected)
	return;
	/*
	* Pause all other wiphys for the duration of the scan even if
	* they are on the current channel now.
	*/
	} else if (aphy->chan_idx == selected->chan_idx)
	return;
	aphy->state = ATH_WIPHY_PAUSED;
	ieee80211_stop_queues(aphy->hw);
	}

	void ath9k_wiphy_pause_all_forced(struct ath_softc *sc,
	struct ath_wiphy *selected)
	{
	int i;
	spin_lock_bh(&sc->wiphy_lock);
	if (sc->pri_wiphy->state == ATH_WIPHY_ACTIVE)
	ath9k_wiphy_pause_chan(sc->pri_wiphy, selected);
	for (i = 0; i < sc->num_sec_wiphy; i++) {
	if (sc->sec_wiphy[i] &&
	sc->sec_wiphy[i]->state == ATH_WIPHY_ACTIVE)
	ath9k_wiphy_pause_chan(sc->sec_wiphy[i], selected);
	}
	spin_unlock_bh(&sc->wiphy_lock);
	}

	void ath9k_wiphy_work(struct work_struct *work)
	{
	struct ath_softc *sc = container_of(work, struct ath_softc,
	wiphy_work.work);
	struct ath_wiphy *aphy = NULL;
	bool first = true;

	spin_lock_bh(&sc->wiphy_lock);

	if (sc->wiphy_scheduler_int == 0) {
	/* wiphy scheduler is disabled */
	spin_unlock_bh(&sc->wiphy_lock);
	return;
	}

	try_again:
	sc->wiphy_scheduler_index++;
	while (sc->wiphy_scheduler_index <= sc->num_sec_wiphy) {
	aphy = sc->sec_wiphy[sc->wiphy_scheduler_index - 1];
	if (aphy && aphy->state != ATH_WIPHY_INACTIVE)
	break;

	sc->wiphy_scheduler_index++;
	aphy = NULL;
	}
	if (aphy == NULL) {
	sc->wiphy_scheduler_index = 0;
	if (sc->pri_wiphy->state == ATH_WIPHY_INACTIVE) {
	if (first) {
	first = false;
	goto try_again;
	}
	/* No wiphy is ready to be scheduled */
	} else
	aphy = sc->pri_wiphy;
	}

	spin_unlock_bh(&sc->wiphy_lock);

	if (aphy &&
	aphy->state != ATH_WIPHY_ACTIVE && aphy->state != ATH_WIPHY_SCAN &&
	ath9k_wiphy_select(aphy)) {
	printk(KERN_DEBUG "ath9k: Failed to schedule virtual wiphy "
	"change\n");
	}

	ieee80211_queue_delayed_work(sc->hw,
	&sc->wiphy_work,
	sc->wiphy_scheduler_int);
	}

	void ath9k_wiphy_set_scheduler(struct ath_softc *sc, unsigned int msec_int)
	{
	cancel_delayed_work_sync(&sc->wiphy_work);
	sc->wiphy_scheduler_int = msecs_to_jiffies(msec_int);
	if (sc->wiphy_scheduler_int)
	ieee80211_queue_delayed_work(sc->hw, &sc->wiphy_work,
	sc->wiphy_scheduler_int);
	}

	/* caller must hold wiphy_lock */
	bool ath9k_all_wiphys_idle(struct ath_softc *sc)
	{
	unsigned int i;
	if (sc->pri_wiphy->state != ATH_WIPHY_INACTIVE) {
	return false;
	}
	for (i = 0; i < sc->num_sec_wiphy; i++) {
	struct ath_wiphy *aphy = sc->sec_wiphy[i];
	if (!aphy)
	continue;
	if (aphy->state != ATH_WIPHY_INACTIVE)
	return false;
	}
	return true;
	}