iwlwifi: 3945 remove iwl-3945-commands.h
[pandora-kernel.git] / drivers / net / wireless / iwlwifi / iwl-3945-rs.c
index 10c64bd..9d63cdb 100644 (file)
@@ -19,7 +19,7 @@
  * file called LICENSE.
  *
  * Contact Information:
- * James P. Ketrenos <ipw2100-admin@linux.intel.com>
+ *  Intel Linux Wireless <ilw@linux.intel.com>
  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  *
  *****************************************************************************/
@@ -36,8 +36,7 @@
 
 #include <linux/workqueue.h>
 
-#include "../net/mac80211/rate.h"
-
+#include "iwl-commands.h"
 #include "iwl-3945.h"
 
 #define RS_NAME "iwl-3945-rs"
@@ -65,6 +64,12 @@ struct iwl3945_rs_sta {
        u8 ibss_sta_added;
        struct timer_list rate_scale_flush;
        struct iwl3945_rate_scale_data win[IWL_RATE_COUNT];
+#ifdef CONFIG_MAC80211_DEBUGFS
+       struct dentry *rs_sta_dbgfs_stats_table_file;
+#endif
+
+       /* used to be in sta_info */
+       int last_txrate_idx;
 };
 
 static s32 iwl3945_expected_tpt_g[IWL_RATE_COUNT] = {
@@ -113,9 +118,11 @@ static struct iwl3945_tpt_entry iwl3945_tpt_table_g[] = {
 };
 
 #define IWL_RATE_MAX_WINDOW          62
-#define IWL_RATE_FLUSH        (3*HZ/10)
+#define IWL_RATE_FLUSH          (3*HZ)
 #define IWL_RATE_WIN_FLUSH       (HZ/2)
 #define IWL_RATE_HIGH_TH          11520
+#define IWL_SUCCESS_UP_TH         8960
+#define IWL_SUCCESS_DOWN_TH      10880
 #define IWL_RATE_MIN_FAILURE_TH       8
 #define IWL_RATE_MIN_SUCCESS_TH       8
 #define IWL_RATE_DECREASE_TH       1920
@@ -202,6 +209,7 @@ static int iwl3945_rate_scale_flush_windows(struct iwl3945_rs_sta *rs_sta)
 
 #define IWL_RATE_FLUSH_MAX              5000   /* msec */
 #define IWL_RATE_FLUSH_MIN              50     /* msec */
+#define IWL_AVERAGE_PACKETS             1500
 
 static void iwl3945_bg_rate_scale_flush(unsigned long data)
 {
@@ -216,8 +224,6 @@ static void iwl3945_bg_rate_scale_flush(unsigned long data)
 
        spin_lock_irqsave(&rs_sta->lock, flags);
 
-       rs_sta->flush_pending = 0;
-
        /* Number of packets Rx'd since last time this timer ran */
        packet_count = (rs_sta->tx_packets - rs_sta->last_tx_packets) + 1;
 
@@ -226,7 +232,6 @@ static void iwl3945_bg_rate_scale_flush(unsigned long data)
        if (unflushed) {
                duration =
                    jiffies_to_msecs(jiffies - rs_sta->last_partial_flush);
-/*              duration = jiffies_to_msecs(rs_sta->flush_time); */
 
                IWL_DEBUG_RATE("Tx'd %d packets in %dms\n",
                               packet_count, duration);
@@ -238,9 +243,11 @@ static void iwl3945_bg_rate_scale_flush(unsigned long data)
                        pps = 0;
 
                if (pps) {
-                       duration = IWL_RATE_FLUSH_MAX / pps;
+                       duration = (IWL_AVERAGE_PACKETS * 1000) / pps;
                        if (duration < IWL_RATE_FLUSH_MIN)
                                duration = IWL_RATE_FLUSH_MIN;
+                       else if (duration > IWL_RATE_FLUSH_MAX)
+                               duration = IWL_RATE_FLUSH_MAX;
                } else
                        duration = IWL_RATE_FLUSH_MAX;
 
@@ -253,8 +260,10 @@ static void iwl3945_bg_rate_scale_flush(unsigned long data)
                          rs_sta->flush_time);
 
                rs_sta->last_partial_flush = jiffies;
+       } else {
+               rs_sta->flush_time = IWL_RATE_FLUSH;
+               rs_sta->flush_pending = 0;
        }
-
        /* If there weren't any unflushed entries, we don't schedule the timer
         * to run again */
 
@@ -274,17 +283,18 @@ static void iwl3945_bg_rate_scale_flush(unsigned long data)
  */
 static void iwl3945_collect_tx_data(struct iwl3945_rs_sta *rs_sta,
                                struct iwl3945_rate_scale_data *window,
-                               int success, int retries)
+                               int success, int retries, int index)
 {
        unsigned long flags;
+       s32 fail_count;
 
        if (!retries) {
                IWL_DEBUG_RATE("leave: retries == 0 -- should be at least 1\n");
                return;
        }
 
+       spin_lock_irqsave(&rs_sta->lock, flags);
        while (retries--) {
-               spin_lock_irqsave(&rs_sta->lock, flags);
 
                /* If we have filled up the window then subtract one from the
                 * success counter if the high-bit is counting toward
@@ -312,13 +322,25 @@ static void iwl3945_collect_tx_data(struct iwl3945_rs_sta *rs_sta,
                /* Tag this window as having been updated */
                window->stamp = jiffies;
 
-               spin_unlock_irqrestore(&rs_sta->lock, flags);
        }
+
+       fail_count = window->counter - window->success_counter;
+       if ((fail_count >= IWL_RATE_MIN_FAILURE_TH) ||
+           (window->success_counter >= IWL_RATE_MIN_SUCCESS_TH))
+               window->average_tpt = ((window->success_ratio *
+                               rs_sta->expected_tpt[index] + 64) / 128);
+       else
+               window->average_tpt = IWL_INV_TPT;
+
+       spin_unlock_irqrestore(&rs_sta->lock, flags);
+
 }
 
-static void rs_rate_init(void *priv_rate, void *priv_sta,
-                        struct ieee80211_local *local, struct sta_info *sta)
+static void rs_rate_init(void *priv_r, struct ieee80211_supported_band *sband,
+                        struct ieee80211_sta *sta, void *priv_sta)
 {
+       struct iwl3945_rs_sta *rs_sta = priv_sta;
+       struct iwl3945_priv *priv = (struct iwl3945_priv *)priv_r;
        int i;
 
        IWL_DEBUG_RATE("enter\n");
@@ -328,25 +350,28 @@ static void rs_rate_init(void *priv_rate, void *priv_sta,
         * previous packets? Need to have IEEE 802.1X auth succeed immediately
         * after assoc.. */
 
-       for (i = IWL_RATE_COUNT - 1; i >= 0; i--) {
-               if (sta->supp_rates[local->hw.conf.channel->band] & (1 << i)) {
-                       sta->txrate_idx = i;
+       for (i = sband->n_bitrates - 1; i >= 0; i--) {
+               if (sta->supp_rates[sband->band] & (1 << i)) {
+                       rs_sta->last_txrate_idx = i;
                        break;
                }
        }
 
-       sta->last_txrate_idx = sta->txrate_idx;
-
+       priv->sta_supp_rates = sta->supp_rates[sband->band];
        /* For 5 GHz band it start at IWL_FIRST_OFDM_RATE */
-       if (local->hw.conf.channel->band == IEEE80211_BAND_5GHZ)
-               sta->last_txrate_idx += IWL_FIRST_OFDM_RATE;
+       if (sband->band == IEEE80211_BAND_5GHZ) {
+               rs_sta->last_txrate_idx += IWL_FIRST_OFDM_RATE;
+               priv->sta_supp_rates = priv->sta_supp_rates <<
+                                               IWL_FIRST_OFDM_RATE;
+       }
+
 
        IWL_DEBUG_RATE("leave\n");
 }
 
-static void *rs_alloc(struct ieee80211_local *local)
+static void *rs_alloc(struct ieee80211_hw *hw, struct dentry *debugfsdir)
 {
-       return local->hw.priv;
+       return hw->priv;
 }
 
 /* rate scale requires free function to be implemented */
@@ -354,17 +379,18 @@ static void rs_free(void *priv)
 {
        return;
 }
-static void rs_clear(void *priv)
-{
-       return;
-}
-
 
-static void *rs_alloc_sta(void *priv, gfp_t gfp)
+static void *rs_alloc_sta(void *priv, struct ieee80211_sta *sta, gfp_t gfp)
 {
        struct iwl3945_rs_sta *rs_sta;
+       struct iwl3945_sta_priv *psta = (void *) sta->drv_priv;
        int i;
 
+       /*
+        * XXX: If it's using sta->drv_priv anyway, it might
+        *      as well just put all the information there.
+        */
+
        IWL_DEBUG_RATE("enter\n");
 
        rs_sta = kzalloc(sizeof(struct iwl3945_rs_sta), gfp);
@@ -373,6 +399,8 @@ static void *rs_alloc_sta(void *priv, gfp_t gfp)
                return NULL;
        }
 
+       psta->rs_sta = rs_sta;
+
        spin_lock_init(&rs_sta->lock);
 
        rs_sta->start_rate = IWL_RATE_INVALID;
@@ -398,10 +426,14 @@ static void *rs_alloc_sta(void *priv, gfp_t gfp)
        return rs_sta;
 }
 
-static void rs_free_sta(void *priv, void *priv_sta)
+static void rs_free_sta(void *priv, struct ieee80211_sta *sta,
+                       void *priv_sta)
 {
+       struct iwl3945_sta_priv *psta = (void *) sta->drv_priv;
        struct iwl3945_rs_sta *rs_sta = priv_sta;
 
+       psta->rs_sta = NULL;
+
        IWL_DEBUG_RATE("enter\n");
        del_timer_sync(&rs_sta->rate_scale_flush);
        kfree(rs_sta);
@@ -409,78 +441,38 @@ static void rs_free_sta(void *priv, void *priv_sta)
 }
 
 
-/*
- * get ieee prev rate from rate scale table.
- * for A and B mode we need to overright prev
- * value
- */
-static int rs_adjust_next_rate(struct iwl3945_priv *priv, int rate)
-{
-       int next_rate = iwl3945_get_prev_ieee_rate(rate);
-
-       switch (priv->band) {
-       case IEEE80211_BAND_5GHZ:
-               if (rate == IWL_RATE_12M_INDEX)
-                       next_rate = IWL_RATE_9M_INDEX;
-               else if (rate == IWL_RATE_6M_INDEX)
-                       next_rate = IWL_RATE_6M_INDEX;
-               break;
-/* XXX cannot be invoked in current mac80211 so not a regression
-       case MODE_IEEE80211B:
-               if (rate == IWL_RATE_11M_INDEX_TABLE)
-                       next_rate = IWL_RATE_5M_INDEX_TABLE;
-               break;
- */
-       default:
-               break;
-       }
-
-       return next_rate;
-}
 /**
  * rs_tx_status - Update rate control values based on Tx results
  *
  * NOTE: Uses iwl3945_priv->retry_rate for the # of retries attempted by
  * the hardware for each rate.
  */
-static void rs_tx_status(void *priv_rate,
-                        struct net_device *dev,
+static void rs_tx_status(void *priv_rate, struct ieee80211_supported_band *sband,
+                        struct ieee80211_sta *sta, void *priv_sta,
                         struct sk_buff *skb)
 {
-       u8 retries, current_count;
+       s8 retries = 0, current_count;
        int scale_rate_index, first_index, last_index;
        unsigned long flags;
-       struct sta_info *sta;
-       struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
        struct iwl3945_priv *priv = (struct iwl3945_priv *)priv_rate;
-       struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
-       struct iwl3945_rs_sta *rs_sta;
-       struct ieee80211_supported_band *sband;
+       struct iwl3945_rs_sta *rs_sta = priv_sta;
        struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
 
        IWL_DEBUG_RATE("enter\n");
 
-       sband = local->hw.wiphy->bands[local->hw.conf.channel->band];
-
+       retries = info->status.rates[0].count;
 
-       retries = info->status.retry_count;
-       first_index = sband->bitrates[info->tx_rate_idx].hw_value;
+       first_index = sband->bitrates[info->status.rates[0].idx].hw_value;
        if ((first_index < 0) || (first_index >= IWL_RATE_COUNT)) {
                IWL_DEBUG_RATE("leave: Rate out of bounds: %d\n", first_index);
                return;
        }
 
-       rcu_read_lock();
-
-       sta = sta_info_get(local, hdr->addr1);
-       if (!sta || !sta->rate_ctrl_priv) {
-               rcu_read_unlock();
+       if (!priv_sta) {
                IWL_DEBUG_RATE("leave: No STA priv data to update!\n");
                return;
        }
 
-       rs_sta = (void *)sta->rate_ctrl_priv;
-
        rs_sta->tx_packets++;
 
        scale_rate_index = first_index;
@@ -496,13 +488,13 @@ static void rs_tx_status(void *priv_rate,
         * at which the frame was finally transmitted (or failed if no
         * ACK)
         */
-       while (retries > 0) {
-               if (retries < priv->retry_rate) {
-                       current_count = retries;
+       while (retries > 1) {
+               if ((retries - 1) < priv->retry_rate) {
+                       current_count = (retries - 1);
                        last_index = scale_rate_index;
                } else {
                        current_count = priv->retry_rate;
-                       last_index = rs_adjust_next_rate(priv,
+                       last_index = iwl3945_rs_next_rate(priv,
                                                         scale_rate_index);
                }
 
@@ -510,15 +502,13 @@ static void rs_tx_status(void *priv_rate,
                 * as was used for it (per current_count) */
                iwl3945_collect_tx_data(rs_sta,
                                    &rs_sta->win[scale_rate_index],
-                                   0, current_count);
+                                   0, current_count, scale_rate_index);
                IWL_DEBUG_RATE("Update rate %d for %d retries.\n",
                               scale_rate_index, current_count);
 
                retries -= current_count;
 
-               if (retries)
-                       scale_rate_index =
-                           rs_adjust_next_rate(priv, scale_rate_index);
+               scale_rate_index = last_index;
        }
 
 
@@ -529,7 +519,7 @@ static void rs_tx_status(void *priv_rate,
                       "success" : "failure");
        iwl3945_collect_tx_data(rs_sta,
                            &rs_sta->win[last_index],
-                           info->flags & IEEE80211_TX_STAT_ACK, 1);
+                           info->flags & IEEE80211_TX_STAT_ACK, 1, last_index);
 
        /* We updated the rate scale window -- if its been more than
         * flush_time since the last run, schedule the flush
@@ -537,9 +527,10 @@ static void rs_tx_status(void *priv_rate,
        spin_lock_irqsave(&rs_sta->lock, flags);
 
        if (!rs_sta->flush_pending &&
-           time_after(jiffies, rs_sta->last_partial_flush +
+           time_after(jiffies, rs_sta->last_flush +
                       rs_sta->flush_time)) {
 
+               rs_sta->last_partial_flush = jiffies;
                rs_sta->flush_pending = 1;
                mod_timer(&rs_sta->rate_scale_flush,
                          jiffies + rs_sta->flush_time);
@@ -547,8 +538,6 @@ static void rs_tx_status(void *priv_rate,
 
        spin_unlock_irqrestore(&rs_sta->lock, flags);
 
-       rcu_read_unlock();
-
        IWL_DEBUG_RATE("leave\n");
 
        return;
@@ -632,16 +621,16 @@ static u16 iwl3945_get_adjacent_rate(struct iwl3945_rs_sta *rs_sta,
  * rate table and must reference the driver allocated rate table
  *
  */
-static void rs_get_rate(void *priv_rate, struct net_device *dev,
-                       struct ieee80211_supported_band *sband,
-                       struct sk_buff *skb,
-                       struct rate_selection *sel)
+static void rs_get_rate(void *priv_r, struct ieee80211_sta *sta,
+                       void *priv_sta, struct ieee80211_tx_rate_control *txrc)
 {
+       struct ieee80211_supported_band *sband = txrc->sband;
+       struct sk_buff *skb = txrc->skb;
        u8 low = IWL_RATE_INVALID;
        u8 high = IWL_RATE_INVALID;
        u16 high_low;
        int index;
-       struct iwl3945_rs_sta *rs_sta;
+       struct iwl3945_rs_sta *rs_sta = priv_sta;
        struct iwl3945_rate_scale_data *window = NULL;
        int current_tpt = IWL_INV_TPT;
        int low_tpt = IWL_INV_TPT;
@@ -649,46 +638,45 @@ static void rs_get_rate(void *priv_rate, struct net_device *dev,
        u32 fail_count;
        s8 scale_action = 0;
        unsigned long flags;
-       struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
        struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
-       struct sta_info *sta;
-       u16 fc, rate_mask;
-       struct iwl3945_priv *priv = (struct iwl3945_priv *)priv_rate;
-       DECLARE_MAC_BUF(mac);
+       u16 fc;
+       u16 rate_mask = 0;
+       struct iwl3945_priv *priv = (struct iwl3945_priv *)priv_r;
+       struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
 
        IWL_DEBUG_RATE("enter\n");
 
-       rcu_read_lock();
-
-       sta = sta_info_get(local, hdr->addr1);
+       if (sta)
+               rate_mask = sta->supp_rates[sband->band];
 
        /* Send management frames and broadcast/multicast data using lowest
         * rate. */
        fc = le16_to_cpu(hdr->frame_control);
        if ((fc & IEEE80211_FCTL_FTYPE) != IEEE80211_FTYPE_DATA ||
            is_multicast_ether_addr(hdr->addr1) ||
-           !sta || !sta->rate_ctrl_priv) {
+           !sta || !priv_sta) {
                IWL_DEBUG_RATE("leave: No STA priv data to update!\n");
-               sel->rate_idx = rate_lowest_index(local, sband, sta);
-               rcu_read_unlock();
+               if (!rate_mask)
+                       info->control.rates[0].idx =
+                                       rate_lowest_index(sband, NULL);
+               else
+                       info->control.rates[0].idx =
+                                       rate_lowest_index(sband, sta);
                return;
        }
 
-       rate_mask = sta->supp_rates[sband->band];
-       index = min(sta->last_txrate_idx & 0xffff, IWL_RATE_COUNT - 1);
+       index = min(rs_sta->last_txrate_idx & 0xffff, IWL_RATE_COUNT - 1);
 
        if (sband->band == IEEE80211_BAND_5GHZ)
                rate_mask = rate_mask << IWL_FIRST_OFDM_RATE;
 
-       rs_sta = (void *)sta->rate_ctrl_priv;
-
-       if ((priv->iw_mode == IEEE80211_IF_TYPE_IBSS) &&
+       if ((priv->iw_mode == NL80211_IFTYPE_ADHOC) &&
            !rs_sta->ibss_sta_added) {
                u8 sta_id = iwl3945_hw_find_station(priv, hdr->addr1);
 
                if (sta_id == IWL_INVALID_STATION) {
-                       IWL_DEBUG_RATE("LQ: ADD station %s\n",
-                                      print_mac(mac, hdr->addr1));
+                       IWL_DEBUG_RATE("LQ: ADD station %pm\n",
+                                      hdr->addr1);
                        sta_id = iwl3945_add_station(priv,
                                    hdr->addr1, 0, CMD_ASYNC);
                }
@@ -698,8 +686,13 @@ static void rs_get_rate(void *priv_rate, struct net_device *dev,
 
        spin_lock_irqsave(&rs_sta->lock, flags);
 
+       /* for recent assoc, choose best rate regarding
+        * to rssi value
+        */
        if (rs_sta->start_rate != IWL_RATE_INVALID) {
-               index = rs_sta->start_rate;
+               if (rs_sta->start_rate < index &&
+                  (rate_mask & (1 << rs_sta->start_rate)))
+                       index = rs_sta->start_rate;
                rs_sta->start_rate = IWL_RATE_INVALID;
        }
 
@@ -709,7 +702,6 @@ static void rs_get_rate(void *priv_rate, struct net_device *dev,
 
        if (((fail_count <= IWL_RATE_MIN_FAILURE_TH) &&
             (window->success_counter < IWL_RATE_MIN_SUCCESS_TH))) {
-               window->average_tpt = IWL_INV_TPT;
                spin_unlock_irqrestore(&rs_sta->lock, flags);
 
                IWL_DEBUG_RATE("Invalid average_tpt on rate %d: "
@@ -723,8 +715,6 @@ static void rs_get_rate(void *priv_rate, struct net_device *dev,
 
        }
 
-       window->average_tpt = ((window->success_ratio *
-                               rs_sta->expected_tpt[index] + 64) / 128);
        current_tpt = window->average_tpt;
 
        high_low = iwl3945_get_adjacent_rate(rs_sta, index, rate_mask,
@@ -772,13 +762,15 @@ static void rs_get_rate(void *priv_rate, struct net_device *dev,
                }
        }
 
-       if ((window->success_ratio > IWL_RATE_HIGH_TH) ||
-           (current_tpt > window->average_tpt)) {
-               IWL_DEBUG_RATE("No action -- success_ratio [%d] > HIGH_TH or "
-                              "current_tpt [%d] > average_tpt [%d]\n",
-                              window->success_ratio,
-                              current_tpt, window->average_tpt);
-               scale_action = 0;
+       if (scale_action == -1) {
+               if (window->success_ratio > IWL_SUCCESS_DOWN_TH)
+                       scale_action = 0;
+       } else if (scale_action == 1) {
+               if (window->success_ratio < IWL_SUCCESS_UP_TH) {
+                       IWL_DEBUG_RATE("No action -- success_ratio [%d] < "
+                              "SUCCESS UP\n", window->success_ratio);
+                       scale_action = 0;
+               }
        }
 
        switch (scale_action) {
@@ -803,140 +795,108 @@ static void rs_get_rate(void *priv_rate, struct net_device *dev,
 
  out:
 
-       sta->last_txrate_idx = index;
+       rs_sta->last_txrate_idx = index;
        if (sband->band == IEEE80211_BAND_5GHZ)
-               sta->txrate_idx = sta->last_txrate_idx - IWL_FIRST_OFDM_RATE;
+               info->control.rates[0].idx = rs_sta->last_txrate_idx -
+                               IWL_FIRST_OFDM_RATE;
        else
-               sta->txrate_idx = sta->last_txrate_idx;
-
-       rcu_read_unlock();
+               info->control.rates[0].idx = rs_sta->last_txrate_idx;
 
        IWL_DEBUG_RATE("leave: %d\n", index);
+}
+
+#ifdef CONFIG_MAC80211_DEBUGFS
+static int iwl3945_open_file_generic(struct inode *inode, struct file *file)
+{
+       file->private_data = inode->i_private;
+       return 0;
+}
+
+static ssize_t iwl3945_sta_dbgfs_stats_table_read(struct file *file,
+                                                 char __user *user_buf,
+                                                 size_t count, loff_t *ppos)
+{
+       char buff[1024];
+       int desc = 0;
+       int j;
+       struct iwl3945_rs_sta *lq_sta = file->private_data;
+
+       desc += sprintf(buff + desc, "tx packets=%d last rate index=%d\n"
+                       "rate=0x%X flush time %d\n",
+                       lq_sta->tx_packets,
+                       lq_sta->last_txrate_idx,
+                       lq_sta->start_rate, jiffies_to_msecs(lq_sta->flush_time));
+       for (j = 0; j < IWL_RATE_COUNT; j++) {
+               desc += sprintf(buff+desc,
+                               "counter=%d success=%d %%=%d\n",
+                               lq_sta->win[j].counter,
+                               lq_sta->win[j].success_counter,
+                               lq_sta->win[j].success_ratio);
+       }
+       return simple_read_from_buffer(user_buf, count, ppos, buff, desc);
+}
+
+static const struct file_operations rs_sta_dbgfs_stats_table_ops = {
+       .read = iwl3945_sta_dbgfs_stats_table_read,
+       .open = iwl3945_open_file_generic,
+};
+
+static void iwl3945_add_debugfs(void *priv, void *priv_sta,
+                               struct dentry *dir)
+{
+       struct iwl3945_rs_sta *lq_sta = priv_sta;
+
+       lq_sta->rs_sta_dbgfs_stats_table_file =
+               debugfs_create_file("rate_stats_table", 0600, dir,
+               lq_sta, &rs_sta_dbgfs_stats_table_ops);
 
-       sel->rate_idx = sta->txrate_idx;
 }
 
+static void iwl3945_remove_debugfs(void *priv, void *priv_sta)
+{
+       struct iwl3945_rs_sta *lq_sta = priv_sta;
+       debugfs_remove(lq_sta->rs_sta_dbgfs_stats_table_file);
+}
+#endif
+
 static struct rate_control_ops rs_ops = {
        .module = NULL,
        .name = RS_NAME,
        .tx_status = rs_tx_status,
        .get_rate = rs_get_rate,
        .rate_init = rs_rate_init,
-       .clear = rs_clear,
        .alloc = rs_alloc,
        .free = rs_free,
        .alloc_sta = rs_alloc_sta,
        .free_sta = rs_free_sta,
-};
-
-int iwl3945_fill_rs_info(struct ieee80211_hw *hw, char *buf, u8 sta_id)
-{
-       struct ieee80211_local *local = hw_to_local(hw);
-       struct iwl3945_priv *priv = hw->priv;
-       struct iwl3945_rs_sta *rs_sta;
-       struct sta_info *sta;
-       unsigned long flags;
-       int count = 0, i;
-       u32 samples = 0, success = 0, good = 0;
-       unsigned long now = jiffies;
-       u32 max_time = 0;
+#ifdef CONFIG_MAC80211_DEBUGFS
+       .add_sta_debugfs = iwl3945_add_debugfs,
+       .remove_sta_debugfs = iwl3945_remove_debugfs,
+#endif
 
-       rcu_read_lock();
-
-       sta = sta_info_get(local, priv->stations[sta_id].sta.sta.addr);
-       if (!sta || !sta->rate_ctrl_priv) {
-               if (sta)
-                       IWL_DEBUG_RATE("leave - no private rate data!\n");
-               else
-                       IWL_DEBUG_RATE("leave - no station!\n");
-               rcu_read_unlock();
-               return sprintf(buf, "station %d not found\n", sta_id);
-       }
-
-       rs_sta = (void *)sta->rate_ctrl_priv;
-       spin_lock_irqsave(&rs_sta->lock, flags);
-       i = IWL_RATE_54M_INDEX;
-       while (1) {
-               u64 mask;
-               int j;
-
-               count +=
-                   sprintf(&buf[count], " %2dMbs: ", iwl3945_rates[i].ieee / 2);
-
-               mask = (1ULL << (IWL_RATE_MAX_WINDOW - 1));
-               for (j = 0; j < IWL_RATE_MAX_WINDOW; j++, mask >>= 1)
-                       buf[count++] =
-                           (rs_sta->win[i].data & mask) ? '1' : '0';
-
-               samples += rs_sta->win[i].counter;
-               good += rs_sta->win[i].success_counter;
-               success += rs_sta->win[i].success_counter *
-                                               iwl3945_rates[i].ieee;
-
-               if (rs_sta->win[i].stamp) {
-                       int delta =
-                           jiffies_to_msecs(now - rs_sta->win[i].stamp);
-
-                       if (delta > max_time)
-                               max_time = delta;
-
-                       count += sprintf(&buf[count], "%5dms\n", delta);
-               } else
-                       buf[count++] = '\n';
-
-               j = iwl3945_get_prev_ieee_rate(i);
-               if (j == i)
-                       break;
-               i = j;
-       }
-       spin_unlock_irqrestore(&rs_sta->lock, flags);
-       rcu_read_unlock();
-
-       /* Display the average rate of all samples taken.
-        *
-        * NOTE:  We multiple # of samples by 2 since the IEEE measurement
-        * added from iwl3945_rates is actually 2X the rate */
-       if (samples)
-               count += sprintf(
-                       &buf[count],
-                       "\nAverage rate is %3d.%02dMbs over last %4dms\n"
-                       "%3d%% success (%d good packets over %d tries)\n",
-                       success / (2 * samples), (success * 5 / samples) % 10,
-                       max_time, good * 100 / samples, good, samples);
-       else
-               count += sprintf(&buf[count], "\nAverage rate: 0Mbs\n");
-
-       return count;
-}
+};
 
 void iwl3945_rate_scale_init(struct ieee80211_hw *hw, s32 sta_id)
 {
        struct iwl3945_priv *priv = hw->priv;
        s32 rssi = 0;
        unsigned long flags;
-       struct ieee80211_local *local = hw_to_local(hw);
        struct iwl3945_rs_sta *rs_sta;
-       struct sta_info *sta;
+       struct ieee80211_sta *sta;
+       struct iwl3945_sta_priv *psta;
 
        IWL_DEBUG_RATE("enter\n");
 
-       if (!local->rate_ctrl->ops->name ||
-           strcmp(local->rate_ctrl->ops->name, RS_NAME)) {
-               IWL_WARNING("iwl-3945-rs not selected as rate control algo!\n");
-               IWL_DEBUG_RATE("leave - mac80211 picked the wrong RC algo.\n");
-               return;
-       }
-
        rcu_read_lock();
 
-       sta = sta_info_get(local, priv->stations[sta_id].sta.sta.addr);
-       if (!sta || !sta->rate_ctrl_priv) {
-               IWL_DEBUG_RATE("leave - no private rate data!\n");
+       sta = ieee80211_find_sta(hw, priv->stations[sta_id].sta.sta.addr);
+       if (!sta) {
                rcu_read_unlock();
                return;
        }
 
-       rs_sta = (void *)sta->rate_ctrl_priv;
+       psta = (void *) sta->drv_priv;
+       rs_sta = psta->rs_sta;
 
        spin_lock_irqsave(&rs_sta->lock, flags);
 
@@ -959,7 +919,6 @@ void iwl3945_rate_scale_init(struct ieee80211_hw *hw, s32 sta_id)
                break;
        }
 
-       rcu_read_unlock();
        spin_unlock_irqrestore(&rs_sta->lock, flags);
 
        rssi = priv->last_rx_rssi;
@@ -973,6 +932,7 @@ void iwl3945_rate_scale_init(struct ieee80211_hw *hw, s32 sta_id)
        IWL_DEBUG_RATE("leave: rssi %d assign rate index: "
                       "%d (plcp 0x%x)\n", rssi, rs_sta->start_rate,
                       iwl3945_rates[rs_sta->start_rate].plcp);
+       rcu_read_unlock();
 }
 
 int iwl3945_rate_control_register(void)