iwl3945: use iwl_set_mode in 3945
[safe/jmp/linux-2.6] / drivers / net / wireless / iwlwifi / iwl-3945-rs.c
index 45ce3ff..f63a9c5 100644 (file)
@@ -124,9 +124,10 @@ static struct iwl3945_tpt_entry iwl3945_tpt_table_g[] = {
 #define IWL39_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_FAILURE_TH       6
 #define IWL_RATE_MIN_SUCCESS_TH       8
 #define IWL_RATE_DECREASE_TH       1920
+#define IWL_RATE_RETRY_TH           15
 
 static u8 iwl3945_get_rate_index_by_rssi(s32 rssi, enum ieee80211_band band)
 {
@@ -197,7 +198,7 @@ static int iwl3945_rate_scale_flush_windows(struct iwl3945_rs_sta *rs_sta)
                spin_lock_irqsave(&rs_sta->lock, flags);
                if (time_after(jiffies, rs_sta->win[i].stamp +
                               IWL_RATE_WIN_FLUSH)) {
-                       IWL_DEBUG_RATE("flushing %d samples of rate "
+                       IWL_DEBUG_RATE(priv, "flushing %d samples of rate "
                                       "index %d\n",
                                       rs_sta->win[i].counter, i);
                        iwl3945_clear_window(&rs_sta->win[i]);
@@ -221,7 +222,7 @@ static void iwl3945_bg_rate_scale_flush(unsigned long data)
        unsigned long flags;
        u32 packet_count, duration, pps;
 
-       IWL_DEBUG_RATE("enter\n");
+       IWL_DEBUG_RATE(priv, "enter\n");
 
        unflushed = iwl3945_rate_scale_flush_windows(rs_sta);
 
@@ -236,7 +237,7 @@ static void iwl3945_bg_rate_scale_flush(unsigned long data)
                duration =
                    jiffies_to_msecs(jiffies - rs_sta->last_partial_flush);
 
-               IWL_DEBUG_RATE("Tx'd %d packets in %dms\n",
+               IWL_DEBUG_RATE(priv, "Tx'd %d packets in %dms\n",
                               packet_count, duration);
 
                /* Determine packets per second */
@@ -256,7 +257,7 @@ static void iwl3945_bg_rate_scale_flush(unsigned long data)
 
                rs_sta->flush_time = msecs_to_jiffies(duration);
 
-               IWL_DEBUG_RATE("new flush period: %d msec ave %d\n",
+               IWL_DEBUG_RATE(priv, "new flush period: %d msec ave %d\n",
                               duration, packet_count);
 
                mod_timer(&rs_sta->rate_scale_flush, jiffies +
@@ -274,7 +275,7 @@ static void iwl3945_bg_rate_scale_flush(unsigned long data)
 
        spin_unlock_irqrestore(&rs_sta->lock, flags);
 
-       IWL_DEBUG_RATE("leave\n");
+       IWL_DEBUG_RATE(priv, "leave\n");
 }
 
 /**
@@ -293,42 +294,58 @@ static void iwl3945_collect_tx_data(struct iwl3945_rs_sta *rs_sta,
        struct iwl_priv *priv __maybe_unused = rs_sta->priv;
 
        if (!retries) {
-               IWL_DEBUG_RATE("leave: retries == 0 -- should be at least 1\n");
+               IWL_DEBUG_RATE(priv, "leave: retries == 0 -- should be at least 1\n");
                return;
        }
 
        spin_lock_irqsave(&rs_sta->lock, flags);
-       while (retries--) {
 
-               /* If we have filled up the window then subtract one from the
-                * success counter if the high-bit is counting toward
-                * success */
-               if (window->counter == IWL_RATE_MAX_WINDOW) {
-                       if (window->data & (1ULL << (IWL_RATE_MAX_WINDOW - 1)))
+       /*
+        * Keep track of only the latest 62 tx frame attempts in this rate's
+        * history window; anything older isn't really relevant any more.
+        * If we have filled up the sliding window, drop the oldest attempt;
+        * if the oldest attempt (highest bit in bitmap) shows "success",
+        * subtract "1" from the success counter (this is the main reason
+        * we keep these bitmaps!).
+        * */
+       while (retries > 0) {
+               if (window->counter >= IWL_RATE_MAX_WINDOW) {
+
+                       /* remove earliest */
+                       window->counter = IWL_RATE_MAX_WINDOW - 1;
+
+                       if (window->data & (1ULL << (IWL_RATE_MAX_WINDOW - 1))) {
+                               window->data &= ~(1ULL << (IWL_RATE_MAX_WINDOW - 1));
                                window->success_counter--;
-               } else
-                       window->counter++;
+                       }
+               }
 
-               /* Slide the window to the left one bit */
-               window->data = (window->data << 1);
+               /* Increment frames-attempted counter */
+               window->counter++;
 
-               /* If this packet was a success then set the low bit high */
-               if (success) {
+               /* Shift bitmap by one frame (throw away oldest history),
+                * OR in "1", and increment "success" if this
+                * frame was successful. */
+               window->data <<= 1;
+               if (success > 0) {
                        window->success_counter++;
-                       window->data |= 1;
+                       window->data |= 0x1;
+                       success--;
                }
 
-               /* window->counter can't be 0 -- it is either >0 or
-                * IWL_RATE_MAX_WINDOW */
-               window->success_ratio = 12800 * window->success_counter /
-                   window->counter;
-
-               /* Tag this window as having been updated */
-               window->stamp = jiffies;
-
+               retries--;
        }
 
+       /* Calculate current success ratio, avoid divide-by-0! */
+       if (window->counter > 0)
+               window->success_ratio = 128 * (100 * window->success_counter)
+                                       / window->counter;
+       else
+               window->success_ratio = IWL_INVALID_VALUE;
+
        fail_count = window->counter - window->success_counter;
+
+       /* Calculate average throughput, if we have enough history. */
        if ((fail_count >= IWL_RATE_MIN_FAILURE_TH) ||
            (window->success_counter >= IWL_RATE_MIN_SUCCESS_TH))
                window->average_tpt = ((window->success_ratio *
@@ -336,6 +353,9 @@ static void iwl3945_collect_tx_data(struct iwl3945_rs_sta *rs_sta,
        else
                window->average_tpt = IWL_INVALID_VALUE;
 
+       /* Tag this window as having been updated */
+       window->stamp = jiffies;
+
        spin_unlock_irqrestore(&rs_sta->lock, flags);
 
 }
@@ -347,7 +367,7 @@ static void rs_rate_init(void *priv_r, struct ieee80211_supported_band *sband,
        struct iwl_priv *priv = (struct iwl_priv *)priv_r;
        int i;
 
-       IWL_DEBUG_RATE("enter\n");
+       IWL_DEBUG_RATE(priv, "enter\n");
 
        /* TODO: what is a good starting rate for STA? About middle? Maybe not
         * the lowest or the highest rate.. Could consider using RSSI from
@@ -370,7 +390,7 @@ static void rs_rate_init(void *priv_r, struct ieee80211_supported_band *sband,
        }
 
 
-       IWL_DEBUG_RATE("leave\n");
+       IWL_DEBUG_RATE(priv, "leave\n");
 }
 
 static void *rs_alloc(struct ieee80211_hw *hw, struct dentry *debugfsdir)
@@ -396,11 +416,11 @@ static void *rs_alloc_sta(void *iwl_priv, struct ieee80211_sta *sta, gfp_t gfp)
         *      as well just put all the information there.
         */
 
-       IWL_DEBUG_RATE("enter\n");
+       IWL_DEBUG_RATE(priv, "enter\n");
 
        rs_sta = kzalloc(sizeof(struct iwl3945_rs_sta), gfp);
        if (!rs_sta) {
-               IWL_DEBUG_RATE("leave: ENOMEM\n");
+               IWL_DEBUG_RATE(priv, "leave: ENOMEM\n");
                return NULL;
        }
 
@@ -428,7 +448,7 @@ static void *rs_alloc_sta(void *iwl_priv, struct ieee80211_sta *sta, gfp_t gfp)
        for (i = 0; i < IWL_RATE_COUNT_3945; i++)
                iwl3945_clear_window(&rs_sta->win[i]);
 
-       IWL_DEBUG_RATE("leave\n");
+       IWL_DEBUG_RATE(priv, "leave\n");
 
        return rs_sta;
 }
@@ -442,10 +462,10 @@ static void rs_free_sta(void *iwl_priv, struct ieee80211_sta *sta,
 
        psta->rs_sta = NULL;
 
-       IWL_DEBUG_RATE("enter\n");
+       IWL_DEBUG_RATE(priv, "enter\n");
        del_timer_sync(&rs_sta->rate_scale_flush);
        kfree(rs_sta);
-       IWL_DEBUG_RATE("leave\n");
+       IWL_DEBUG_RATE(priv, "leave\n");
 }
 
 
@@ -466,18 +486,21 @@ static void rs_tx_status(void *priv_rate, 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");
+       IWL_DEBUG_RATE(priv, "enter\n");
 
        retries = info->status.rates[0].count;
+       /* Sanity Check for retries */
+       if (retries > IWL_RATE_RETRY_TH)
+               retries = IWL_RATE_RETRY_TH;
 
        first_index = sband->bitrates[info->status.rates[0].idx].hw_value;
        if ((first_index < 0) || (first_index >= IWL_RATE_COUNT_3945)) {
-               IWL_DEBUG_RATE("leave: Rate out of bounds: %d\n", first_index);
+               IWL_DEBUG_RATE(priv, "leave: Rate out of bounds: %d\n", first_index);
                return;
        }
 
        if (!priv_sta) {
-               IWL_DEBUG_RATE("leave: No STA priv data to update!\n");
+               IWL_DEBUG_RATE(priv, "leave: No STA priv data to update!\n");
                return;
        }
 
@@ -511,7 +534,7 @@ static void rs_tx_status(void *priv_rate, struct ieee80211_supported_band *sband
                iwl3945_collect_tx_data(rs_sta,
                                    &rs_sta->win[scale_rate_index],
                                    0, current_count, scale_rate_index);
-               IWL_DEBUG_RATE("Update rate %d for %d retries.\n",
+               IWL_DEBUG_RATE(priv, "Update rate %d for %d retries.\n",
                               scale_rate_index, current_count);
 
                retries -= current_count;
@@ -521,7 +544,7 @@ static void rs_tx_status(void *priv_rate, struct ieee80211_supported_band *sband
 
 
        /* Update the last index window with success/failure based on ACK */
-       IWL_DEBUG_RATE("Update rate %d with %s.\n",
+       IWL_DEBUG_RATE(priv, "Update rate %d with %s.\n",
                       last_index,
                       (info->flags & IEEE80211_TX_STAT_ACK) ?
                       "success" : "failure");
@@ -546,7 +569,7 @@ static void rs_tx_status(void *priv_rate, struct ieee80211_supported_band *sband
 
        spin_unlock_irqrestore(&rs_sta->lock, flags);
 
-       IWL_DEBUG_RATE("leave\n");
+       IWL_DEBUG_RATE(priv, "leave\n");
 
        return;
 }
@@ -596,7 +619,7 @@ static u16 iwl3945_get_adjacent_rate(struct iwl3945_rs_sta *rs_sta,
                        break;
                if (rate_mask & (1 << low))
                        break;
-               IWL_DEBUG_RATE("Skipping masked lower rate: %d\n", low);
+               IWL_DEBUG_RATE(priv, "Skipping masked lower rate: %d\n", low);
        }
 
        high = index;
@@ -609,7 +632,7 @@ static u16 iwl3945_get_adjacent_rate(struct iwl3945_rs_sta *rs_sta,
                        break;
                if (rate_mask & (1 << high))
                        break;
-               IWL_DEBUG_RATE("Skipping masked higher rate: %d\n", high);
+               IWL_DEBUG_RATE(priv, "Skipping masked higher rate: %d\n", high);
        }
 
        return (high << 8) | low;
@@ -655,7 +678,7 @@ static void rs_get_rate(void *priv_r, struct ieee80211_sta *sta,
        struct iwl_priv *priv = (struct iwl_priv *)priv_r;
        struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
 
-       IWL_DEBUG_RATE("enter\n");
+       IWL_DEBUG_RATE(priv, "enter\n");
 
        if (sta)
                rate_mask = sta->supp_rates[sband->band];
@@ -666,7 +689,7 @@ static void rs_get_rate(void *priv_r, struct ieee80211_sta *sta,
        if ((fc & IEEE80211_FCTL_FTYPE) != IEEE80211_FTYPE_DATA ||
            is_multicast_ether_addr(hdr->addr1) ||
            !sta || !priv_sta) {
-               IWL_DEBUG_RATE("leave: No STA priv data to update!\n");
+               IWL_DEBUG_RATE(priv, "leave: No STA priv data to update!\n");
                if (!rate_mask)
                        info->control.rates[0].idx =
                                        rate_lowest_index(sband, NULL);
@@ -693,10 +716,10 @@ static void rs_get_rate(void *priv_r, struct ieee80211_sta *sta,
                u8 sta_id = iwl3945_hw_find_station(priv, hdr->addr1);
 
                if (sta_id == IWL_INVALID_STATION) {
-                       IWL_DEBUG_RATE("LQ: ADD station %pm\n",
+                       IWL_DEBUG_RATE(priv, "LQ: ADD station %pm\n",
                                       hdr->addr1);
                        sta_id = iwl3945_add_station(priv,
-                                   hdr->addr1, 0, CMD_ASYNC);
+                                   hdr->addr1, 0, CMD_ASYNC, NULL);
                }
                if (sta_id != IWL_INVALID_STATION)
                        rs_sta->ibss_sta_added = 1;
@@ -724,17 +747,20 @@ static void rs_get_rate(void *priv_r, struct ieee80211_sta *sta,
 
        fail_count = window->counter - window->success_counter;
 
-       if (((fail_count <= IWL_RATE_MIN_FAILURE_TH) &&
+       if (((fail_count < IWL_RATE_MIN_FAILURE_TH) &&
             (window->success_counter < IWL_RATE_MIN_SUCCESS_TH))) {
                spin_unlock_irqrestore(&rs_sta->lock, flags);
 
-               IWL_DEBUG_RATE("Invalid average_tpt on rate %d: "
+               IWL_DEBUG_RATE(priv, "Invalid average_tpt on rate %d: "
                               "counter: %d, success_counter: %d, "
                               "expected_tpt is %sNULL\n",
                               index,
                               window->counter,
                               window->success_counter,
                               rs_sta->expected_tpt ? "not " : "");
+
+          /* Can't calculate this yet; not enough history */
+               window->average_tpt = IWL_INVALID_VALUE;
                goto out;
 
        }
@@ -750,6 +776,7 @@ static void rs_get_rate(void *priv_r, struct ieee80211_sta *sta,
        if ((max_rate_idx != -1) && (max_rate_idx < high))
                high = IWL_RATE_INVALID;
 
+       /* Collect Measured throughputs of adjacent rates */
        if (low != IWL_RATE_INVALID)
                low_tpt = rs_sta->win[low].average_tpt;
 
@@ -758,58 +785,78 @@ static void rs_get_rate(void *priv_r, struct ieee80211_sta *sta,
 
        spin_unlock_irqrestore(&rs_sta->lock, flags);
 
-       scale_action = 1;
+       scale_action = 0;
 
+       /* Low success ratio , need to drop the rate */
        if ((window->success_ratio < IWL_RATE_DECREASE_TH) || !current_tpt) {
-               IWL_DEBUG_RATE("decrease rate because of low success_ratio\n");
+               IWL_DEBUG_RATE(priv, "decrease rate because of low success_ratio\n");
                scale_action = -1;
+       /* No throughput measured yet for adjacent rates,
+        * try increase */
        } else if ((low_tpt == IWL_INVALID_VALUE) &&
-                  (high_tpt == IWL_INVALID_VALUE))
-               scale_action = 1;
-       else if ((low_tpt != IWL_INVALID_VALUE) &&
+                  (high_tpt == IWL_INVALID_VALUE)) {
+
+               if (high != IWL_RATE_INVALID && window->success_ratio >= IWL_RATE_INCREASE_TH)
+                       scale_action = 1;
+               else if (low != IWL_RATE_INVALID)
+                       scale_action = 0;
+
+       /* Both adjacent throughputs are measured, but neither one has
+        * better throughput; we're using the best rate, don't change
+        * it! */
+       } else if ((low_tpt != IWL_INVALID_VALUE) &&
                 (high_tpt != IWL_INVALID_VALUE) &&
                 (low_tpt < current_tpt) && (high_tpt < current_tpt)) {
-               IWL_DEBUG_RATE("No action -- low [%d] & high [%d] < "
+
+               IWL_DEBUG_RATE(priv, "No action -- low [%d] & high [%d] < "
                               "current_tpt [%d]\n",
                               low_tpt, high_tpt, current_tpt);
                scale_action = 0;
+
+       /* At least one of the rates has better throughput */
        } else {
                if (high_tpt != IWL_INVALID_VALUE) {
-                       if (high_tpt > current_tpt)
+
+                       /* High rate has better throughput, Increase
+                        * rate */
+                       if (high_tpt > current_tpt &&
+                               window->success_ratio >= IWL_RATE_INCREASE_TH)
                                scale_action = 1;
                        else {
-                               IWL_DEBUG_RATE
-                                   ("decrease rate because of high tpt\n");
-                               scale_action = -1;
+                               IWL_DEBUG_RATE(priv,
+                                   "decrease rate because of high tpt\n");
+                               scale_action = 0;
                        }
                } else if (low_tpt != IWL_INVALID_VALUE) {
                        if (low_tpt > current_tpt) {
-                               IWL_DEBUG_RATE
-                                   ("decrease rate because of low tpt\n");
+                               IWL_DEBUG_RATE(priv,
+                                   "decrease rate because of low tpt\n");
                                scale_action = -1;
-                       } else
+                       } else if (window->success_ratio >= IWL_RATE_INCREASE_TH) {
+                               /* Lower rate has better
+                                * throughput,decrease rate */
                                scale_action = 1;
+                       }
                }
        }
 
-       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;
-               }
-       }
+       /* Sanity check; asked for decrease, but success rate or throughput
+        * has been good at old rate.  Don't change it. */
+       if ((scale_action == -1) && (low != IWL_RATE_INVALID) &&
+                   ((window->success_ratio > IWL_RATE_HIGH_TH) ||
+                    (current_tpt > (100 * rs_sta->expected_tpt[low]))))
+               scale_action = 0;
 
        switch (scale_action) {
        case -1:
+
+               /* Decrese rate */
                if (low != IWL_RATE_INVALID)
                        index = low;
                break;
 
        case 1:
+               /* Increase rate */
                if (high != IWL_RATE_INVALID)
                        index = high;
 
@@ -817,10 +864,11 @@ static void rs_get_rate(void *priv_r, struct ieee80211_sta *sta,
 
        case 0:
        default:
+               /* No change */
                break;
        }
 
-       IWL_DEBUG_RATE("Selected %d (action %d) - low %d high %d\n",
+       IWL_DEBUG_RATE(priv, "Selected %d (action %d) - low %d high %d\n",
                       index, scale_action, low, high);
 
  out:
@@ -832,7 +880,7 @@ static void rs_get_rate(void *priv_r, struct ieee80211_sta *sta,
        else
                info->control.rates[0].idx = rs_sta->last_txrate_idx;
 
-       IWL_DEBUG_RATE("leave: %d\n", index);
+       IWL_DEBUG_RATE(priv, "leave: %d\n", index);
 }
 
 #ifdef CONFIG_MAC80211_DEBUGFS
@@ -846,11 +894,16 @@ 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];
+       char *buff;
        int desc = 0;
        int j;
+       ssize_t ret;
        struct iwl3945_rs_sta *lq_sta = file->private_data;
 
+       buff = kmalloc(1024, GFP_KERNEL);
+       if (!buff)
+               return -ENOMEM;
+
        desc += sprintf(buff + desc, "tx packets=%d last rate index=%d\n"
                        "rate=0x%X flush time %d\n",
                        lq_sta->tx_packets,
@@ -863,7 +916,9 @@ static ssize_t iwl3945_sta_dbgfs_stats_table_read(struct file *file,
                                lq_sta->win[j].success_counter,
                                lq_sta->win[j].success_ratio);
        }
-       return simple_read_from_buffer(user_buf, count, ppos, buff, desc);
+       ret = simple_read_from_buffer(user_buf, count, ppos, buff, desc);
+       kfree(buff);
+       return ret;
 }
 
 static const struct file_operations rs_sta_dbgfs_stats_table_ops = {
@@ -915,7 +970,7 @@ void iwl3945_rate_scale_init(struct ieee80211_hw *hw, s32 sta_id)
        struct ieee80211_sta *sta;
        struct iwl3945_sta_priv *psta;
 
-       IWL_DEBUG_RATE("enter\n");
+       IWL_DEBUG_RATE(priv, "enter\n");
 
        rcu_read_lock();
 
@@ -955,11 +1010,11 @@ void iwl3945_rate_scale_init(struct ieee80211_hw *hw, s32 sta_id)
        if (rssi == 0)
                rssi = IWL_MIN_RSSI_VAL;
 
-       IWL_DEBUG(IWL_DL_INFO | IWL_DL_RATE, "Network RSSI: %d\n", rssi);
+       IWL_DEBUG_RATE(priv, "Network RSSI: %d\n", rssi);
 
        rs_sta->start_rate = iwl3945_get_rate_index_by_rssi(rssi, priv->band);
 
-       IWL_DEBUG_RATE("leave: rssi %d assign rate index: "
+       IWL_DEBUG_RATE(priv, "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();