]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blame_incremental - drivers/net/wireless/iwlwifi/iwl-agn-rs.c
projects / mirror_ubuntu-zesty-kernel.git / blame_incremental
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (non-incremental) | history | HEAD
mac80211: share sta_info->ht_info
[mirror_ubuntu-zesty-kernel.git] / drivers / net / wireless / iwlwifi / iwl-agn-rs.c
... / ...
CommitLineData
1/******************************************************************************
2 *
3 * Copyright(c) 2005 - 2008 Intel Corporation. All rights reserved.
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:
22 * James P. Ketrenos <ipw2100-admin@linux.intel.com>
23 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
24 *
25 *****************************************************************************/
26#include <linux/kernel.h>
27#include <linux/init.h>
28#include <linux/skbuff.h>
29#include <linux/wireless.h>
30#include <net/mac80211.h>
31
32#include <linux/netdevice.h>
33#include <linux/etherdevice.h>
34#include <linux/delay.h>
35
36#include <linux/workqueue.h>
37
38#include "../net/mac80211/rate.h"
39
40#include "iwl-dev.h"
41#include "iwl-sta.h"
42#include "iwl-core.h"
43#include "iwl-helpers.h"
44
45#define RS_NAME "iwl-agn-rs"
46
47#define NUM_TRY_BEFORE_ANT_TOGGLE 1
48#define IWL_NUMBER_TRY 1
49#define IWL_HT_NUMBER_TRY 3
50
51#define IWL_RATE_MAX_WINDOW 62 /* # tx in history window */
52#define IWL_RATE_MIN_FAILURE_TH 6 /* min failures to calc tpt */
53#define IWL_RATE_MIN_SUCCESS_TH 8 /* min successes to calc tpt */
54
55/* max time to accum history 2 seconds */
56#define IWL_RATE_SCALE_FLUSH_INTVL (2*HZ)
57
58static u8 rs_ht_to_legacy[] = {
59 IWL_RATE_6M_INDEX, IWL_RATE_6M_INDEX,
60 IWL_RATE_6M_INDEX, IWL_RATE_6M_INDEX,
61 IWL_RATE_6M_INDEX,
62 IWL_RATE_6M_INDEX, IWL_RATE_9M_INDEX,
63 IWL_RATE_12M_INDEX, IWL_RATE_18M_INDEX,
64 IWL_RATE_24M_INDEX, IWL_RATE_36M_INDEX,
65 IWL_RATE_48M_INDEX, IWL_RATE_54M_INDEX
66};
67
68static const u8 ant_toggle_lookup[] = {
69 /*ANT_NONE -> */ ANT_NONE,
70 /*ANT_A -> */ ANT_B,
71 /*ANT_B -> */ ANT_C,
72 /*ANT_AB -> */ ANT_BC,
73 /*ANT_C -> */ ANT_A,
74 /*ANT_AC -> */ ANT_AB,
75 /*ANT_BC -> */ ANT_AC,
76 /*ANT_ABC -> */ ANT_ABC,
77};
78
79/**
80 * struct iwl_rate_scale_data -- tx success history for one rate
81 */
82struct iwl_rate_scale_data {
83 u64 data; /* bitmap of successful frames */
84 s32 success_counter; /* number of frames successful */
85 s32 success_ratio; /* per-cent * 128 */
86 s32 counter; /* number of frames attempted */
87 s32 average_tpt; /* success ratio * expected throughput */
88 unsigned long stamp;
89};
90
91/**
92 * struct iwl_scale_tbl_info -- tx params and success history for all rates
93 *
94 * There are two of these in struct iwl_lq_sta,
95 * one for "active", and one for "search".
96 */
97struct iwl_scale_tbl_info {
98 enum iwl_table_type lq_type;
99 u8 ant_type;
100 u8 is_SGI; /* 1 = short guard interval */
101 u8 is_fat; /* 1 = 40 MHz channel width */
102 u8 is_dup; /* 1 = duplicated data streams */
103 u8 action; /* change modulation; IWL_[LEGACY/SISO/MIMO]_SWITCH_* */
104 s32 *expected_tpt; /* throughput metrics; expected_tpt_G, etc. */
105 u32 current_rate; /* rate_n_flags, uCode API format */
106 struct iwl_rate_scale_data win[IWL_RATE_COUNT]; /* rate histories */
107};
108
109struct iwl_traffic_load {
110 unsigned long time_stamp; /* age of the oldest statistics */
111 u32 packet_count[TID_QUEUE_MAX_SIZE]; /* packet count in this time
112 * slice */
113 u32 total; /* total num of packets during the
114 * last TID_MAX_TIME_DIFF */
115 u8 queue_count; /* number of queues that has
116 * been used since the last cleanup */
117 u8 head; /* start of the circular buffer */
118};
119
120/**
121 * struct iwl_lq_sta -- driver's rate scaling private structure
122 *
123 * Pointer to this gets passed back and forth between driver and mac80211.
124 */
125struct iwl_lq_sta {
126 u8 active_tbl; /* index of active table, range 0-1 */
127 u8 enable_counter; /* indicates HT mode */
128 u8 stay_in_tbl; /* 1: disallow, 0: allow search for new mode */
129 u8 search_better_tbl; /* 1: currently trying alternate mode */
130 s32 last_tpt;
131
132 /* The following determine when to search for a new mode */
133 u32 table_count_limit;
134 u32 max_failure_limit; /* # failed frames before new search */
135 u32 max_success_limit; /* # successful frames before new search */
136 u32 table_count;
137 u32 total_failed; /* total failed frames, any/all rates */
138 u32 total_success; /* total successful frames, any/all rates */
139 u32 flush_timer; /* time staying in mode before new search */
140
141 u8 action_counter; /* # mode-switch actions tried */
142 u8 is_green;
143 u8 is_dup;
144 enum ieee80211_band band;
145 u8 ibss_sta_added;
146
147 /* The following are bitmaps of rates; IWL_RATE_6M_MASK, etc. */
148 u32 supp_rates;
149 u16 active_legacy_rate;
150 u16 active_siso_rate;
151 u16 active_mimo2_rate;
152 u16 active_mimo3_rate;
153 u16 active_rate_basic;
154
155 struct iwl_link_quality_cmd lq;
156 struct iwl_scale_tbl_info lq_info[LQ_SIZE]; /* "active", "search" */
157 struct iwl_traffic_load load[TID_MAX_LOAD_COUNT];
158 u8 tx_agg_tid_en;
159#ifdef CONFIG_MAC80211_DEBUGFS
160 struct dentry *rs_sta_dbgfs_scale_table_file;
161 struct dentry *rs_sta_dbgfs_stats_table_file;
162 struct dentry *rs_sta_dbgfs_tx_agg_tid_en_file;
163 u32 dbg_fixed_rate;
164#endif
165 struct iwl_priv *drv;
166
167 /* used to be in sta_info */
168 int last_txrate_idx;
169};
170
171static void rs_rate_scale_perform(struct iwl_priv *priv,
172 struct net_device *dev,
173 struct ieee80211_hdr *hdr,
174 struct sta_info *sta);
175static void rs_fill_link_cmd(const struct iwl_priv *priv,
176 struct iwl_lq_sta *lq_sta, u32 rate_n_flags);
177
178
179#ifdef CONFIG_MAC80211_DEBUGFS
180static void rs_dbgfs_set_mcs(struct iwl_lq_sta *lq_sta,
181 u32 *rate_n_flags, int index);
182#else
183static void rs_dbgfs_set_mcs(struct iwl_lq_sta *lq_sta,
184 u32 *rate_n_flags, int index)
185{}
186#endif
187
188/*
189 * Expected throughput metrics for following rates:
190 * 1, 2, 5.5, 11, 6, 9, 12, 18, 24, 36, 48, 54, 60 MBits
191 * "G" is the only table that supports CCK (the first 4 rates).
192 */
193/*FIXME:RS:need to spearate tables for MIMO2/MIMO3*/
194static s32 expected_tpt_A[IWL_RATE_COUNT] = {
195 0, 0, 0, 0, 40, 57, 72, 98, 121, 154, 177, 186, 186
196};
197
198static s32 expected_tpt_G[IWL_RATE_COUNT] = {
199 7, 13, 35, 58, 40, 57, 72, 98, 121, 154, 177, 186, 186
200};
201
202static s32 expected_tpt_siso20MHz[IWL_RATE_COUNT] = {
203 0, 0, 0, 0, 42, 42, 76, 102, 124, 159, 183, 193, 202
204};
205
206static s32 expected_tpt_siso20MHzSGI[IWL_RATE_COUNT] = {
207 0, 0, 0, 0, 46, 46, 82, 110, 132, 168, 192, 202, 211
208};
209
210static s32 expected_tpt_mimo20MHz[IWL_RATE_COUNT] = {
211 0, 0, 0, 0, 74, 74, 123, 155, 179, 214, 236, 244, 251
212};
213
214static s32 expected_tpt_mimo20MHzSGI[IWL_RATE_COUNT] = {
215 0, 0, 0, 0, 81, 81, 131, 164, 188, 222, 243, 251, 257
216};
217
218static s32 expected_tpt_siso40MHz[IWL_RATE_COUNT] = {
219 0, 0, 0, 0, 77, 77, 127, 160, 184, 220, 242, 250, 257
220};
221
222static s32 expected_tpt_siso40MHzSGI[IWL_RATE_COUNT] = {
223 0, 0, 0, 0, 83, 83, 135, 169, 193, 229, 250, 257, 264
224};
225
226static s32 expected_tpt_mimo40MHz[IWL_RATE_COUNT] = {
227 0, 0, 0, 0, 123, 123, 182, 214, 235, 264, 279, 285, 289
228};
229
230static s32 expected_tpt_mimo40MHzSGI[IWL_RATE_COUNT] = {
231 0, 0, 0, 0, 131, 131, 191, 222, 242, 270, 284, 289, 293
232};
233
234static inline u8 rs_extract_rate(u32 rate_n_flags)
235{
236 return (u8)(rate_n_flags & 0xFF);
237}
238
239static void rs_rate_scale_clear_window(struct iwl_rate_scale_data *window)
240{
241 window->data = 0;
242 window->success_counter = 0;
243 window->success_ratio = IWL_INVALID_VALUE;
244 window->counter = 0;
245 window->average_tpt = IWL_INVALID_VALUE;
246 window->stamp = 0;
247}
248
249static inline u8 rs_is_valid_ant(u8 valid_antenna, u8 ant_type)
250{
251 return (ant_type & valid_antenna) == ant_type;
252}
253
254/*
255 * removes the old data from the statistics. All data that is older than
256 * TID_MAX_TIME_DIFF, will be deleted.
257 */
258static void rs_tl_rm_old_stats(struct iwl_traffic_load *tl, u32 curr_time)
259{
260 /* The oldest age we want to keep */
261 u32 oldest_time = curr_time - TID_MAX_TIME_DIFF;
262
263 while (tl->queue_count &&
264 (tl->time_stamp < oldest_time)) {
265 tl->total -= tl->packet_count[tl->head];
266 tl->packet_count[tl->head] = 0;
267 tl->time_stamp += TID_QUEUE_CELL_SPACING;
268 tl->queue_count--;
269 tl->head++;
270 if (tl->head >= TID_QUEUE_MAX_SIZE)
271 tl->head = 0;
272 }
273}
274
275/*
276 * increment traffic load value for tid and also remove
277 * any old values if passed the certain time period
278 */
279static u8 rs_tl_add_packet(struct iwl_lq_sta *lq_data,
280 struct ieee80211_hdr *hdr)
281{
282 u32 curr_time = jiffies_to_msecs(jiffies);
283 u32 time_diff;
284 s32 index;
285 struct iwl_traffic_load *tl = NULL;
286 __le16 fc = hdr->frame_control;
287 u8 tid;
288
289 if (ieee80211_is_data_qos(fc)) {
290 u8 *qc = ieee80211_get_qos_ctl(hdr);
291 tid = qc[0] & 0xf;
292 } else
293 return MAX_TID_COUNT;
294
295 tl = &lq_data->load[tid];
296
297 curr_time -= curr_time % TID_ROUND_VALUE;
298
299 /* Happens only for the first packet. Initialize the data */
300 if (!(tl->queue_count)) {
301 tl->total = 1;
302 tl->time_stamp = curr_time;
303 tl->queue_count = 1;
304 tl->head = 0;
305 tl->packet_count[0] = 1;
306 return MAX_TID_COUNT;
307 }
308
309 time_diff = TIME_WRAP_AROUND(tl->time_stamp, curr_time);
310 index = time_diff / TID_QUEUE_CELL_SPACING;
311
312 /* The history is too long: remove data that is older than */
313 /* TID_MAX_TIME_DIFF */
314 if (index >= TID_QUEUE_MAX_SIZE)
315 rs_tl_rm_old_stats(tl, curr_time);
316
317 index = (tl->head + index) % TID_QUEUE_MAX_SIZE;
318 tl->packet_count[index] = tl->packet_count[index] + 1;
319 tl->total = tl->total + 1;
320
321 if ((index + 1) > tl->queue_count)
322 tl->queue_count = index + 1;
323
324 return tid;
325}
326
327/*
328 get the traffic load value for tid
329*/
330static u32 rs_tl_get_load(struct iwl_lq_sta *lq_data, u8 tid)
331{
332 u32 curr_time = jiffies_to_msecs(jiffies);
333 u32 time_diff;
334 s32 index;
335 struct iwl_traffic_load *tl = NULL;
336
337 if (tid >= TID_MAX_LOAD_COUNT)
338 return 0;
339
340 tl = &(lq_data->load[tid]);
341
342 curr_time -= curr_time % TID_ROUND_VALUE;
343
344 if (!(tl->queue_count))
345 return 0;
346
347 time_diff = TIME_WRAP_AROUND(tl->time_stamp, curr_time);
348 index = time_diff / TID_QUEUE_CELL_SPACING;
349
350 /* The history is too long: remove data that is older than */
351 /* TID_MAX_TIME_DIFF */
352 if (index >= TID_QUEUE_MAX_SIZE)
353 rs_tl_rm_old_stats(tl, curr_time);
354
355 return tl->total;
356}
357
358static void rs_tl_turn_on_agg_for_tid(struct iwl_priv *priv,
359 struct iwl_lq_sta *lq_data, u8 tid,
360 struct sta_info *sta)
361{
362 unsigned long state;
363 DECLARE_MAC_BUF(mac);
364
365 spin_lock_bh(&sta->lock);
366 state = sta->ampdu_mlme.tid_state_tx[tid];
367 spin_unlock_bh(&sta->lock);
368
369 if (state == HT_AGG_STATE_IDLE &&
370 rs_tl_get_load(lq_data, tid) > IWL_AGG_LOAD_THRESHOLD) {
371 IWL_DEBUG_HT("Starting Tx agg: STA: %s tid: %d\n",
372 print_mac(mac, sta->sta.addr), tid);
373 ieee80211_start_tx_ba_session(priv->hw, sta->sta.addr, tid);
374 }
375}
376
377static void rs_tl_turn_on_agg(struct iwl_priv *priv, u8 tid,
378 struct iwl_lq_sta *lq_data,
379 struct sta_info *sta)
380{
381 if ((tid < TID_MAX_LOAD_COUNT))
382 rs_tl_turn_on_agg_for_tid(priv, lq_data, tid, sta);
383 else if (tid == IWL_AGG_ALL_TID)
384 for (tid = 0; tid < TID_MAX_LOAD_COUNT; tid++)
385 rs_tl_turn_on_agg_for_tid(priv, lq_data, tid, sta);
386}
387
388static inline int get_num_of_ant_from_rate(u32 rate_n_flags)
389{
390 return !!(rate_n_flags & RATE_MCS_ANT_A_MSK) +
391 !!(rate_n_flags & RATE_MCS_ANT_B_MSK) +
392 !!(rate_n_flags & RATE_MCS_ANT_C_MSK);
393}
394
395/**
396 * rs_collect_tx_data - Update the success/failure sliding window
397 *
398 * We keep a sliding window of the last 62 packets transmitted
399 * at this rate. window->data contains the bitmask of successful
400 * packets.
401 */
402static int rs_collect_tx_data(struct iwl_rate_scale_data *windows,
403 int scale_index, s32 tpt, int retries,
404 int successes)
405{
406 struct iwl_rate_scale_data *window = NULL;
407 static const u64 mask = (((u64)1) << (IWL_RATE_MAX_WINDOW - 1));
408 s32 fail_count;
409
410 if (scale_index < 0 || scale_index >= IWL_RATE_COUNT)
411 return -EINVAL;
412
413 /* Select data for current tx bit rate */
414 window = &(windows[scale_index]);
415
416 /*
417 * Keep track of only the latest 62 tx frame attempts in this rate's
418 * history window; anything older isn't really relevant any more.
419 * If we have filled up the sliding window, drop the oldest attempt;
420 * if the oldest attempt (highest bit in bitmap) shows "success",
421 * subtract "1" from the success counter (this is the main reason
422 * we keep these bitmaps!).
423 */
424 while (retries > 0) {
425 if (window->counter >= IWL_RATE_MAX_WINDOW) {
426
427 /* remove earliest */
428 window->counter = IWL_RATE_MAX_WINDOW - 1;
429
430 if (window->data & mask) {
431 window->data &= ~mask;
432 window->success_counter--;
433 }
434 }
435
436 /* Increment frames-attempted counter */
437 window->counter++;
438
439 /* Shift bitmap by one frame (throw away oldest history),
440 * OR in "1", and increment "success" if this
441 * frame was successful. */
442 window->data <<= 1;
443 if (successes > 0) {
444 window->success_counter++;
445 window->data |= 0x1;
446 successes--;
447 }
448
449 retries--;
450 }
451
452 /* Calculate current success ratio, avoid divide-by-0! */
453 if (window->counter > 0)
454 window->success_ratio = 128 * (100 * window->success_counter)
455 / window->counter;
456 else
457 window->success_ratio = IWL_INVALID_VALUE;
458
459 fail_count = window->counter - window->success_counter;
460
461 /* Calculate average throughput, if we have enough history. */
462 if ((fail_count >= IWL_RATE_MIN_FAILURE_TH) ||
463 (window->success_counter >= IWL_RATE_MIN_SUCCESS_TH))
464 window->average_tpt = (window->success_ratio * tpt + 64) / 128;
465 else
466 window->average_tpt = IWL_INVALID_VALUE;
467
468 /* Tag this window as having been updated */
469 window->stamp = jiffies;
470
471 return 0;
472}
473
474/*
475 * Fill uCode API rate_n_flags field, based on "search" or "active" table.
476 */
477/* FIXME:RS:remove this function and put the flags statically in the table */
478static u32 rate_n_flags_from_tbl(struct iwl_scale_tbl_info *tbl,
479 int index, u8 use_green)
480{
481 u32 rate_n_flags = 0;
482
483 if (is_legacy(tbl->lq_type)) {
484 rate_n_flags = iwl_rates[index].plcp;
485 if (index >= IWL_FIRST_CCK_RATE && index <= IWL_LAST_CCK_RATE)
486 rate_n_flags |= RATE_MCS_CCK_MSK;
487
488 } else if (is_Ht(tbl->lq_type)) {
489 if (index > IWL_LAST_OFDM_RATE) {
490 IWL_ERROR("invalid HT rate index %d\n", index);
491 index = IWL_LAST_OFDM_RATE;
492 }
493 rate_n_flags = RATE_MCS_HT_MSK;
494
495 if (is_siso(tbl->lq_type))
496 rate_n_flags |= iwl_rates[index].plcp_siso;
497 else if (is_mimo2(tbl->lq_type))
498 rate_n_flags |= iwl_rates[index].plcp_mimo2;
499 else
500 rate_n_flags |= iwl_rates[index].plcp_mimo3;
501 } else {
502 IWL_ERROR("Invalid tbl->lq_type %d\n", tbl->lq_type);
503 }
504
505 rate_n_flags |= ((tbl->ant_type << RATE_MCS_ANT_POS) &
506 RATE_MCS_ANT_ABC_MSK);
507
508 if (is_Ht(tbl->lq_type)) {
509 if (tbl->is_fat) {
510 if (tbl->is_dup)
511 rate_n_flags |= RATE_MCS_DUP_MSK;
512 else
513 rate_n_flags |= RATE_MCS_FAT_MSK;
514 }
515 if (tbl->is_SGI)
516 rate_n_flags |= RATE_MCS_SGI_MSK;
517
518 if (use_green) {
519 rate_n_flags |= RATE_MCS_GF_MSK;
520 if (is_siso(tbl->lq_type) && tbl->is_SGI) {
521 rate_n_flags &= ~RATE_MCS_SGI_MSK;
522 IWL_ERROR("GF was set with SGI:SISO\n");
523 }
524 }
525 }
526 return rate_n_flags;
527}
528
529/*
530 * Interpret uCode API's rate_n_flags format,
531 * fill "search" or "active" tx mode table.
532 */
533static int rs_get_tbl_info_from_mcs(const u32 rate_n_flags,
534 enum ieee80211_band band,
535 struct iwl_scale_tbl_info *tbl,
536 int *rate_idx)
537{
538 u32 ant_msk = (rate_n_flags & RATE_MCS_ANT_ABC_MSK);
539 u8 num_of_ant = get_num_of_ant_from_rate(rate_n_flags);
540 u8 mcs;
541
542 *rate_idx = iwl_hwrate_to_plcp_idx(rate_n_flags);
543
544 if (*rate_idx == IWL_RATE_INVALID) {
545 *rate_idx = -1;
546 return -EINVAL;
547 }
548 tbl->is_SGI = 0; /* default legacy setup */
549 tbl->is_fat = 0;
550 tbl->is_dup = 0;
551 tbl->ant_type = (ant_msk >> RATE_MCS_ANT_POS);
552 tbl->lq_type = LQ_NONE;
553
554 /* legacy rate format */
555 if (!(rate_n_flags & RATE_MCS_HT_MSK)) {
556 if (num_of_ant == 1) {
557 if (band == IEEE80211_BAND_5GHZ)
558 tbl->lq_type = LQ_A;
559 else
560 tbl->lq_type = LQ_G;
561 }
562 /* HT rate format */
563 } else {
564 if (rate_n_flags & RATE_MCS_SGI_MSK)
565 tbl->is_SGI = 1;
566
567 if ((rate_n_flags & RATE_MCS_FAT_MSK) ||
568 (rate_n_flags & RATE_MCS_DUP_MSK))
569 tbl->is_fat = 1;
570
571 if (rate_n_flags & RATE_MCS_DUP_MSK)
572 tbl->is_dup = 1;
573
574 mcs = rs_extract_rate(rate_n_flags);
575
576 /* SISO */
577 if (mcs <= IWL_RATE_SISO_60M_PLCP) {
578 if (num_of_ant == 1)
579 tbl->lq_type = LQ_SISO; /*else NONE*/
580 /* MIMO2 */
581 } else if (mcs <= IWL_RATE_MIMO2_60M_PLCP) {
582 if (num_of_ant == 2)
583 tbl->lq_type = LQ_MIMO2;
584 /* MIMO3 */
585 } else {
586 if (num_of_ant == 3)
587 tbl->lq_type = LQ_MIMO3;
588 }
589 }
590 return 0;
591}
592
593/* switch to another antenna/antennas and return 1 */
594/* if no other valid antenna found, return 0 */
595static int rs_toggle_antenna(u32 valid_ant, u32 *rate_n_flags,
596 struct iwl_scale_tbl_info *tbl)
597{
598 u8 new_ant_type;
599
600 if (!tbl->ant_type || tbl->ant_type > ANT_ABC)
601 return 0;
602
603 if (!rs_is_valid_ant(valid_ant, tbl->ant_type))
604 return 0;
605
606 new_ant_type = ant_toggle_lookup[tbl->ant_type];
607
608 while ((new_ant_type != tbl->ant_type) &&
609 !rs_is_valid_ant(valid_ant, new_ant_type))
610 new_ant_type = ant_toggle_lookup[new_ant_type];
611
612 if (new_ant_type == tbl->ant_type)
613 return 0;
614
615 tbl->ant_type = new_ant_type;
616 *rate_n_flags &= ~RATE_MCS_ANT_ABC_MSK;
617 *rate_n_flags |= new_ant_type << RATE_MCS_ANT_POS;
618 return 1;
619}
620
621/* FIXME:RS: in 4965 we don't use greenfield at all */
622/* FIXME:RS: don't use greenfield for now in TX */
623#if 0
624static inline u8 rs_use_green(struct iwl_priv *priv, struct ieee80211_conf *conf)
625{
626 return (conf->flags & IEEE80211_CONF_SUPPORT_HT_MODE) &&
627 priv->current_ht_config.is_green_field &&
628 !priv->current_ht_config.non_GF_STA_present;
629}
630#endif
631static inline u8 rs_use_green(struct iwl_priv *priv, struct ieee80211_conf *conf)
632{
633 return 0;
634}
635
636/**
637 * rs_get_supported_rates - get the available rates
638 *
639 * if management frame or broadcast frame only return
640 * basic available rates.
641 *
642 */
643static u16 rs_get_supported_rates(struct iwl_lq_sta *lq_sta,
644 struct ieee80211_hdr *hdr,
645 enum iwl_table_type rate_type)
646{
647 if (hdr && is_multicast_ether_addr(hdr->addr1) &&
648 lq_sta->active_rate_basic)
649 return lq_sta->active_rate_basic;
650
651 if (is_legacy(rate_type)) {
652 return lq_sta->active_legacy_rate;
653 } else {
654 if (is_siso(rate_type))
655 return lq_sta->active_siso_rate;
656 else if (is_mimo2(rate_type))
657 return lq_sta->active_mimo2_rate;
658 else
659 return lq_sta->active_mimo3_rate;
660 }
661}
662
663static u16 rs_get_adjacent_rate(struct iwl_priv *priv, u8 index, u16 rate_mask,
664 int rate_type)
665{
666 u8 high = IWL_RATE_INVALID;
667 u8 low = IWL_RATE_INVALID;
668
669 /* 802.11A or ht walks to the next literal adjacent rate in
670 * the rate table */
671 if (is_a_band(rate_type) || !is_legacy(rate_type)) {
672 int i;
673 u32 mask;
674
675 /* Find the previous rate that is in the rate mask */
676 i = index - 1;
677 for (mask = (1 << i); i >= 0; i--, mask >>= 1) {
678 if (rate_mask & mask) {
679 low = i;
680 break;
681 }
682 }
683
684 /* Find the next rate that is in the rate mask */
685 i = index + 1;
686 for (mask = (1 << i); i < IWL_RATE_COUNT; i++, mask <<= 1) {
687 if (rate_mask & mask) {
688 high = i;
689 break;
690 }
691 }
692
693 return (high << 8) | low;
694 }
695
696 low = index;
697 while (low != IWL_RATE_INVALID) {
698 low = iwl_rates[low].prev_rs;
699 if (low == IWL_RATE_INVALID)
700 break;
701 if (rate_mask & (1 << low))
702 break;
703 IWL_DEBUG_RATE("Skipping masked lower rate: %d\n", low);
704 }
705
706 high = index;
707 while (high != IWL_RATE_INVALID) {
708 high = iwl_rates[high].next_rs;
709 if (high == IWL_RATE_INVALID)
710 break;
711 if (rate_mask & (1 << high))
712 break;
713 IWL_DEBUG_RATE("Skipping masked higher rate: %d\n", high);
714 }
715
716 return (high << 8) | low;
717}
718
719static u32 rs_get_lower_rate(struct iwl_lq_sta *lq_sta,
720 struct iwl_scale_tbl_info *tbl,
721 u8 scale_index, u8 ht_possible)
722{
723 s32 low;
724 u16 rate_mask;
725 u16 high_low;
726 u8 switch_to_legacy = 0;
727 u8 is_green = lq_sta->is_green;
728
729 /* check if we need to switch from HT to legacy rates.
730 * assumption is that mandatory rates (1Mbps or 6Mbps)
731 * are always supported (spec demand) */
732 if (!is_legacy(tbl->lq_type) && (!ht_possible || !scale_index)) {
733 switch_to_legacy = 1;
734 scale_index = rs_ht_to_legacy[scale_index];
735 if (lq_sta->band == IEEE80211_BAND_5GHZ)
736 tbl->lq_type = LQ_A;
737 else
738 tbl->lq_type = LQ_G;
739
740 if (num_of_ant(tbl->ant_type) > 1)
741 tbl->ant_type = ANT_A;/*FIXME:RS*/
742
743 tbl->is_fat = 0;
744 tbl->is_SGI = 0;
745 }
746
747 rate_mask = rs_get_supported_rates(lq_sta, NULL, tbl->lq_type);
748
749 /* Mask with station rate restriction */
750 if (is_legacy(tbl->lq_type)) {
751 /* supp_rates has no CCK bits in A mode */
752 if (lq_sta->band == IEEE80211_BAND_5GHZ)
753 rate_mask = (u16)(rate_mask &
754 (lq_sta->supp_rates << IWL_FIRST_OFDM_RATE));
755 else
756 rate_mask = (u16)(rate_mask & lq_sta->supp_rates);
757 }
758
759 /* If we switched from HT to legacy, check current rate */
760 if (switch_to_legacy && (rate_mask & (1 << scale_index))) {
761 low = scale_index;
762 goto out;
763 }
764
765 high_low = rs_get_adjacent_rate(lq_sta->drv, scale_index, rate_mask,
766 tbl->lq_type);
767 low = high_low & 0xff;
768
769 if (low == IWL_RATE_INVALID)
770 low = scale_index;
771
772out:
773 return rate_n_flags_from_tbl(tbl, low, is_green);
774}
775
776/*
777 * mac80211 sends us Tx status
778 */
779static void rs_tx_status(void *priv_rate, struct net_device *dev,
780 struct sk_buff *skb)
781{
782 int status;
783 u8 retries;
784 int rs_index, index = 0;
785 struct iwl_lq_sta *lq_sta;
786 struct iwl_link_quality_cmd *table;
787 struct sta_info *sta;
788 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
789 struct iwl_priv *priv = (struct iwl_priv *)priv_rate;
790 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
791 struct ieee80211_hw *hw = local_to_hw(local);
792 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
793 struct iwl_rate_scale_data *window = NULL;
794 struct iwl_rate_scale_data *search_win = NULL;
795 u32 tx_rate;
796 struct iwl_scale_tbl_info tbl_type;
797 struct iwl_scale_tbl_info *curr_tbl, *search_tbl;
798 u8 active_index = 0;
799 __le16 fc = hdr->frame_control;
800 s32 tpt = 0;
801
802 IWL_DEBUG_RATE_LIMIT("get frame ack response, update rate scale window\n");
803
804 if (!ieee80211_is_data(fc) || is_multicast_ether_addr(hdr->addr1))
805 return;
806
807 /* This packet was aggregated but doesn't carry rate scale info */
808 if ((info->flags & IEEE80211_TX_CTL_AMPDU) &&
809 !(info->flags & IEEE80211_TX_STAT_AMPDU))
810 return;
811
812 retries = info->status.retry_count;
813
814 if (retries > 15)
815 retries = 15;
816
817 rcu_read_lock();
818
819 sta = sta_info_get(local, hdr->addr1);
820
821 if (!sta || !sta->rate_ctrl_priv)
822 goto out;
823
824
825 lq_sta = (struct iwl_lq_sta *)sta->rate_ctrl_priv;
826
827 if ((priv->iw_mode == NL80211_IFTYPE_ADHOC) &&
828 !lq_sta->ibss_sta_added)
829 goto out;
830
831 table = &lq_sta->lq;
832 active_index = lq_sta->active_tbl;
833
834 curr_tbl = &(lq_sta->lq_info[active_index]);
835 search_tbl = &(lq_sta->lq_info[(1 - active_index)]);
836 window = (struct iwl_rate_scale_data *)&(curr_tbl->win[0]);
837 search_win = (struct iwl_rate_scale_data *)&(search_tbl->win[0]);
838
839 /*
840 * Ignore this Tx frame response if its initial rate doesn't match
841 * that of latest Link Quality command. There may be stragglers
842 * from a previous Link Quality command, but we're no longer interested
843 * in those; they're either from the "active" mode while we're trying
844 * to check "search" mode, or a prior "search" mode after we've moved
845 * to a new "search" mode (which might become the new "active" mode).
846 */
847 tx_rate = le32_to_cpu(table->rs_table[0].rate_n_flags);
848 rs_get_tbl_info_from_mcs(tx_rate, priv->band, &tbl_type, &rs_index);
849 if (priv->band == IEEE80211_BAND_5GHZ)
850 rs_index -= IWL_FIRST_OFDM_RATE;
851
852 if ((info->tx_rate_idx < 0) ||
853 (tbl_type.is_SGI ^
854 !!(info->flags & IEEE80211_TX_CTL_SHORT_GI)) ||
855 (tbl_type.is_fat ^
856 !!(info->flags & IEEE80211_TX_CTL_40_MHZ_WIDTH)) ||
857 (tbl_type.is_dup ^
858 !!(info->flags & IEEE80211_TX_CTL_DUP_DATA)) ||
859 (tbl_type.ant_type ^ info->antenna_sel_tx) ||
860 (!!(tx_rate & RATE_MCS_HT_MSK) ^
861 !!(info->flags & IEEE80211_TX_CTL_OFDM_HT)) ||
862 (!!(tx_rate & RATE_MCS_GF_MSK) ^
863 !!(info->flags & IEEE80211_TX_CTL_GREEN_FIELD)) ||
864 (hw->wiphy->bands[priv->band]->bitrates[rs_index].bitrate !=
865 hw->wiphy->bands[info->band]->bitrates[info->tx_rate_idx].bitrate)) {
866 IWL_DEBUG_RATE("initial rate does not match 0x%x\n", tx_rate);
867 goto out;
868 }
869
870 /* Update frame history window with "failure" for each Tx retry. */
871 while (retries) {
872 /* Look up the rate and other info used for each tx attempt.
873 * Each tx attempt steps one entry deeper in the rate table. */
874 tx_rate = le32_to_cpu(table->rs_table[index].rate_n_flags);
875 rs_get_tbl_info_from_mcs(tx_rate, priv->band,
876 &tbl_type, &rs_index);
877
878 /* If type matches "search" table,
879 * add failure to "search" history */
880 if ((tbl_type.lq_type == search_tbl->lq_type) &&
881 (tbl_type.ant_type == search_tbl->ant_type) &&
882 (tbl_type.is_SGI == search_tbl->is_SGI)) {
883 if (search_tbl->expected_tpt)
884 tpt = search_tbl->expected_tpt[rs_index];
885 else
886 tpt = 0;
887 rs_collect_tx_data(search_win, rs_index, tpt, 1, 0);
888
889 /* Else if type matches "current/active" table,
890 * add failure to "current/active" history */
891 } else if ((tbl_type.lq_type == curr_tbl->lq_type) &&
892 (tbl_type.ant_type == curr_tbl->ant_type) &&
893 (tbl_type.is_SGI == curr_tbl->is_SGI)) {
894 if (curr_tbl->expected_tpt)
895 tpt = curr_tbl->expected_tpt[rs_index];
896 else
897 tpt = 0;
898 rs_collect_tx_data(window, rs_index, tpt, 1, 0);
899 }
900
901 /* If not searching for a new mode, increment failed counter
902 * ... this helps determine when to start searching again */
903 if (lq_sta->stay_in_tbl)
904 lq_sta->total_failed++;
905 --retries;
906 index++;
907
908 }
909
910 /*
911 * Find (by rate) the history window to update with final Tx attempt;
912 * if Tx was successful first try, use original rate,
913 * else look up the rate that was, finally, successful.
914 */
915 tx_rate = le32_to_cpu(table->rs_table[index].rate_n_flags);
916 rs_get_tbl_info_from_mcs(tx_rate, priv->band, &tbl_type, &rs_index);
917
918 /* Update frame history window with "success" if Tx got ACKed ... */
919 status = !!(info->flags & IEEE80211_TX_STAT_ACK);
920
921 /* If type matches "search" table,
922 * add final tx status to "search" history */
923 if ((tbl_type.lq_type == search_tbl->lq_type) &&
924 (tbl_type.ant_type == search_tbl->ant_type) &&
925 (tbl_type.is_SGI == search_tbl->is_SGI)) {
926 if (search_tbl->expected_tpt)
927 tpt = search_tbl->expected_tpt[rs_index];
928 else
929 tpt = 0;
930 if (info->flags & IEEE80211_TX_CTL_AMPDU)
931 rs_collect_tx_data(search_win, rs_index, tpt,
932 info->status.ampdu_ack_len,
933 info->status.ampdu_ack_map);
934 else
935 rs_collect_tx_data(search_win, rs_index, tpt,
936 1, status);
937 /* Else if type matches "current/active" table,
938 * add final tx status to "current/active" history */
939 } else if ((tbl_type.lq_type == curr_tbl->lq_type) &&
940 (tbl_type.ant_type == curr_tbl->ant_type) &&
941 (tbl_type.is_SGI == curr_tbl->is_SGI)) {
942 if (curr_tbl->expected_tpt)
943 tpt = curr_tbl->expected_tpt[rs_index];
944 else
945 tpt = 0;
946 if (info->flags & IEEE80211_TX_CTL_AMPDU)
947 rs_collect_tx_data(window, rs_index, tpt,
948 info->status.ampdu_ack_len,
949 info->status.ampdu_ack_map);
950 else
951 rs_collect_tx_data(window, rs_index, tpt,
952 1, status);
953 }
954
955 /* If not searching for new mode, increment success/failed counter
956 * ... these help determine when to start searching again */
957 if (lq_sta->stay_in_tbl) {
958 if (info->flags & IEEE80211_TX_CTL_AMPDU) {
959 lq_sta->total_success += info->status.ampdu_ack_map;
960 lq_sta->total_failed +=
961 (info->status.ampdu_ack_len - info->status.ampdu_ack_map);
962 } else {
963 if (status)
964 lq_sta->total_success++;
965 else
966 lq_sta->total_failed++;
967 }
968 }
969
970 /* See if there's a better rate or modulation mode to try. */
971 rs_rate_scale_perform(priv, dev, hdr, sta);
972out:
973 rcu_read_unlock();
974 return;
975}
976
977/*
978 * Begin a period of staying with a selected modulation mode.
979 * Set "stay_in_tbl" flag to prevent any mode switches.
980 * Set frame tx success limits according to legacy vs. high-throughput,
981 * and reset overall (spanning all rates) tx success history statistics.
982 * These control how long we stay using same modulation mode before
983 * searching for a new mode.
984 */
985static void rs_set_stay_in_table(struct iwl_priv *priv, u8 is_legacy,
986 struct iwl_lq_sta *lq_sta)
987{
988 IWL_DEBUG_RATE("we are staying in the same table\n");
989 lq_sta->stay_in_tbl = 1; /* only place this gets set */
990 if (is_legacy) {
991 lq_sta->table_count_limit = IWL_LEGACY_TABLE_COUNT;
992 lq_sta->max_failure_limit = IWL_LEGACY_FAILURE_LIMIT;
993 lq_sta->max_success_limit = IWL_LEGACY_SUCCESS_LIMIT;
994 } else {
995 lq_sta->table_count_limit = IWL_NONE_LEGACY_TABLE_COUNT;
996 lq_sta->max_failure_limit = IWL_NONE_LEGACY_FAILURE_LIMIT;
997 lq_sta->max_success_limit = IWL_NONE_LEGACY_SUCCESS_LIMIT;
998 }
999 lq_sta->table_count = 0;
1000 lq_sta->total_failed = 0;
1001 lq_sta->total_success = 0;
1002}
1003
1004/*
1005 * Find correct throughput table for given mode of modulation
1006 */
1007static void rs_set_expected_tpt_table(struct iwl_lq_sta *lq_sta,
1008 struct iwl_scale_tbl_info *tbl)
1009{
1010 if (is_legacy(tbl->lq_type)) {
1011 if (!is_a_band(tbl->lq_type))
1012 tbl->expected_tpt = expected_tpt_G;
1013 else
1014 tbl->expected_tpt = expected_tpt_A;
1015 } else if (is_siso(tbl->lq_type)) {
1016 if (tbl->is_fat && !lq_sta->is_dup)
1017 if (tbl->is_SGI)
1018 tbl->expected_tpt = expected_tpt_siso40MHzSGI;
1019 else
1020 tbl->expected_tpt = expected_tpt_siso40MHz;
1021 else if (tbl->is_SGI)
1022 tbl->expected_tpt = expected_tpt_siso20MHzSGI;
1023 else
1024 tbl->expected_tpt = expected_tpt_siso20MHz;
1025
1026 } else if (is_mimo(tbl->lq_type)) { /* FIXME:need to separate mimo2/3 */
1027 if (tbl->is_fat && !lq_sta->is_dup)
1028 if (tbl->is_SGI)
1029 tbl->expected_tpt = expected_tpt_mimo40MHzSGI;
1030 else
1031 tbl->expected_tpt = expected_tpt_mimo40MHz;
1032 else if (tbl->is_SGI)
1033 tbl->expected_tpt = expected_tpt_mimo20MHzSGI;
1034 else
1035 tbl->expected_tpt = expected_tpt_mimo20MHz;
1036 } else
1037 tbl->expected_tpt = expected_tpt_G;
1038}
1039
1040/*
1041 * Find starting rate for new "search" high-throughput mode of modulation.
1042 * Goal is to find lowest expected rate (under perfect conditions) that is
1043 * above the current measured throughput of "active" mode, to give new mode
1044 * a fair chance to prove itself without too many challenges.
1045 *
1046 * This gets called when transitioning to more aggressive modulation
1047 * (i.e. legacy to SISO or MIMO, or SISO to MIMO), as well as less aggressive
1048 * (i.e. MIMO to SISO). When moving to MIMO, bit rate will typically need
1049 * to decrease to match "active" throughput. When moving from MIMO to SISO,
1050 * bit rate will typically need to increase, but not if performance was bad.
1051 */
1052static s32 rs_get_best_rate(struct iwl_priv *priv,
1053 struct iwl_lq_sta *lq_sta,
1054 struct iwl_scale_tbl_info *tbl, /* "search" */
1055 u16 rate_mask, s8 index)
1056{
1057 /* "active" values */
1058 struct iwl_scale_tbl_info *active_tbl =
1059 &(lq_sta->lq_info[lq_sta->active_tbl]);
1060 s32 active_sr = active_tbl->win[index].success_ratio;
1061 s32 active_tpt = active_tbl->expected_tpt[index];
1062
1063 /* expected "search" throughput */
1064 s32 *tpt_tbl = tbl->expected_tpt;
1065
1066 s32 new_rate, high, low, start_hi;
1067 u16 high_low;
1068 s8 rate = index;
1069
1070 new_rate = high = low = start_hi = IWL_RATE_INVALID;
1071
1072 for (; ;) {
1073 high_low = rs_get_adjacent_rate(priv, rate, rate_mask,
1074 tbl->lq_type);
1075
1076 low = high_low & 0xff;
1077 high = (high_low >> 8) & 0xff;
1078
1079 /*
1080 * Lower the "search" bit rate, to give new "search" mode
1081 * approximately the same throughput as "active" if:
1082 *
1083 * 1) "Active" mode has been working modestly well (but not
1084 * great), and expected "search" throughput (under perfect
1085 * conditions) at candidate rate is above the actual
1086 * measured "active" throughput (but less than expected
1087 * "active" throughput under perfect conditions).
1088 * OR
1089 * 2) "Active" mode has been working perfectly or very well
1090 * and expected "search" throughput (under perfect
1091 * conditions) at candidate rate is above expected
1092 * "active" throughput (under perfect conditions).
1093 */
1094 if ((((100 * tpt_tbl[rate]) > lq_sta->last_tpt) &&
1095 ((active_sr > IWL_RATE_DECREASE_TH) &&
1096 (active_sr <= IWL_RATE_HIGH_TH) &&
1097 (tpt_tbl[rate] <= active_tpt))) ||
1098 ((active_sr >= IWL_RATE_SCALE_SWITCH) &&
1099 (tpt_tbl[rate] > active_tpt))) {
1100
1101 /* (2nd or later pass)
1102 * If we've already tried to raise the rate, and are
1103 * now trying to lower it, use the higher rate. */
1104 if (start_hi != IWL_RATE_INVALID) {
1105 new_rate = start_hi;
1106 break;
1107 }
1108
1109 new_rate = rate;
1110
1111 /* Loop again with lower rate */
1112 if (low != IWL_RATE_INVALID)
1113 rate = low;
1114
1115 /* Lower rate not available, use the original */
1116 else
1117 break;
1118
1119 /* Else try to raise the "search" rate to match "active" */
1120 } else {
1121 /* (2nd or later pass)
1122 * If we've already tried to lower the rate, and are
1123 * now trying to raise it, use the lower rate. */
1124 if (new_rate != IWL_RATE_INVALID)
1125 break;
1126
1127 /* Loop again with higher rate */
1128 else if (high != IWL_RATE_INVALID) {
1129 start_hi = high;
1130 rate = high;
1131
1132 /* Higher rate not available, use the original */
1133 } else {
1134 new_rate = rate;
1135 break;
1136 }
1137 }
1138 }
1139
1140 return new_rate;
1141}
1142
1143/*
1144 * Set up search table for MIMO
1145 */
1146static int rs_switch_to_mimo2(struct iwl_priv *priv,
1147 struct iwl_lq_sta *lq_sta,
1148 struct ieee80211_conf *conf,
1149 struct sta_info *sta,
1150 struct iwl_scale_tbl_info *tbl, int index)
1151{
1152 u16 rate_mask;
1153 s32 rate;
1154 s8 is_green = lq_sta->is_green;
1155
1156 if (!(conf->flags & IEEE80211_CONF_SUPPORT_HT_MODE) ||
1157 !sta->sta.ht_info.ht_supported)
1158 return -1;
1159
1160 if (((sta->sta.ht_info.cap & IEEE80211_HT_CAP_SM_PS) >> 2)
1161 == WLAN_HT_CAP_SM_PS_STATIC)
1162 return -1;
1163
1164 /* Need both Tx chains/antennas to support MIMO */
1165 if (priv->hw_params.tx_chains_num < 2)
1166 return -1;
1167
1168 IWL_DEBUG_RATE("LQ: try to switch to MIMO2\n");
1169
1170 tbl->lq_type = LQ_MIMO2;
1171 tbl->is_dup = lq_sta->is_dup;
1172 tbl->action = 0;
1173 rate_mask = lq_sta->active_mimo2_rate;
1174
1175 if (priv->current_ht_config.supported_chan_width
1176 == IWL_CHANNEL_WIDTH_40MHZ)
1177 tbl->is_fat = 1;
1178 else
1179 tbl->is_fat = 0;
1180
1181 /* FIXME: - don't toggle SGI here
1182 if (tbl->is_fat) {
1183 if (priv->current_ht_config.sgf & HT_SHORT_GI_40MHZ_ONLY)
1184 tbl->is_SGI = 1;
1185 else
1186 tbl->is_SGI = 0;
1187 } else if (priv->current_ht_config.sgf & HT_SHORT_GI_20MHZ_ONLY)
1188 tbl->is_SGI = 1;
1189 else
1190 tbl->is_SGI = 0;
1191 */
1192
1193 rs_set_expected_tpt_table(lq_sta, tbl);
1194
1195 rate = rs_get_best_rate(priv, lq_sta, tbl, rate_mask, index);
1196
1197 IWL_DEBUG_RATE("LQ: MIMO2 best rate %d mask %X\n", rate, rate_mask);
1198
1199 if ((rate == IWL_RATE_INVALID) || !((1 << rate) & rate_mask)) {
1200 IWL_DEBUG_RATE("Can't switch with index %d rate mask %x\n",
1201 rate, rate_mask);
1202 return -1;
1203 }
1204 tbl->current_rate = rate_n_flags_from_tbl(tbl, rate, is_green);
1205
1206 IWL_DEBUG_RATE("LQ: Switch to new mcs %X index is green %X\n",
1207 tbl->current_rate, is_green);
1208 return 0;
1209}
1210
1211/*
1212 * Set up search table for SISO
1213 */
1214static int rs_switch_to_siso(struct iwl_priv *priv,
1215 struct iwl_lq_sta *lq_sta,
1216 struct ieee80211_conf *conf,
1217 struct sta_info *sta,
1218 struct iwl_scale_tbl_info *tbl, int index)
1219{
1220 u16 rate_mask;
1221 u8 is_green = lq_sta->is_green;
1222 s32 rate;
1223
1224 if (!(conf->flags & IEEE80211_CONF_SUPPORT_HT_MODE) ||
1225 !sta->sta.ht_info.ht_supported)
1226 return -1;
1227
1228 IWL_DEBUG_RATE("LQ: try to switch to SISO\n");
1229
1230 tbl->is_dup = lq_sta->is_dup;
1231 tbl->lq_type = LQ_SISO;
1232 tbl->action = 0;
1233 rate_mask = lq_sta->active_siso_rate;
1234
1235 if (priv->current_ht_config.supported_chan_width
1236 == IWL_CHANNEL_WIDTH_40MHZ)
1237 tbl->is_fat = 1;
1238 else
1239 tbl->is_fat = 0;
1240
1241 /* FIXME: - don't toggle SGI here
1242 if (tbl->is_fat) {
1243 if (priv->current_ht_config.sgf & HT_SHORT_GI_40MHZ_ONLY)
1244 tbl->is_SGI = 1;
1245 else
1246 tbl->is_SGI = 0;
1247 } else if (priv->current_ht_config.sgf & HT_SHORT_GI_20MHZ_ONLY)
1248 tbl->is_SGI = 1;
1249 else
1250 tbl->is_SGI = 0;
1251 */
1252
1253 if (is_green)
1254 tbl->is_SGI = 0; /*11n spec: no SGI in SISO+Greenfield*/
1255
1256 rs_set_expected_tpt_table(lq_sta, tbl);
1257 rate = rs_get_best_rate(priv, lq_sta, tbl, rate_mask, index);
1258
1259 IWL_DEBUG_RATE("LQ: get best rate %d mask %X\n", rate, rate_mask);
1260 if ((rate == IWL_RATE_INVALID) || !((1 << rate) & rate_mask)) {
1261 IWL_DEBUG_RATE("can not switch with index %d rate mask %x\n",
1262 rate, rate_mask);
1263 return -1;
1264 }
1265 tbl->current_rate = rate_n_flags_from_tbl(tbl, rate, is_green);
1266 IWL_DEBUG_RATE("LQ: Switch to new mcs %X index is green %X\n",
1267 tbl->current_rate, is_green);
1268 return 0;
1269}
1270
1271/*
1272 * Try to switch to new modulation mode from legacy
1273 */
1274static int rs_move_legacy_other(struct iwl_priv *priv,
1275 struct iwl_lq_sta *lq_sta,
1276 struct ieee80211_conf *conf,
1277 struct sta_info *sta,
1278 int index)
1279{
1280 struct iwl_scale_tbl_info *tbl = &(lq_sta->lq_info[lq_sta->active_tbl]);
1281 struct iwl_scale_tbl_info *search_tbl =
1282 &(lq_sta->lq_info[(1 - lq_sta->active_tbl)]);
1283 struct iwl_rate_scale_data *window = &(tbl->win[index]);
1284 u32 sz = (sizeof(struct iwl_scale_tbl_info) -
1285 (sizeof(struct iwl_rate_scale_data) * IWL_RATE_COUNT));
1286 u8 start_action = tbl->action;
1287 u8 valid_tx_ant = priv->hw_params.valid_tx_ant;
1288 u8 tx_chains_num = priv->hw_params.tx_chains_num;
1289 int ret = 0;
1290
1291 for (; ;) {
1292 switch (tbl->action) {
1293 case IWL_LEGACY_SWITCH_ANTENNA1:
1294 case IWL_LEGACY_SWITCH_ANTENNA2:
1295 IWL_DEBUG_RATE("LQ: Legacy toggle Antenna\n");
1296
1297 lq_sta->action_counter++;
1298
1299 if ((tbl->action == IWL_LEGACY_SWITCH_ANTENNA1 &&
1300 tx_chains_num <= 1) ||
1301 (tbl->action == IWL_LEGACY_SWITCH_ANTENNA2 &&
1302 tx_chains_num <= 2))
1303 break;
1304
1305 /* Don't change antenna if success has been great */
1306 if (window->success_ratio >= IWL_RS_GOOD_RATIO)
1307 break;
1308
1309 /* Set up search table to try other antenna */
1310 memcpy(search_tbl, tbl, sz);
1311
1312 if (rs_toggle_antenna(valid_tx_ant,
1313 &search_tbl->current_rate, search_tbl)) {
1314 rs_set_expected_tpt_table(lq_sta, search_tbl);
1315 goto out;
1316 }
1317 break;
1318 case IWL_LEGACY_SWITCH_SISO:
1319 IWL_DEBUG_RATE("LQ: Legacy switch to SISO\n");
1320
1321 /* Set up search table to try SISO */
1322 memcpy(search_tbl, tbl, sz);
1323 search_tbl->is_SGI = 0;
1324 ret = rs_switch_to_siso(priv, lq_sta, conf, sta,
1325 search_tbl, index);
1326 if (!ret) {
1327 lq_sta->action_counter = 0;
1328 goto out;
1329 }
1330
1331 break;
1332 case IWL_LEGACY_SWITCH_MIMO2_AB:
1333 case IWL_LEGACY_SWITCH_MIMO2_AC:
1334 case IWL_LEGACY_SWITCH_MIMO2_BC:
1335 IWL_DEBUG_RATE("LQ: Legacy switch to MIMO2\n");
1336
1337 /* Set up search table to try MIMO */
1338 memcpy(search_tbl, tbl, sz);
1339 search_tbl->is_SGI = 0;
1340
1341 if (tbl->action == IWL_LEGACY_SWITCH_MIMO2_AB)
1342 search_tbl->ant_type = ANT_AB;
1343 else if (tbl->action == IWL_LEGACY_SWITCH_MIMO2_AC)
1344 search_tbl->ant_type = ANT_AC;
1345 else
1346 search_tbl->ant_type = ANT_BC;
1347
1348 if (!rs_is_valid_ant(valid_tx_ant, search_tbl->ant_type))
1349 break;
1350
1351 ret = rs_switch_to_mimo2(priv, lq_sta, conf, sta,
1352 search_tbl, index);
1353 if (!ret) {
1354 lq_sta->action_counter = 0;
1355 goto out;
1356 }
1357 break;
1358 }
1359 tbl->action++;
1360 if (tbl->action > IWL_LEGACY_SWITCH_MIMO2_BC)
1361 tbl->action = IWL_LEGACY_SWITCH_ANTENNA1;
1362
1363 if (tbl->action == start_action)
1364 break;
1365
1366 }
1367 search_tbl->lq_type = LQ_NONE;
1368 return 0;
1369
1370out:
1371 lq_sta->search_better_tbl = 1;
1372 tbl->action++;
1373 if (tbl->action > IWL_LEGACY_SWITCH_MIMO2_BC)
1374 tbl->action = IWL_LEGACY_SWITCH_ANTENNA1;
1375 return 0;
1376
1377}
1378
1379/*
1380 * Try to switch to new modulation mode from SISO
1381 */
1382static int rs_move_siso_to_other(struct iwl_priv *priv,
1383 struct iwl_lq_sta *lq_sta,
1384 struct ieee80211_conf *conf,
1385 struct sta_info *sta, int index)
1386{
1387 u8 is_green = lq_sta->is_green;
1388 struct iwl_scale_tbl_info *tbl = &(lq_sta->lq_info[lq_sta->active_tbl]);
1389 struct iwl_scale_tbl_info *search_tbl =
1390 &(lq_sta->lq_info[(1 - lq_sta->active_tbl)]);
1391 struct iwl_rate_scale_data *window = &(tbl->win[index]);
1392 u32 sz = (sizeof(struct iwl_scale_tbl_info) -
1393 (sizeof(struct iwl_rate_scale_data) * IWL_RATE_COUNT));
1394 u8 start_action = tbl->action;
1395 u8 valid_tx_ant = priv->hw_params.valid_tx_ant;
1396 u8 tx_chains_num = priv->hw_params.tx_chains_num;
1397 int ret;
1398
1399 for (;;) {
1400 lq_sta->action_counter++;
1401 switch (tbl->action) {
1402 case IWL_SISO_SWITCH_ANTENNA1:
1403 case IWL_SISO_SWITCH_ANTENNA2:
1404 IWL_DEBUG_RATE("LQ: SISO toggle Antenna\n");
1405
1406 if ((tbl->action == IWL_SISO_SWITCH_ANTENNA1 &&
1407 tx_chains_num <= 1) ||
1408 (tbl->action == IWL_SISO_SWITCH_ANTENNA2 &&
1409 tx_chains_num <= 2))
1410 break;
1411
1412 if (window->success_ratio >= IWL_RS_GOOD_RATIO)
1413 break;
1414
1415 memcpy(search_tbl, tbl, sz);
1416 if (rs_toggle_antenna(valid_tx_ant,
1417 &search_tbl->current_rate, search_tbl))
1418 goto out;
1419 break;
1420 case IWL_SISO_SWITCH_MIMO2_AB:
1421 case IWL_SISO_SWITCH_MIMO2_AC:
1422 case IWL_SISO_SWITCH_MIMO2_BC:
1423 IWL_DEBUG_RATE("LQ: SISO switch to MIMO2\n");
1424 memcpy(search_tbl, tbl, sz);
1425 search_tbl->is_SGI = 0;
1426
1427 if (tbl->action == IWL_SISO_SWITCH_MIMO2_AB)
1428 search_tbl->ant_type = ANT_AB;
1429 else if (tbl->action == IWL_SISO_SWITCH_MIMO2_AC)
1430 search_tbl->ant_type = ANT_AC;
1431 else
1432 search_tbl->ant_type = ANT_BC;
1433
1434 if (!rs_is_valid_ant(valid_tx_ant, search_tbl->ant_type))
1435 break;
1436
1437 ret = rs_switch_to_mimo2(priv, lq_sta, conf, sta,
1438 search_tbl, index);
1439 if (!ret)
1440 goto out;
1441 break;
1442 case IWL_SISO_SWITCH_GI:
1443 if (!tbl->is_fat &&
1444 !(priv->current_ht_config.sgf &
1445 HT_SHORT_GI_20MHZ))
1446 break;
1447 if (tbl->is_fat &&
1448 !(priv->current_ht_config.sgf &
1449 HT_SHORT_GI_40MHZ))
1450 break;
1451
1452 IWL_DEBUG_RATE("LQ: SISO toggle SGI/NGI\n");
1453
1454 memcpy(search_tbl, tbl, sz);
1455 if (is_green) {
1456 if (!tbl->is_SGI)
1457 break;
1458 else
1459 IWL_ERROR("SGI was set in GF+SISO\n");
1460 }
1461 search_tbl->is_SGI = !tbl->is_SGI;
1462 rs_set_expected_tpt_table(lq_sta, search_tbl);
1463 if (tbl->is_SGI) {
1464 s32 tpt = lq_sta->last_tpt / 100;
1465 if (tpt >= search_tbl->expected_tpt[index])
1466 break;
1467 }
1468 search_tbl->current_rate = rate_n_flags_from_tbl(
1469 search_tbl, index, is_green);
1470 goto out;
1471 }
1472 tbl->action++;
1473 if (tbl->action > IWL_SISO_SWITCH_GI)
1474 tbl->action = IWL_SISO_SWITCH_ANTENNA1;
1475
1476 if (tbl->action == start_action)
1477 break;
1478 }
1479 search_tbl->lq_type = LQ_NONE;
1480 return 0;
1481
1482 out:
1483 lq_sta->search_better_tbl = 1;
1484 tbl->action++;
1485 if (tbl->action > IWL_SISO_SWITCH_GI)
1486 tbl->action = IWL_SISO_SWITCH_ANTENNA1;
1487 return 0;
1488}
1489
1490/*
1491 * Try to switch to new modulation mode from MIMO
1492 */
1493static int rs_move_mimo_to_other(struct iwl_priv *priv,
1494 struct iwl_lq_sta *lq_sta,
1495 struct ieee80211_conf *conf,
1496 struct sta_info *sta, int index)
1497{
1498 s8 is_green = lq_sta->is_green;
1499 struct iwl_scale_tbl_info *tbl = &(lq_sta->lq_info[lq_sta->active_tbl]);
1500 struct iwl_scale_tbl_info *search_tbl =
1501 &(lq_sta->lq_info[(1 - lq_sta->active_tbl)]);
1502 struct iwl_rate_scale_data *window = &(tbl->win[index]);
1503 u32 sz = (sizeof(struct iwl_scale_tbl_info) -
1504 (sizeof(struct iwl_rate_scale_data) * IWL_RATE_COUNT));
1505 u8 start_action = tbl->action;
1506 u8 valid_tx_ant = priv->hw_params.valid_tx_ant;
1507 u8 tx_chains_num = priv->hw_params.tx_chains_num;
1508 int ret;
1509
1510 for (;;) {
1511 lq_sta->action_counter++;
1512 switch (tbl->action) {
1513 case IWL_MIMO2_SWITCH_ANTENNA1:
1514 case IWL_MIMO2_SWITCH_ANTENNA2:
1515 IWL_DEBUG_RATE("LQ: MIMO toggle Antennas\n");
1516
1517 if (tx_chains_num <= 2)
1518 break;
1519
1520 if (window->success_ratio >= IWL_RS_GOOD_RATIO)
1521 break;
1522
1523 memcpy(search_tbl, tbl, sz);
1524 if (rs_toggle_antenna(valid_tx_ant,
1525 &search_tbl->current_rate, search_tbl))
1526 goto out;
1527 break;
1528 case IWL_MIMO2_SWITCH_SISO_A:
1529 case IWL_MIMO2_SWITCH_SISO_B:
1530 case IWL_MIMO2_SWITCH_SISO_C:
1531 IWL_DEBUG_RATE("LQ: MIMO2 switch to SISO\n");
1532
1533 /* Set up new search table for SISO */
1534 memcpy(search_tbl, tbl, sz);
1535
1536 if (tbl->action == IWL_MIMO2_SWITCH_SISO_A)
1537 search_tbl->ant_type = ANT_A;
1538 else if (tbl->action == IWL_MIMO2_SWITCH_SISO_B)
1539 search_tbl->ant_type = ANT_B;
1540 else
1541 search_tbl->ant_type = ANT_C;
1542
1543 if (!rs_is_valid_ant(valid_tx_ant, search_tbl->ant_type))
1544 break;
1545
1546 ret = rs_switch_to_siso(priv, lq_sta, conf, sta,
1547 search_tbl, index);
1548 if (!ret)
1549 goto out;
1550
1551 break;
1552
1553 case IWL_MIMO2_SWITCH_GI:
1554 if (!tbl->is_fat &&
1555 !(priv->current_ht_config.sgf &
1556 HT_SHORT_GI_20MHZ))
1557 break;
1558 if (tbl->is_fat &&
1559 !(priv->current_ht_config.sgf &
1560 HT_SHORT_GI_40MHZ))
1561 break;
1562
1563 IWL_DEBUG_RATE("LQ: MIMO toggle SGI/NGI\n");
1564
1565 /* Set up new search table for MIMO */
1566 memcpy(search_tbl, tbl, sz);
1567 search_tbl->is_SGI = !tbl->is_SGI;
1568 rs_set_expected_tpt_table(lq_sta, search_tbl);
1569 /*
1570 * If active table already uses the fastest possible
1571 * modulation (dual stream with short guard interval),
1572 * and it's working well, there's no need to look
1573 * for a better type of modulation!
1574 */
1575 if (tbl->is_SGI) {
1576 s32 tpt = lq_sta->last_tpt / 100;
1577 if (tpt >= search_tbl->expected_tpt[index])
1578 break;
1579 }
1580 search_tbl->current_rate = rate_n_flags_from_tbl(
1581 search_tbl, index, is_green);
1582 goto out;
1583
1584 }
1585 tbl->action++;
1586 if (tbl->action > IWL_MIMO2_SWITCH_GI)
1587 tbl->action = IWL_MIMO2_SWITCH_ANTENNA1;
1588
1589 if (tbl->action == start_action)
1590 break;
1591 }
1592 search_tbl->lq_type = LQ_NONE;
1593 return 0;
1594 out:
1595 lq_sta->search_better_tbl = 1;
1596 tbl->action++;
1597 if (tbl->action > IWL_MIMO2_SWITCH_GI)
1598 tbl->action = IWL_MIMO2_SWITCH_ANTENNA1;
1599 return 0;
1600
1601}
1602
1603/*
1604 * Check whether we should continue using same modulation mode, or
1605 * begin search for a new mode, based on:
1606 * 1) # tx successes or failures while using this mode
1607 * 2) # times calling this function
1608 * 3) elapsed time in this mode (not used, for now)
1609 */
1610static void rs_stay_in_table(struct iwl_lq_sta *lq_sta)
1611{
1612 struct iwl_scale_tbl_info *tbl;
1613 int i;
1614 int active_tbl;
1615 int flush_interval_passed = 0;
1616 struct iwl_priv *priv;
1617
1618 priv = lq_sta->drv;
1619 active_tbl = lq_sta->active_tbl;
1620
1621 tbl = &(lq_sta->lq_info[active_tbl]);
1622
1623 /* If we've been disallowing search, see if we should now allow it */
1624 if (lq_sta->stay_in_tbl) {
1625
1626 /* Elapsed time using current modulation mode */
1627 if (lq_sta->flush_timer)
1628 flush_interval_passed =
1629 time_after(jiffies,
1630 (unsigned long)(lq_sta->flush_timer +
1631 IWL_RATE_SCALE_FLUSH_INTVL));
1632
1633 /*
1634 * Check if we should allow search for new modulation mode.
1635 * If many frames have failed or succeeded, or we've used
1636 * this same modulation for a long time, allow search, and
1637 * reset history stats that keep track of whether we should
1638 * allow a new search. Also (below) reset all bitmaps and
1639 * stats in active history.
1640 */
1641 if ((lq_sta->total_failed > lq_sta->max_failure_limit) ||
1642 (lq_sta->total_success > lq_sta->max_success_limit) ||
1643 ((!lq_sta->search_better_tbl) && (lq_sta->flush_timer)
1644 && (flush_interval_passed))) {
1645 IWL_DEBUG_RATE("LQ: stay is expired %d %d %d\n:",
1646 lq_sta->total_failed,
1647 lq_sta->total_success,
1648 flush_interval_passed);
1649
1650 /* Allow search for new mode */
1651 lq_sta->stay_in_tbl = 0; /* only place reset */
1652 lq_sta->total_failed = 0;
1653 lq_sta->total_success = 0;
1654 lq_sta->flush_timer = 0;
1655
1656 /*
1657 * Else if we've used this modulation mode enough repetitions
1658 * (regardless of elapsed time or success/failure), reset
1659 * history bitmaps and rate-specific stats for all rates in
1660 * active table.
1661 */
1662 } else {
1663 lq_sta->table_count++;
1664 if (lq_sta->table_count >=
1665 lq_sta->table_count_limit) {
1666 lq_sta->table_count = 0;
1667
1668 IWL_DEBUG_RATE("LQ: stay in table clear win\n");
1669 for (i = 0; i < IWL_RATE_COUNT; i++)
1670 rs_rate_scale_clear_window(
1671 &(tbl->win[i]));
1672 }
1673 }
1674
1675 /* If transitioning to allow "search", reset all history
1676 * bitmaps and stats in active table (this will become the new
1677 * "search" table). */
1678 if (!lq_sta->stay_in_tbl) {
1679 for (i = 0; i < IWL_RATE_COUNT; i++)
1680 rs_rate_scale_clear_window(&(tbl->win[i]));
1681 }
1682 }
1683}
1684
1685/*
1686 * Do rate scaling and search for new modulation mode.
1687 */
1688static void rs_rate_scale_perform(struct iwl_priv *priv,
1689 struct net_device *dev,
1690 struct ieee80211_hdr *hdr,
1691 struct sta_info *sta)
1692{
1693 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1694 struct ieee80211_hw *hw = local_to_hw(local);
1695 struct ieee80211_conf *conf = &hw->conf;
1696 int low = IWL_RATE_INVALID;
1697 int high = IWL_RATE_INVALID;
1698 int index;
1699 int i;
1700 struct iwl_rate_scale_data *window = NULL;
1701 int current_tpt = IWL_INVALID_VALUE;
1702 int low_tpt = IWL_INVALID_VALUE;
1703 int high_tpt = IWL_INVALID_VALUE;
1704 u32 fail_count;
1705 s8 scale_action = 0;
1706 __le16 fc;
1707 u16 rate_mask;
1708 u8 update_lq = 0;
1709 struct iwl_lq_sta *lq_sta;
1710 struct iwl_scale_tbl_info *tbl, *tbl1;
1711 u16 rate_scale_index_msk = 0;
1712 u32 rate;
1713 u8 is_green = 0;
1714 u8 active_tbl = 0;
1715 u8 done_search = 0;
1716 u16 high_low;
1717 s32 sr;
1718 u8 tid = MAX_TID_COUNT;
1719
1720 IWL_DEBUG_RATE("rate scale calculate new rate for skb\n");
1721
1722 fc = hdr->frame_control;
1723 if (!ieee80211_is_data(fc) || is_multicast_ether_addr(hdr->addr1)) {
1724 /* Send management frames and broadcast/multicast data using
1725 * lowest rate. */
1726 /* TODO: this could probably be improved.. */
1727 return;
1728 }
1729
1730 if (!sta || !sta->rate_ctrl_priv)
1731 return;
1732
1733 lq_sta = (struct iwl_lq_sta *)sta->rate_ctrl_priv;
1734 lq_sta->supp_rates = sta->sta.supp_rates[lq_sta->band];
1735
1736 tid = rs_tl_add_packet(lq_sta, hdr);
1737
1738 /*
1739 * Select rate-scale / modulation-mode table to work with in
1740 * the rest of this function: "search" if searching for better
1741 * modulation mode, or "active" if doing rate scaling within a mode.
1742 */
1743 if (!lq_sta->search_better_tbl)
1744 active_tbl = lq_sta->active_tbl;
1745 else
1746 active_tbl = 1 - lq_sta->active_tbl;
1747
1748 tbl = &(lq_sta->lq_info[active_tbl]);
1749 is_green = lq_sta->is_green;
1750
1751 /* current tx rate */
1752 index = lq_sta->last_txrate_idx;
1753
1754 IWL_DEBUG_RATE("Rate scale index %d for type %d\n", index,
1755 tbl->lq_type);
1756
1757 /* rates available for this association, and for modulation mode */
1758 rate_mask = rs_get_supported_rates(lq_sta, hdr, tbl->lq_type);
1759
1760 IWL_DEBUG_RATE("mask 0x%04X \n", rate_mask);
1761
1762 /* mask with station rate restriction */
1763 if (is_legacy(tbl->lq_type)) {
1764 if (lq_sta->band == IEEE80211_BAND_5GHZ)
1765 /* supp_rates has no CCK bits in A mode */
1766 rate_scale_index_msk = (u16) (rate_mask &
1767 (lq_sta->supp_rates << IWL_FIRST_OFDM_RATE));
1768 else
1769 rate_scale_index_msk = (u16) (rate_mask &
1770 lq_sta->supp_rates);
1771
1772 } else
1773 rate_scale_index_msk = rate_mask;
1774
1775 if (!rate_scale_index_msk)
1776 rate_scale_index_msk = rate_mask;
1777
1778 if (!((1 << index) & rate_scale_index_msk)) {
1779 IWL_ERROR("Current Rate is not valid\n");
1780 return;
1781 }
1782
1783 /* Get expected throughput table and history window for current rate */
1784 if (!tbl->expected_tpt) {
1785 IWL_ERROR("tbl->expected_tpt is NULL\n");
1786 return;
1787 }
1788
1789 window = &(tbl->win[index]);
1790
1791 /*
1792 * If there is not enough history to calculate actual average
1793 * throughput, keep analyzing results of more tx frames, without
1794 * changing rate or mode (bypass most of the rest of this function).
1795 * Set up new rate table in uCode only if old rate is not supported
1796 * in current association (use new rate found above).
1797 */
1798 fail_count = window->counter - window->success_counter;
1799 if ((fail_count < IWL_RATE_MIN_FAILURE_TH) &&
1800 (window->success_counter < IWL_RATE_MIN_SUCCESS_TH)) {
1801 IWL_DEBUG_RATE("LQ: still below TH. succ=%d total=%d "
1802 "for index %d\n",
1803 window->success_counter, window->counter, index);
1804
1805 /* Can't calculate this yet; not enough history */
1806 window->average_tpt = IWL_INVALID_VALUE;
1807
1808 /* Should we stay with this modulation mode,
1809 * or search for a new one? */
1810 rs_stay_in_table(lq_sta);
1811
1812 goto out;
1813 }
1814
1815 /* Else we have enough samples; calculate estimate of
1816 * actual average throughput */
1817
1818 BUG_ON(window->average_tpt != ((window->success_ratio *
1819 tbl->expected_tpt[index] + 64) / 128));
1820
1821 /* If we are searching for better modulation mode, check success. */
1822 if (lq_sta->search_better_tbl) {
1823
1824 /* If good success, continue using the "search" mode;
1825 * no need to send new link quality command, since we're
1826 * continuing to use the setup that we've been trying. */
1827 if (window->average_tpt > lq_sta->last_tpt) {
1828
1829 IWL_DEBUG_RATE("LQ: SWITCHING TO NEW TABLE "
1830 "suc=%d cur-tpt=%d old-tpt=%d\n",
1831 window->success_ratio,
1832 window->average_tpt,
1833 lq_sta->last_tpt);
1834
1835 if (!is_legacy(tbl->lq_type))
1836 lq_sta->enable_counter = 1;
1837
1838 /* Swap tables; "search" becomes "active" */
1839 lq_sta->active_tbl = active_tbl;
1840 current_tpt = window->average_tpt;
1841
1842 /* Else poor success; go back to mode in "active" table */
1843 } else {
1844
1845 IWL_DEBUG_RATE("LQ: GOING BACK TO THE OLD TABLE "
1846 "suc=%d cur-tpt=%d old-tpt=%d\n",
1847 window->success_ratio,
1848 window->average_tpt,
1849 lq_sta->last_tpt);
1850
1851 /* Nullify "search" table */
1852 tbl->lq_type = LQ_NONE;
1853
1854 /* Revert to "active" table */
1855 active_tbl = lq_sta->active_tbl;
1856 tbl = &(lq_sta->lq_info[active_tbl]);
1857
1858 /* Revert to "active" rate and throughput info */
1859 index = iwl_hwrate_to_plcp_idx(tbl->current_rate);
1860 current_tpt = lq_sta->last_tpt;
1861
1862 /* Need to set up a new rate table in uCode */
1863 update_lq = 1;
1864 }
1865
1866 /* Either way, we've made a decision; modulation mode
1867 * search is done, allow rate adjustment next time. */
1868 lq_sta->search_better_tbl = 0;
1869 done_search = 1; /* Don't switch modes below! */
1870 goto lq_update;
1871 }
1872
1873 /* (Else) not in search of better modulation mode, try for better
1874 * starting rate, while staying in this mode. */
1875 high_low = rs_get_adjacent_rate(priv, index, rate_scale_index_msk,
1876 tbl->lq_type);
1877 low = high_low & 0xff;
1878 high = (high_low >> 8) & 0xff;
1879
1880 sr = window->success_ratio;
1881
1882 /* Collect measured throughputs for current and adjacent rates */
1883 current_tpt = window->average_tpt;
1884 if (low != IWL_RATE_INVALID)
1885 low_tpt = tbl->win[low].average_tpt;
1886 if (high != IWL_RATE_INVALID)
1887 high_tpt = tbl->win[high].average_tpt;
1888
1889 scale_action = 0;
1890
1891 /* Too many failures, decrease rate */
1892 if ((sr <= IWL_RATE_DECREASE_TH) || (current_tpt == 0)) {
1893 IWL_DEBUG_RATE("decrease rate because of low success_ratio\n");
1894 scale_action = -1;
1895
1896 /* No throughput measured yet for adjacent rates; try increase. */
1897 } else if ((low_tpt == IWL_INVALID_VALUE) &&
1898 (high_tpt == IWL_INVALID_VALUE)) {
1899
1900 if (high != IWL_RATE_INVALID && sr >= IWL_RATE_INCREASE_TH)
1901 scale_action = 1;
1902 else if (low != IWL_RATE_INVALID)
1903 scale_action = -1;
1904 }
1905
1906 /* Both adjacent throughputs are measured, but neither one has better
1907 * throughput; we're using the best rate, don't change it! */
1908 else if ((low_tpt != IWL_INVALID_VALUE) &&
1909 (high_tpt != IWL_INVALID_VALUE) &&
1910 (low_tpt < current_tpt) &&
1911 (high_tpt < current_tpt))
1912 scale_action = 0;
1913
1914 /* At least one adjacent rate's throughput is measured,
1915 * and may have better performance. */
1916 else {
1917 /* Higher adjacent rate's throughput is measured */
1918 if (high_tpt != IWL_INVALID_VALUE) {
1919 /* Higher rate has better throughput */
1920 if (high_tpt > current_tpt &&
1921 sr >= IWL_RATE_INCREASE_TH) {
1922 scale_action = 1;
1923 } else {
1924 IWL_DEBUG_RATE
1925 ("decrease rate because of high tpt\n");
1926 scale_action = -1;
1927 }
1928
1929 /* Lower adjacent rate's throughput is measured */
1930 } else if (low_tpt != IWL_INVALID_VALUE) {
1931 /* Lower rate has better throughput */
1932 if (low_tpt > current_tpt) {
1933 IWL_DEBUG_RATE
1934 ("decrease rate because of low tpt\n");
1935 scale_action = -1;
1936 } else if (sr >= IWL_RATE_INCREASE_TH) {
1937 scale_action = 1;
1938 }
1939 }
1940 }
1941
1942 /* Sanity check; asked for decrease, but success rate or throughput
1943 * has been good at old rate. Don't change it. */
1944 if ((scale_action == -1) && (low != IWL_RATE_INVALID) &&
1945 ((sr > IWL_RATE_HIGH_TH) ||
1946 (current_tpt > (100 * tbl->expected_tpt[low]))))
1947 scale_action = 0;
1948
1949 switch (scale_action) {
1950 case -1:
1951 /* Decrease starting rate, update uCode's rate table */
1952 if (low != IWL_RATE_INVALID) {
1953 update_lq = 1;
1954 index = low;
1955 }
1956 break;
1957 case 1:
1958 /* Increase starting rate, update uCode's rate table */
1959 if (high != IWL_RATE_INVALID) {
1960 update_lq = 1;
1961 index = high;
1962 }
1963
1964 break;
1965 case 0:
1966 /* No change */
1967 default:
1968 break;
1969 }
1970
1971 IWL_DEBUG_RATE("choose rate scale index %d action %d low %d "
1972 "high %d type %d\n",
1973 index, scale_action, low, high, tbl->lq_type);
1974
1975lq_update:
1976 /* Replace uCode's rate table for the destination station. */
1977 if (update_lq) {
1978 rate = rate_n_flags_from_tbl(tbl, index, is_green);
1979 rs_fill_link_cmd(priv, lq_sta, rate);
1980 iwl_send_lq_cmd(priv, &lq_sta->lq, CMD_ASYNC);
1981 }
1982
1983 /* Should we stay with this modulation mode, or search for a new one? */
1984 rs_stay_in_table(lq_sta);
1985
1986 /*
1987 * Search for new modulation mode if we're:
1988 * 1) Not changing rates right now
1989 * 2) Not just finishing up a search
1990 * 3) Allowing a new search
1991 */
1992 if (!update_lq && !done_search && !lq_sta->stay_in_tbl && window->counter) {
1993 /* Save current throughput to compare with "search" throughput*/
1994 lq_sta->last_tpt = current_tpt;
1995
1996 /* Select a new "search" modulation mode to try.
1997 * If one is found, set up the new "search" table. */
1998 if (is_legacy(tbl->lq_type))
1999 rs_move_legacy_other(priv, lq_sta, conf, sta, index);
2000 else if (is_siso(tbl->lq_type))
2001 rs_move_siso_to_other(priv, lq_sta, conf, sta, index);
2002 else
2003 rs_move_mimo_to_other(priv, lq_sta, conf, sta, index);
2004
2005 /* If new "search" mode was selected, set up in uCode table */
2006 if (lq_sta->search_better_tbl) {
2007 /* Access the "search" table, clear its history. */
2008 tbl = &(lq_sta->lq_info[(1 - lq_sta->active_tbl)]);
2009 for (i = 0; i < IWL_RATE_COUNT; i++)
2010 rs_rate_scale_clear_window(&(tbl->win[i]));
2011
2012 /* Use new "search" start rate */
2013 index = iwl_hwrate_to_plcp_idx(tbl->current_rate);
2014
2015 IWL_DEBUG_RATE("Switch current mcs: %X index: %d\n",
2016 tbl->current_rate, index);
2017 rs_fill_link_cmd(priv, lq_sta, tbl->current_rate);
2018 iwl_send_lq_cmd(priv, &lq_sta->lq, CMD_ASYNC);
2019 }
2020
2021 /* If the "active" (non-search) mode was legacy,
2022 * and we've tried switching antennas,
2023 * but we haven't been able to try HT modes (not available),
2024 * stay with best antenna legacy modulation for a while
2025 * before next round of mode comparisons. */
2026 tbl1 = &(lq_sta->lq_info[lq_sta->active_tbl]);
2027 if (is_legacy(tbl1->lq_type) &&
2028 (!(conf->flags & IEEE80211_CONF_SUPPORT_HT_MODE)) &&
2029 (lq_sta->action_counter >= 1)) {
2030 lq_sta->action_counter = 0;
2031 IWL_DEBUG_RATE("LQ: STAY in legacy table\n");
2032 rs_set_stay_in_table(priv, 1, lq_sta);
2033 }
2034
2035 /* If we're in an HT mode, and all 3 mode switch actions
2036 * have been tried and compared, stay in this best modulation
2037 * mode for a while before next round of mode comparisons. */
2038 if (lq_sta->enable_counter &&
2039 (lq_sta->action_counter >= IWL_ACTION_LIMIT)) {
2040 if ((lq_sta->last_tpt > IWL_AGG_TPT_THREHOLD) &&
2041 (lq_sta->tx_agg_tid_en & (1 << tid)) &&
2042 (tid != MAX_TID_COUNT)) {
2043 IWL_DEBUG_RATE("try to aggregate tid %d\n", tid);
2044 rs_tl_turn_on_agg(priv, tid, lq_sta, sta);
2045 }
2046 lq_sta->action_counter = 0;
2047 rs_set_stay_in_table(priv, 0, lq_sta);
2048 }
2049
2050 /*
2051 * Else, don't search for a new modulation mode.
2052 * Put new timestamp in stay-in-modulation-mode flush timer if:
2053 * 1) Not changing rates right now
2054 * 2) Not just finishing up a search
2055 * 3) flush timer is empty
2056 */
2057 } else {
2058 if ((!update_lq) && (!done_search) && (!lq_sta->flush_timer))
2059 lq_sta->flush_timer = jiffies;
2060 }
2061
2062out:
2063 tbl->current_rate = rate_n_flags_from_tbl(tbl, index, is_green);
2064 i = index;
2065 lq_sta->last_txrate_idx = i;
2066
2067 return;
2068}
2069
2070
2071static void rs_initialize_lq(struct iwl_priv *priv,
2072 struct ieee80211_conf *conf,
2073 struct sta_info *sta)
2074{
2075 struct iwl_lq_sta *lq_sta;
2076 struct iwl_scale_tbl_info *tbl;
2077 int rate_idx;
2078 int i;
2079 u32 rate;
2080 u8 use_green = rs_use_green(priv, conf);
2081 u8 active_tbl = 0;
2082 u8 valid_tx_ant;
2083
2084 if (!sta || !sta->rate_ctrl_priv)
2085 goto out;
2086
2087 lq_sta = (struct iwl_lq_sta *)sta->rate_ctrl_priv;
2088 i = lq_sta->last_txrate_idx;
2089
2090 if ((lq_sta->lq.sta_id == 0xff) &&
2091 (priv->iw_mode == NL80211_IFTYPE_ADHOC))
2092 goto out;
2093
2094 valid_tx_ant = priv->hw_params.valid_tx_ant;
2095
2096 if (!lq_sta->search_better_tbl)
2097 active_tbl = lq_sta->active_tbl;
2098 else
2099 active_tbl = 1 - lq_sta->active_tbl;
2100
2101 tbl = &(lq_sta->lq_info[active_tbl]);
2102
2103 if ((i < 0) || (i >= IWL_RATE_COUNT))
2104 i = 0;
2105
2106 /* FIXME:RS: This is also wrong in 4965 */
2107 rate = iwl_rates[i].plcp;
2108 rate |= RATE_MCS_ANT_B_MSK;
2109 rate &= ~RATE_MCS_ANT_A_MSK;
2110
2111 if (i >= IWL_FIRST_CCK_RATE && i <= IWL_LAST_CCK_RATE)
2112 rate |= RATE_MCS_CCK_MSK;
2113
2114 tbl->ant_type = ANT_B;
2115 rs_get_tbl_info_from_mcs(rate, priv->band, tbl, &rate_idx);
2116 if (!rs_is_valid_ant(valid_tx_ant, tbl->ant_type))
2117 rs_toggle_antenna(valid_tx_ant, &rate, tbl);
2118
2119 rate = rate_n_flags_from_tbl(tbl, rate_idx, use_green);
2120 tbl->current_rate = rate;
2121 rs_set_expected_tpt_table(lq_sta, tbl);
2122 rs_fill_link_cmd(NULL, lq_sta, rate);
2123 iwl_send_lq_cmd(priv, &lq_sta->lq, CMD_ASYNC);
2124 out:
2125 return;
2126}
2127
2128static void rs_get_rate(void *priv_rate, struct net_device *dev,
2129 struct ieee80211_supported_band *sband,
2130 struct sk_buff *skb,
2131 struct rate_selection *sel)
2132{
2133
2134 int i;
2135 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2136 struct ieee80211_conf *conf = &local->hw.conf;
2137 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
2138 struct sta_info *sta;
2139 __le16 fc;
2140 struct iwl_priv *priv = (struct iwl_priv *)priv_rate;
2141 struct iwl_lq_sta *lq_sta;
2142
2143 IWL_DEBUG_RATE_LIMIT("rate scale calculate new rate for skb\n");
2144
2145 rcu_read_lock();
2146
2147 sta = sta_info_get(local, hdr->addr1);
2148
2149 /* Send management frames and broadcast/multicast data using lowest
2150 * rate. */
2151 fc = hdr->frame_control;
2152 if (!ieee80211_is_data(fc) || is_multicast_ether_addr(hdr->addr1) ||
2153 !sta || !sta->rate_ctrl_priv) {
2154 sel->rate_idx = rate_lowest_index(local, sband, sta);
2155 goto out;
2156 }
2157
2158 lq_sta = (struct iwl_lq_sta *)sta->rate_ctrl_priv;
2159 i = lq_sta->last_txrate_idx;
2160
2161 if ((priv->iw_mode == NL80211_IFTYPE_ADHOC) &&
2162 !lq_sta->ibss_sta_added) {
2163 u8 sta_id = iwl_find_station(priv, hdr->addr1);
2164 DECLARE_MAC_BUF(mac);
2165
2166 if (sta_id == IWL_INVALID_STATION) {
2167 IWL_DEBUG_RATE("LQ: ADD station %s\n",
2168 print_mac(mac, hdr->addr1));
2169 sta_id = iwl_add_station_flags(priv, hdr->addr1,
2170 0, CMD_ASYNC, NULL);
2171 }
2172 if ((sta_id != IWL_INVALID_STATION)) {
2173 lq_sta->lq.sta_id = sta_id;
2174 lq_sta->lq.rs_table[0].rate_n_flags = 0;
2175 lq_sta->ibss_sta_added = 1;
2176 rs_initialize_lq(priv, conf, sta);
2177 }
2178 }
2179
2180 if ((i < 0) || (i > IWL_RATE_COUNT)) {
2181 sel->rate_idx = rate_lowest_index(local, sband, sta);
2182 goto out;
2183 }
2184
2185 if (sband->band == IEEE80211_BAND_5GHZ)
2186 i -= IWL_FIRST_OFDM_RATE;
2187 sel->rate_idx = i;
2188out:
2189 rcu_read_unlock();
2190}
2191
2192static void *rs_alloc_sta(void *priv_rate, gfp_t gfp)
2193{
2194 struct iwl_lq_sta *lq_sta;
2195 struct iwl_priv *priv;
2196 int i, j;
2197
2198 priv = (struct iwl_priv *)priv_rate;
2199 IWL_DEBUG_RATE("create station rate scale window\n");
2200
2201 lq_sta = kzalloc(sizeof(struct iwl_lq_sta), gfp);
2202
2203 if (lq_sta == NULL)
2204 return NULL;
2205 lq_sta->lq.sta_id = 0xff;
2206
2207
2208 for (j = 0; j < LQ_SIZE; j++)
2209 for (i = 0; i < IWL_RATE_COUNT; i++)
2210 rs_rate_scale_clear_window(&lq_sta->lq_info[j].win[i]);
2211
2212 return lq_sta;
2213}
2214
2215static void rs_rate_init(void *priv_rate, void *priv_sta,
2216 struct ieee80211_local *local,
2217 struct sta_info *sta)
2218{
2219 int i, j;
2220 struct ieee80211_conf *conf = &local->hw.conf;
2221 struct ieee80211_supported_band *sband;
2222 struct iwl_priv *priv = (struct iwl_priv *)priv_rate;
2223 struct iwl_lq_sta *lq_sta = priv_sta;
2224
2225 sband = local->hw.wiphy->bands[local->hw.conf.channel->band];
2226
2227 lq_sta->flush_timer = 0;
2228 lq_sta->supp_rates = sta->sta.supp_rates[sband->band];
2229 for (j = 0; j < LQ_SIZE; j++)
2230 for (i = 0; i < IWL_RATE_COUNT; i++)
2231 rs_rate_scale_clear_window(&lq_sta->lq_info[j].win[i]);
2232
2233 IWL_DEBUG_RATE("LQ: *** rate scale station global init ***\n");
2234 /* TODO: what is a good starting rate for STA? About middle? Maybe not
2235 * the lowest or the highest rate.. Could consider using RSSI from
2236 * previous packets? Need to have IEEE 802.1X auth succeed immediately
2237 * after assoc.. */
2238
2239 lq_sta->ibss_sta_added = 0;
2240 if (priv->iw_mode == NL80211_IFTYPE_AP) {
2241 u8 sta_id = iwl_find_station(priv, sta->sta.addr);
2242 DECLARE_MAC_BUF(mac);
2243
2244 /* for IBSS the call are from tasklet */
2245 IWL_DEBUG_RATE("LQ: ADD station %s\n",
2246 print_mac(mac, sta->sta.addr));
2247
2248 if (sta_id == IWL_INVALID_STATION) {
2249 IWL_DEBUG_RATE("LQ: ADD station %s\n",
2250 print_mac(mac, sta->sta.addr));
2251 sta_id = iwl_add_station_flags(priv, sta->sta.addr,
2252 0, CMD_ASYNC, NULL);
2253 }
2254 if ((sta_id != IWL_INVALID_STATION)) {
2255 lq_sta->lq.sta_id = sta_id;
2256 lq_sta->lq.rs_table[0].rate_n_flags = 0;
2257 }
2258 /* FIXME: this is w/a remove it later */
2259 priv->assoc_station_added = 1;
2260 }
2261
2262 /* Find highest tx rate supported by hardware and destination station */
2263 lq_sta->last_txrate_idx = 3;
2264 for (i = 0; i < sband->n_bitrates; i++)
2265 if (sta->sta.supp_rates[sband->band] & BIT(i))
2266 lq_sta->last_txrate_idx = i;
2267
2268 /* For MODE_IEEE80211A, skip over cck rates in global rate table */
2269 if (local->hw.conf.channel->band == IEEE80211_BAND_5GHZ)
2270 lq_sta->last_txrate_idx += IWL_FIRST_OFDM_RATE;
2271
2272 lq_sta->is_dup = 0;
2273 lq_sta->is_green = rs_use_green(priv, conf);
2274 lq_sta->active_legacy_rate = priv->active_rate & ~(0x1000);
2275 lq_sta->active_rate_basic = priv->active_rate_basic;
2276 lq_sta->band = priv->band;
2277 /*
2278 * active_siso_rate mask includes 9 MBits (bit 5), and CCK (bits 0-3),
2279 * supp_rates[] does not; shift to convert format, force 9 MBits off.
2280 */
2281 lq_sta->active_siso_rate = conf->ht_conf.supp_mcs_set[0] << 1;
2282 lq_sta->active_siso_rate |= conf->ht_conf.supp_mcs_set[0] & 0x1;
2283 lq_sta->active_siso_rate &= ~((u16)0x2);
2284 lq_sta->active_siso_rate <<= IWL_FIRST_OFDM_RATE;
2285
2286 /* Same here */
2287 lq_sta->active_mimo2_rate = conf->ht_conf.supp_mcs_set[1] << 1;
2288 lq_sta->active_mimo2_rate |= conf->ht_conf.supp_mcs_set[1] & 0x1;
2289 lq_sta->active_mimo2_rate &= ~((u16)0x2);
2290 lq_sta->active_mimo2_rate <<= IWL_FIRST_OFDM_RATE;
2291
2292 lq_sta->active_mimo3_rate = conf->ht_conf.supp_mcs_set[2] << 1;
2293 lq_sta->active_mimo3_rate |= conf->ht_conf.supp_mcs_set[2] & 0x1;
2294 lq_sta->active_mimo3_rate &= ~((u16)0x2);
2295 lq_sta->active_mimo3_rate <<= IWL_FIRST_OFDM_RATE;
2296
2297 IWL_DEBUG_RATE("SISO-RATE=%X MIMO2-RATE=%X MIMO3-RATE=%X\n",
2298 lq_sta->active_siso_rate,
2299 lq_sta->active_mimo2_rate,
2300 lq_sta->active_mimo3_rate);
2301
2302 /* These values will be overriden later */
2303 lq_sta->lq.general_params.single_stream_ant_msk = ANT_A;
2304 lq_sta->lq.general_params.dual_stream_ant_msk = ANT_AB;
2305
2306 /* as default allow aggregation for all tids */
2307 lq_sta->tx_agg_tid_en = IWL_AGG_ALL_TID;
2308 lq_sta->drv = priv;
2309
2310 rs_initialize_lq(priv, conf, sta);
2311}
2312
2313static void rs_fill_link_cmd(const struct iwl_priv *priv,
2314 struct iwl_lq_sta *lq_sta, u32 new_rate)
2315{
2316 struct iwl_scale_tbl_info tbl_type;
2317 int index = 0;
2318 int rate_idx;
2319 int repeat_rate = 0;
2320 u8 ant_toggle_cnt = 0;
2321 u8 use_ht_possible = 1;
2322 u8 valid_tx_ant = 0;
2323 struct iwl_link_quality_cmd *lq_cmd = &lq_sta->lq;
2324
2325 /* Override starting rate (index 0) if needed for debug purposes */
2326 rs_dbgfs_set_mcs(lq_sta, &new_rate, index);
2327
2328 /* Interpret new_rate (rate_n_flags) */
2329 memset(&tbl_type, 0, sizeof(tbl_type));
2330 rs_get_tbl_info_from_mcs(new_rate, lq_sta->band,
2331 &tbl_type, &rate_idx);
2332
2333 /* How many times should we repeat the initial rate? */
2334 if (is_legacy(tbl_type.lq_type)) {
2335 ant_toggle_cnt = 1;
2336 repeat_rate = IWL_NUMBER_TRY;
2337 } else {
2338 repeat_rate = IWL_HT_NUMBER_TRY;
2339 }
2340
2341 lq_cmd->general_params.mimo_delimiter =
2342 is_mimo(tbl_type.lq_type) ? 1 : 0;
2343
2344 /* Fill 1st table entry (index 0) */
2345 lq_cmd->rs_table[index].rate_n_flags = cpu_to_le32(new_rate);
2346
2347 if (num_of_ant(tbl_type.ant_type) == 1) {
2348 lq_cmd->general_params.single_stream_ant_msk =
2349 tbl_type.ant_type;
2350 } else if (num_of_ant(tbl_type.ant_type) == 2) {
2351 lq_cmd->general_params.dual_stream_ant_msk =
2352 tbl_type.ant_type;
2353 } /* otherwise we don't modify the existing value */
2354
2355 index++;
2356 repeat_rate--;
2357
2358 if (priv)
2359 valid_tx_ant = priv->hw_params.valid_tx_ant;
2360
2361 /* Fill rest of rate table */
2362 while (index < LINK_QUAL_MAX_RETRY_NUM) {
2363 /* Repeat initial/next rate.
2364 * For legacy IWL_NUMBER_TRY == 1, this loop will not execute.
2365 * For HT IWL_HT_NUMBER_TRY == 3, this executes twice. */
2366 while (repeat_rate > 0 && (index < LINK_QUAL_MAX_RETRY_NUM)) {
2367 if (is_legacy(tbl_type.lq_type)) {
2368 if (ant_toggle_cnt < NUM_TRY_BEFORE_ANT_TOGGLE)
2369 ant_toggle_cnt++;
2370 else if (priv &&
2371 rs_toggle_antenna(valid_tx_ant,
2372 &new_rate, &tbl_type))
2373 ant_toggle_cnt = 1;
2374}
2375
2376 /* Override next rate if needed for debug purposes */
2377 rs_dbgfs_set_mcs(lq_sta, &new_rate, index);
2378
2379 /* Fill next table entry */
2380 lq_cmd->rs_table[index].rate_n_flags =
2381 cpu_to_le32(new_rate);
2382 repeat_rate--;
2383 index++;
2384 }
2385
2386 rs_get_tbl_info_from_mcs(new_rate, lq_sta->band, &tbl_type,
2387 &rate_idx);
2388
2389 /* Indicate to uCode which entries might be MIMO.
2390 * If initial rate was MIMO, this will finally end up
2391 * as (IWL_HT_NUMBER_TRY * 2), after 2nd pass, otherwise 0. */
2392 if (is_mimo(tbl_type.lq_type))
2393 lq_cmd->general_params.mimo_delimiter = index;
2394
2395 /* Get next rate */
2396 new_rate = rs_get_lower_rate(lq_sta, &tbl_type, rate_idx,
2397 use_ht_possible);
2398
2399 /* How many times should we repeat the next rate? */
2400 if (is_legacy(tbl_type.lq_type)) {
2401 if (ant_toggle_cnt < NUM_TRY_BEFORE_ANT_TOGGLE)
2402 ant_toggle_cnt++;
2403 else if (priv &&
2404 rs_toggle_antenna(valid_tx_ant,
2405 &new_rate, &tbl_type))
2406 ant_toggle_cnt = 1;
2407
2408 repeat_rate = IWL_NUMBER_TRY;
2409 } else {
2410 repeat_rate = IWL_HT_NUMBER_TRY;
2411 }
2412
2413 /* Don't allow HT rates after next pass.
2414 * rs_get_lower_rate() will change type to LQ_A or LQ_G. */
2415 use_ht_possible = 0;
2416
2417 /* Override next rate if needed for debug purposes */
2418 rs_dbgfs_set_mcs(lq_sta, &new_rate, index);
2419
2420 /* Fill next table entry */
2421 lq_cmd->rs_table[index].rate_n_flags = cpu_to_le32(new_rate);
2422
2423 index++;
2424 repeat_rate--;
2425 }
2426
2427 lq_cmd->agg_params.agg_frame_cnt_limit = 64;
2428 lq_cmd->agg_params.agg_dis_start_th = 3;
2429 lq_cmd->agg_params.agg_time_limit = cpu_to_le16(4000);
2430}
2431
2432static void *rs_alloc(struct ieee80211_local *local)
2433{
2434 return local->hw.priv;
2435}
2436/* rate scale requires free function to be implemented */
2437static void rs_free(void *priv_rate)
2438{
2439 return;
2440}
2441
2442static void rs_clear(void *priv_rate)
2443{
2444#ifdef CONFIG_IWLWIFI_DEBUG
2445 struct iwl_priv *priv = (struct iwl_priv *) priv_rate;
2446
2447 IWL_DEBUG_RATE("enter\n");
2448
2449 /* TODO - add rate scale state reset */
2450
2451 IWL_DEBUG_RATE("leave\n");
2452#endif /* CONFIG_IWLWIFI_DEBUG */
2453}
2454
2455static void rs_free_sta(void *priv_rate, void *priv_sta)
2456{
2457 struct iwl_lq_sta *lq_sta = priv_sta;
2458 struct iwl_priv *priv;
2459
2460 priv = (struct iwl_priv *)priv_rate;
2461 IWL_DEBUG_RATE("enter\n");
2462 kfree(lq_sta);
2463 IWL_DEBUG_RATE("leave\n");
2464}
2465
2466
2467#ifdef CONFIG_MAC80211_DEBUGFS
2468static int open_file_generic(struct inode *inode, struct file *file)
2469{
2470 file->private_data = inode->i_private;
2471 return 0;
2472}
2473static void rs_dbgfs_set_mcs(struct iwl_lq_sta *lq_sta,
2474 u32 *rate_n_flags, int index)
2475{
2476 struct iwl_priv *priv;
2477
2478 priv = lq_sta->drv;
2479 if (lq_sta->dbg_fixed_rate) {
2480 if (index < 12) {
2481 *rate_n_flags = lq_sta->dbg_fixed_rate;
2482 } else {
2483 if (lq_sta->band == IEEE80211_BAND_5GHZ)
2484 *rate_n_flags = 0x800D;
2485 else
2486 *rate_n_flags = 0x820A;
2487 }
2488 IWL_DEBUG_RATE("Fixed rate ON\n");
2489 } else {
2490 IWL_DEBUG_RATE("Fixed rate OFF\n");
2491 }
2492}
2493
2494static ssize_t rs_sta_dbgfs_scale_table_write(struct file *file,
2495 const char __user *user_buf, size_t count, loff_t *ppos)
2496{
2497 struct iwl_lq_sta *lq_sta = file->private_data;
2498 struct iwl_priv *priv;
2499 char buf[64];
2500 int buf_size;
2501 u32 parsed_rate;
2502
2503 priv = lq_sta->drv;
2504 memset(buf, 0, sizeof(buf));
2505 buf_size = min(count, sizeof(buf) - 1);
2506 if (copy_from_user(buf, user_buf, buf_size))
2507 return -EFAULT;
2508
2509 if (sscanf(buf, "%x", &parsed_rate) == 1)
2510 lq_sta->dbg_fixed_rate = parsed_rate;
2511 else
2512 lq_sta->dbg_fixed_rate = 0;
2513
2514 lq_sta->active_legacy_rate = 0x0FFF; /* 1 - 54 MBits, includes CCK */
2515 lq_sta->active_siso_rate = 0x1FD0; /* 6 - 60 MBits, no 9, no CCK */
2516 lq_sta->active_mimo2_rate = 0x1FD0; /* 6 - 60 MBits, no 9, no CCK */
2517 lq_sta->active_mimo3_rate = 0x1FD0; /* 6 - 60 MBits, no 9, no CCK */
2518
2519 IWL_DEBUG_RATE("sta_id %d rate 0x%X\n",
2520 lq_sta->lq.sta_id, lq_sta->dbg_fixed_rate);
2521
2522 if (lq_sta->dbg_fixed_rate) {
2523 rs_fill_link_cmd(NULL, lq_sta, lq_sta->dbg_fixed_rate);
2524 iwl_send_lq_cmd(lq_sta->drv, &lq_sta->lq, CMD_ASYNC);
2525 }
2526
2527 return count;
2528}
2529
2530static ssize_t rs_sta_dbgfs_scale_table_read(struct file *file,
2531 char __user *user_buf, size_t count, loff_t *ppos)
2532{
2533 char buff[1024];
2534 int desc = 0;
2535 int i = 0;
2536
2537 struct iwl_lq_sta *lq_sta = file->private_data;
2538
2539 desc += sprintf(buff+desc, "sta_id %d\n", lq_sta->lq.sta_id);
2540 desc += sprintf(buff+desc, "failed=%d success=%d rate=0%X\n",
2541 lq_sta->total_failed, lq_sta->total_success,
2542 lq_sta->active_legacy_rate);
2543 desc += sprintf(buff+desc, "fixed rate 0x%X\n",
2544 lq_sta->dbg_fixed_rate);
2545 desc += sprintf(buff+desc, "general:"
2546 "flags=0x%X mimo-d=%d s-ant0x%x d-ant=0x%x\n",
2547 lq_sta->lq.general_params.flags,
2548 lq_sta->lq.general_params.mimo_delimiter,
2549 lq_sta->lq.general_params.single_stream_ant_msk,
2550 lq_sta->lq.general_params.dual_stream_ant_msk);
2551
2552 desc += sprintf(buff+desc, "agg:"
2553 "time_limit=%d dist_start_th=%d frame_cnt_limit=%d\n",
2554 le16_to_cpu(lq_sta->lq.agg_params.agg_time_limit),
2555 lq_sta->lq.agg_params.agg_dis_start_th,
2556 lq_sta->lq.agg_params.agg_frame_cnt_limit);
2557
2558 desc += sprintf(buff+desc,
2559 "Start idx [0]=0x%x [1]=0x%x [2]=0x%x [3]=0x%x\n",
2560 lq_sta->lq.general_params.start_rate_index[0],
2561 lq_sta->lq.general_params.start_rate_index[1],
2562 lq_sta->lq.general_params.start_rate_index[2],
2563 lq_sta->lq.general_params.start_rate_index[3]);
2564
2565
2566 for (i = 0; i < LINK_QUAL_MAX_RETRY_NUM; i++)
2567 desc += sprintf(buff+desc, " rate[%d] 0x%X\n",
2568 i, le32_to_cpu(lq_sta->lq.rs_table[i].rate_n_flags));
2569
2570 return simple_read_from_buffer(user_buf, count, ppos, buff, desc);
2571}
2572
2573static const struct file_operations rs_sta_dbgfs_scale_table_ops = {
2574 .write = rs_sta_dbgfs_scale_table_write,
2575 .read = rs_sta_dbgfs_scale_table_read,
2576 .open = open_file_generic,
2577};
2578static ssize_t rs_sta_dbgfs_stats_table_read(struct file *file,
2579 char __user *user_buf, size_t count, loff_t *ppos)
2580{
2581 char buff[1024];
2582 int desc = 0;
2583 int i, j;
2584
2585 struct iwl_lq_sta *lq_sta = file->private_data;
2586 for (i = 0; i < LQ_SIZE; i++) {
2587 desc += sprintf(buff+desc, "%s type=%d SGI=%d FAT=%d DUP=%d\n"
2588 "rate=0x%X\n",
2589 lq_sta->active_tbl == i?"*":"x",
2590 lq_sta->lq_info[i].lq_type,
2591 lq_sta->lq_info[i].is_SGI,
2592 lq_sta->lq_info[i].is_fat,
2593 lq_sta->lq_info[i].is_dup,
2594 lq_sta->lq_info[i].current_rate);
2595 for (j = 0; j < IWL_RATE_COUNT; j++) {
2596 desc += sprintf(buff+desc,
2597 "counter=%d success=%d %%=%d\n",
2598 lq_sta->lq_info[i].win[j].counter,
2599 lq_sta->lq_info[i].win[j].success_counter,
2600 lq_sta->lq_info[i].win[j].success_ratio);
2601 }
2602 }
2603 return simple_read_from_buffer(user_buf, count, ppos, buff, desc);
2604}
2605
2606static const struct file_operations rs_sta_dbgfs_stats_table_ops = {
2607 .read = rs_sta_dbgfs_stats_table_read,
2608 .open = open_file_generic,
2609};
2610
2611static void rs_add_debugfs(void *priv, void *priv_sta,
2612 struct dentry *dir)
2613{
2614 struct iwl_lq_sta *lq_sta = priv_sta;
2615 lq_sta->rs_sta_dbgfs_scale_table_file =
2616 debugfs_create_file("rate_scale_table", 0600, dir,
2617 lq_sta, &rs_sta_dbgfs_scale_table_ops);
2618 lq_sta->rs_sta_dbgfs_stats_table_file =
2619 debugfs_create_file("rate_stats_table", 0600, dir,
2620 lq_sta, &rs_sta_dbgfs_stats_table_ops);
2621 lq_sta->rs_sta_dbgfs_tx_agg_tid_en_file =
2622 debugfs_create_u8("tx_agg_tid_enable", 0600, dir,
2623 &lq_sta->tx_agg_tid_en);
2624
2625}
2626
2627static void rs_remove_debugfs(void *priv, void *priv_sta)
2628{
2629 struct iwl_lq_sta *lq_sta = priv_sta;
2630 debugfs_remove(lq_sta->rs_sta_dbgfs_scale_table_file);
2631 debugfs_remove(lq_sta->rs_sta_dbgfs_stats_table_file);
2632 debugfs_remove(lq_sta->rs_sta_dbgfs_tx_agg_tid_en_file);
2633}
2634#endif
2635
2636static struct rate_control_ops rs_ops = {
2637 .module = NULL,
2638 .name = RS_NAME,
2639 .tx_status = rs_tx_status,
2640 .get_rate = rs_get_rate,
2641 .rate_init = rs_rate_init,
2642 .clear = rs_clear,
2643 .alloc = rs_alloc,
2644 .free = rs_free,
2645 .alloc_sta = rs_alloc_sta,
2646 .free_sta = rs_free_sta,
2647#ifdef CONFIG_MAC80211_DEBUGFS
2648 .add_sta_debugfs = rs_add_debugfs,
2649 .remove_sta_debugfs = rs_remove_debugfs,
2650#endif
2651};
2652
2653int iwlagn_rate_control_register(void)
2654{
2655 return ieee80211_rate_control_register(&rs_ops);
2656}
2657
2658void iwlagn_rate_control_unregister(void)
2659{
2660 ieee80211_rate_control_unregister(&rs_ops);
2661}
2662
ubuntu-zesty-kernel mirror