Commit | Line | Data |
---|---|---|
b481de9c ZY |
1 | /****************************************************************************** |
2 | * | |
01f8162a | 3 | * Copyright(c) 2005 - 2009 Intel Corporation. All rights reserved. |
b481de9c ZY |
4 | * |
5 | * This program is free software; you can redistribute it and/or modify it | |
6 | * under the terms of version 2 of the GNU General Public License as | |
7 | * published by the Free Software Foundation. | |
8 | * | |
9 | * This program is distributed in the hope that it will be useful, but WITHOUT | |
10 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
11 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
12 | * more details. | |
13 | * | |
14 | * You should have received a copy of the GNU General Public License along with | |
15 | * this program; if not, write to the Free Software Foundation, Inc., | |
16 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA | |
17 | * | |
18 | * The full GNU General Public License is included in this distribution in the | |
19 | * file called LICENSE. | |
20 | * | |
21 | * Contact Information: | |
759ef89f | 22 | * Intel Linux Wireless <ilw@linux.intel.com> |
b481de9c ZY |
23 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 |
24 | * | |
25 | *****************************************************************************/ | |
26 | ||
27 | #include <linux/kernel.h> | |
28 | #include <linux/init.h> | |
29 | #include <linux/skbuff.h> | |
30 | #include <linux/wireless.h> | |
31 | #include <net/mac80211.h> | |
b481de9c ZY |
32 | |
33 | #include <linux/netdevice.h> | |
34 | #include <linux/etherdevice.h> | |
35 | #include <linux/delay.h> | |
36 | ||
37 | #include <linux/workqueue.h> | |
38 | ||
600c0e11 | 39 | #include "iwl-commands.h" |
5d08cd1d | 40 | #include "iwl-3945.h" |
c587de0b | 41 | #include "iwl-sta.h" |
b481de9c ZY |
42 | |
43 | #define RS_NAME "iwl-3945-rs" | |
44 | ||
bb8c093b | 45 | struct iwl3945_rate_scale_data { |
b481de9c ZY |
46 | u64 data; |
47 | s32 success_counter; | |
48 | s32 success_ratio; | |
49 | s32 counter; | |
50 | s32 average_tpt; | |
51 | unsigned long stamp; | |
52 | }; | |
53 | ||
fa254a68 | 54 | struct iwl3945_rs_sta { |
b481de9c | 55 | spinlock_t lock; |
4a8a4322 | 56 | struct iwl_priv *priv; |
b481de9c ZY |
57 | s32 *expected_tpt; |
58 | unsigned long last_partial_flush; | |
59 | unsigned long last_flush; | |
60 | u32 flush_time; | |
61 | u32 last_tx_packets; | |
62 | u32 tx_packets; | |
63 | u8 tgg; | |
64 | u8 flush_pending; | |
65 | u8 start_rate; | |
66 | u8 ibss_sta_added; | |
67 | struct timer_list rate_scale_flush; | |
d9829a67 | 68 | struct iwl3945_rate_scale_data win[IWL_RATE_COUNT_3945]; |
c30e30e1 AM |
69 | #ifdef CONFIG_MAC80211_DEBUGFS |
70 | struct dentry *rs_sta_dbgfs_stats_table_file; | |
71 | #endif | |
b7e35008 JB |
72 | |
73 | /* used to be in sta_info */ | |
74 | int last_txrate_idx; | |
b481de9c ZY |
75 | }; |
76 | ||
d9829a67 | 77 | static s32 iwl3945_expected_tpt_g[IWL_RATE_COUNT_3945] = { |
14577f23 | 78 | 7, 13, 35, 58, 0, 0, 76, 104, 130, 168, 191, 202 |
b481de9c ZY |
79 | }; |
80 | ||
d9829a67 | 81 | static s32 iwl3945_expected_tpt_g_prot[IWL_RATE_COUNT_3945] = { |
14577f23 | 82 | 7, 13, 35, 58, 0, 0, 0, 80, 93, 113, 123, 125 |
b481de9c ZY |
83 | }; |
84 | ||
d9829a67 | 85 | static s32 iwl3945_expected_tpt_a[IWL_RATE_COUNT_3945] = { |
14577f23 | 86 | 0, 0, 0, 0, 40, 57, 72, 98, 121, 154, 177, 186 |
b481de9c ZY |
87 | }; |
88 | ||
d9829a67 | 89 | static s32 iwl3945_expected_tpt_b[IWL_RATE_COUNT_3945] = { |
14577f23 | 90 | 7, 13, 35, 58, 0, 0, 0, 0, 0, 0, 0, 0 |
b481de9c ZY |
91 | }; |
92 | ||
bb8c093b | 93 | struct iwl3945_tpt_entry { |
b481de9c ZY |
94 | s8 min_rssi; |
95 | u8 index; | |
96 | }; | |
97 | ||
bb8c093b | 98 | static struct iwl3945_tpt_entry iwl3945_tpt_table_a[] = { |
b481de9c ZY |
99 | {-60, IWL_RATE_54M_INDEX}, |
100 | {-64, IWL_RATE_48M_INDEX}, | |
101 | {-72, IWL_RATE_36M_INDEX}, | |
102 | {-80, IWL_RATE_24M_INDEX}, | |
103 | {-84, IWL_RATE_18M_INDEX}, | |
104 | {-85, IWL_RATE_12M_INDEX}, | |
105 | {-87, IWL_RATE_9M_INDEX}, | |
106 | {-89, IWL_RATE_6M_INDEX} | |
107 | }; | |
108 | ||
bb8c093b | 109 | static struct iwl3945_tpt_entry iwl3945_tpt_table_g[] = { |
b481de9c ZY |
110 | {-60, IWL_RATE_54M_INDEX}, |
111 | {-64, IWL_RATE_48M_INDEX}, | |
112 | {-68, IWL_RATE_36M_INDEX}, | |
113 | {-80, IWL_RATE_24M_INDEX}, | |
114 | {-84, IWL_RATE_18M_INDEX}, | |
115 | {-85, IWL_RATE_12M_INDEX}, | |
116 | {-86, IWL_RATE_11M_INDEX}, | |
117 | {-88, IWL_RATE_5M_INDEX}, | |
118 | {-90, IWL_RATE_2M_INDEX}, | |
119 | {-92, IWL_RATE_1M_INDEX} | |
120 | }; | |
121 | ||
122 | #define IWL_RATE_MAX_WINDOW 62 | |
74221d07 | 123 | #define IWL_RATE_FLUSH (3*HZ) |
b481de9c | 124 | #define IWL_RATE_WIN_FLUSH (HZ/2) |
d9829a67 | 125 | #define IWL39_RATE_HIGH_TH 11520 |
74221d07 AM |
126 | #define IWL_SUCCESS_UP_TH 8960 |
127 | #define IWL_SUCCESS_DOWN_TH 10880 | |
82127493 | 128 | #define IWL_RATE_MIN_FAILURE_TH 6 |
b481de9c ZY |
129 | #define IWL_RATE_MIN_SUCCESS_TH 8 |
130 | #define IWL_RATE_DECREASE_TH 1920 | |
dd5b687e | 131 | #define IWL_RATE_RETRY_TH 15 |
b481de9c | 132 | |
8318d78a | 133 | static u8 iwl3945_get_rate_index_by_rssi(s32 rssi, enum ieee80211_band band) |
b481de9c ZY |
134 | { |
135 | u32 index = 0; | |
136 | u32 table_size = 0; | |
bb8c093b | 137 | struct iwl3945_tpt_entry *tpt_table = NULL; |
b481de9c ZY |
138 | |
139 | if ((rssi < IWL_MIN_RSSI_VAL) || (rssi > IWL_MAX_RSSI_VAL)) | |
140 | rssi = IWL_MIN_RSSI_VAL; | |
141 | ||
8318d78a JB |
142 | switch (band) { |
143 | case IEEE80211_BAND_2GHZ: | |
bb8c093b CH |
144 | tpt_table = iwl3945_tpt_table_g; |
145 | table_size = ARRAY_SIZE(iwl3945_tpt_table_g); | |
b481de9c ZY |
146 | break; |
147 | ||
8318d78a | 148 | case IEEE80211_BAND_5GHZ: |
bb8c093b CH |
149 | tpt_table = iwl3945_tpt_table_a; |
150 | table_size = ARRAY_SIZE(iwl3945_tpt_table_a); | |
b481de9c ZY |
151 | break; |
152 | ||
153 | default: | |
8318d78a | 154 | BUG(); |
b481de9c ZY |
155 | break; |
156 | } | |
157 | ||
158 | while ((index < table_size) && (rssi < tpt_table[index].min_rssi)) | |
159 | index++; | |
160 | ||
161 | index = min(index, (table_size - 1)); | |
162 | ||
163 | return tpt_table[index].index; | |
164 | } | |
165 | ||
bb8c093b | 166 | static void iwl3945_clear_window(struct iwl3945_rate_scale_data *window) |
b481de9c ZY |
167 | { |
168 | window->data = 0; | |
169 | window->success_counter = 0; | |
28447f3c | 170 | window->success_ratio = -1; |
b481de9c | 171 | window->counter = 0; |
d9829a67 | 172 | window->average_tpt = IWL_INVALID_VALUE; |
b481de9c ZY |
173 | window->stamp = 0; |
174 | } | |
175 | ||
176 | /** | |
bb8c093b | 177 | * iwl3945_rate_scale_flush_windows - flush out the rate scale windows |
b481de9c ZY |
178 | * |
179 | * Returns the number of windows that have gathered data but were | |
180 | * not flushed. If there were any that were not flushed, then | |
181 | * reschedule the rate flushing routine. | |
182 | */ | |
fa254a68 | 183 | static int iwl3945_rate_scale_flush_windows(struct iwl3945_rs_sta *rs_sta) |
b481de9c ZY |
184 | { |
185 | int unflushed = 0; | |
186 | int i; | |
187 | unsigned long flags; | |
7530f85f | 188 | struct iwl_priv *priv __maybe_unused = rs_sta->priv; |
b481de9c ZY |
189 | |
190 | /* | |
191 | * For each rate, if we have collected data on that rate | |
192 | * and it has been more than IWL_RATE_WIN_FLUSH | |
193 | * since we flushed, clear out the gathered statistics | |
194 | */ | |
d9829a67 | 195 | for (i = 0; i < IWL_RATE_COUNT_3945; i++) { |
fa254a68 | 196 | if (!rs_sta->win[i].counter) |
b481de9c ZY |
197 | continue; |
198 | ||
fa254a68 TW |
199 | spin_lock_irqsave(&rs_sta->lock, flags); |
200 | if (time_after(jiffies, rs_sta->win[i].stamp + | |
b481de9c | 201 | IWL_RATE_WIN_FLUSH)) { |
e1623446 | 202 | IWL_DEBUG_RATE(priv, "flushing %d samples of rate " |
b481de9c | 203 | "index %d\n", |
fa254a68 TW |
204 | rs_sta->win[i].counter, i); |
205 | iwl3945_clear_window(&rs_sta->win[i]); | |
b481de9c ZY |
206 | } else |
207 | unflushed++; | |
fa254a68 | 208 | spin_unlock_irqrestore(&rs_sta->lock, flags); |
b481de9c ZY |
209 | } |
210 | ||
211 | return unflushed; | |
212 | } | |
213 | ||
214 | #define IWL_RATE_FLUSH_MAX 5000 /* msec */ | |
215 | #define IWL_RATE_FLUSH_MIN 50 /* msec */ | |
74221d07 | 216 | #define IWL_AVERAGE_PACKETS 1500 |
b481de9c | 217 | |
bb8c093b | 218 | static void iwl3945_bg_rate_scale_flush(unsigned long data) |
b481de9c | 219 | { |
fa254a68 | 220 | struct iwl3945_rs_sta *rs_sta = (void *)data; |
7530f85f | 221 | struct iwl_priv *priv __maybe_unused = rs_sta->priv; |
b481de9c ZY |
222 | int unflushed = 0; |
223 | unsigned long flags; | |
224 | u32 packet_count, duration, pps; | |
225 | ||
e1623446 | 226 | IWL_DEBUG_RATE(priv, "enter\n"); |
b481de9c | 227 | |
fa254a68 | 228 | unflushed = iwl3945_rate_scale_flush_windows(rs_sta); |
b481de9c | 229 | |
fa254a68 | 230 | spin_lock_irqsave(&rs_sta->lock, flags); |
b481de9c | 231 | |
b481de9c | 232 | /* Number of packets Rx'd since last time this timer ran */ |
fa254a68 | 233 | packet_count = (rs_sta->tx_packets - rs_sta->last_tx_packets) + 1; |
b481de9c | 234 | |
fa254a68 | 235 | rs_sta->last_tx_packets = rs_sta->tx_packets + 1; |
b481de9c ZY |
236 | |
237 | if (unflushed) { | |
238 | duration = | |
fa254a68 | 239 | jiffies_to_msecs(jiffies - rs_sta->last_partial_flush); |
b481de9c | 240 | |
e1623446 | 241 | IWL_DEBUG_RATE(priv, "Tx'd %d packets in %dms\n", |
b481de9c ZY |
242 | packet_count, duration); |
243 | ||
244 | /* Determine packets per second */ | |
245 | if (duration) | |
246 | pps = (packet_count * 1000) / duration; | |
247 | else | |
248 | pps = 0; | |
249 | ||
250 | if (pps) { | |
74221d07 | 251 | duration = (IWL_AVERAGE_PACKETS * 1000) / pps; |
b481de9c ZY |
252 | if (duration < IWL_RATE_FLUSH_MIN) |
253 | duration = IWL_RATE_FLUSH_MIN; | |
74221d07 AM |
254 | else if (duration > IWL_RATE_FLUSH_MAX) |
255 | duration = IWL_RATE_FLUSH_MAX; | |
b481de9c ZY |
256 | } else |
257 | duration = IWL_RATE_FLUSH_MAX; | |
258 | ||
fa254a68 | 259 | rs_sta->flush_time = msecs_to_jiffies(duration); |
b481de9c | 260 | |
e1623446 | 261 | IWL_DEBUG_RATE(priv, "new flush period: %d msec ave %d\n", |
b481de9c ZY |
262 | duration, packet_count); |
263 | ||
fa254a68 TW |
264 | mod_timer(&rs_sta->rate_scale_flush, jiffies + |
265 | rs_sta->flush_time); | |
b481de9c | 266 | |
fa254a68 | 267 | rs_sta->last_partial_flush = jiffies; |
74221d07 AM |
268 | } else { |
269 | rs_sta->flush_time = IWL_RATE_FLUSH; | |
270 | rs_sta->flush_pending = 0; | |
b481de9c | 271 | } |
b481de9c ZY |
272 | /* If there weren't any unflushed entries, we don't schedule the timer |
273 | * to run again */ | |
274 | ||
fa254a68 | 275 | rs_sta->last_flush = jiffies; |
b481de9c | 276 | |
fa254a68 | 277 | spin_unlock_irqrestore(&rs_sta->lock, flags); |
b481de9c | 278 | |
e1623446 | 279 | IWL_DEBUG_RATE(priv, "leave\n"); |
b481de9c ZY |
280 | } |
281 | ||
282 | /** | |
bb8c093b | 283 | * iwl3945_collect_tx_data - Update the success/failure sliding window |
b481de9c ZY |
284 | * |
285 | * We keep a sliding window of the last 64 packets transmitted | |
286 | * at this rate. window->data contains the bitmask of successful | |
287 | * packets. | |
288 | */ | |
fa254a68 | 289 | static void iwl3945_collect_tx_data(struct iwl3945_rs_sta *rs_sta, |
bb8c093b | 290 | struct iwl3945_rate_scale_data *window, |
74221d07 | 291 | int success, int retries, int index) |
b481de9c ZY |
292 | { |
293 | unsigned long flags; | |
74221d07 | 294 | s32 fail_count; |
7530f85f | 295 | struct iwl_priv *priv __maybe_unused = rs_sta->priv; |
b481de9c ZY |
296 | |
297 | if (!retries) { | |
e1623446 | 298 | IWL_DEBUG_RATE(priv, "leave: retries == 0 -- should be at least 1\n"); |
b481de9c ZY |
299 | return; |
300 | } | |
301 | ||
74221d07 | 302 | spin_lock_irqsave(&rs_sta->lock, flags); |
b481de9c | 303 | |
dd5b687e AK |
304 | /* |
305 | * Keep track of only the latest 62 tx frame attempts in this rate's | |
306 | * history window; anything older isn't really relevant any more. | |
307 | * If we have filled up the sliding window, drop the oldest attempt; | |
308 | * if the oldest attempt (highest bit in bitmap) shows "success", | |
309 | * subtract "1" from the success counter (this is the main reason | |
310 | * we keep these bitmaps!). | |
311 | * */ | |
312 | while (retries > 0) { | |
313 | if (window->counter >= IWL_RATE_MAX_WINDOW) { | |
314 | ||
315 | /* remove earliest */ | |
316 | window->counter = IWL_RATE_MAX_WINDOW - 1; | |
317 | ||
318 | if (window->data & (1ULL << (IWL_RATE_MAX_WINDOW - 1))) { | |
319 | window->data &= ~(1ULL << (IWL_RATE_MAX_WINDOW - 1)); | |
b481de9c | 320 | window->success_counter--; |
dd5b687e AK |
321 | } |
322 | } | |
b481de9c | 323 | |
dd5b687e AK |
324 | /* Increment frames-attempted counter */ |
325 | window->counter++; | |
b481de9c | 326 | |
dd5b687e AK |
327 | /* Shift bitmap by one frame (throw away oldest history), |
328 | * OR in "1", and increment "success" if this | |
329 | * frame was successful. */ | |
330 | window->data <<= 1; | |
331 | if (success > 0) { | |
b481de9c | 332 | window->success_counter++; |
dd5b687e AK |
333 | window->data |= 0x1; |
334 | success--; | |
b481de9c ZY |
335 | } |
336 | ||
dd5b687e | 337 | retries--; |
b481de9c | 338 | } |
74221d07 | 339 | |
dd5b687e AK |
340 | /* Calculate current success ratio, avoid divide-by-0! */ |
341 | if (window->counter > 0) | |
342 | window->success_ratio = 128 * (100 * window->success_counter) | |
343 | / window->counter; | |
344 | else | |
345 | window->success_ratio = IWL_INVALID_VALUE; | |
346 | ||
74221d07 | 347 | fail_count = window->counter - window->success_counter; |
dd5b687e AK |
348 | |
349 | /* Calculate average throughput, if we have enough history. */ | |
74221d07 AM |
350 | if ((fail_count >= IWL_RATE_MIN_FAILURE_TH) || |
351 | (window->success_counter >= IWL_RATE_MIN_SUCCESS_TH)) | |
352 | window->average_tpt = ((window->success_ratio * | |
353 | rs_sta->expected_tpt[index] + 64) / 128); | |
354 | else | |
d9829a67 | 355 | window->average_tpt = IWL_INVALID_VALUE; |
74221d07 | 356 | |
dd5b687e AK |
357 | /* Tag this window as having been updated */ |
358 | window->stamp = jiffies; | |
359 | ||
74221d07 AM |
360 | spin_unlock_irqrestore(&rs_sta->lock, flags); |
361 | ||
b481de9c ZY |
362 | } |
363 | ||
7262796a | 364 | static void rs_rate_init(void *priv_r, struct ieee80211_supported_band *sband, |
4b7679a5 | 365 | struct ieee80211_sta *sta, void *priv_sta) |
b481de9c | 366 | { |
4b7679a5 | 367 | struct iwl3945_rs_sta *rs_sta = priv_sta; |
4a8a4322 | 368 | struct iwl_priv *priv = (struct iwl_priv *)priv_r; |
b481de9c ZY |
369 | int i; |
370 | ||
e1623446 | 371 | IWL_DEBUG_RATE(priv, "enter\n"); |
b481de9c ZY |
372 | |
373 | /* TODO: what is a good starting rate for STA? About middle? Maybe not | |
374 | * the lowest or the highest rate.. Could consider using RSSI from | |
375 | * previous packets? Need to have IEEE 802.1X auth succeed immediately | |
376 | * after assoc.. */ | |
377 | ||
7262796a | 378 | for (i = sband->n_bitrates - 1; i >= 0; i--) { |
4b7679a5 | 379 | if (sta->supp_rates[sband->band] & (1 << i)) { |
ae17e986 | 380 | rs_sta->last_txrate_idx = i; |
b481de9c ZY |
381 | break; |
382 | } | |
383 | } | |
384 | ||
7262796a | 385 | priv->sta_supp_rates = sta->supp_rates[sband->band]; |
8318d78a | 386 | /* For 5 GHz band it start at IWL_FIRST_OFDM_RATE */ |
7262796a | 387 | if (sband->band == IEEE80211_BAND_5GHZ) { |
b7e35008 | 388 | rs_sta->last_txrate_idx += IWL_FIRST_OFDM_RATE; |
7262796a AM |
389 | priv->sta_supp_rates = priv->sta_supp_rates << |
390 | IWL_FIRST_OFDM_RATE; | |
391 | } | |
392 | ||
14577f23 | 393 | |
e1623446 | 394 | IWL_DEBUG_RATE(priv, "leave\n"); |
b481de9c ZY |
395 | } |
396 | ||
4b7679a5 | 397 | static void *rs_alloc(struct ieee80211_hw *hw, struct dentry *debugfsdir) |
b481de9c | 398 | { |
4b7679a5 | 399 | return hw->priv; |
b481de9c ZY |
400 | } |
401 | ||
01ebd063 | 402 | /* rate scale requires free function to be implemented */ |
b481de9c ZY |
403 | static void rs_free(void *priv) |
404 | { | |
405 | return; | |
406 | } | |
4b7679a5 | 407 | |
40b8ec0b | 408 | static void *rs_alloc_sta(void *iwl_priv, struct ieee80211_sta *sta, gfp_t gfp) |
b481de9c | 409 | { |
fa254a68 | 410 | struct iwl3945_rs_sta *rs_sta; |
4b7679a5 | 411 | struct iwl3945_sta_priv *psta = (void *) sta->drv_priv; |
4a8a4322 | 412 | struct iwl_priv *priv = iwl_priv; |
b481de9c ZY |
413 | int i; |
414 | ||
4b7679a5 JB |
415 | /* |
416 | * XXX: If it's using sta->drv_priv anyway, it might | |
417 | * as well just put all the information there. | |
418 | */ | |
419 | ||
e1623446 | 420 | IWL_DEBUG_RATE(priv, "enter\n"); |
b481de9c | 421 | |
fa254a68 TW |
422 | rs_sta = kzalloc(sizeof(struct iwl3945_rs_sta), gfp); |
423 | if (!rs_sta) { | |
e1623446 | 424 | IWL_DEBUG_RATE(priv, "leave: ENOMEM\n"); |
b481de9c ZY |
425 | return NULL; |
426 | } | |
427 | ||
4b7679a5 JB |
428 | psta->rs_sta = rs_sta; |
429 | ||
fa254a68 | 430 | spin_lock_init(&rs_sta->lock); |
b481de9c | 431 | |
40b8ec0b SO |
432 | rs_sta->priv = priv; |
433 | ||
fa254a68 | 434 | rs_sta->start_rate = IWL_RATE_INVALID; |
b481de9c ZY |
435 | |
436 | /* default to just 802.11b */ | |
fa254a68 | 437 | rs_sta->expected_tpt = iwl3945_expected_tpt_b; |
b481de9c | 438 | |
fa254a68 TW |
439 | rs_sta->last_partial_flush = jiffies; |
440 | rs_sta->last_flush = jiffies; | |
441 | rs_sta->flush_time = IWL_RATE_FLUSH; | |
442 | rs_sta->last_tx_packets = 0; | |
443 | rs_sta->ibss_sta_added = 0; | |
b481de9c | 444 | |
fa254a68 TW |
445 | init_timer(&rs_sta->rate_scale_flush); |
446 | rs_sta->rate_scale_flush.data = (unsigned long)rs_sta; | |
447 | rs_sta->rate_scale_flush.function = &iwl3945_bg_rate_scale_flush; | |
b481de9c | 448 | |
d9829a67 | 449 | for (i = 0; i < IWL_RATE_COUNT_3945; i++) |
fa254a68 | 450 | iwl3945_clear_window(&rs_sta->win[i]); |
b481de9c | 451 | |
e1623446 | 452 | IWL_DEBUG_RATE(priv, "leave\n"); |
b481de9c | 453 | |
fa254a68 | 454 | return rs_sta; |
b481de9c ZY |
455 | } |
456 | ||
40b8ec0b | 457 | static void rs_free_sta(void *iwl_priv, struct ieee80211_sta *sta, |
4b7679a5 | 458 | void *priv_sta) |
b481de9c | 459 | { |
4b7679a5 | 460 | struct iwl3945_sta_priv *psta = (void *) sta->drv_priv; |
fa254a68 | 461 | struct iwl3945_rs_sta *rs_sta = priv_sta; |
7530f85f | 462 | struct iwl_priv *priv __maybe_unused = rs_sta->priv; |
b481de9c | 463 | |
4b7679a5 JB |
464 | psta->rs_sta = NULL; |
465 | ||
e1623446 | 466 | IWL_DEBUG_RATE(priv, "enter\n"); |
fa254a68 TW |
467 | del_timer_sync(&rs_sta->rate_scale_flush); |
468 | kfree(rs_sta); | |
e1623446 | 469 | IWL_DEBUG_RATE(priv, "leave\n"); |
b481de9c ZY |
470 | } |
471 | ||
14577f23 | 472 | |
b481de9c ZY |
473 | /** |
474 | * rs_tx_status - Update rate control values based on Tx results | |
475 | * | |
4a8a4322 | 476 | * NOTE: Uses iwl_priv->retry_rate for the # of retries attempted by |
b481de9c ZY |
477 | * the hardware for each rate. |
478 | */ | |
4b7679a5 JB |
479 | static void rs_tx_status(void *priv_rate, struct ieee80211_supported_band *sband, |
480 | struct ieee80211_sta *sta, void *priv_sta, | |
e039fa4a | 481 | struct sk_buff *skb) |
b481de9c | 482 | { |
74221d07 | 483 | s8 retries = 0, current_count; |
b481de9c ZY |
484 | int scale_rate_index, first_index, last_index; |
485 | unsigned long flags; | |
4a8a4322 | 486 | struct iwl_priv *priv = (struct iwl_priv *)priv_rate; |
4b7679a5 | 487 | struct iwl3945_rs_sta *rs_sta = priv_sta; |
e039fa4a | 488 | struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); |
8318d78a | 489 | |
e1623446 | 490 | IWL_DEBUG_RATE(priv, "enter\n"); |
28447f3c | 491 | |
82127493 | 492 | retries = info->status.rates[0].count; |
dd5b687e AK |
493 | /* Sanity Check for retries */ |
494 | if (retries > IWL_RATE_RETRY_TH) | |
495 | retries = IWL_RATE_RETRY_TH; | |
e6a9854b JB |
496 | |
497 | first_index = sband->bitrates[info->status.rates[0].idx].hw_value; | |
d9829a67 | 498 | if ((first_index < 0) || (first_index >= IWL_RATE_COUNT_3945)) { |
e1623446 | 499 | IWL_DEBUG_RATE(priv, "leave: Rate out of bounds: %d\n", first_index); |
b481de9c ZY |
500 | return; |
501 | } | |
502 | ||
4b7679a5 | 503 | if (!priv_sta) { |
e1623446 | 504 | IWL_DEBUG_RATE(priv, "leave: No STA priv data to update!\n"); |
b481de9c ZY |
505 | return; |
506 | } | |
507 | ||
fa254a68 | 508 | rs_sta->tx_packets++; |
b481de9c ZY |
509 | |
510 | scale_rate_index = first_index; | |
511 | last_index = first_index; | |
512 | ||
513 | /* | |
514 | * Update the window for each rate. We determine which rates | |
515 | * were Tx'd based on the total number of retries vs. the number | |
516 | * of retries configured for each rate -- currently set to the | |
517 | * priv value 'retry_rate' vs. rate specific | |
518 | * | |
519 | * On exit from this while loop last_index indicates the rate | |
520 | * at which the frame was finally transmitted (or failed if no | |
521 | * ACK) | |
522 | */ | |
74221d07 AM |
523 | while (retries > 1) { |
524 | if ((retries - 1) < priv->retry_rate) { | |
525 | current_count = (retries - 1); | |
b481de9c ZY |
526 | last_index = scale_rate_index; |
527 | } else { | |
528 | current_count = priv->retry_rate; | |
e6a9854b | 529 | last_index = iwl3945_rs_next_rate(priv, |
14577f23 | 530 | scale_rate_index); |
b481de9c ZY |
531 | } |
532 | ||
533 | /* Update this rate accounting for as many retries | |
534 | * as was used for it (per current_count) */ | |
fa254a68 TW |
535 | iwl3945_collect_tx_data(rs_sta, |
536 | &rs_sta->win[scale_rate_index], | |
74221d07 | 537 | 0, current_count, scale_rate_index); |
e1623446 | 538 | IWL_DEBUG_RATE(priv, "Update rate %d for %d retries.\n", |
b481de9c ZY |
539 | scale_rate_index, current_count); |
540 | ||
541 | retries -= current_count; | |
542 | ||
74221d07 | 543 | scale_rate_index = last_index; |
b481de9c ZY |
544 | } |
545 | ||
14577f23 | 546 | |
b481de9c | 547 | /* Update the last index window with success/failure based on ACK */ |
e1623446 | 548 | IWL_DEBUG_RATE(priv, "Update rate %d with %s.\n", |
b481de9c | 549 | last_index, |
e039fa4a | 550 | (info->flags & IEEE80211_TX_STAT_ACK) ? |
b481de9c | 551 | "success" : "failure"); |
fa254a68 TW |
552 | iwl3945_collect_tx_data(rs_sta, |
553 | &rs_sta->win[last_index], | |
74221d07 | 554 | info->flags & IEEE80211_TX_STAT_ACK, 1, last_index); |
b481de9c ZY |
555 | |
556 | /* We updated the rate scale window -- if its been more than | |
557 | * flush_time since the last run, schedule the flush | |
558 | * again */ | |
fa254a68 | 559 | spin_lock_irqsave(&rs_sta->lock, flags); |
b481de9c | 560 | |
fa254a68 | 561 | if (!rs_sta->flush_pending && |
74221d07 | 562 | time_after(jiffies, rs_sta->last_flush + |
fa254a68 | 563 | rs_sta->flush_time)) { |
b481de9c | 564 | |
74221d07 | 565 | rs_sta->last_partial_flush = jiffies; |
fa254a68 TW |
566 | rs_sta->flush_pending = 1; |
567 | mod_timer(&rs_sta->rate_scale_flush, | |
568 | jiffies + rs_sta->flush_time); | |
b481de9c ZY |
569 | } |
570 | ||
fa254a68 | 571 | spin_unlock_irqrestore(&rs_sta->lock, flags); |
b481de9c | 572 | |
e1623446 | 573 | IWL_DEBUG_RATE(priv, "leave\n"); |
b481de9c ZY |
574 | |
575 | return; | |
576 | } | |
577 | ||
fa254a68 | 578 | static u16 iwl3945_get_adjacent_rate(struct iwl3945_rs_sta *rs_sta, |
8318d78a | 579 | u8 index, u16 rate_mask, enum ieee80211_band band) |
b481de9c ZY |
580 | { |
581 | u8 high = IWL_RATE_INVALID; | |
582 | u8 low = IWL_RATE_INVALID; | |
7530f85f | 583 | struct iwl_priv *priv __maybe_unused = rs_sta->priv; |
b481de9c | 584 | |
01ebd063 | 585 | /* 802.11A walks to the next literal adjacent rate in |
b481de9c | 586 | * the rate table */ |
8318d78a | 587 | if (unlikely(band == IEEE80211_BAND_5GHZ)) { |
b481de9c ZY |
588 | int i; |
589 | u32 mask; | |
590 | ||
591 | /* Find the previous rate that is in the rate mask */ | |
592 | i = index - 1; | |
593 | for (mask = (1 << i); i >= 0; i--, mask >>= 1) { | |
594 | if (rate_mask & mask) { | |
595 | low = i; | |
596 | break; | |
597 | } | |
598 | } | |
599 | ||
600 | /* Find the next rate that is in the rate mask */ | |
601 | i = index + 1; | |
d9829a67 SO |
602 | for (mask = (1 << i); i < IWL_RATE_COUNT_3945; |
603 | i++, mask <<= 1) { | |
b481de9c ZY |
604 | if (rate_mask & mask) { |
605 | high = i; | |
606 | break; | |
607 | } | |
608 | } | |
609 | ||
610 | return (high << 8) | low; | |
611 | } | |
612 | ||
613 | low = index; | |
614 | while (low != IWL_RATE_INVALID) { | |
fa254a68 | 615 | if (rs_sta->tgg) |
bb8c093b | 616 | low = iwl3945_rates[low].prev_rs_tgg; |
b481de9c | 617 | else |
bb8c093b | 618 | low = iwl3945_rates[low].prev_rs; |
b481de9c ZY |
619 | if (low == IWL_RATE_INVALID) |
620 | break; | |
621 | if (rate_mask & (1 << low)) | |
622 | break; | |
e1623446 | 623 | IWL_DEBUG_RATE(priv, "Skipping masked lower rate: %d\n", low); |
b481de9c ZY |
624 | } |
625 | ||
626 | high = index; | |
627 | while (high != IWL_RATE_INVALID) { | |
fa254a68 | 628 | if (rs_sta->tgg) |
bb8c093b | 629 | high = iwl3945_rates[high].next_rs_tgg; |
b481de9c | 630 | else |
bb8c093b | 631 | high = iwl3945_rates[high].next_rs; |
b481de9c ZY |
632 | if (high == IWL_RATE_INVALID) |
633 | break; | |
634 | if (rate_mask & (1 << high)) | |
635 | break; | |
e1623446 | 636 | IWL_DEBUG_RATE(priv, "Skipping masked higher rate: %d\n", high); |
b481de9c ZY |
637 | } |
638 | ||
639 | return (high << 8) | low; | |
640 | } | |
641 | ||
642 | /** | |
643 | * rs_get_rate - find the rate for the requested packet | |
644 | * | |
645 | * Returns the ieee80211_rate structure allocated by the driver. | |
646 | * | |
647 | * The rate control algorithm has no internal mapping between hw_mode's | |
648 | * rate ordering and the rate ordering used by the rate control algorithm. | |
649 | * | |
650 | * The rate control algorithm uses a single table of rates that goes across | |
651 | * the entire A/B/G spectrum vs. being limited to just one particular | |
652 | * hw_mode. | |
653 | * | |
654 | * As such, we can't convert the index obtained below into the hw_mode's | |
655 | * rate table and must reference the driver allocated rate table | |
656 | * | |
657 | */ | |
e6a9854b JB |
658 | static void rs_get_rate(void *priv_r, struct ieee80211_sta *sta, |
659 | void *priv_sta, struct ieee80211_tx_rate_control *txrc) | |
b481de9c | 660 | { |
e6a9854b JB |
661 | struct ieee80211_supported_band *sband = txrc->sband; |
662 | struct sk_buff *skb = txrc->skb; | |
b481de9c ZY |
663 | u8 low = IWL_RATE_INVALID; |
664 | u8 high = IWL_RATE_INVALID; | |
665 | u16 high_low; | |
666 | int index; | |
4b7679a5 | 667 | struct iwl3945_rs_sta *rs_sta = priv_sta; |
bb8c093b | 668 | struct iwl3945_rate_scale_data *window = NULL; |
d9829a67 SO |
669 | int current_tpt = IWL_INVALID_VALUE; |
670 | int low_tpt = IWL_INVALID_VALUE; | |
671 | int high_tpt = IWL_INVALID_VALUE; | |
b481de9c ZY |
672 | u32 fail_count; |
673 | s8 scale_action = 0; | |
674 | unsigned long flags; | |
b481de9c | 675 | struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; |
c338ba3c AM |
676 | u16 fc; |
677 | u16 rate_mask = 0; | |
c6ec7a9b | 678 | s8 max_rate_idx = -1; |
4a8a4322 | 679 | struct iwl_priv *priv = (struct iwl_priv *)priv_r; |
e6a9854b | 680 | struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); |
b481de9c | 681 | |
e1623446 | 682 | IWL_DEBUG_RATE(priv, "enter\n"); |
b481de9c | 683 | |
c338ba3c AM |
684 | if (sta) |
685 | rate_mask = sta->supp_rates[sband->band]; | |
686 | ||
514d65c1 | 687 | /* Send management frames and NO_ACK data using lowest rate. */ |
2bc454b0 MW |
688 | fc = le16_to_cpu(hdr->frame_control); |
689 | if ((fc & IEEE80211_FCTL_FTYPE) != IEEE80211_FTYPE_DATA || | |
514d65c1 | 690 | info->flags & IEEE80211_TX_CTL_NO_ACK || |
4b7679a5 | 691 | !sta || !priv_sta) { |
e1623446 | 692 | IWL_DEBUG_RATE(priv, "leave: No STA priv data to update!\n"); |
c338ba3c AM |
693 | if (!rate_mask) |
694 | info->control.rates[0].idx = | |
695 | rate_lowest_index(sband, NULL); | |
696 | else | |
697 | info->control.rates[0].idx = | |
698 | rate_lowest_index(sband, sta); | |
514d65c1 GS |
699 | if (info->flags & IEEE80211_TX_CTL_NO_ACK) |
700 | info->control.rates[0].count = 1; | |
1abbe498 | 701 | return; |
b481de9c ZY |
702 | } |
703 | ||
c6ec7a9b AM |
704 | /* get user max rate if set */ |
705 | max_rate_idx = txrc->max_rate_idx; | |
706 | if ((sband->band == IEEE80211_BAND_5GHZ) && (max_rate_idx != -1)) | |
707 | max_rate_idx += IWL_FIRST_OFDM_RATE; | |
708 | if ((max_rate_idx < 0) || (max_rate_idx >= IWL_RATE_COUNT)) | |
709 | max_rate_idx = -1; | |
710 | ||
d9829a67 | 711 | index = min(rs_sta->last_txrate_idx & 0xffff, IWL_RATE_COUNT_3945 - 1); |
14577f23 | 712 | |
28447f3c | 713 | if (sband->band == IEEE80211_BAND_5GHZ) |
14577f23 | 714 | rate_mask = rate_mask << IWL_FIRST_OFDM_RATE; |
b481de9c | 715 | |
05c914fe | 716 | if ((priv->iw_mode == NL80211_IFTYPE_ADHOC) && |
fa254a68 | 717 | !rs_sta->ibss_sta_added) { |
c587de0b | 718 | u8 sta_id = iwl_find_station(priv, hdr->addr1); |
b481de9c ZY |
719 | |
720 | if (sta_id == IWL_INVALID_STATION) { | |
e1623446 | 721 | IWL_DEBUG_RATE(priv, "LQ: ADD station %pm\n", |
e174961c | 722 | hdr->addr1); |
c587de0b TW |
723 | sta_id = iwl_add_station(priv, hdr->addr1, false, |
724 | CMD_ASYNC, NULL); | |
b481de9c ZY |
725 | } |
726 | if (sta_id != IWL_INVALID_STATION) | |
fa254a68 | 727 | rs_sta->ibss_sta_added = 1; |
b481de9c ZY |
728 | } |
729 | ||
fa254a68 | 730 | spin_lock_irqsave(&rs_sta->lock, flags); |
b481de9c | 731 | |
74221d07 AM |
732 | /* for recent assoc, choose best rate regarding |
733 | * to rssi value | |
734 | */ | |
fa254a68 | 735 | if (rs_sta->start_rate != IWL_RATE_INVALID) { |
74221d07 AM |
736 | if (rs_sta->start_rate < index && |
737 | (rate_mask & (1 << rs_sta->start_rate))) | |
738 | index = rs_sta->start_rate; | |
fa254a68 | 739 | rs_sta->start_rate = IWL_RATE_INVALID; |
b481de9c ZY |
740 | } |
741 | ||
c6ec7a9b AM |
742 | /* force user max rate if set by user */ |
743 | if ((max_rate_idx != -1) && (max_rate_idx < index)) { | |
744 | if (rate_mask & (1 << max_rate_idx)) | |
745 | index = max_rate_idx; | |
746 | } | |
747 | ||
fa254a68 | 748 | window = &(rs_sta->win[index]); |
b481de9c ZY |
749 | |
750 | fail_count = window->counter - window->success_counter; | |
751 | ||
dd5b687e | 752 | if (((fail_count < IWL_RATE_MIN_FAILURE_TH) && |
b481de9c | 753 | (window->success_counter < IWL_RATE_MIN_SUCCESS_TH))) { |
fa254a68 | 754 | spin_unlock_irqrestore(&rs_sta->lock, flags); |
b481de9c | 755 | |
e1623446 | 756 | IWL_DEBUG_RATE(priv, "Invalid average_tpt on rate %d: " |
b481de9c ZY |
757 | "counter: %d, success_counter: %d, " |
758 | "expected_tpt is %sNULL\n", | |
759 | index, | |
760 | window->counter, | |
761 | window->success_counter, | |
fa254a68 | 762 | rs_sta->expected_tpt ? "not " : ""); |
dd5b687e AK |
763 | |
764 | /* Can't calculate this yet; not enough history */ | |
765 | window->average_tpt = IWL_INVALID_VALUE; | |
b481de9c ZY |
766 | goto out; |
767 | ||
768 | } | |
769 | ||
b481de9c ZY |
770 | current_tpt = window->average_tpt; |
771 | ||
fa254a68 | 772 | high_low = iwl3945_get_adjacent_rate(rs_sta, index, rate_mask, |
28447f3c | 773 | sband->band); |
b481de9c ZY |
774 | low = high_low & 0xff; |
775 | high = (high_low >> 8) & 0xff; | |
776 | ||
c6ec7a9b AM |
777 | /* If user set max rate, dont allow higher than user constrain */ |
778 | if ((max_rate_idx != -1) && (max_rate_idx < high)) | |
779 | high = IWL_RATE_INVALID; | |
780 | ||
dd5b687e | 781 | /* Collect Measured throughputs of adjacent rates */ |
b481de9c | 782 | if (low != IWL_RATE_INVALID) |
fa254a68 | 783 | low_tpt = rs_sta->win[low].average_tpt; |
b481de9c ZY |
784 | |
785 | if (high != IWL_RATE_INVALID) | |
fa254a68 | 786 | high_tpt = rs_sta->win[high].average_tpt; |
b481de9c | 787 | |
fa254a68 | 788 | spin_unlock_irqrestore(&rs_sta->lock, flags); |
b481de9c | 789 | |
dd5b687e | 790 | scale_action = 0; |
b481de9c | 791 | |
dd5b687e | 792 | /* Low success ratio , need to drop the rate */ |
b481de9c | 793 | if ((window->success_ratio < IWL_RATE_DECREASE_TH) || !current_tpt) { |
e1623446 | 794 | IWL_DEBUG_RATE(priv, "decrease rate because of low success_ratio\n"); |
b481de9c | 795 | scale_action = -1; |
dd5b687e AK |
796 | /* No throughput measured yet for adjacent rates, |
797 | * try increase */ | |
d9829a67 | 798 | } else if ((low_tpt == IWL_INVALID_VALUE) && |
dd5b687e AK |
799 | (high_tpt == IWL_INVALID_VALUE)) { |
800 | ||
82127493 | 801 | if (high != IWL_RATE_INVALID && window->success_ratio >= IWL_RATE_INCREASE_TH) |
dd5b687e AK |
802 | scale_action = 1; |
803 | else if (low != IWL_RATE_INVALID) | |
82127493 | 804 | scale_action = 0; |
dd5b687e AK |
805 | |
806 | /* Both adjacent throughputs are measured, but neither one has | |
807 | * better throughput; we're using the best rate, don't change | |
808 | * it! */ | |
809 | } else if ((low_tpt != IWL_INVALID_VALUE) && | |
d9829a67 | 810 | (high_tpt != IWL_INVALID_VALUE) && |
28447f3c | 811 | (low_tpt < current_tpt) && (high_tpt < current_tpt)) { |
dd5b687e | 812 | |
e1623446 | 813 | IWL_DEBUG_RATE(priv, "No action -- low [%d] & high [%d] < " |
b481de9c ZY |
814 | "current_tpt [%d]\n", |
815 | low_tpt, high_tpt, current_tpt); | |
816 | scale_action = 0; | |
dd5b687e AK |
817 | |
818 | /* At least one of the rates has better throughput */ | |
b481de9c | 819 | } else { |
d9829a67 | 820 | if (high_tpt != IWL_INVALID_VALUE) { |
dd5b687e AK |
821 | |
822 | /* High rate has better throughput, Increase | |
823 | * rate */ | |
824 | if (high_tpt > current_tpt && | |
825 | window->success_ratio >= IWL_RATE_INCREASE_TH) | |
b481de9c ZY |
826 | scale_action = 1; |
827 | else { | |
e1623446 TW |
828 | IWL_DEBUG_RATE(priv, |
829 | "decrease rate because of high tpt\n"); | |
82127493 | 830 | scale_action = 0; |
b481de9c | 831 | } |
d9829a67 | 832 | } else if (low_tpt != IWL_INVALID_VALUE) { |
b481de9c | 833 | if (low_tpt > current_tpt) { |
e1623446 TW |
834 | IWL_DEBUG_RATE(priv, |
835 | "decrease rate because of low tpt\n"); | |
b481de9c | 836 | scale_action = -1; |
82127493 | 837 | } else if (window->success_ratio >= IWL_RATE_INCREASE_TH) { |
dd5b687e AK |
838 | /* Lower rate has better |
839 | * throughput,decrease rate */ | |
b481de9c | 840 | scale_action = 1; |
dd5b687e | 841 | } |
b481de9c ZY |
842 | } |
843 | } | |
844 | ||
dd5b687e AK |
845 | /* Sanity check; asked for decrease, but success rate or throughput |
846 | * has been good at old rate. Don't change it. */ | |
847 | if ((scale_action == -1) && (low != IWL_RATE_INVALID) && | |
848 | ((window->success_ratio > IWL_RATE_HIGH_TH) || | |
849 | (current_tpt > (100 * rs_sta->expected_tpt[low])))) | |
850 | scale_action = 0; | |
b481de9c ZY |
851 | |
852 | switch (scale_action) { | |
853 | case -1: | |
dd5b687e AK |
854 | |
855 | /* Decrese rate */ | |
b481de9c ZY |
856 | if (low != IWL_RATE_INVALID) |
857 | index = low; | |
858 | break; | |
859 | ||
860 | case 1: | |
dd5b687e | 861 | /* Increase rate */ |
b481de9c ZY |
862 | if (high != IWL_RATE_INVALID) |
863 | index = high; | |
864 | ||
865 | break; | |
866 | ||
867 | case 0: | |
868 | default: | |
dd5b687e | 869 | /* No change */ |
b481de9c ZY |
870 | break; |
871 | } | |
872 | ||
e1623446 | 873 | IWL_DEBUG_RATE(priv, "Selected %d (action %d) - low %d high %d\n", |
b481de9c ZY |
874 | index, scale_action, low, high); |
875 | ||
876 | out: | |
877 | ||
b7e35008 | 878 | rs_sta->last_txrate_idx = index; |
28447f3c | 879 | if (sband->band == IEEE80211_BAND_5GHZ) |
e6a9854b JB |
880 | info->control.rates[0].idx = rs_sta->last_txrate_idx - |
881 | IWL_FIRST_OFDM_RATE; | |
14577f23 | 882 | else |
e6a9854b | 883 | info->control.rates[0].idx = rs_sta->last_txrate_idx; |
14577f23 | 884 | |
e1623446 | 885 | IWL_DEBUG_RATE(priv, "leave: %d\n", index); |
b481de9c ZY |
886 | } |
887 | ||
c30e30e1 AM |
888 | #ifdef CONFIG_MAC80211_DEBUGFS |
889 | static int iwl3945_open_file_generic(struct inode *inode, struct file *file) | |
890 | { | |
891 | file->private_data = inode->i_private; | |
892 | return 0; | |
893 | } | |
894 | ||
895 | static ssize_t iwl3945_sta_dbgfs_stats_table_read(struct file *file, | |
896 | char __user *user_buf, | |
897 | size_t count, loff_t *ppos) | |
898 | { | |
a412c804 | 899 | char *buff; |
c30e30e1 AM |
900 | int desc = 0; |
901 | int j; | |
a412c804 | 902 | ssize_t ret; |
c30e30e1 AM |
903 | struct iwl3945_rs_sta *lq_sta = file->private_data; |
904 | ||
a412c804 FS |
905 | buff = kmalloc(1024, GFP_KERNEL); |
906 | if (!buff) | |
907 | return -ENOMEM; | |
908 | ||
c30e30e1 AM |
909 | desc += sprintf(buff + desc, "tx packets=%d last rate index=%d\n" |
910 | "rate=0x%X flush time %d\n", | |
911 | lq_sta->tx_packets, | |
912 | lq_sta->last_txrate_idx, | |
913 | lq_sta->start_rate, jiffies_to_msecs(lq_sta->flush_time)); | |
d9829a67 | 914 | for (j = 0; j < IWL_RATE_COUNT_3945; j++) { |
c30e30e1 AM |
915 | desc += sprintf(buff+desc, |
916 | "counter=%d success=%d %%=%d\n", | |
917 | lq_sta->win[j].counter, | |
918 | lq_sta->win[j].success_counter, | |
919 | lq_sta->win[j].success_ratio); | |
920 | } | |
a412c804 FS |
921 | ret = simple_read_from_buffer(user_buf, count, ppos, buff, desc); |
922 | kfree(buff); | |
923 | return ret; | |
c30e30e1 AM |
924 | } |
925 | ||
926 | static const struct file_operations rs_sta_dbgfs_stats_table_ops = { | |
927 | .read = iwl3945_sta_dbgfs_stats_table_read, | |
928 | .open = iwl3945_open_file_generic, | |
929 | }; | |
930 | ||
931 | static void iwl3945_add_debugfs(void *priv, void *priv_sta, | |
932 | struct dentry *dir) | |
933 | { | |
934 | struct iwl3945_rs_sta *lq_sta = priv_sta; | |
935 | ||
936 | lq_sta->rs_sta_dbgfs_stats_table_file = | |
937 | debugfs_create_file("rate_stats_table", 0600, dir, | |
938 | lq_sta, &rs_sta_dbgfs_stats_table_ops); | |
939 | ||
940 | } | |
941 | ||
942 | static void iwl3945_remove_debugfs(void *priv, void *priv_sta) | |
943 | { | |
944 | struct iwl3945_rs_sta *lq_sta = priv_sta; | |
945 | debugfs_remove(lq_sta->rs_sta_dbgfs_stats_table_file); | |
946 | } | |
947 | #endif | |
948 | ||
b481de9c ZY |
949 | static struct rate_control_ops rs_ops = { |
950 | .module = NULL, | |
951 | .name = RS_NAME, | |
952 | .tx_status = rs_tx_status, | |
953 | .get_rate = rs_get_rate, | |
954 | .rate_init = rs_rate_init, | |
b481de9c ZY |
955 | .alloc = rs_alloc, |
956 | .free = rs_free, | |
957 | .alloc_sta = rs_alloc_sta, | |
958 | .free_sta = rs_free_sta, | |
c30e30e1 AM |
959 | #ifdef CONFIG_MAC80211_DEBUGFS |
960 | .add_sta_debugfs = iwl3945_add_debugfs, | |
961 | .remove_sta_debugfs = iwl3945_remove_debugfs, | |
962 | #endif | |
963 | ||
b481de9c ZY |
964 | }; |
965 | ||
bb8c093b | 966 | void iwl3945_rate_scale_init(struct ieee80211_hw *hw, s32 sta_id) |
b481de9c | 967 | { |
4a8a4322 | 968 | struct iwl_priv *priv = hw->priv; |
b481de9c ZY |
969 | s32 rssi = 0; |
970 | unsigned long flags; | |
fa254a68 | 971 | struct iwl3945_rs_sta *rs_sta; |
4b7679a5 JB |
972 | struct ieee80211_sta *sta; |
973 | struct iwl3945_sta_priv *psta; | |
b481de9c | 974 | |
e1623446 | 975 | IWL_DEBUG_RATE(priv, "enter\n"); |
b481de9c | 976 | |
d0709a65 JB |
977 | rcu_read_lock(); |
978 | ||
c587de0b | 979 | sta = ieee80211_find_sta(hw, priv->stations[sta_id].sta.sta.addr); |
52518189 | 980 | if (!sta) { |
d0709a65 | 981 | rcu_read_unlock(); |
b481de9c ZY |
982 | return; |
983 | } | |
984 | ||
52518189 | 985 | psta = (void *) sta->drv_priv; |
4b7679a5 | 986 | rs_sta = psta->rs_sta; |
b481de9c | 987 | |
fa254a68 | 988 | spin_lock_irqsave(&rs_sta->lock, flags); |
b481de9c | 989 | |
fa254a68 | 990 | rs_sta->tgg = 0; |
8318d78a JB |
991 | switch (priv->band) { |
992 | case IEEE80211_BAND_2GHZ: | |
993 | /* TODO: this always does G, not a regression */ | |
8ccde88a | 994 | if (priv->active_rxon.flags & RXON_FLG_TGG_PROTECT_MSK) { |
fa254a68 TW |
995 | rs_sta->tgg = 1; |
996 | rs_sta->expected_tpt = iwl3945_expected_tpt_g_prot; | |
b481de9c | 997 | } else |
fa254a68 | 998 | rs_sta->expected_tpt = iwl3945_expected_tpt_g; |
b481de9c ZY |
999 | break; |
1000 | ||
8318d78a | 1001 | case IEEE80211_BAND_5GHZ: |
fa254a68 | 1002 | rs_sta->expected_tpt = iwl3945_expected_tpt_a; |
b481de9c | 1003 | break; |
8318d78a JB |
1004 | case IEEE80211_NUM_BANDS: |
1005 | BUG(); | |
b481de9c ZY |
1006 | break; |
1007 | } | |
1008 | ||
fa254a68 | 1009 | spin_unlock_irqrestore(&rs_sta->lock, flags); |
b481de9c ZY |
1010 | |
1011 | rssi = priv->last_rx_rssi; | |
1012 | if (rssi == 0) | |
1013 | rssi = IWL_MIN_RSSI_VAL; | |
1014 | ||
e1623446 | 1015 | IWL_DEBUG_RATE(priv, "Network RSSI: %d\n", rssi); |
b481de9c | 1016 | |
8318d78a | 1017 | rs_sta->start_rate = iwl3945_get_rate_index_by_rssi(rssi, priv->band); |
b481de9c | 1018 | |
e1623446 | 1019 | IWL_DEBUG_RATE(priv, "leave: rssi %d assign rate index: " |
fa254a68 TW |
1020 | "%d (plcp 0x%x)\n", rssi, rs_sta->start_rate, |
1021 | iwl3945_rates[rs_sta->start_rate].plcp); | |
52518189 | 1022 | rcu_read_unlock(); |
b481de9c ZY |
1023 | } |
1024 | ||
897e1cf2 | 1025 | int iwl3945_rate_control_register(void) |
b481de9c | 1026 | { |
897e1cf2 | 1027 | return ieee80211_rate_control_register(&rs_ops); |
b481de9c ZY |
1028 | } |
1029 | ||
897e1cf2 | 1030 | void iwl3945_rate_control_unregister(void) |
b481de9c ZY |
1031 | { |
1032 | ieee80211_rate_control_unregister(&rs_ops); | |
1033 | } | |
1034 | ||
1035 |