drivers/net/wireless/ath/ath5k/mac80211-ops.c

   1 /*-
   2  * Copyright (c) 2002-2005 Sam Leffler, Errno Consulting
   3  * Copyright (c) 2004-2005 Atheros Communications, Inc.
   4  * Copyright (c) 2006 Devicescape Software, Inc.
   5  * Copyright (c) 2007 Jiri Slaby <jirislaby@gmail.com>
   6  * Copyright (c) 2007 Luis R. Rodriguez <mcgrof@winlab.rutgers.edu>
   7  * Copyright (c) 2010 Bruno Randolf <br1@einfach.org>
   8  *
   9  * All rights reserved.
  10  *
  11  * Redistribution and use in source and binary forms, with or without
  12  * modification, are permitted provided that the following conditions
  13  * are met:
  14  * 1. Redistributions of source code must retain the above copyright
  15  *    notice, this list of conditions and the following disclaimer,
  16  *    without modification.
  17  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
  18  *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
  19  *    redistribution must be conditioned upon including a substantially
  20  *    similar Disclaimer requirement for further binary redistribution.
  21  * 3. Neither the names of the above-listed copyright holders nor the names
  22  *    of any contributors may be used to endorse or promote products derived
  23  *    from this software without specific prior written permission.
  24  *
  25  * Alternatively, this software may be distributed under the terms of the
  26  * GNU General Public License ("GPL") version 2 as published by the Free
  27  * Software Foundation.
  28  *
  29  * NO WARRANTY
  30  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  31  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  32  * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
  33  * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
  34  * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
  35  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  36  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  37  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
  38  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  39  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
  40  * THE POSSIBILITY OF SUCH DAMAGES.
  41  *
  42  */
  43
  44 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  45
  46 #include <net/mac80211.h>
  47 #include <asm/unaligned.h>
  48
  49 #include "ath5k.h"
  50 #include "base.h"
  51 #include "reg.h"
  52
  53 /********************\
  54 * Mac80211 functions *
  55 \********************/
  56
  57 static void
  58 ath5k_tx(struct ieee80211_hw *hw, struct ieee80211_tx_control *control,
  59          struct sk_buff *skb)
  60 {
  61         struct ath5k_hw *ah = hw->priv;
  62         u16 qnum = skb_get_queue_mapping(skb);
  63
  64         if (WARN_ON(qnum >= ah->ah_capabilities.cap_queues.q_tx_num)) {
  65                 ieee80211_free_txskb(hw, skb);
  66                 return;
  67         }
  68
  69         ath5k_tx_queue(hw, skb, &ah->txqs[qnum], control);
  70 }
  71
  72
  73 static int
  74 ath5k_add_interface(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
  75 {
  76         struct ath5k_hw *ah = hw->priv;
  77         int ret;
  78         struct ath5k_vif *avf = (void *)vif->drv_priv;
  79
  80         mutex_lock(&ah->lock);
  81
  82         if ((vif->type == NL80211_IFTYPE_AP ||
  83              vif->type == NL80211_IFTYPE_ADHOC)
  84             && (ah->num_ap_vifs + ah->num_adhoc_vifs) >= ATH_BCBUF) {
  85                 ret = -ELNRNG;
  86                 goto end;
  87         }
  88
  89         /* Don't allow other interfaces if one ad-hoc is configured.
  90          * TODO: Fix the problems with ad-hoc and multiple other interfaces.
  91          * We would need to operate the HW in ad-hoc mode to allow TSF updates
  92          * for the IBSS, but this breaks with additional AP or STA interfaces
  93          * at the moment. */
  94         if (ah->num_adhoc_vifs ||
  95             (ah->nvifs && vif->type == NL80211_IFTYPE_ADHOC)) {
  96                 ATH5K_ERR(ah, "Only one single ad-hoc interface is allowed.\n");
  97                 ret = -ELNRNG;
  98                 goto end;
  99         }
 100
 101         switch (vif->type) {
 102         case NL80211_IFTYPE_AP:
 103         case NL80211_IFTYPE_STATION:
 104         case NL80211_IFTYPE_ADHOC:
 105         case NL80211_IFTYPE_MESH_POINT:
 106                 avf->opmode = vif->type;
 107                 break;
 108         default:
 109                 ret = -EOPNOTSUPP;
 110                 goto end;
 111         }
 112
 113         ah->nvifs++;
 114         ATH5K_DBG(ah, ATH5K_DEBUG_MODE, "add interface mode %d\n", avf->opmode);
 115
 116         /* Assign the vap/adhoc to a beacon xmit slot. */
 117         if ((avf->opmode == NL80211_IFTYPE_AP) ||
 118             (avf->opmode == NL80211_IFTYPE_ADHOC) ||
 119             (avf->opmode == NL80211_IFTYPE_MESH_POINT)) {
 120                 int slot;
 121
 122                 WARN_ON(list_empty(&ah->bcbuf));
 123                 avf->bbuf = list_first_entry(&ah->bcbuf, struct ath5k_buf,
 124                                              list);
 125                 list_del(&avf->bbuf->list);
 126
 127                 avf->bslot = 0;
 128                 for (slot = 0; slot < ATH_BCBUF; slot++) {
 129                         if (!ah->bslot[slot]) {
 130                                 avf->bslot = slot;
 131                                 break;
 132                         }
 133                 }
 134                 BUG_ON(ah->bslot[avf->bslot] != NULL);
 135                 ah->bslot[avf->bslot] = vif;
 136                 if (avf->opmode == NL80211_IFTYPE_AP)
 137                         ah->num_ap_vifs++;
 138                 else if (avf->opmode == NL80211_IFTYPE_ADHOC)
 139                         ah->num_adhoc_vifs++;
 140                 else if (avf->opmode == NL80211_IFTYPE_MESH_POINT)
 141                         ah->num_mesh_vifs++;
 142         }
 143
 144         /* Any MAC address is fine, all others are included through the
 145          * filter.
 146          */
 147         ath5k_hw_set_lladdr(ah, vif->addr);
 148
 149         ath5k_update_bssid_mask_and_opmode(ah, vif);
 150         ret = 0;
 151 end:
 152         mutex_unlock(&ah->lock);
 153         return ret;
 154 }
 155
 156
 157 static void
 158 ath5k_remove_interface(struct ieee80211_hw *hw,
 159                        struct ieee80211_vif *vif)
 160 {
 161         struct ath5k_hw *ah = hw->priv;
 162         struct ath5k_vif *avf = (void *)vif->drv_priv;
 163         unsigned int i;
 164
 165         mutex_lock(&ah->lock);
 166         ah->nvifs--;
 167
 168         if (avf->bbuf) {
 169                 ath5k_txbuf_free_skb(ah, avf->bbuf);
 170                 list_add_tail(&avf->bbuf->list, &ah->bcbuf);
 171                 for (i = 0; i < ATH_BCBUF; i++) {
 172                         if (ah->bslot[i] == vif) {
 173                                 ah->bslot[i] = NULL;
 174                                 break;
 175                         }
 176                 }
 177                 avf->bbuf = NULL;
 178         }
 179         if (avf->opmode == NL80211_IFTYPE_AP)
 180                 ah->num_ap_vifs--;
 181         else if (avf->opmode == NL80211_IFTYPE_ADHOC)
 182                 ah->num_adhoc_vifs--;
 183         else if (avf->opmode == NL80211_IFTYPE_MESH_POINT)
 184                 ah->num_mesh_vifs--;
 185
 186         ath5k_update_bssid_mask_and_opmode(ah, NULL);
 187         mutex_unlock(&ah->lock);
 188 }
 189
 190
 191 /*
 192  * TODO: Phy disable/diversity etc
 193  */
 194 static int
 195 ath5k_config(struct ieee80211_hw *hw, u32 changed)
 196 {
 197         struct ath5k_hw *ah = hw->priv;
 198         struct ieee80211_conf *conf = &hw->conf;
 199         int ret = 0;
 200         int i;
 201
 202         mutex_lock(&ah->lock);
 203
 204         if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
 205                 ret = ath5k_chan_set(ah, &conf->chandef);
 206                 if (ret < 0)
 207                         goto unlock;
 208         }
 209
 210         if ((changed & IEEE80211_CONF_CHANGE_POWER) &&
 211         (ah->ah_txpower.txp_requested != conf->power_level)) {
 212                 ah->ah_txpower.txp_requested = conf->power_level;
 213
 214                 /* Half dB steps */
 215                 ath5k_hw_set_txpower_limit(ah, (conf->power_level * 2));
 216         }
 217
 218         if (changed & IEEE80211_CONF_CHANGE_RETRY_LIMITS) {
 219                 ah->ah_retry_long = conf->long_frame_max_tx_count;
 220                 ah->ah_retry_short = conf->short_frame_max_tx_count;
 221
 222                 for (i = 0; i < ah->ah_capabilities.cap_queues.q_tx_num; i++)
 223                         ath5k_hw_set_tx_retry_limits(ah, i);
 224         }
 225
 226         /* TODO:
 227          * 1) Move this on config_interface and handle each case
 228          * separately eg. when we have only one STA vif, use
 229          * AR5K_ANTMODE_SINGLE_AP
 230          *
 231          * 2) Allow the user to change antenna mode eg. when only
 232          * one antenna is present
 233          *
 234          * 3) Allow the user to set default/tx antenna when possible
 235          *
 236          * 4) Default mode should handle 90% of the cases, together
 237          * with fixed a/b and single AP modes we should be able to
 238          * handle 99%. Sectored modes are extreme cases and i still
 239          * haven't found a usage for them. If we decide to support them,
 240          * then we must allow the user to set how many tx antennas we
 241          * have available
 242          */
 243         ath5k_hw_set_antenna_mode(ah, ah->ah_ant_mode);
 244
 245 unlock:
 246         mutex_unlock(&ah->lock);
 247         return ret;
 248 }
 249
 250
 251 static void
 252 ath5k_bss_info_changed(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
 253                        struct ieee80211_bss_conf *bss_conf, u32 changes)
 254 {
 255         struct ath5k_vif *avf = (void *)vif->drv_priv;
 256         struct ath5k_hw *ah = hw->priv;
 257         struct ath_common *common = ath5k_hw_common(ah);
 258
 259         mutex_lock(&ah->lock);
 260
 261         if (changes & BSS_CHANGED_BSSID) {
 262                 /* Cache for later use during resets */
 263                 memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
 264                 common->curaid = 0;
 265                 ath5k_hw_set_bssid(ah);
 266                 mmiowb();
 267         }
 268
 269         if (changes & BSS_CHANGED_BEACON_INT)
 270                 ah->bintval = bss_conf->beacon_int;
 271
 272         if (changes & BSS_CHANGED_ERP_SLOT) {
 273                 int slot_time;
 274
 275                 ah->ah_short_slot = bss_conf->use_short_slot;
 276                 slot_time = ath5k_hw_get_default_slottime(ah) +
 277                             3 * ah->ah_coverage_class;
 278                 ath5k_hw_set_ifs_intervals(ah, slot_time);
 279         }
 280
 281         if (changes & BSS_CHANGED_ASSOC) {
 282                 avf->assoc = bss_conf->assoc;
 283                 if (bss_conf->assoc)
 284                         ah->assoc = bss_conf->assoc;
 285                 else
 286                         ah->assoc = ath5k_any_vif_assoc(ah);
 287
 288                 if (ah->opmode == NL80211_IFTYPE_STATION)
 289                         ath5k_set_beacon_filter(hw, ah->assoc);
 290                 ath5k_hw_set_ledstate(ah, ah->assoc ?
 291                         AR5K_LED_ASSOC : AR5K_LED_INIT);
 292                 if (bss_conf->assoc) {
 293                         ATH5K_DBG(ah, ATH5K_DEBUG_ANY,
 294                                   "Bss Info ASSOC %d, bssid: %pM\n",
 295                                   bss_conf->aid, common->curbssid);
 296                         common->curaid = bss_conf->aid;
 297                         ath5k_hw_set_bssid(ah);
 298                         /* Once ANI is available you would start it here */
 299                 }
 300         }
 301
 302         if (changes & BSS_CHANGED_BEACON) {
 303                 spin_lock_bh(&ah->block);
 304                 ath5k_beacon_update(hw, vif);
 305                 spin_unlock_bh(&ah->block);
 306         }
 307
 308         if (changes & BSS_CHANGED_BEACON_ENABLED)
 309                 ah->enable_beacon = bss_conf->enable_beacon;
 310
 311         if (changes & (BSS_CHANGED_BEACON | BSS_CHANGED_BEACON_ENABLED |
 312                        BSS_CHANGED_BEACON_INT))
 313                 ath5k_beacon_config(ah);
 314
 315         mutex_unlock(&ah->lock);
 316 }
 317
 318
 319 static u64
 320 ath5k_prepare_multicast(struct ieee80211_hw *hw,
 321                         struct netdev_hw_addr_list *mc_list)
 322 {
 323         u32 mfilt[2], val;
 324         u8 pos;
 325         struct netdev_hw_addr *ha;
 326
 327         mfilt[0] = 0;
 328         mfilt[1] = 0;
 329
 330         netdev_hw_addr_list_for_each(ha, mc_list) {
 331                 /* calculate XOR of eight 6-bit values */
 332                 val = get_unaligned_le32(ha->addr + 0);
 333                 pos = (val >> 18) ^ (val >> 12) ^ (val >> 6) ^ val;
 334                 val = get_unaligned_le32(ha->addr + 3);
 335                 pos ^= (val >> 18) ^ (val >> 12) ^ (val >> 6) ^ val;
 336                 pos &= 0x3f;
 337                 mfilt[pos / 32] |= (1 << (pos % 32));
 338                 /* XXX: we might be able to just do this instead,
 339                 * but not sure, needs testing, if we do use this we'd
 340                 * need to inform below not to reset the mcast */
 341                 /* ath5k_hw_set_mcast_filterindex(ah,
 342                  *      ha->addr[5]); */
 343         }
 344
 345         return ((u64)(mfilt[1]) << 32) | mfilt[0];
 346 }
 347
 348
 349 /*
 350  * o always accept unicast, broadcast, and multicast traffic
 351  * o multicast traffic for all BSSIDs will be enabled if mac80211
 352  *   says it should be
 353  * o maintain current state of phy ofdm or phy cck error reception.
 354  *   If the hardware detects any of these type of errors then
 355  *   ath5k_hw_get_rx_filter() will pass to us the respective
 356  *   hardware filters to be able to receive these type of frames.
 357  * o probe request frames are accepted only when operating in
 358  *   hostap, adhoc, or monitor modes
 359  * o enable promiscuous mode according to the interface state
 360  * o accept beacons:
 361  *   - when operating in adhoc mode so the 802.11 layer creates
 362  *     node table entries for peers,
 363  *   - when operating in station mode for collecting rssi data when
 364  *     the station is otherwise quiet, or
 365  *   - when scanning
 366  */
 367 static void
 368 ath5k_configure_filter(struct ieee80211_hw *hw, unsigned int changed_flags,
 369                        unsigned int *new_flags, u64 multicast)
 370 {
 371 #define SUPPORTED_FIF_FLAGS \
 372         (FIF_PROMISC_IN_BSS |  FIF_ALLMULTI | FIF_FCSFAIL | \
 373         FIF_PLCPFAIL | FIF_CONTROL | FIF_OTHER_BSS | \
 374         FIF_BCN_PRBRESP_PROMISC)
 375
 376         struct ath5k_hw *ah = hw->priv;
 377         u32 mfilt[2], rfilt;
 378         struct ath5k_vif_iter_data iter_data; /* to count STA interfaces */
 379
 380         mutex_lock(&ah->lock);
 381
 382         mfilt[0] = multicast;
 383         mfilt[1] = multicast >> 32;
 384
 385         /* Only deal with supported flags */
 386         changed_flags &= SUPPORTED_FIF_FLAGS;
 387         *new_flags &= SUPPORTED_FIF_FLAGS;
 388
 389         /* If HW detects any phy or radar errors, leave those filters on.
 390          * Also, always enable Unicast, Broadcasts and Multicast
 391          * XXX: move unicast, bssid broadcasts and multicast to mac80211 */
 392         rfilt = (ath5k_hw_get_rx_filter(ah) & (AR5K_RX_FILTER_PHYERR)) |
 393                 (AR5K_RX_FILTER_UCAST | AR5K_RX_FILTER_BCAST |
 394                 AR5K_RX_FILTER_MCAST);
 395
 396         if (changed_flags & (FIF_PROMISC_IN_BSS | FIF_OTHER_BSS)) {
 397                 if (*new_flags & FIF_PROMISC_IN_BSS)
 398                         __set_bit(ATH_STAT_PROMISC, ah->status);
 399                 else
 400                         __clear_bit(ATH_STAT_PROMISC, ah->status);
 401         }
 402
 403         if (test_bit(ATH_STAT_PROMISC, ah->status))
 404                 rfilt |= AR5K_RX_FILTER_PROM;
 405
 406         /* Note, AR5K_RX_FILTER_MCAST is already enabled */
 407         if (*new_flags & FIF_ALLMULTI) {
 408                 mfilt[0] =  ~0;
 409                 mfilt[1] =  ~0;
 410         }
 411
 412         /* This is the best we can do */
 413         if (*new_flags & (FIF_FCSFAIL | FIF_PLCPFAIL))
 414                 rfilt |= AR5K_RX_FILTER_PHYERR;
 415
 416         /* FIF_BCN_PRBRESP_PROMISC really means to enable beacons
 417         * and probes for any BSSID */
 418         if ((*new_flags & FIF_BCN_PRBRESP_PROMISC) || (ah->nvifs > 1))
 419                 rfilt |= AR5K_RX_FILTER_BEACON;
 420
 421         /* FIF_CONTROL doc says that if FIF_PROMISC_IN_BSS is not
 422          * set we should only pass on control frames for this
 423          * station. This needs testing. I believe right now this
 424          * enables *all* control frames, which is OK.. but
 425          * but we should see if we can improve on granularity */
 426         if (*new_flags & FIF_CONTROL)
 427                 rfilt |= AR5K_RX_FILTER_CONTROL;
 428
 429         /* Additional settings per mode -- this is per ath5k */
 430
 431         /* XXX move these to mac80211, and add a beacon IFF flag to mac80211 */
 432
 433         switch (ah->opmode) {
 434         case NL80211_IFTYPE_MESH_POINT:
 435                 rfilt |= AR5K_RX_FILTER_CONTROL |
 436                          AR5K_RX_FILTER_BEACON |
 437                          AR5K_RX_FILTER_PROBEREQ |
 438                          AR5K_RX_FILTER_PROM;
 439                 break;
 440         case NL80211_IFTYPE_AP:
 441         case NL80211_IFTYPE_ADHOC:
 442                 rfilt |= AR5K_RX_FILTER_PROBEREQ |
 443                          AR5K_RX_FILTER_BEACON;
 444                 break;
 445         case NL80211_IFTYPE_STATION:
 446                 if (ah->assoc)
 447                         rfilt |= AR5K_RX_FILTER_BEACON;
 448         default:
 449                 break;
 450         }
 451
 452         iter_data.hw_macaddr = NULL;
 453         iter_data.n_stas = 0;
 454         iter_data.need_set_hw_addr = false;
 455         ieee80211_iterate_active_interfaces_atomic(
 456                 ah->hw, IEEE80211_IFACE_ITER_RESUME_ALL,
 457                 ath5k_vif_iter, &iter_data);
 458
 459         /* Set up RX Filter */
 460         if (iter_data.n_stas > 1) {
 461                 /* If you have multiple STA interfaces connected to
 462                  * different APs, ARPs are not received (most of the time?)
 463                  * Enabling PROMISC appears to fix that problem.
 464                  */
 465                 rfilt |= AR5K_RX_FILTER_PROM;
 466         }
 467
 468         /* Set filters */
 469         ath5k_hw_set_rx_filter(ah, rfilt);
 470
 471         /* Set multicast bits */
 472         ath5k_hw_set_mcast_filter(ah, mfilt[0], mfilt[1]);
 473         /* Set the cached hw filter flags, this will later actually
 474          * be set in HW */
 475         ah->filter_flags = rfilt;
 476         /* Store current FIF filter flags */
 477         ah->fif_filter_flags = *new_flags;
 478
 479         mutex_unlock(&ah->lock);
 480 }
 481
 482
 483 static int
 484 ath5k_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
 485               struct ieee80211_vif *vif, struct ieee80211_sta *sta,
 486               struct ieee80211_key_conf *key)
 487 {
 488         struct ath5k_hw *ah = hw->priv;
 489         struct ath_common *common = ath5k_hw_common(ah);
 490         int ret = 0;
 491
 492         if (ath5k_modparam_nohwcrypt)
 493                 return -EOPNOTSUPP;
 494
 495         if (key->flags & IEEE80211_KEY_FLAG_RX_MGMT)
 496                 return -EOPNOTSUPP;
 497
 498         if (vif->type == NL80211_IFTYPE_ADHOC &&
 499             (key->cipher == WLAN_CIPHER_SUITE_TKIP ||
 500              key->cipher == WLAN_CIPHER_SUITE_CCMP) &&
 501             !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) {
 502                 /* don't program group keys when using IBSS_RSN */
 503                 return -EOPNOTSUPP;
 504         }
 505
 506         switch (key->cipher) {
 507         case WLAN_CIPHER_SUITE_WEP40:
 508         case WLAN_CIPHER_SUITE_WEP104:
 509         case WLAN_CIPHER_SUITE_TKIP:
 510                 break;
 511         case WLAN_CIPHER_SUITE_CCMP:
 512                 if (common->crypt_caps & ATH_CRYPT_CAP_CIPHER_AESCCM)
 513                         break;
 514                 return -EOPNOTSUPP;
 515         default:
 516                 WARN_ON(1);
 517                 return -EINVAL;
 518         }
 519
 520         mutex_lock(&ah->lock);
 521
 522         switch (cmd) {
 523         case SET_KEY:
 524                 ret = ath_key_config(common, vif, sta, key);
 525                 if (ret >= 0) {
 526                         key->hw_key_idx = ret;
 527                         /* push IV and Michael MIC generation to stack */
 528                         key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
 529                         if (key->cipher == WLAN_CIPHER_SUITE_TKIP)
 530                                 key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
 531                         if (key->cipher == WLAN_CIPHER_SUITE_CCMP)
 532                                 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX;
 533                         ret = 0;
 534                 }
 535                 break;
 536         case DISABLE_KEY:
 537                 ath_key_delete(common, key);
 538                 break;
 539         default:
 540                 ret = -EINVAL;
 541         }
 542
 543         mmiowb();
 544         mutex_unlock(&ah->lock);
 545         return ret;
 546 }
 547
 548
 549 static void
 550 ath5k_sw_scan_start(struct ieee80211_hw *hw,
 551                     struct ieee80211_vif *vif,
 552                     const u8 *mac_addr)
 553 {
 554         struct ath5k_hw *ah = hw->priv;
 555         if (!ah->assoc)
 556                 ath5k_hw_set_ledstate(ah, AR5K_LED_SCAN);
 557 }
 558
 559
 560 static void
 561 ath5k_sw_scan_complete(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
 562 {
 563         struct ath5k_hw *ah = hw->priv;
 564         ath5k_hw_set_ledstate(ah, ah->assoc ?
 565                 AR5K_LED_ASSOC : AR5K_LED_INIT);
 566 }
 567
 568
 569 static int
 570 ath5k_get_stats(struct ieee80211_hw *hw,
 571                 struct ieee80211_low_level_stats *stats)
 572 {
 573         struct ath5k_hw *ah = hw->priv;
 574
 575         /* Force update */
 576         ath5k_hw_update_mib_counters(ah);
 577
 578         stats->dot11ACKFailureCount = ah->stats.ack_fail;
 579         stats->dot11RTSFailureCount = ah->stats.rts_fail;
 580         stats->dot11RTSSuccessCount = ah->stats.rts_ok;
 581         stats->dot11FCSErrorCount = ah->stats.fcs_error;
 582
 583         return 0;
 584 }
 585
 586
 587 static int
 588 ath5k_conf_tx(struct ieee80211_hw *hw, struct ieee80211_vif *vif, u16 queue,
 589               const struct ieee80211_tx_queue_params *params)
 590 {
 591         struct ath5k_hw *ah = hw->priv;
 592         struct ath5k_txq_info qi;
 593         int ret = 0;
 594
 595         if (queue >= ah->ah_capabilities.cap_queues.q_tx_num)
 596                 return 0;
 597
 598         mutex_lock(&ah->lock);
 599
 600         ath5k_hw_get_tx_queueprops(ah, queue, &qi);
 601
 602         qi.tqi_aifs = params->aifs;
 603         qi.tqi_cw_min = params->cw_min;
 604         qi.tqi_cw_max = params->cw_max;
 605         qi.tqi_burst_time = params->txop * 32;
 606
 607         ATH5K_DBG(ah, ATH5K_DEBUG_ANY,
 608                   "Configure tx [queue %d],  "
 609                   "aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n",
 610                   queue, params->aifs, params->cw_min,
 611                   params->cw_max, params->txop);
 612
 613         if (ath5k_hw_set_tx_queueprops(ah, queue, &qi)) {
 614                 ATH5K_ERR(ah,
 615                           "Unable to update hardware queue %u!\n", queue);
 616                 ret = -EIO;
 617         } else
 618                 ath5k_hw_reset_tx_queue(ah, queue);
 619
 620         mutex_unlock(&ah->lock);
 621
 622         return ret;
 623 }
 624
 625
 626 static u64
 627 ath5k_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
 628 {
 629         struct ath5k_hw *ah = hw->priv;
 630
 631         return ath5k_hw_get_tsf64(ah);
 632 }
 633
 634
 635 static void
 636 ath5k_set_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif, u64 tsf)
 637 {
 638         struct ath5k_hw *ah = hw->priv;
 639
 640         ath5k_hw_set_tsf64(ah, tsf);
 641 }
 642
 643
 644 static void
 645 ath5k_reset_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
 646 {
 647         struct ath5k_hw *ah = hw->priv;
 648
 649         /*
 650          * in IBSS mode we need to update the beacon timers too.
 651          * this will also reset the TSF if we call it with 0
 652          */
 653         if (ah->opmode == NL80211_IFTYPE_ADHOC)
 654                 ath5k_beacon_update_timers(ah, 0);
 655         else
 656                 ath5k_hw_reset_tsf(ah);
 657 }
 658
 659
 660 static int
 661 ath5k_get_survey(struct ieee80211_hw *hw, int idx, struct survey_info *survey)
 662 {
 663         struct ath5k_hw *ah = hw->priv;
 664         struct ieee80211_conf *conf = &hw->conf;
 665         struct ath_common *common = ath5k_hw_common(ah);
 666         struct ath_cycle_counters *cc = &common->cc_survey;
 667         unsigned int div = common->clockrate * 1000;
 668
 669         if (idx != 0)
 670                 return -ENOENT;
 671
 672         spin_lock_bh(&common->cc_lock);
 673         ath_hw_cycle_counters_update(common);
 674         if (cc->cycles > 0) {
 675                 ah->survey.channel_time += cc->cycles / div;
 676                 ah->survey.channel_time_busy += cc->rx_busy / div;
 677                 ah->survey.channel_time_rx += cc->rx_frame / div;
 678                 ah->survey.channel_time_tx += cc->tx_frame / div;
 679         }
 680         memset(cc, 0, sizeof(*cc));
 681         spin_unlock_bh(&common->cc_lock);
 682
 683         memcpy(survey, &ah->survey, sizeof(*survey));
 684
 685         survey->channel = conf->chandef.chan;
 686         survey->noise = ah->ah_noise_floor;
 687         survey->filled = SURVEY_INFO_NOISE_DBM |
 688                         SURVEY_INFO_IN_USE |
 689                         SURVEY_INFO_CHANNEL_TIME |
 690                         SURVEY_INFO_CHANNEL_TIME_BUSY |
 691                         SURVEY_INFO_CHANNEL_TIME_RX |
 692                         SURVEY_INFO_CHANNEL_TIME_TX;
 693
 694         return 0;
 695 }
 696
 697
 698 /**
 699  * ath5k_set_coverage_class - Set IEEE 802.11 coverage class
 700  *
 701  * @hw: struct ieee80211_hw pointer
 702  * @coverage_class: IEEE 802.11 coverage class number
 703  *
 704  * Mac80211 callback. Sets slot time, ACK timeout and CTS timeout for given
 705  * coverage class. The values are persistent, they are restored after device
 706  * reset.
 707  */
 708 static void
 709 ath5k_set_coverage_class(struct ieee80211_hw *hw, s16 coverage_class)
 710 {
 711         struct ath5k_hw *ah = hw->priv;
 712
 713         mutex_lock(&ah->lock);
 714         ath5k_hw_set_coverage_class(ah, coverage_class);
 715         mutex_unlock(&ah->lock);
 716 }
 717
 718
 719 static int
 720 ath5k_set_antenna(struct ieee80211_hw *hw, u32 tx_ant, u32 rx_ant)
 721 {
 722         struct ath5k_hw *ah = hw->priv;
 723
 724         if (tx_ant == 1 && rx_ant == 1)
 725                 ath5k_hw_set_antenna_mode(ah, AR5K_ANTMODE_FIXED_A);
 726         else if (tx_ant == 2 && rx_ant == 2)
 727                 ath5k_hw_set_antenna_mode(ah, AR5K_ANTMODE_FIXED_B);
 728         else if ((tx_ant & 3) == 3 && (rx_ant & 3) == 3)
 729                 ath5k_hw_set_antenna_mode(ah, AR5K_ANTMODE_DEFAULT);
 730         else
 731                 return -EINVAL;
 732         return 0;
 733 }
 734
 735
 736 static int
 737 ath5k_get_antenna(struct ieee80211_hw *hw, u32 *tx_ant, u32 *rx_ant)
 738 {
 739         struct ath5k_hw *ah = hw->priv;
 740
 741         switch (ah->ah_ant_mode) {
 742         case AR5K_ANTMODE_FIXED_A:
 743                 *tx_ant = 1; *rx_ant = 1; break;
 744         case AR5K_ANTMODE_FIXED_B:
 745                 *tx_ant = 2; *rx_ant = 2; break;
 746         case AR5K_ANTMODE_DEFAULT:
 747                 *tx_ant = 3; *rx_ant = 3; break;
 748         }
 749         return 0;
 750 }
 751
 752
 753 static void ath5k_get_ringparam(struct ieee80211_hw *hw,
 754                                 u32 *tx, u32 *tx_max, u32 *rx, u32 *rx_max)
 755 {
 756         struct ath5k_hw *ah = hw->priv;
 757
 758         *tx = ah->txqs[AR5K_TX_QUEUE_ID_DATA_MIN].txq_max;
 759
 760         *tx_max = ATH5K_TXQ_LEN_MAX;
 761         *rx = *rx_max = ATH_RXBUF;
 762 }
 763
 764
 765 static int ath5k_set_ringparam(struct ieee80211_hw *hw, u32 tx, u32 rx)
 766 {
 767         struct ath5k_hw *ah = hw->priv;
 768         u16 qnum;
 769
 770         /* only support setting tx ring size for now */
 771         if (rx != ATH_RXBUF)
 772                 return -EINVAL;
 773
 774         /* restrict tx ring size min/max */
 775         if (!tx || tx > ATH5K_TXQ_LEN_MAX)
 776                 return -EINVAL;
 777
 778         for (qnum = 0; qnum < ARRAY_SIZE(ah->txqs); qnum++) {
 779                 if (!ah->txqs[qnum].setup)
 780                         continue;
 781                 if (ah->txqs[qnum].qnum < AR5K_TX_QUEUE_ID_DATA_MIN ||
 782                     ah->txqs[qnum].qnum > AR5K_TX_QUEUE_ID_DATA_MAX)
 783                         continue;
 784
 785                 ah->txqs[qnum].txq_max = tx;
 786                 if (ah->txqs[qnum].txq_len >= ah->txqs[qnum].txq_max)
 787                         ieee80211_stop_queue(hw, ah->txqs[qnum].qnum);
 788         }
 789
 790         return 0;
 791 }
 792
 793
 794 const struct ieee80211_ops ath5k_hw_ops = {
 795         .tx                     = ath5k_tx,
 796         .start                  = ath5k_start,
 797         .stop                   = ath5k_stop,
 798         .add_interface          = ath5k_add_interface,
 799         /* .change_interface    = not implemented */
 800         .remove_interface       = ath5k_remove_interface,
 801         .config                 = ath5k_config,
 802         .bss_info_changed       = ath5k_bss_info_changed,
 803         .prepare_multicast      = ath5k_prepare_multicast,
 804         .configure_filter       = ath5k_configure_filter,
 805         /* .set_tim             = not implemented */
 806         .set_key                = ath5k_set_key,
 807         /* .update_tkip_key     = not implemented */
 808         /* .hw_scan             = not implemented */
 809         .sw_scan_start          = ath5k_sw_scan_start,
 810         .sw_scan_complete       = ath5k_sw_scan_complete,
 811         .get_stats              = ath5k_get_stats,
 812         /* .get_tkip_seq        = not implemented */
 813         /* .set_frag_threshold  = not implemented */
 814         /* .set_rts_threshold   = not implemented */
 815         /* .sta_add             = not implemented */
 816         /* .sta_remove          = not implemented */
 817         /* .sta_notify          = not implemented */
 818         .conf_tx                = ath5k_conf_tx,
 819         .get_tsf                = ath5k_get_tsf,
 820         .set_tsf                = ath5k_set_tsf,
 821         .reset_tsf              = ath5k_reset_tsf,
 822         /* .tx_last_beacon      = not implemented */
 823         /* .ampdu_action        = not needed */
 824         .get_survey             = ath5k_get_survey,
 825         .set_coverage_class     = ath5k_set_coverage_class,
 826         /* .rfkill_poll         = not implemented */
 827         /* .flush               = not implemented */
 828         /* .channel_switch      = not implemented */
 829         /* .napi_poll           = not implemented */
 830         .set_antenna            = ath5k_set_antenna,
 831         .get_antenna            = ath5k_get_antenna,
 832         .set_ringparam          = ath5k_set_ringparam,
 833         .get_ringparam          = ath5k_get_ringparam,
 834 };