Quelle  mac80211-ops.c   Sprache: C

/*-
 * Copyright (c) 2002-2005 Sam Leffler, Errno Consulting
 * Copyright (c) 2004-2005 Atheros Communications, Inc.
 * Copyright (c) 2006 Devicescape Software, Inc.
 * Copyright (c) 2007 Jiri Slaby <jirislaby@gmail.com>
 * Copyright (c) 2007 Luis R. Rodriguez <mcgrof@winlab.rutgers.edu>
 * Copyright (c) 2010 Bruno Randolf <br1@einfach.org>
 *
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer,
 *    without modification.
 * 2. Redistributions in binary form must reproduce at minimum a disclaimer
 *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
 *    redistribution must be conditioned upon including a substantially
 *    similar Disclaimer requirement for further binary redistribution.
 * 3. Neither the names of the above-listed copyright holders nor the names
 *    of any contributors may be used to endorse or promote products derived
 *    from this software without specific prior written permission.
 *
 * Alternatively, this software may be distributed under the terms of the
 * GNU General Public License ("GPL") version 2 as published by the Free
 * Software Foundation.
 *
 * NO WARRANTY
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
 * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
 * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
 * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
 * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
 * THE POSSIBILITY OF SUCH DAMAGES.
 *
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <net/mac80211.h>
#include <linux/unaligned.h>

#include "ath5k.h"
#include "base.h"
#include "reg.h"

/********************\
* Mac80211 functions *
\********************/

static void
ath5k_tx(struct ieee80211_hw *hw, struct ieee80211_tx_control *control,
  struct sk_buff *skb)
{
 struct ath5k_hw *ah = hw->priv;
 u16 qnum = skb_get_queue_mapping(skb);

 if (WARN_ON(qnum >= ah->ah_capabilities.cap_queues.q_tx_num)) {
  ieee80211_free_txskb(hw, skb);
  return;
 }

 ath5k_tx_queue(hw, skb, &ah->txqs[qnum], control);
}


static int
ath5k_add_interface(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
{
 struct ath5k_hw *ah = hw->priv;
 int ret;
 struct ath5k_vif *avf = (void *)vif->drv_priv;

 mutex_lock(&ah->lock);

 if ((vif->type == NL80211_IFTYPE_AP ||
      vif->type == NL80211_IFTYPE_ADHOC)
     && (ah->num_ap_vifs + ah->num_adhoc_vifs) >= ATH_BCBUF) {
  ret = -ELNRNG;
  goto end;
 }

 /* Don't allow other interfaces if one ad-hoc is configured.
  * TODO: Fix the problems with ad-hoc and multiple other interfaces.
  * We would need to operate the HW in ad-hoc mode to allow TSF updates
  * for the IBSS, but this breaks with additional AP or STA interfaces
 * at the moment. */
 if (ah->num_adhoc_vifs ||
     (ah->nvifs && vif->type == NL80211_IFTYPE_ADHOC)) {
  ATH5K_ERR(ah, "Only one single ad-hoc interface is allowed.\n");
  ret = -ELNRNG;
  goto end;
 }

 switch (vif->type) {
 case NL80211_IFTYPE_AP:
 case NL80211_IFTYPE_STATION:
 case NL80211_IFTYPE_ADHOC:
 case NL80211_IFTYPE_MESH_POINT:
  avf->opmode = vif->type;
  break;
 default:
  ret = -EOPNOTSUPP;
  goto end;
 }

 ah->nvifs++;
 ATH5K_DBG(ah, ATH5K_DEBUG_MODE, "add interface mode %d\n", avf->opmode);

 /* Assign the vap/adhoc to a beacon xmit slot. */
 if ((avf->opmode == NL80211_IFTYPE_AP) ||
     (avf->opmode == NL80211_IFTYPE_ADHOC) ||
     (avf->opmode == NL80211_IFTYPE_MESH_POINT)) {
  int slot;

  WARN_ON(list_empty(&ah->bcbuf));
  avf->bbuf = list_first_entry(&ah->bcbuf, struct ath5k_buf,
          list);
  list_del(&avf->bbuf->list);

  avf->bslot = 0;
  for (slot = 0; slot < ATH_BCBUF; slot++) {
   if (!ah->bslot[slot]) {
    avf->bslot = slot;
    break;
   }
  }
  BUG_ON(ah->bslot[avf->bslot] != NULL);
  ah->bslot[avf->bslot] = vif;
  if (avf->opmode == NL80211_IFTYPE_AP)
   ah->num_ap_vifs++;
  else if (avf->opmode == NL80211_IFTYPE_ADHOC)
   ah->num_adhoc_vifs++;
  else if (avf->opmode == NL80211_IFTYPE_MESH_POINT)
   ah->num_mesh_vifs++;
 }

 /* Any MAC address is fine, all others are included through the
  * filter.
 */
 ath5k_hw_set_lladdr(ah, vif->addr);

 ath5k_update_bssid_mask_and_opmode(ah, vif);
 ret = 0;
end:
 mutex_unlock(&ah->lock);
 return ret;
}


static void
ath5k_remove_interface(struct ieee80211_hw *hw,
         struct ieee80211_vif *vif)
{
 struct ath5k_hw *ah = hw->priv;
 struct ath5k_vif *avf = (void *)vif->drv_priv;
 unsigned int i;

 mutex_lock(&ah->lock);
 ah->nvifs--;

 if (avf->bbuf) {
  ath5k_txbuf_free_skb(ah, avf->bbuf);
  list_add_tail(&avf->bbuf->list, &ah->bcbuf);
  for (i = 0; i < ATH_BCBUF; i++) {
   if (ah->bslot[i] == vif) {
    ah->bslot[i] = NULL;
    break;
   }
  }
  avf->bbuf = NULL;
 }
 if (avf->opmode == NL80211_IFTYPE_AP)
  ah->num_ap_vifs--;
 else if (avf->opmode == NL80211_IFTYPE_ADHOC)
  ah->num_adhoc_vifs--;
 else if (avf->opmode == NL80211_IFTYPE_MESH_POINT)
  ah->num_mesh_vifs--;

 ath5k_update_bssid_mask_and_opmode(ah, NULL);
 mutex_unlock(&ah->lock);
}


/*
 * TODO: Phy disable/diversity etc
 */
static int
ath5k_config(struct ieee80211_hw *hw, int radio_idx, u32 changed)
{
 struct ath5k_hw *ah = hw->priv;
 struct ieee80211_conf *conf = &hw->conf;
 int ret = 0;
 int i;

 mutex_lock(&ah->lock);

 if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
  ret = ath5k_chan_set(ah, &conf->chandef);
  if (ret < 0)
   goto unlock;
 }

 if ((changed & IEEE80211_CONF_CHANGE_POWER) &&
 (ah->ah_txpower.txp_requested != conf->power_level)) {
  ah->ah_txpower.txp_requested = conf->power_level;

  /* Half dB steps */
  ath5k_hw_set_txpower_limit(ah, (conf->power_level * 2));
 }

 if (changed & IEEE80211_CONF_CHANGE_RETRY_LIMITS) {
  ah->ah_retry_long = conf->long_frame_max_tx_count;
  ah->ah_retry_short = conf->short_frame_max_tx_count;

  for (i = 0; i < ah->ah_capabilities.cap_queues.q_tx_num; i++)
   ath5k_hw_set_tx_retry_limits(ah, i);
 }

 /* TODO:
  * 1) Move this on config_interface and handle each case
  * separately eg. when we have only one STA vif, use
  * AR5K_ANTMODE_SINGLE_AP
  *
  * 2) Allow the user to change antenna mode eg. when only
  * one antenna is present
  *
  * 3) Allow the user to set default/tx antenna when possible
  *
  * 4) Default mode should handle 90% of the cases, together
  * with fixed a/b and single AP modes we should be able to
  * handle 99%. Sectored modes are extreme cases and i still
  * haven't found a usage for them. If we decide to support them,
  * then we must allow the user to set how many tx antennas we
  * have available
 */
 ath5k_hw_set_antenna_mode(ah, ah->ah_ant_mode);

unlock:
 mutex_unlock(&ah->lock);
 return ret;
}


static void
ath5k_bss_info_changed(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
         struct ieee80211_bss_conf *bss_conf, u64 changes)
{
 struct ath5k_vif *avf = (void *)vif->drv_priv;
 struct ath5k_hw *ah = hw->priv;
 struct ath_common *common = ath5k_hw_common(ah);

 mutex_lock(&ah->lock);

 if (changes & BSS_CHANGED_BSSID) {
  /* Cache for later use during resets */
  memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
  common->curaid = 0;
  ath5k_hw_set_bssid(ah);
 }

 if (changes & BSS_CHANGED_BEACON_INT)
  ah->bintval = bss_conf->beacon_int;

 if (changes & BSS_CHANGED_ERP_SLOT) {
  int slot_time;

  ah->ah_short_slot = bss_conf->use_short_slot;
  slot_time = ath5k_hw_get_default_slottime(ah) +
       3 * ah->ah_coverage_class;
  ath5k_hw_set_ifs_intervals(ah, slot_time);
 }

 if (changes & BSS_CHANGED_ASSOC) {
  avf->assoc = vif->cfg.assoc;
  if (vif->cfg.assoc)
   ah->assoc = vif->cfg.assoc;
  else
   ah->assoc = ath5k_any_vif_assoc(ah);

  if (ah->opmode == NL80211_IFTYPE_STATION)
   ath5k_set_beacon_filter(hw, ah->assoc);
  ath5k_hw_set_ledstate(ah, ah->assoc ?
   AR5K_LED_ASSOC : AR5K_LED_INIT);
  if (vif->cfg.assoc) {
   ATH5K_DBG(ah, ATH5K_DEBUG_ANY,
      "Bss Info ASSOC %d, bssid: %pM\n",
      vif->cfg.aid, common->curbssid);
   common->curaid = vif->cfg.aid;
   ath5k_hw_set_bssid(ah);
   /* Once ANI is available you would start it here */
  }
 }

 if (changes & BSS_CHANGED_BEACON) {
  spin_lock_bh(&ah->block);
  ath5k_beacon_update(hw, vif);
  spin_unlock_bh(&ah->block);
 }

 if (changes & BSS_CHANGED_BEACON_ENABLED)
  ah->enable_beacon = bss_conf->enable_beacon;

 if (changes & (BSS_CHANGED_BEACON | BSS_CHANGED_BEACON_ENABLED |
         BSS_CHANGED_BEACON_INT))
  ath5k_beacon_config(ah);

 mutex_unlock(&ah->lock);
}


static u64
ath5k_prepare_multicast(struct ieee80211_hw *hw,
   struct netdev_hw_addr_list *mc_list)
{
 u32 mfilt[2], val;
 u8 pos;
 struct netdev_hw_addr *ha;

 mfilt[0] = 0;
 mfilt[1] = 0;

 netdev_hw_addr_list_for_each(ha, mc_list) {
  /* calculate XOR of eight 6-bit values */
  val = get_unaligned_le32(ha->addr + 0);
  pos = (val >> 18) ^ (val >> 12) ^ (val >> 6) ^ val;
  val = get_unaligned_le32(ha->addr + 3);
  pos ^= (val >> 18) ^ (val >> 12) ^ (val >> 6) ^ val;
  pos &= 0x3f;
  mfilt[pos / 32] |= (1 << (pos % 32));
  /* XXX: we might be able to just do this instead,
  * but not sure, needs testing, if we do use this we'd
* need to inform below not to reset the mcast */
  /* ath5k_hw_set_mcast_filterindex(ah,
 *      ha->addr[5]); */
 }

 return ((u64)(mfilt[1]) << 32) | mfilt[0];
}


/*
 * o always accept unicast, broadcast, and multicast traffic
 * o multicast traffic for all BSSIDs will be enabled if mac80211
 *   says it should be
 * o maintain current state of phy ofdm or phy cck error reception.
 *   If the hardware detects any of these type of errors then
 *   ath5k_hw_get_rx_filter() will pass to us the respective
 *   hardware filters to be able to receive these type of frames.
 * o probe request frames are accepted only when operating in
 *   hostap, adhoc, or monitor modes
 * o enable promiscuous mode according to the interface state
 * o accept beacons:
 *   - when operating in adhoc mode so the 802.11 layer creates
 *     node table entries for peers,
 *   - when operating in station mode for collecting rssi data when
 *     the station is otherwise quiet, or
 *   - when scanning
 */
static void
ath5k_configure_filter(struct ieee80211_hw *hw, unsigned int changed_flags,
         unsigned int *new_flags, u64 multicast)
{
#define SUPPORTED_FIF_FLAGS \
 (FIF_ALLMULTI | FIF_FCSFAIL | \
 FIF_PLCPFAIL | FIF_CONTROL | FIF_OTHER_BSS | \
 FIF_BCN_PRBRESP_PROMISC)

 struct ath5k_hw *ah = hw->priv;
 u32 mfilt[2], rfilt;
 struct ath5k_vif_iter_data iter_data; /* to count STA interfaces */

 mutex_lock(&ah->lock);

 mfilt[0] = multicast;
 mfilt[1] = multicast >> 32;

 /* Only deal with supported flags */
 *new_flags &= SUPPORTED_FIF_FLAGS;

 /* If HW detects any phy or radar errors, leave those filters on.
  * Also, always enable Unicast, Broadcasts and Multicast
 * XXX: move unicast, bssid broadcasts and multicast to mac80211 */
 rfilt = (ath5k_hw_get_rx_filter(ah) & (AR5K_RX_FILTER_PHYERR)) |
  (AR5K_RX_FILTER_UCAST | AR5K_RX_FILTER_BCAST |
  AR5K_RX_FILTER_MCAST);

 /* Note, AR5K_RX_FILTER_MCAST is already enabled */
 if (*new_flags & FIF_ALLMULTI) {
  mfilt[0] =  ~0;
  mfilt[1] =  ~0;
 }

 /* This is the best we can do */
 if (*new_flags & (FIF_FCSFAIL | FIF_PLCPFAIL))
  rfilt |= AR5K_RX_FILTER_PHYERR;

 /* FIF_BCN_PRBRESP_PROMISC really means to enable beacons
* and probes for any BSSID */
 if ((*new_flags & FIF_BCN_PRBRESP_PROMISC) || (ah->nvifs > 1))
  rfilt |= AR5K_RX_FILTER_BEACON;

 /* FIF_CONTROL doc says we should only pass on control frames for this
  * station. This needs testing. I believe right now this
  * enables *all* control frames, which is OK.. but
 * we should see if we can improve on granularity */
 if (*new_flags & FIF_CONTROL)
  rfilt |= AR5K_RX_FILTER_CONTROL;

 /* Additional settings per mode -- this is per ath5k */

 /* XXX move these to mac80211, and add a beacon IFF flag to mac80211 */

 switch (ah->opmode) {
 case NL80211_IFTYPE_MESH_POINT:
  rfilt |= AR5K_RX_FILTER_CONTROL |
    AR5K_RX_FILTER_BEACON |
    AR5K_RX_FILTER_PROBEREQ |
    AR5K_RX_FILTER_PROM;
  break;
 case NL80211_IFTYPE_AP:
 case NL80211_IFTYPE_ADHOC:
  rfilt |= AR5K_RX_FILTER_PROBEREQ |
    AR5K_RX_FILTER_BEACON;
  break;
 case NL80211_IFTYPE_STATION:
  if (ah->assoc)
   rfilt |= AR5K_RX_FILTER_BEACON;
  break;
 default:
  break;
 }

 iter_data.hw_macaddr = NULL;
 iter_data.n_stas = 0;
 iter_data.need_set_hw_addr = false;
 ieee80211_iterate_active_interfaces_atomic(
  ah->hw, IEEE80211_IFACE_ITER_RESUME_ALL,
  ath5k_vif_iter, &iter_data);

 /* Set up RX Filter */
 if (iter_data.n_stas > 1) {
  /* If you have multiple STA interfaces connected to
   * different APs, ARPs are not received (most of the time?)
   * Enabling PROMISC appears to fix that problem.
 */
  rfilt |= AR5K_RX_FILTER_PROM;
 }

 /* Set filters */
 ath5k_hw_set_rx_filter(ah, rfilt);

 /* Set multicast bits */
 ath5k_hw_set_mcast_filter(ah, mfilt[0], mfilt[1]);
 /* Set the cached hw filter flags, this will later actually
 * be set in HW */
 ah->filter_flags = rfilt;
 /* Store current FIF filter flags */
 ah->fif_filter_flags = *new_flags;

 mutex_unlock(&ah->lock);
}


static int
ath5k_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
       struct ieee80211_vif *vif, struct ieee80211_sta *sta,
       struct ieee80211_key_conf *key)
{
 struct ath5k_hw *ah = hw->priv;
 struct ath_common *common = ath5k_hw_common(ah);
 int ret = 0;

 if (ath5k_modparam_nohwcrypt)
  return -EOPNOTSUPP;

 if (key->flags & IEEE80211_KEY_FLAG_RX_MGMT)
  return -EOPNOTSUPP;

 if (vif->type == NL80211_IFTYPE_ADHOC &&
     (key->cipher == WLAN_CIPHER_SUITE_TKIP ||
      key->cipher == WLAN_CIPHER_SUITE_CCMP) &&
     !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) {
  /* don't program group keys when using IBSS_RSN */
  return -EOPNOTSUPP;
 }

 switch (key->cipher) {
 case WLAN_CIPHER_SUITE_WEP40:
 case WLAN_CIPHER_SUITE_WEP104:
 case WLAN_CIPHER_SUITE_TKIP:
  break;
 case WLAN_CIPHER_SUITE_CCMP:
  if (common->crypt_caps & ATH_CRYPT_CAP_CIPHER_AESCCM)
   break;
  return -EOPNOTSUPP;
 default:
  return -EOPNOTSUPP;
 }

 mutex_lock(&ah->lock);

 switch (cmd) {
 case SET_KEY:
  ret = ath_key_config(common, vif, sta, key);
  if (ret >= 0) {
   key->hw_key_idx = ret;
   /* push IV and Michael MIC generation to stack */
   key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
   if (key->cipher == WLAN_CIPHER_SUITE_TKIP)
    key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
   if (key->cipher == WLAN_CIPHER_SUITE_CCMP)
    key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX;
   ret = 0;
  }
  break;
 case DISABLE_KEY:
  ath_key_delete(common, key->hw_key_idx);
  break;
 default:
  ret = -EINVAL;
 }

 mutex_unlock(&ah->lock);
 return ret;
}


static void
ath5k_sw_scan_start(struct ieee80211_hw *hw,
      struct ieee80211_vif *vif,
      const u8 *mac_addr)
{
 struct ath5k_hw *ah = hw->priv;
 if (!ah->assoc)
  ath5k_hw_set_ledstate(ah, AR5K_LED_SCAN);
}


static void
ath5k_sw_scan_complete(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
{
 struct ath5k_hw *ah = hw->priv;
 ath5k_hw_set_ledstate(ah, ah->assoc ?
  AR5K_LED_ASSOC : AR5K_LED_INIT);
}


static int
ath5k_get_stats(struct ieee80211_hw *hw,
  struct ieee80211_low_level_stats *stats)
{
 struct ath5k_hw *ah = hw->priv;

 /* Force update */
 ath5k_hw_update_mib_counters(ah);

 stats->dot11ACKFailureCount = ah->stats.ack_fail;
 stats->dot11RTSFailureCount = ah->stats.rts_fail;
 stats->dot11RTSSuccessCount = ah->stats.rts_ok;
 stats->dot11FCSErrorCount = ah->stats.fcs_error;

 return 0;
}


static int
ath5k_conf_tx(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
       unsigned int link_id, u16 queue,
       const struct ieee80211_tx_queue_params *params)
{
 struct ath5k_hw *ah = hw->priv;
 struct ath5k_txq_info qi;
 int ret = 0;

 if (queue >= ah->ah_capabilities.cap_queues.q_tx_num)
  return 0;

 mutex_lock(&ah->lock);

 ath5k_hw_get_tx_queueprops(ah, queue, &qi);

 qi.tqi_aifs = params->aifs;
 qi.tqi_cw_min = params->cw_min;
 qi.tqi_cw_max = params->cw_max;
 qi.tqi_burst_time = params->txop * 32;

 ATH5K_DBG(ah, ATH5K_DEBUG_ANY,
    "Configure tx [queue %d],  "
    "aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n",
    queue, params->aifs, params->cw_min,
    params->cw_max, params->txop);

 if (ath5k_hw_set_tx_queueprops(ah, queue, &qi)) {
  ATH5K_ERR(ah,
     "Unable to update hardware queue %u!\n", queue);
  ret = -EIO;
 } else
  ath5k_hw_reset_tx_queue(ah, queue);

 mutex_unlock(&ah->lock);

 return ret;
}


static u64
ath5k_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
{
 struct ath5k_hw *ah = hw->priv;

 return ath5k_hw_get_tsf64(ah);
}


static void
ath5k_set_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif, u64 tsf)
{
 struct ath5k_hw *ah = hw->priv;

 ath5k_hw_set_tsf64(ah, tsf);
}


static void
ath5k_reset_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
{
 struct ath5k_hw *ah = hw->priv;

 /*
  * in IBSS mode we need to update the beacon timers too.
  * this will also reset the TSF if we call it with 0
 */
 if (ah->opmode == NL80211_IFTYPE_ADHOC)
  ath5k_beacon_update_timers(ah, 0);
 else
  ath5k_hw_reset_tsf(ah);
}


static int
ath5k_get_survey(struct ieee80211_hw *hw, int idx, struct survey_info *survey)
{
 struct ath5k_hw *ah = hw->priv;
 struct ieee80211_conf *conf = &hw->conf;
 struct ath_common *common = ath5k_hw_common(ah);
 struct ath_cycle_counters *cc = &common->cc_survey;
 unsigned int div = common->clockrate * 1000;

 if (idx != 0)
  return -ENOENT;

 spin_lock_bh(&common->cc_lock);
 ath_hw_cycle_counters_update(common);
 if (cc->cycles > 0) {
  ah->survey.time += cc->cycles / div;
  ah->survey.time_busy += cc->rx_busy / div;
  ah->survey.time_rx += cc->rx_frame / div;
  ah->survey.time_tx += cc->tx_frame / div;
 }
 memset(cc, 0, sizeof(*cc));
 spin_unlock_bh(&common->cc_lock);

 memcpy(survey, &ah->survey, sizeof(*survey));

 survey->channel = conf->chandef.chan;
 survey->noise = ah->ah_noise_floor;
 survey->filled = SURVEY_INFO_NOISE_DBM |
   SURVEY_INFO_IN_USE |
   SURVEY_INFO_TIME |
   SURVEY_INFO_TIME_BUSY |
   SURVEY_INFO_TIME_RX |
   SURVEY_INFO_TIME_TX;

 return 0;
}


/**
 * ath5k_set_coverage_class - Set IEEE 802.11 coverage class
 *
 * @hw: struct ieee80211_hw pointer
 * @radio_idx: Radio index
 * @coverage_class: IEEE 802.11 coverage class number
 *
 * Mac80211 callback. Sets slot time, ACK timeout and CTS timeout for given
 * coverage class. The values are persistent, they are restored after device
 * reset.
 */
static void
ath5k_set_coverage_class(struct ieee80211_hw *hw, int radio_idx,
    s16 coverage_class)
{
 struct ath5k_hw *ah = hw->priv;

 mutex_lock(&ah->lock);
 ath5k_hw_set_coverage_class(ah, coverage_class);
 mutex_unlock(&ah->lock);
}


static int
ath5k_set_antenna(struct ieee80211_hw *hw, int radio_idx, u32 tx_ant,
    u32 rx_ant)
{
 struct ath5k_hw *ah = hw->priv;

 if (tx_ant == 1 && rx_ant == 1)
  ath5k_hw_set_antenna_mode(ah, AR5K_ANTMODE_FIXED_A);
 else if (tx_ant == 2 && rx_ant == 2)
  ath5k_hw_set_antenna_mode(ah, AR5K_ANTMODE_FIXED_B);
 else if ((tx_ant & 3) == 3 && (rx_ant & 3) == 3)
  ath5k_hw_set_antenna_mode(ah, AR5K_ANTMODE_DEFAULT);
 else
  return -EINVAL;
 return 0;
}


static int
ath5k_get_antenna(struct ieee80211_hw *hw, int radio_idx,
    u32 *tx_ant, u32 *rx_ant)
{
 struct ath5k_hw *ah = hw->priv;

 switch (ah->ah_ant_mode) {
 case AR5K_ANTMODE_FIXED_A:
  *tx_ant = 1; *rx_ant = 1; break;
 case AR5K_ANTMODE_FIXED_B:
  *tx_ant = 2; *rx_ant = 2; break;
 case AR5K_ANTMODE_DEFAULT:
  *tx_ant = 3; *rx_ant = 3; break;
 }
 return 0;
}


static void ath5k_get_ringparam(struct ieee80211_hw *hw,
    u32 *tx, u32 *tx_max, u32 *rx, u32 *rx_max)
{
 struct ath5k_hw *ah = hw->priv;

 *tx = ah->txqs[AR5K_TX_QUEUE_ID_DATA_MIN].txq_max;

 *tx_max = ATH5K_TXQ_LEN_MAX;
 *rx = *rx_max = ATH_RXBUF;
}


static int ath5k_set_ringparam(struct ieee80211_hw *hw, u32 tx, u32 rx)
{
 struct ath5k_hw *ah = hw->priv;
 u16 qnum;

 /* only support setting tx ring size for now */
 if (rx != ATH_RXBUF)
  return -EINVAL;

 /* restrict tx ring size min/max */
 if (!tx || tx > ATH5K_TXQ_LEN_MAX)
  return -EINVAL;

 for (qnum = 0; qnum < ARRAY_SIZE(ah->txqs); qnum++) {
  if (!ah->txqs[qnum].setup)
   continue;
  if (ah->txqs[qnum].qnum < AR5K_TX_QUEUE_ID_DATA_MIN ||
      ah->txqs[qnum].qnum > AR5K_TX_QUEUE_ID_DATA_MAX)
   continue;

  ah->txqs[qnum].txq_max = tx;
  if (ah->txqs[qnum].txq_len >= ah->txqs[qnum].txq_max)
   ieee80211_stop_queue(hw, ah->txqs[qnum].qnum);
 }

 return 0;
}


const struct ieee80211_ops ath5k_hw_ops = {
 .add_chanctx = ieee80211_emulate_add_chanctx,
 .remove_chanctx = ieee80211_emulate_remove_chanctx,
 .change_chanctx = ieee80211_emulate_change_chanctx,
 .switch_vif_chanctx = ieee80211_emulate_switch_vif_chanctx,
 .tx   = ath5k_tx,
 .wake_tx_queue  = ieee80211_handle_wake_tx_queue,
 .start   = ath5k_start,
 .stop   = ath5k_stop,
 .add_interface  = ath5k_add_interface,
 /* .change_interface = not implemented */
 .remove_interface = ath5k_remove_interface,
 .config   = ath5k_config,
 .bss_info_changed = ath5k_bss_info_changed,
 .prepare_multicast = ath5k_prepare_multicast,
 .configure_filter = ath5k_configure_filter,
 /* .set_tim = not implemented */
 .set_key  = ath5k_set_key,
 /* .update_tkip_key = not implemented */
 /* .hw_scan = not implemented */
 .sw_scan_start  = ath5k_sw_scan_start,
 .sw_scan_complete = ath5k_sw_scan_complete,
 .get_stats  = ath5k_get_stats,
 /* .set_frag_threshold = not implemented */
 /* .set_rts_threshold = not implemented */
 /* .sta_add = not implemented */
 /* .sta_remove = not implemented */
 /* .sta_notify = not implemented */
 .conf_tx  = ath5k_conf_tx,
 .get_tsf  = ath5k_get_tsf,
 .set_tsf  = ath5k_set_tsf,
 .reset_tsf  = ath5k_reset_tsf,
 /* .tx_last_beacon = not implemented */
 /* .ampdu_action = not needed */
 .get_survey  = ath5k_get_survey,
 .set_coverage_class = ath5k_set_coverage_class,
 /* .rfkill_poll = not implemented */
 /* .flush = not implemented */
 /* .channel_switch = not implemented */
 /* .napi_poll = not implemented */
 .set_antenna  = ath5k_set_antenna,
 .get_antenna  = ath5k_get_antenna,
 .set_ringparam  = ath5k_set_ringparam,
 .get_ringparam  = ath5k_get_ringparam,
};