rc.c 49.8 KB
Newer Older
1 2
/*
 * Copyright (c) 2004 Video54 Technologies, Inc.
3
 * Copyright (c) 2004-2009 Atheros Communications, Inc.
4 5 6 7 8 9 10 11 12 13 14 15 16 17
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

18 19
#include <linux/slab.h>

S
Sujith 已提交
20
#include "ath9k.h"
21

22
static const struct ath_rate_table ar5416_11na_ratetable = {
23
	68,
24
	8, /* MCS start */
25
	{
26
		[0] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 6000,
27
			5400, 0, 12, 0, 0, 0, 0 }, /* 6 Mb */
28
		[1] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 9000,
29
			7800,  1, 18, 0, 1, 1, 1 }, /* 9 Mb */
30
		[2] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 12000,
31
			10000, 2, 24, 2, 2, 2, 2 }, /* 12 Mb */
32
		[3] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 18000,
33
			13900, 3, 36, 2, 3, 3, 3 }, /* 18 Mb */
34
		[4] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 24000,
35
			17300, 4, 48, 4, 4, 4, 4 }, /* 24 Mb */
36
		[5] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 36000,
37
			23000, 5, 72, 4, 5, 5, 5 }, /* 36 Mb */
38
		[6] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 48000,
39
			27400, 6, 96, 4, 6, 6, 6 }, /* 48 Mb */
40
		[7] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 54000,
41
			29300, 7, 108, 4, 7, 7, 7 }, /* 54 Mb */
42
		[8] = { RC_HT_SDT_2040, WLAN_RC_PHY_HT_20_SS, 6500,
43
			6400, 0, 0, 0, 38, 8, 38 }, /* 6.5 Mb */
44
		[9] = { RC_HT_SDT_20, WLAN_RC_PHY_HT_20_SS, 13000,
45
			12700, 1, 1, 2, 39, 9, 39 }, /* 13 Mb */
46
		[10] = { RC_HT_SDT_20, WLAN_RC_PHY_HT_20_SS, 19500,
47
			18800, 2, 2, 2, 40, 10, 40 }, /* 19.5 Mb */
48
		[11] = { RC_HT_SD_20, WLAN_RC_PHY_HT_20_SS, 26000,
49
			25000, 3, 3, 4, 41, 11, 41 }, /* 26 Mb */
50
		[12] = { RC_HT_SD_20, WLAN_RC_PHY_HT_20_SS, 39000,
51
			36700, 4, 4, 4, 42, 12, 42 }, /* 39 Mb */
52
		[13] = { RC_HT_S_20, WLAN_RC_PHY_HT_20_SS, 52000,
53
			48100, 5, 5, 4, 43, 13, 43 }, /* 52 Mb */
54
		[14] = { RC_HT_S_20, WLAN_RC_PHY_HT_20_SS, 58500,
55
			53500, 6, 6, 4, 44, 14, 44 }, /* 58.5 Mb */
56
		[15] = { RC_HT_S_20, WLAN_RC_PHY_HT_20_SS, 65000,
57
			59000, 7, 7, 4, 45, 16, 46 }, /* 65 Mb */
58
		[16] = { RC_HT_S_20, WLAN_RC_PHY_HT_20_SS_HGI, 72200,
59
			65400, 7, 7, 4, 45, 16, 46 }, /* 75 Mb */
60
		[17] = { RC_INVALID, WLAN_RC_PHY_HT_20_DS, 13000,
61
			12700, 8, 8, 0, 47, 17, 47 }, /* 13 Mb */
62
		[18] = { RC_HT_T_20, WLAN_RC_PHY_HT_20_DS, 26000,
63
			24800, 9, 9, 2, 48, 18, 48 }, /* 26 Mb */
64
		[19] = { RC_HT_T_20, WLAN_RC_PHY_HT_20_DS, 39000,
65
			36600, 10, 10, 2, 49, 19, 49 }, /* 39 Mb */
66
		[20] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS, 52000,
67
			48100, 11, 11, 4, 50, 20, 50 }, /* 52 Mb */
68
		[21] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS, 78000,
69
			69500, 12, 12, 4, 51, 21, 51 }, /* 78 Mb */
70
		[22] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS, 104000,
71
			89500, 13, 13, 4, 52, 22, 52 }, /* 104 Mb */
72
		[23] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS, 117000,
73
			98900, 14, 14, 4, 53, 23, 53 }, /* 117 Mb */
74
		[24] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS, 130000,
75
			108300, 15, 15, 4, 54, 25, 55 }, /* 130 Mb */
76
		[25] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS_HGI, 144400,
77
			120000, 15, 15, 4, 54, 25, 55 }, /* 144.4 Mb */
78
		[26] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS, 19500,
79
			17400, 16, 16, 0, 56, 26, 56 }, /* 19.5 Mb */
80
		[27] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS, 39000,
81
			35100, 17, 17, 2, 57, 27, 57 }, /* 39 Mb */
82
		[28] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS, 58500,
83
			52600, 18, 18, 2, 58, 28, 58 }, /* 58.5 Mb */
84
		[29] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS, 78000,
85
			70400, 19, 19, 4, 59, 29, 59 }, /* 78 Mb */
86
		[30] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS, 117000,
87
			104900, 20, 20, 4, 60, 31, 61 }, /* 117 Mb */
88
		[31] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS_HGI, 130000,
89
			115800, 20, 20, 4, 60, 31, 61 }, /* 130 Mb*/
90
		[32] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS, 156000,
91
			137200, 21, 21, 4, 62, 33, 63 }, /* 156 Mb */
92
		[33] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS_HGI, 173300,
93
			151100, 21, 21, 4, 62, 33, 63 }, /* 173.3 Mb */
94
		[34] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS, 175500,
95
			152800, 22, 22, 4, 64, 35, 65 }, /* 175.5 Mb */
96
		[35] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS_HGI, 195000,
97
			168400, 22, 22, 4, 64, 35, 65 }, /* 195 Mb*/
98
		[36] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS, 195000,
99
			168400, 23, 23, 4, 66, 37, 67 }, /* 195 Mb */
100
		[37] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS_HGI, 216700,
101
			185000, 23, 23, 4, 66, 37, 67 }, /* 216.7 Mb */
102
		[38] = { RC_HT_SDT_40, WLAN_RC_PHY_HT_40_SS, 13500,
103
			13200, 0, 0, 0, 38, 38, 38 }, /* 13.5 Mb*/
104
		[39] = { RC_HT_SDT_40, WLAN_RC_PHY_HT_40_SS, 27500,
105
			25900, 1, 1, 2, 39, 39, 39 }, /* 27.0 Mb*/
106
		[40] = { RC_HT_SDT_40, WLAN_RC_PHY_HT_40_SS, 40500,
107
			38600, 2, 2, 2, 40, 40, 40 }, /* 40.5 Mb*/
108
		[41] = { RC_HT_SD_40, WLAN_RC_PHY_HT_40_SS, 54000,
109
			49800, 3, 3, 4, 41, 41, 41 }, /* 54 Mb */
110
		[42] = { RC_HT_SD_40, WLAN_RC_PHY_HT_40_SS, 81500,
111
			72200, 4, 4, 4, 42, 42, 42 }, /* 81 Mb */
112
		[43] = { RC_HT_S_40, WLAN_RC_PHY_HT_40_SS, 108000,
113
			92900, 5, 5, 4, 43, 43, 43 }, /* 108 Mb */
114
		[44] = { RC_HT_S_40, WLAN_RC_PHY_HT_40_SS, 121500,
115
			102700, 6, 6, 4, 44, 44, 44 }, /* 121.5 Mb*/
116
		[45] = { RC_HT_S_40, WLAN_RC_PHY_HT_40_SS, 135000,
117
			112000, 7, 7, 4, 45, 46, 46 }, /* 135 Mb */
118
		[46] = { RC_HT_S_40, WLAN_RC_PHY_HT_40_SS_HGI, 150000,
119
			122000, 7, 7, 4, 45, 46, 46 }, /* 150 Mb */
120
		[47] = { RC_INVALID, WLAN_RC_PHY_HT_40_DS, 27000,
121
			25800, 8, 8, 0, 47, 47, 47 }, /* 27 Mb */
122
		[48] = { RC_HT_T_40, WLAN_RC_PHY_HT_40_DS, 54000,
123
			49800, 9, 9, 2, 48, 48, 48 }, /* 54 Mb */
124
		[49] = { RC_HT_T_40, WLAN_RC_PHY_HT_40_DS, 81000,
125
			71900, 10, 10, 2, 49, 49, 49 }, /* 81 Mb */
126
		[50] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS, 108000,
127
			92500, 11, 11, 4, 50, 50, 50 }, /* 108 Mb */
128
		[51] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS, 162000,
129
			130300, 12, 12, 4, 51, 51, 51 }, /* 162 Mb */
130
		[52] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS, 216000,
131
			162800, 13, 13, 4, 52, 52, 52 }, /* 216 Mb */
132
		[53] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS, 243000,
133
			178200, 14, 14, 4, 53, 53, 53 }, /* 243 Mb */
134
		[54] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS, 270000,
135
			192100, 15, 15, 4, 54, 55, 55 }, /* 270 Mb */
136
		[55] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS_HGI, 300000,
137
			207000, 15, 15, 4, 54, 55, 55 }, /* 300 Mb */
138
		[56] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS, 40500,
139
			36100, 16, 16, 0, 56, 56, 56 }, /* 40.5 Mb */
140
		[57] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS, 81000,
141
			72900, 17, 17, 2, 57, 57, 57 }, /* 81 Mb */
142
		[58] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS, 121500,
143
			108300, 18, 18, 2, 58, 58, 58 }, /* 121.5 Mb */
144
		[59] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS, 162000,
145
			142000, 19, 19, 4, 59, 59, 59 }, /*  162 Mb */
146
		[60] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS, 243000,
147
			205100, 20, 20, 4, 60, 61, 61 }, /*  243 Mb */
148
		[61] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS_HGI, 270000,
149
			224700, 20, 20, 4, 60, 61, 61 }, /*  270 Mb */
150
		[62] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS, 324000,
151
			263100, 21, 21, 4, 62, 63, 63 }, /*  324 Mb */
152
		[63] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS_HGI, 360000,
153
			288000, 21, 21, 4, 62, 63, 63 }, /*  360 Mb */
154
		[64] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS, 364500,
155
			290700, 22, 22, 4, 64, 65, 65 }, /* 364.5 Mb */
156
		[65] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS_HGI, 405000,
157
			317200, 22, 22, 4, 64, 65, 65 }, /* 405 Mb */
158
		[66] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS, 405000,
159
			317200, 23, 23, 4, 66, 67, 67 }, /* 405 Mb */
160
		[67] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS_HGI, 450000,
161
			346400, 23, 23, 4, 66, 67, 67 }, /* 450 Mb */
162 163 164 165 166 167 168 169
	},
	50,  /* probe interval */
	WLAN_RC_HT_FLAG,  /* Phy rates allowed initially */
};

/* 4ms frame limit not used for NG mode.  The values filled
 * for HT are the 64K max aggregate limit */

170
static const struct ath_rate_table ar5416_11ng_ratetable = {
171
	72,
172
	12, /* MCS start */
173
	{
174
		[0] = { RC_ALL, WLAN_RC_PHY_CCK, 1000,
175
			900, 0, 2, 0, 0, 0, 0 }, /* 1 Mb */
176
		[1] = { RC_ALL, WLAN_RC_PHY_CCK, 2000,
177
			1900, 1, 4, 1, 1, 1, 1 }, /* 2 Mb */
178
		[2] = { RC_ALL, WLAN_RC_PHY_CCK, 5500,
179
			4900, 2, 11, 2, 2, 2, 2 }, /* 5.5 Mb */
180
		[3] = { RC_ALL, WLAN_RC_PHY_CCK, 11000,
181
			8100, 3, 22, 3, 3, 3, 3 }, /* 11 Mb */
182
		[4] = { RC_INVALID, WLAN_RC_PHY_OFDM, 6000,
183
			5400, 4, 12, 4, 4, 4, 4 }, /* 6 Mb */
184
		[5] = { RC_INVALID, WLAN_RC_PHY_OFDM, 9000,
185
			7800, 5, 18, 4, 5, 5, 5 }, /* 9 Mb */
186
		[6] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 12000,
187
			10100, 6, 24, 6, 6, 6, 6 }, /* 12 Mb */
188
		[7] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 18000,
189
			14100, 7, 36, 6, 7, 7, 7 }, /* 18 Mb */
190
		[8] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 24000,
191
			17700, 8, 48, 8, 8, 8, 8 }, /* 24 Mb */
192
		[9] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 36000,
193
			23700, 9, 72, 8, 9, 9, 9 }, /* 36 Mb */
194
		[10] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 48000,
195
			27400, 10, 96, 8, 10, 10, 10 }, /* 48 Mb */
196
		[11] = { RC_L_SDT, WLAN_RC_PHY_OFDM, 54000,
197
			30900, 11, 108, 8, 11, 11, 11 }, /* 54 Mb */
198
		[12] = { RC_INVALID, WLAN_RC_PHY_HT_20_SS, 6500,
199
			6400, 0, 0, 4, 42, 12, 42 }, /* 6.5 Mb */
200
		[13] = { RC_HT_SDT_20, WLAN_RC_PHY_HT_20_SS, 13000,
201
			12700, 1, 1, 6, 43, 13, 43 }, /* 13 Mb */
202
		[14] = { RC_HT_SDT_20, WLAN_RC_PHY_HT_20_SS, 19500,
203
			18800, 2, 2, 6, 44, 14, 44 }, /* 19.5 Mb*/
204
		[15] = { RC_HT_SD_20, WLAN_RC_PHY_HT_20_SS, 26000,
205
			25000, 3, 3, 8, 45, 15, 45 }, /* 26 Mb */
206
		[16] = { RC_HT_SD_20, WLAN_RC_PHY_HT_20_SS, 39000,
207
			36700, 4, 4, 8, 46, 16, 46 }, /* 39 Mb */
208
		[17] = { RC_HT_S_20, WLAN_RC_PHY_HT_20_SS, 52000,
209
			48100, 5, 5, 8, 47, 17, 47 }, /* 52 Mb */
210
		[18] = { RC_HT_S_20, WLAN_RC_PHY_HT_20_SS, 58500,
211
			53500, 6, 6, 8, 48, 18, 48 }, /* 58.5 Mb */
212
		[19] = { RC_HT_S_20, WLAN_RC_PHY_HT_20_SS, 65000,
213
			59000, 7, 7, 8, 49, 20, 50 }, /* 65 Mb */
214
		[20] = { RC_HT_S_20, WLAN_RC_PHY_HT_20_SS_HGI, 72200,
215
			65400, 7, 7, 8, 49, 20, 50 }, /* 65 Mb*/
216
		[21] = { RC_INVALID, WLAN_RC_PHY_HT_20_DS, 13000,
217
			12700, 8, 8, 4, 51, 21, 51 }, /* 13 Mb */
218
		[22] = { RC_HT_T_20, WLAN_RC_PHY_HT_20_DS, 26000,
219
			24800, 9, 9, 6, 52, 22, 52 }, /* 26 Mb */
220
		[23] = { RC_HT_T_20, WLAN_RC_PHY_HT_20_DS, 39000,
221
			36600, 10, 10, 6, 53, 23, 53 }, /* 39 Mb */
222
		[24] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS, 52000,
223
			48100, 11, 11, 8, 54, 24, 54 }, /* 52 Mb */
224
		[25] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS, 78000,
225
			69500, 12, 12, 8, 55, 25, 55 }, /* 78 Mb */
226
		[26] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS, 104000,
227
			89500, 13, 13, 8, 56, 26, 56 }, /* 104 Mb */
228
		[27] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS, 117000,
229
			98900, 14, 14, 8, 57, 27, 57 }, /* 117 Mb */
230
		[28] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS, 130000,
231
			108300, 15, 15, 8, 58, 29, 59 }, /* 130 Mb */
232
		[29] = { RC_HT_DT_20, WLAN_RC_PHY_HT_20_DS_HGI, 144400,
233
			120000, 15, 15, 8, 58, 29, 59 }, /* 144.4 Mb */
234
		[30] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS, 19500,
235
			17400, 16, 16, 4, 60, 30, 60 }, /* 19.5 Mb */
236
		[31] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS, 39000,
237
			35100, 17, 17, 6, 61, 31, 61 }, /* 39 Mb */
238
		[32] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS, 58500,
239
			52600, 18, 18, 6, 62, 32, 62 }, /* 58.5 Mb */
240
		[33] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS, 78000,
241
			70400, 19, 19, 8, 63, 33, 63 }, /* 78 Mb */
242
		[34] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS, 117000,
243
			104900, 20, 20, 8, 64, 35, 65 }, /* 117 Mb */
244
		[35] = {  RC_INVALID, WLAN_RC_PHY_HT_20_TS_HGI, 130000,
245
			115800, 20, 20, 8, 64, 35, 65 }, /* 130 Mb */
246
		[36] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS, 156000,
247
			137200, 21, 21, 8, 66, 37, 67 }, /* 156 Mb */
248
		[37] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS_HGI, 173300,
249
			151100, 21, 21, 8, 66, 37, 67 }, /* 173.3 Mb */
250
		[38] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS, 175500,
251
			152800, 22, 22, 8, 68, 39, 69 }, /* 175.5 Mb */
252
		[39] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS_HGI, 195000,
253
			168400, 22, 22, 8, 68, 39, 69 }, /* 195 Mb */
254
		[40] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS, 195000,
255
			168400, 23, 23, 8, 70, 41, 71 }, /* 195 Mb */
256
		[41] = {  RC_HT_T_20, WLAN_RC_PHY_HT_20_TS_HGI, 216700,
257
			185000, 23, 23, 8, 70, 41, 71 }, /* 216.7 Mb */
258
		[42] = { RC_HT_SDT_40, WLAN_RC_PHY_HT_40_SS, 13500,
259
			13200, 0, 0, 8, 42, 42, 42 }, /* 13.5 Mb */
260
		[43] = { RC_HT_SDT_40, WLAN_RC_PHY_HT_40_SS, 27500,
261
			25900, 1, 1, 8, 43, 43, 43 }, /* 27.0 Mb */
262
		[44] = { RC_HT_SDT_40, WLAN_RC_PHY_HT_40_SS, 40500,
263
			38600, 2, 2, 8, 44, 44, 44 }, /* 40.5 Mb */
264
		[45] = { RC_HT_SD_40, WLAN_RC_PHY_HT_40_SS, 54000,
265
			49800, 3, 3, 8, 45, 45, 45 }, /* 54 Mb */
266
		[46] = { RC_HT_SD_40, WLAN_RC_PHY_HT_40_SS, 81500,
267
			72200, 4, 4, 8, 46, 46, 46 }, /* 81 Mb */
268
		[47] = { RC_HT_S_40 , WLAN_RC_PHY_HT_40_SS, 108000,
269
			92900, 5, 5, 8, 47, 47, 47 }, /* 108 Mb */
270
		[48] = { RC_HT_S_40, WLAN_RC_PHY_HT_40_SS, 121500,
271
			102700, 6, 6, 8, 48, 48, 48 }, /* 121.5 Mb */
272
		[49] = { RC_HT_S_40, WLAN_RC_PHY_HT_40_SS, 135000,
273
			112000, 7, 7, 8, 49, 50, 50 }, /* 135 Mb */
274
		[50] = { RC_HT_S_40, WLAN_RC_PHY_HT_40_SS_HGI, 150000,
275
			122000, 7, 7, 8, 49, 50, 50 }, /* 150 Mb */
276
		[51] = { RC_INVALID, WLAN_RC_PHY_HT_40_DS, 27000,
277
			25800, 8, 8, 8, 51, 51, 51 }, /* 27 Mb */
278
		[52] = { RC_HT_T_40, WLAN_RC_PHY_HT_40_DS, 54000,
279
			49800, 9, 9, 8, 52, 52, 52 }, /* 54 Mb */
280
		[53] = { RC_HT_T_40, WLAN_RC_PHY_HT_40_DS, 81000,
281
			71900, 10, 10, 8, 53, 53, 53 }, /* 81 Mb */
282
		[54] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS, 108000,
283
			92500, 11, 11, 8, 54, 54, 54 }, /* 108 Mb */
284
		[55] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS, 162000,
285
			130300, 12, 12, 8, 55, 55, 55 }, /* 162 Mb */
286
		[56] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS, 216000,
287
			162800, 13, 13, 8, 56, 56, 56 }, /* 216 Mb */
288
		[57] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS, 243000,
289
			178200, 14, 14, 8, 57, 57, 57 }, /* 243 Mb */
290
		[58] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS, 270000,
291
			192100, 15, 15, 8, 58, 59, 59 }, /* 270 Mb */
292
		[59] = { RC_HT_DT_40, WLAN_RC_PHY_HT_40_DS_HGI, 300000,
293
			207000, 15, 15, 8, 58, 59, 59 }, /* 300 Mb */
294
		[60] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS, 40500,
295
			36100, 16, 16, 8, 60, 60, 60 }, /* 40.5 Mb */
296
		[61] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS, 81000,
297
			72900, 17, 17, 8, 61, 61, 61 }, /* 81 Mb */
298
		[62] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS, 121500,
299
			108300, 18, 18, 8, 62, 62, 62 }, /* 121.5 Mb */
300
		[63] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS, 162000,
301
			142000, 19, 19, 8, 63, 63, 63 }, /* 162 Mb */
302
		[64] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS, 243000,
303
			205100, 20, 20, 8, 64, 65, 65 }, /* 243 Mb */
304
		[65] = {  RC_INVALID, WLAN_RC_PHY_HT_40_TS_HGI, 270000,
305
			224700, 20, 20, 8, 64, 65, 65 }, /* 270 Mb */
306
		[66] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS, 324000,
307
			263100, 21, 21, 8, 66, 67, 67 }, /* 324 Mb */
308
		[67] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS_HGI, 360000,
309
			288000, 21, 21, 8, 66, 67, 67 }, /* 360 Mb */
310
		[68] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS, 364500,
311
			290700, 22, 22, 8, 68, 69, 69 }, /* 364.5 Mb */
312
		[69] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS_HGI, 405000,
313
			317200, 22, 22, 8, 68, 69, 69 }, /* 405 Mb */
314
		[70] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS, 405000,
315
			317200, 23, 23, 8, 70, 71, 71 }, /* 405 Mb */
316
		[71] = {  RC_HT_T_40, WLAN_RC_PHY_HT_40_TS_HGI, 450000,
317
			346400, 23, 23, 8, 70, 71, 71 }, /* 450 Mb */
F
Felix Fietkau 已提交
318
	},
319 320 321 322
	50,  /* probe interval */
	WLAN_RC_HT_FLAG,  /* Phy rates allowed initially */
};

323
static const struct ath_rate_table ar5416_11a_ratetable = {
324
	8,
325
	0,
326
	{
327
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 6000, /* 6 Mb */
328
			5400, 0, 12, 0},
329
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 9000, /* 9 Mb */
330
			7800,  1, 18, 0},
331
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 12000, /* 12 Mb */
332
			10000, 2, 24, 2},
333
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 18000, /* 18 Mb */
334
			13900, 3, 36, 2},
335
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 24000, /* 24 Mb */
336
			17300, 4, 48, 4},
337
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 36000, /* 36 Mb */
338
			23000, 5, 72, 4},
339
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 48000, /* 48 Mb */
340
			27400, 6, 96, 4},
341
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 54000, /* 54 Mb */
342
			29300, 7, 108, 4},
343 344 345 346 347
	},
	50,  /* probe interval */
	0,   /* Phy rates allowed initially */
};

348
static const struct ath_rate_table ar5416_11g_ratetable = {
349
	12,
350
	0,
351
	{
352
		{ RC_L_SDT, WLAN_RC_PHY_CCK, 1000, /* 1 Mb */
353
			900, 0, 2, 0},
354
		{ RC_L_SDT, WLAN_RC_PHY_CCK, 2000, /* 2 Mb */
355
			1900, 1, 4, 1},
356
		{ RC_L_SDT, WLAN_RC_PHY_CCK, 5500, /* 5.5 Mb */
357
			4900, 2, 11, 2},
358
		{ RC_L_SDT, WLAN_RC_PHY_CCK, 11000, /* 11 Mb */
359
			8100, 3, 22, 3},
360
		{ RC_INVALID, WLAN_RC_PHY_OFDM, 6000, /* 6 Mb */
361
			5400, 4, 12, 4},
362
		{ RC_INVALID, WLAN_RC_PHY_OFDM, 9000, /* 9 Mb */
363
			7800, 5, 18, 4},
364
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 12000, /* 12 Mb */
365
			10000, 6, 24, 6},
366
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 18000, /* 18 Mb */
367
			13900, 7, 36, 6},
368
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 24000, /* 24 Mb */
369
			17300, 8, 48, 8},
370
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 36000, /* 36 Mb */
371
			23000, 9, 72, 8},
372
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 48000, /* 48 Mb */
373
			27400, 10, 96, 8},
374
		{ RC_L_SDT, WLAN_RC_PHY_OFDM, 54000, /* 54 Mb */
375
			29300, 11, 108, 8},
376 377 378 379 380
	},
	50,  /* probe interval */
	0,   /* Phy rates allowed initially */
};

381 382 383 384 385 386 387 388 389 390 391 392 393 394
static const struct ath_rate_table *hw_rate_table[ATH9K_MODE_MAX] = {
	[ATH9K_MODE_11A] = &ar5416_11a_ratetable,
	[ATH9K_MODE_11G] = &ar5416_11g_ratetable,
	[ATH9K_MODE_11NA_HT20] = &ar5416_11na_ratetable,
	[ATH9K_MODE_11NG_HT20] = &ar5416_11ng_ratetable,
	[ATH9K_MODE_11NA_HT40PLUS] = &ar5416_11na_ratetable,
	[ATH9K_MODE_11NA_HT40MINUS] = &ar5416_11na_ratetable,
	[ATH9K_MODE_11NG_HT40PLUS] = &ar5416_11ng_ratetable,
	[ATH9K_MODE_11NG_HT40MINUS] = &ar5416_11ng_ratetable,
};

static int ath_rc_get_rateindex(const struct ath_rate_table *rate_table,
				struct ieee80211_tx_rate *rate);

395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413
static inline int8_t median(int8_t a, int8_t b, int8_t c)
{
	if (a >= b) {
		if (b >= c)
			return b;
		else if (a > c)
			return c;
		else
			return a;
	} else {
		if (a >= c)
			return a;
		else if (b >= c)
			return c;
		else
			return b;
	}
}

414
static void ath_rc_sort_validrates(const struct ath_rate_table *rate_table,
S
Sujith 已提交
415
				   struct ath_rate_priv *ath_rc_priv)
416 417 418
{
	u8 i, j, idx, idx_next;

419
	for (i = ath_rc_priv->max_valid_rate - 1; i > 0; i--) {
420
		for (j = 0; j <= i-1; j++) {
421 422
			idx = ath_rc_priv->valid_rate_index[j];
			idx_next = ath_rc_priv->valid_rate_index[j+1];
423 424 425

			if (rate_table->info[idx].ratekbps >
				rate_table->info[idx_next].ratekbps) {
426 427
				ath_rc_priv->valid_rate_index[j] = idx_next;
				ath_rc_priv->valid_rate_index[j+1] = idx;
428 429 430 431 432
			}
		}
	}
}

S
Sujith 已提交
433
static void ath_rc_init_valid_txmask(struct ath_rate_priv *ath_rc_priv)
434 435 436
{
	u8 i;

437
	for (i = 0; i < ath_rc_priv->rate_table_size; i++)
S
Sujith 已提交
438
		ath_rc_priv->valid_rate_index[i] = 0;
439 440
}

S
Sujith 已提交
441
static inline void ath_rc_set_valid_txmask(struct ath_rate_priv *ath_rc_priv,
442 443
					   u8 index, int valid_tx_rate)
{
444
	BUG_ON(index > ath_rc_priv->rate_table_size);
445
	ath_rc_priv->valid_rate_index[index] = !!valid_tx_rate;
446 447
}

448 449 450 451 452
static inline
int ath_rc_get_nextvalid_txrate(const struct ath_rate_table *rate_table,
				struct ath_rate_priv *ath_rc_priv,
				u8 cur_valid_txrate,
				u8 *next_idx)
453 454 455
{
	u8 i;

456 457 458
	for (i = 0; i < ath_rc_priv->max_valid_rate - 1; i++) {
		if (ath_rc_priv->valid_rate_index[i] == cur_valid_txrate) {
			*next_idx = ath_rc_priv->valid_rate_index[i+1];
S
Sujith 已提交
459
			return 1;
460 461 462 463 464
		}
	}

	/* No more valid rates */
	*next_idx = 0;
S
Sujith 已提交
465

S
Sujith 已提交
466
	return 0;
467 468 469 470 471 472
}

/* Return true only for single stream */

static int ath_rc_valid_phyrate(u32 phy, u32 capflag, int ignore_cw)
{
473
	if (WLAN_RC_PHY_HT(phy) && !(capflag & WLAN_RC_HT_FLAG))
S
Sujith 已提交
474
		return 0;
475
	if (WLAN_RC_PHY_DS(phy) && !(capflag & WLAN_RC_DS_FLAG))
S
Sujith 已提交
476
		return 0;
477 478
	if (WLAN_RC_PHY_TS(phy) && !(capflag & WLAN_RC_TS_FLAG))
		return 0;
479
	if (WLAN_RC_PHY_SGI(phy) && !(capflag & WLAN_RC_SGI_FLAG))
S
Sujith 已提交
480
		return 0;
481 482
	if (!ignore_cw && WLAN_RC_PHY_HT(phy))
		if (WLAN_RC_PHY_40(phy) && !(capflag & WLAN_RC_40_FLAG))
S
Sujith 已提交
483 484
			return 0;
	return 1;
485 486 487
}

static inline int
488 489 490
ath_rc_get_lower_rix(const struct ath_rate_table *rate_table,
		     struct ath_rate_priv *ath_rc_priv,
		     u8 cur_valid_txrate, u8 *next_idx)
491 492 493
{
	int8_t i;

494 495 496
	for (i = 1; i < ath_rc_priv->max_valid_rate ; i++) {
		if (ath_rc_priv->valid_rate_index[i] == cur_valid_txrate) {
			*next_idx = ath_rc_priv->valid_rate_index[i-1];
S
Sujith 已提交
497
			return 1;
498 499
		}
	}
S
Sujith 已提交
500

S
Sujith 已提交
501
	return 0;
502 503
}

S
Sujith 已提交
504
static u8 ath_rc_init_validrates(struct ath_rate_priv *ath_rc_priv,
505
				 const struct ath_rate_table *rate_table,
S
Sujith 已提交
506
				 u32 capflag)
507 508 509 510
{
	u8 i, hi = 0;

	for (i = 0; i < rate_table->rate_cnt; i++) {
511
		if (rate_table->info[i].rate_flags & RC_LEGACY) {
512 513 514
			u32 phy = rate_table->info[i].phy;
			u8 valid_rate_count = 0;

S
Sujith 已提交
515
			if (!ath_rc_valid_phyrate(phy, capflag, 0))
516 517
				continue;

518
			valid_rate_count = ath_rc_priv->valid_phy_ratecnt[phy];
519

520 521
			ath_rc_priv->valid_phy_rateidx[phy][valid_rate_count] = i;
			ath_rc_priv->valid_phy_ratecnt[phy] += 1;
S
Sujith 已提交
522
			ath_rc_set_valid_txmask(ath_rc_priv, i, 1);
523
			hi = i;
524 525
		}
	}
S
Sujith 已提交
526

527 528 529
	return hi;
}

S
Sujith 已提交
530
static u8 ath_rc_setvalid_rates(struct ath_rate_priv *ath_rc_priv,
531
				const struct ath_rate_table *rate_table,
S
Sujith 已提交
532 533
				struct ath_rateset *rateset,
				u32 capflag)
534 535 536 537 538 539 540
{
	u8 i, j, hi = 0;

	/* Use intersection of working rates and valid rates */
	for (i = 0; i < rateset->rs_nrates; i++) {
		for (j = 0; j < rate_table->rate_cnt; j++) {
			u32 phy = rate_table->info[j].phy;
541
			u16 rate_flags = rate_table->info[i].rate_flags;
S
Sujith 已提交
542 543
			u8 rate = rateset->rs_rates[i];
			u8 dot11rate = rate_table->info[j].dot11rate;
544 545 546

			/* We allow a rate only if its valid and the
			 * capflag matches one of the validity
S
Sujith 已提交
547
			 * (VALID/VALID_20/VALID_40) flags */
548

549
			if ((rate == dot11rate) &&
550 551 552
			    (rate_flags & WLAN_RC_CAP_MODE(capflag)) ==
			    WLAN_RC_CAP_MODE(capflag) &&
			    (rate_flags & WLAN_RC_CAP_STREAM(capflag)) &&
S
Sujith 已提交
553
			    !WLAN_RC_PHY_HT(phy)) {
554 555
				u8 valid_rate_count = 0;

S
Sujith 已提交
556
				if (!ath_rc_valid_phyrate(phy, capflag, 0))
557 558 559
					continue;

				valid_rate_count =
560
					ath_rc_priv->valid_phy_ratecnt[phy];
561

562
				ath_rc_priv->valid_phy_rateidx[phy]
563
					[valid_rate_count] = j;
564
				ath_rc_priv->valid_phy_ratecnt[phy] += 1;
S
Sujith 已提交
565
				ath_rc_set_valid_txmask(ath_rc_priv, j, 1);
566 567 568 569
				hi = A_MAX(hi, j);
			}
		}
	}
S
Sujith 已提交
570

571 572 573
	return hi;
}

S
Sujith 已提交
574
static u8 ath_rc_setvalid_htrates(struct ath_rate_priv *ath_rc_priv,
575
				  const struct ath_rate_table *rate_table,
S
Sujith 已提交
576
				  u8 *mcs_set, u32 capflag)
577
{
S
Sujith 已提交
578 579
	struct ath_rateset *rateset = (struct ath_rateset *)mcs_set;

580 581 582
	u8 i, j, hi = 0;

	/* Use intersection of working rates and valid rates */
S
Sujith 已提交
583
	for (i = 0; i < rateset->rs_nrates; i++) {
584 585
		for (j = 0; j < rate_table->rate_cnt; j++) {
			u32 phy = rate_table->info[j].phy;
586
			u16 rate_flags = rate_table->info[j].rate_flags;
S
Sujith 已提交
587 588
			u8 rate = rateset->rs_rates[i];
			u8 dot11rate = rate_table->info[j].dot11rate;
589

590
			if ((rate != dot11rate) || !WLAN_RC_PHY_HT(phy) ||
591 592
			    !(rate_flags & WLAN_RC_CAP_STREAM(capflag)) ||
			    !WLAN_RC_PHY_HT_VALID(rate_flags, capflag))
593 594
				continue;

S
Sujith 已提交
595
			if (!ath_rc_valid_phyrate(phy, capflag, 0))
596 597
				continue;

598 599 600
			ath_rc_priv->valid_phy_rateidx[phy]
				[ath_rc_priv->valid_phy_ratecnt[phy]] = j;
			ath_rc_priv->valid_phy_ratecnt[phy] += 1;
S
Sujith 已提交
601
			ath_rc_set_valid_txmask(ath_rc_priv, j, 1);
602 603 604 605
			hi = A_MAX(hi, j);
		}
	}

S
Sujith 已提交
606
	return hi;
607 608
}

609 610 611 612 613
/* Finds the highest rate index we can use */
static u8 ath_rc_get_highest_rix(struct ath_softc *sc,
			         struct ath_rate_priv *ath_rc_priv,
				 const struct ath_rate_table *rate_table,
				 int *is_probing)
614
{
615
	u32 best_thruput, this_thruput, now_msec;
616
	u8 rate, next_rate, best_rate, maxindex, minindex;
617
	int8_t index = 0;
618 619

	now_msec = jiffies_to_msecs(jiffies);
620
	*is_probing = 0;
621
	best_thruput = 0;
622
	maxindex = ath_rc_priv->max_valid_rate-1;
623 624 625 626 627 628 629 630 631 632
	minindex = 0;
	best_rate = minindex;

	/*
	 * Try the higher rate first. It will reduce memory moving time
	 * if we have very good channel characteristics.
	 */
	for (index = maxindex; index >= minindex ; index--) {
		u8 per_thres;

633 634
		rate = ath_rc_priv->valid_rate_index[index];
		if (rate > ath_rc_priv->rate_max_phy)
635 636 637 638 639 640 641 642 643 644 645 646 647
			continue;

		/*
		 * For TCP the average collision rate is around 11%,
		 * so we ignore PERs less than this.  This is to
		 * prevent the rate we are currently using (whose
		 * PER might be in the 10-15 range because of TCP
		 * collisions) looking worse than the next lower
		 * rate whose PER has decayed close to 0.  If we
		 * used to next lower rate, its PER would grow to
		 * 10-15 and we would be worse off then staying
		 * at the current rate.
		 */
648
		per_thres = ath_rc_priv->per[rate];
649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667
		if (per_thres < 12)
			per_thres = 12;

		this_thruput = rate_table->info[rate].user_ratekbps *
			(100 - per_thres);

		if (best_thruput <= this_thruput) {
			best_thruput = this_thruput;
			best_rate    = rate;
		}
	}

	rate = best_rate;

	/*
	 * Must check the actual rate (ratekbps) to account for
	 * non-monoticity of 11g's rate table
	 */

S
Sujith 已提交
668
	if (rate >= ath_rc_priv->rate_max_phy) {
669
		rate = ath_rc_priv->rate_max_phy;
670 671 672

		/* Probe the next allowed phy state */
		if (ath_rc_get_nextvalid_txrate(rate_table,
S
Sujith 已提交
673
					ath_rc_priv, rate, &next_rate) &&
674
		    (now_msec - ath_rc_priv->probe_time >
675
		     rate_table->probe_interval) &&
676
		    (ath_rc_priv->hw_maxretry_pktcnt >= 1)) {
677
			rate = next_rate;
678 679 680
			ath_rc_priv->probe_rate = rate;
			ath_rc_priv->probe_time = now_msec;
			ath_rc_priv->hw_maxretry_pktcnt = 0;
S
Sujith 已提交
681
			*is_probing = 1;
682 683 684
		}
	}

685 686
	if (rate > (ath_rc_priv->rate_table_size - 1))
		rate = ath_rc_priv->rate_table_size - 1;
687

688 689 690 691 692 693
	if (RC_TS_ONLY(rate_table->info[rate].rate_flags) &&
	    (ath_rc_priv->ht_cap & WLAN_RC_TS_FLAG))
		return rate;

	if (RC_DS_OR_LATER(rate_table->info[rate].rate_flags) &&
	    (ath_rc_priv->ht_cap & (WLAN_RC_DS_FLAG | WLAN_RC_TS_FLAG)))
694 695
		return rate;

696
	if (RC_SS_OR_LEGACY(rate_table->info[rate].rate_flags))
697 698 699 700 701 702
		return rate;

	/* This should not happen */
	WARN_ON(1);

	rate = ath_rc_priv->valid_rate_index[0];
703 704 705 706

	return rate;
}

707
static void ath_rc_rate_set_series(const struct ath_rate_table *rate_table,
S
Sujith 已提交
708
				   struct ieee80211_tx_rate *rate,
709
				   struct ieee80211_tx_rate_control *txrc,
S
Sujith 已提交
710
				   u8 tries, u8 rix, int rtsctsenable)
711
{
S
Sujith 已提交
712
	rate->count = tries;
713
	rate->idx = rate_table->info[rix].ratecode;
S
Sujith 已提交
714

715 716 717
	if (txrc->short_preamble)
		rate->flags |= IEEE80211_TX_RC_USE_SHORT_PREAMBLE;
	if (txrc->rts || rtsctsenable)
S
Sujith 已提交
718
		rate->flags |= IEEE80211_TX_RC_USE_RTS_CTS;
719 720

	if (WLAN_RC_PHY_HT(rate_table->info[rix].phy)) {
S
Sujith 已提交
721
		rate->flags |= IEEE80211_TX_RC_MCS;
722 723 724 725 726
		if (WLAN_RC_PHY_40(rate_table->info[rix].phy))
			rate->flags |= IEEE80211_TX_RC_40_MHZ_WIDTH;
		if (WLAN_RC_PHY_SGI(rate_table->info[rix].phy))
			rate->flags |= IEEE80211_TX_RC_SHORT_GI;
	}
727 728
}

729
static void ath_rc_rate_set_rtscts(struct ath_softc *sc,
730
				   const struct ath_rate_table *rate_table,
731 732 733 734 735 736 737 738
				   struct ieee80211_tx_info *tx_info)
{
	struct ieee80211_tx_rate *rates = tx_info->control.rates;
	int i = 0, rix = 0, cix, enable_g_protection = 0;

	/* get the cix for the lowest valid rix */
	for (i = 3; i >= 0; i--) {
		if (rates[i].count && (rates[i].idx >= 0)) {
739
			rix = ath_rc_get_rateindex(rate_table, &rates[i]);
740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764
			break;
		}
	}
	cix = rate_table->info[rix].ctrl_rate;

	/* All protection frames are transmited at 2Mb/s for 802.11g,
	 * otherwise we transmit them at 1Mb/s */
	if (sc->hw->conf.channel->band == IEEE80211_BAND_2GHZ &&
	    !conf_is_ht(&sc->hw->conf))
		enable_g_protection = 1;

	/*
	 * If 802.11g protection is enabled, determine whether to use RTS/CTS or
	 * just CTS.  Note that this is only done for OFDM/HT unicast frames.
	 */
	if ((sc->sc_flags & SC_OP_PROTECT_ENABLE) &&
	    (rate_table->info[rix].phy == WLAN_RC_PHY_OFDM ||
	     WLAN_RC_PHY_HT(rate_table->info[rix].phy))) {
		rates[0].flags |= IEEE80211_TX_RC_USE_CTS_PROTECT;
		cix = rate_table->info[enable_g_protection].ctrl_rate;
	}

	tx_info->control.rts_cts_rate_idx = cix;
}

765 766
static void ath_get_rate(void *priv, struct ieee80211_sta *sta, void *priv_sta,
			 struct ieee80211_tx_rate_control *txrc)
767
{
768 769
	struct ath_softc *sc = priv;
	struct ath_rate_priv *ath_rc_priv = priv_sta;
770
	const struct ath_rate_table *rate_table;
S
Sujith 已提交
771 772
	struct sk_buff *skb = txrc->skb;
	struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
S
Sujith 已提交
773
	struct ieee80211_tx_rate *rates = tx_info->control.rates;
774 775
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
	__le16 fc = hdr->frame_control;
776
	u8 try_per_rate, i = 0, rix;
S
Sujith 已提交
777
	int is_probe = 0;
778

779 780 781
	if (rate_control_send_low(sta, priv_sta, txrc))
		return;

782 783 784 785
	/*
	 * For Multi Rate Retry we use a different number of
	 * retry attempt counts. This ends up looking like this:
	 *
786 787 788 789
	 * MRR[0] = 4
	 * MRR[1] = 4
	 * MRR[2] = 4
	 * MRR[3] = 8
790 791
	 *
	 */
792
	try_per_rate = 4;
793

S
Sujith 已提交
794
	rate_table = sc->cur_rate_table;
795
	rix = ath_rc_get_highest_rix(sc, ath_rc_priv, rate_table, &is_probe);
796

L
Luis R. Rodriguez 已提交
797 798 799 800 801 802 803 804 805
	/*
	 * If we're in HT mode and both us and our peer supports LDPC.
	 * We don't need to check our own device's capabilities as our own
	 * ht capabilities would have already been intersected with our peer's.
	 */
	if (conf_is_ht(&sc->hw->conf) &&
	    (sta->ht_cap.cap & IEEE80211_HT_CAP_LDPC_CODING))
		tx_info->flags |= IEEE80211_TX_CTL_LDPC;

806 807 808 809
	if (conf_is_ht(&sc->hw->conf) &&
	    (sta->ht_cap.cap & IEEE80211_HT_CAP_TX_STBC))
		tx_info->flags |= (1 << IEEE80211_TX_CTL_STBC_SHIFT);

S
Sujith 已提交
810
	if (is_probe) {
811 812
		/* set one try for probe rates. For the
		 * probes don't enable rts */
813
		ath_rc_rate_set_series(rate_table, &rates[i++], txrc,
814
				       1, rix, 0);
815 816 817 818

		/* Get the next tried/allowed rate. No RTS for the next series
		 * after the probe rate
		 */
819
		ath_rc_get_lower_rix(rate_table, ath_rc_priv, rix, &rix);
820
		ath_rc_rate_set_series(rate_table, &rates[i++], txrc,
821
				       try_per_rate, rix, 0);
822 823

		tx_info->flags |= IEEE80211_TX_CTL_RATE_CTRL_PROBE;
824 825
	} else {
		/* Set the choosen rate. No RTS for first series entry. */
826
		ath_rc_rate_set_series(rate_table, &rates[i++], txrc,
827
				       try_per_rate, rix, 0);
828 829 830
	}

	/* Fill in the other rates for multirate retry */
S
Sujith 已提交
831
	for ( ; i < 4; i++) {
832 833
		/* Use twice the number of tries for the last MRR segment. */
		if (i + 1 == 4)
834
			try_per_rate = 8;
835

836
		ath_rc_get_lower_rix(rate_table, ath_rc_priv, rix, &rix);
837
		/* All other rates in the series have RTS enabled */
838
		ath_rc_rate_set_series(rate_table, &rates[i], txrc,
839
				       try_per_rate, rix, 1);
840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856
	}

	/*
	 * NB:Change rate series to enable aggregation when operating
	 * at lower MCS rates. When first rate in series is MCS2
	 * in HT40 @ 2.4GHz, series should look like:
	 *
	 * {MCS2, MCS1, MCS0, MCS0}.
	 *
	 * When first rate in series is MCS3 in HT20 @ 2.4GHz, series should
	 * look like:
	 *
	 * {MCS3, MCS2, MCS1, MCS1}
	 *
	 * So, set fourth rate in series to be same as third one for
	 * above conditions.
	 */
857
	if ((sc->hw->conf.channel->band == IEEE80211_BAND_2GHZ) &&
858
	    (conf_is_ht(&sc->hw->conf))) {
S
Sujith 已提交
859
		u8 dot11rate = rate_table->info[rix].dot11rate;
860 861 862
		u8 phy = rate_table->info[rix].phy;
		if (i == 4 &&
		    ((dot11rate == 2 && phy == WLAN_RC_PHY_HT_40_SS) ||
S
Sujith 已提交
863
		     (dot11rate == 3 && phy == WLAN_RC_PHY_HT_20_SS))) {
S
Sujith 已提交
864 865
			rates[3].idx = rates[2].idx;
			rates[3].flags = rates[2].flags;
866 867
		}
	}
868 869 870 871 872 873 874 875

	/*
	 * Force hardware to use computed duration for next
	 * fragment by disabling multi-rate retry, which
	 * updates duration based on the multi-rate duration table.
	 *
	 * FIXME: Fix duration
	 */
876 877
	if (ieee80211_has_morefrags(fc) ||
	    (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_FRAG)) {
878 879 880 881 882 883 884
		rates[1].count = rates[2].count = rates[3].count = 0;
		rates[1].idx = rates[2].idx = rates[3].idx = 0;
		rates[0].count = ATH_TXMAXTRY;
	}

	/* Setup RTS/CTS */
	ath_rc_rate_set_rtscts(sc, rate_table, tx_info);
885 886
}

S
Sujith 已提交
887
static bool ath_rc_update_per(struct ath_softc *sc,
888
			      const struct ath_rate_table *rate_table,
S
Sujith 已提交
889
			      struct ath_rate_priv *ath_rc_priv,
F
Felix Fietkau 已提交
890
				  struct ieee80211_tx_info *tx_info,
S
Sujith 已提交
891 892
			      int tx_rate, int xretries, int retries,
			      u32 now_msec)
893
{
S
Sujith 已提交
894
	bool state_change = false;
F
Felix Fietkau 已提交
895
	int count, n_bad_frames;
896 897 898 899 900 901 902 903 904 905 906 907 908 909
	u8 last_per;
	static u32 nretry_to_per_lookup[10] = {
		100 * 0 / 1,
		100 * 1 / 4,
		100 * 1 / 2,
		100 * 3 / 4,
		100 * 4 / 5,
		100 * 5 / 6,
		100 * 6 / 7,
		100 * 7 / 8,
		100 * 8 / 9,
		100 * 9 / 10
	};

910
	last_per = ath_rc_priv->per[tx_rate];
F
Felix Fietkau 已提交
911
	n_bad_frames = tx_info->status.ampdu_len - tx_info->status.ampdu_ack_len;
912 913 914

	if (xretries) {
		if (xretries == 1) {
915 916 917
			ath_rc_priv->per[tx_rate] += 30;
			if (ath_rc_priv->per[tx_rate] > 100)
				ath_rc_priv->per[tx_rate] = 100;
918 919
		} else {
			/* xretries == 2 */
920
			count = ARRAY_SIZE(nretry_to_per_lookup);
921 922
			if (retries >= count)
				retries = count - 1;
S
Sujith 已提交
923

924
			/* new_PER = 7/8*old_PER + 1/8*(currentPER) */
925
			ath_rc_priv->per[tx_rate] =
S
Sujith 已提交
926
				(u8)(last_per - (last_per >> 3) + (100 >> 3));
927 928 929 930
		}

		/* xretries == 1 or 2 */

931 932
		if (ath_rc_priv->probe_rate == tx_rate)
			ath_rc_priv->probe_rate = 0;
933

S
Sujith 已提交
934
	} else { /* xretries == 0 */
935
		count = ARRAY_SIZE(nretry_to_per_lookup);
936 937
		if (retries >= count)
			retries = count - 1;
S
Sujith 已提交
938

F
Felix Fietkau 已提交
939
		if (n_bad_frames) {
S
Sujith 已提交
940
			/* new_PER = 7/8*old_PER + 1/8*(currentPER)
941 942 943 944 945 946 947 948 949 950 951
			 * Assuming that n_frames is not 0.  The current PER
			 * from the retries is 100 * retries / (retries+1),
			 * since the first retries attempts failed, and the
			 * next one worked.  For the one that worked,
			 * n_bad_frames subframes out of n_frames wored,
			 * so the PER for that part is
			 * 100 * n_bad_frames / n_frames, and it contributes
			 * 100 * n_bad_frames / (n_frames * (retries+1)) to
			 * the above PER.  The expression below is a
			 * simplified version of the sum of these two terms.
			 */
F
Felix Fietkau 已提交
952 953
			if (tx_info->status.ampdu_len > 0) {
				int n_frames, n_bad_tries;
S
Sujith 已提交
954 955
				u8 cur_per, new_per;

F
Felix Fietkau 已提交
956 957 958 959
				n_bad_tries = retries * tx_info->status.ampdu_len +
					n_bad_frames;
				n_frames = tx_info->status.ampdu_len * (retries + 1);
				cur_per = (100 * n_bad_tries / n_frames) >> 3;
S
Sujith 已提交
960
				new_per = (u8)(last_per - (last_per >> 3) + cur_per);
961
				ath_rc_priv->per[tx_rate] = new_per;
S
Sujith 已提交
962
			}
963
		} else {
964
			ath_rc_priv->per[tx_rate] =
S
Sujith 已提交
965 966
				(u8)(last_per - (last_per >> 3) +
				     (nretry_to_per_lookup[retries] >> 3));
967 968 969 970 971 972 973
		}


		/*
		 * If we got at most one retry then increase the max rate if
		 * this was a probe.  Otherwise, ignore the probe.
		 */
974
		if (ath_rc_priv->probe_rate && ath_rc_priv->probe_rate == tx_rate) {
F
Felix Fietkau 已提交
975
			if (retries > 0 || 2 * n_bad_frames > tx_info->status.ampdu_len) {
976 977 978 979 980 981 982
				/*
				 * Since we probed with just a single attempt,
				 * any retries means the probe failed.  Also,
				 * if the attempt worked, but more than half
				 * the subframes were bad then also consider
				 * the probe a failure.
				 */
983
				ath_rc_priv->probe_rate = 0;
984 985 986
			} else {
				u8 probe_rate = 0;

S
Sujith 已提交
987 988
				ath_rc_priv->rate_max_phy =
					ath_rc_priv->probe_rate;
989
				probe_rate = ath_rc_priv->probe_rate;
990

991 992
				if (ath_rc_priv->per[probe_rate] > 30)
					ath_rc_priv->per[probe_rate] = 20;
993

994
				ath_rc_priv->probe_rate = 0;
995 996 997 998 999

				/*
				 * Since this probe succeeded, we allow the next
				 * probe twice as soon.  This allows the maxRate
				 * to move up faster if the probes are
1000
				 * successful.
1001
				 */
S
Sujith 已提交
1002 1003
				ath_rc_priv->probe_time =
					now_msec - rate_table->probe_interval / 2;
1004 1005 1006 1007 1008 1009 1010 1011
			}
		}

		if (retries > 0) {
			/*
			 * Don't update anything.  We don't know if
			 * this was because of collisions or poor signal.
			 */
1012
			ath_rc_priv->hw_maxretry_pktcnt = 0;
1013 1014 1015 1016 1017
		} else {
			/*
			 * It worked with no retries. First ignore bogus (small)
			 * rssi_ack values.
			 */
1018 1019 1020
			if (tx_rate == ath_rc_priv->rate_max_phy &&
			    ath_rc_priv->hw_maxretry_pktcnt < 255) {
				ath_rc_priv->hw_maxretry_pktcnt++;
1021 1022 1023 1024
			}

		}
	}
1025

S
Sujith 已提交
1026 1027 1028 1029 1030 1031 1032 1033
	return state_change;
}

/* Update PER, RSSI and whatever else that the code thinks it is doing.
   If you can make sense of all this, you really need to go out more. */

static void ath_rc_update_ht(struct ath_softc *sc,
			     struct ath_rate_priv *ath_rc_priv,
F
Felix Fietkau 已提交
1034
			     struct ieee80211_tx_info *tx_info,
S
Sujith 已提交
1035 1036 1037 1038 1039 1040
			     int tx_rate, int xretries, int retries)
{
	u32 now_msec = jiffies_to_msecs(jiffies);
	int rate;
	u8 last_per;
	bool state_change = false;
1041
	const struct ath_rate_table *rate_table = sc->cur_rate_table;
S
Sujith 已提交
1042 1043 1044 1045
	int size = ath_rc_priv->rate_table_size;

	if ((tx_rate < 0) || (tx_rate > rate_table->rate_cnt))
		return;
1046

1047
	last_per = ath_rc_priv->per[tx_rate];
S
Sujith 已提交
1048 1049 1050

	/* Update PER first */
	state_change = ath_rc_update_per(sc, rate_table, ath_rc_priv,
F
Felix Fietkau 已提交
1051
					 tx_info, tx_rate, xretries,
S
Sujith 已提交
1052
					 retries, now_msec);
1053 1054 1055 1056 1057

	/*
	 * If this rate looks bad (high PER) then stop using it for
	 * a while (except if we are probing).
	 */
1058
	if (ath_rc_priv->per[tx_rate] >= 55 && tx_rate > 0 &&
S
Sujith 已提交
1059
	    rate_table->info[tx_rate].ratekbps <=
1060
	    rate_table->info[ath_rc_priv->rate_max_phy].ratekbps) {
1061 1062
		ath_rc_get_lower_rix(rate_table, ath_rc_priv,
				     (u8)tx_rate, &ath_rc_priv->rate_max_phy);
1063 1064

		/* Don't probe for a little while. */
1065
		ath_rc_priv->probe_time = now_msec;
1066 1067 1068 1069
	}

	/* Make sure the rates below this have lower PER */
	/* Monotonicity is kept only for rates below the current rate. */
1070
	if (ath_rc_priv->per[tx_rate] < last_per) {
1071 1072
		for (rate = tx_rate - 1; rate >= 0; rate--) {

1073 1074 1075 1076
			if (ath_rc_priv->per[rate] >
			    ath_rc_priv->per[rate+1]) {
				ath_rc_priv->per[rate] =
					ath_rc_priv->per[rate+1];
1077 1078 1079 1080 1081
			}
		}
	}

	/* Maintain monotonicity for rates above the current rate */
S
Sujith 已提交
1082
	for (rate = tx_rate; rate < size - 1; rate++) {
1083 1084 1085 1086
		if (ath_rc_priv->per[rate+1] <
		    ath_rc_priv->per[rate])
			ath_rc_priv->per[rate+1] =
				ath_rc_priv->per[rate];
1087 1088 1089 1090
	}

	/* Every so often, we reduce the thresholds
	 * and PER (different for CCK and OFDM). */
1091
	if (now_msec - ath_rc_priv->per_down_time >=
1092
	    rate_table->probe_interval) {
S
Sujith 已提交
1093
		for (rate = 0; rate < size; rate++) {
1094 1095
			ath_rc_priv->per[rate] =
				7 * ath_rc_priv->per[rate] / 8;
1096 1097
		}

1098
		ath_rc_priv->per_down_time = now_msec;
1099
	}
S
Sujith 已提交
1100

S
Sujith 已提交
1101
	ath_debug_stat_retries(sc, tx_rate, xretries, retries,
1102
			       ath_rc_priv->per[tx_rate]);
1103

S
Sujith 已提交
1104 1105
}

1106
static int ath_rc_get_rateindex(const struct ath_rate_table *rate_table,
S
Sujith 已提交
1107 1108
				struct ieee80211_tx_rate *rate)
{
1109 1110
	int rix = 0, i = 0;
	int mcs_rix_off[] = { 7, 15, 20, 21, 22, 23 };
S
Sujith 已提交
1111

1112 1113 1114
	if (!(rate->flags & IEEE80211_TX_RC_MCS))
		return rate->idx;

1115 1116 1117 1118 1119 1120 1121
	while (rate->idx > mcs_rix_off[i] &&
	      i < sizeof(mcs_rix_off)/sizeof(int)) {
		rix++; i++;
	}

	rix += rate->idx + rate_table->mcs_start;

S
Sujith 已提交
1122 1123
	if ((rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH) &&
	    (rate->flags & IEEE80211_TX_RC_SHORT_GI))
1124
		rix = rate_table->info[rix].ht_index;
S
Sujith 已提交
1125
	else if (rate->flags & IEEE80211_TX_RC_SHORT_GI)
1126
		rix = rate_table->info[rix].sgi_index;
S
Sujith 已提交
1127
	else if (rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
1128
		rix = rate_table->info[rix].cw40index;
S
Sujith 已提交
1129 1130

	return rix;
1131 1132
}

S
Sujith 已提交
1133 1134 1135 1136
static void ath_rc_tx_status(struct ath_softc *sc,
			     struct ath_rate_priv *ath_rc_priv,
			     struct ieee80211_tx_info *tx_info,
			     int final_ts_idx, int xretries, int long_retry)
1137
{
1138
	const struct ath_rate_table *rate_table;
S
Sujith 已提交
1139
	struct ieee80211_tx_rate *rates = tx_info->status.rates;
1140
	u8 flags;
S
Sujith 已提交
1141
	u32 i = 0, rix;
1142

S
Sujith 已提交
1143
	rate_table = sc->cur_rate_table;
1144 1145 1146 1147 1148 1149 1150

	/*
	 * If the first rate is not the final index, there
	 * are intermediate rate failures to be processed.
	 */
	if (final_ts_idx != 0) {
		/* Process intermediate rates that failed.*/
S
Sujith 已提交
1151 1152 1153 1154
		for (i = 0; i < final_ts_idx ; i++) {
			if (rates[i].count != 0 && (rates[i].idx >= 0)) {
				flags = rates[i].flags;

1155 1156
				/* If HT40 and we have switched mode from
				 * 40 to 20 => don't update */
S
Sujith 已提交
1157

S
Sujith 已提交
1158
				if ((flags & IEEE80211_TX_RC_40_MHZ_WIDTH) &&
S
Sujith 已提交
1159
				    !(ath_rc_priv->ht_cap & WLAN_RC_40_FLAG))
1160
					return;
S
Sujith 已提交
1161

S
Sujith 已提交
1162
				rix = ath_rc_get_rateindex(rate_table, &rates[i]);
F
Felix Fietkau 已提交
1163 1164
				ath_rc_update_ht(sc, ath_rc_priv, tx_info,
						rix, xretries ? 1 : 2,
S
Sujith 已提交
1165
						rates[i].count);
1166 1167 1168 1169 1170 1171 1172 1173 1174
			}
		}
	} else {
		/*
		 * Handle the special case of MIMO PS burst, where the second
		 * aggregate is sent out with only one rate and one try.
		 * Treating it as an excessive retry penalizes the rate
		 * inordinately.
		 */
S
Sujith 已提交
1175
		if (rates[0].count == 1 && xretries == 1)
1176 1177 1178
			xretries = 2;
	}

S
Sujith 已提交
1179 1180
	flags = rates[i].flags;

1181
	/* If HT40 and we have switched mode from 40 to 20 => don't update */
S
Sujith 已提交
1182
	if ((flags & IEEE80211_TX_RC_40_MHZ_WIDTH) &&
S
Sujith 已提交
1183
	    !(ath_rc_priv->ht_cap & WLAN_RC_40_FLAG))
1184 1185
		return;

S
Sujith 已提交
1186
	rix = ath_rc_get_rateindex(rate_table, &rates[i]);
F
Felix Fietkau 已提交
1187
	ath_rc_update_ht(sc, ath_rc_priv, tx_info, rix, xretries, long_retry);
1188 1189
}

1190 1191 1192 1193 1194
static const
struct ath_rate_table *ath_choose_rate_table(struct ath_softc *sc,
					     enum ieee80211_band band,
					     bool is_ht,
					     bool is_cw_40)
1195 1196
{
	int mode = 0;
1197
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214

	switch(band) {
	case IEEE80211_BAND_2GHZ:
		mode = ATH9K_MODE_11G;
		if (is_ht)
			mode = ATH9K_MODE_11NG_HT20;
		if (is_cw_40)
			mode = ATH9K_MODE_11NG_HT40PLUS;
		break;
	case IEEE80211_BAND_5GHZ:
		mode = ATH9K_MODE_11A;
		if (is_ht)
			mode = ATH9K_MODE_11NA_HT20;
		if (is_cw_40)
			mode = ATH9K_MODE_11NA_HT40PLUS;
		break;
	default:
1215
		ath_print(common, ATH_DBG_CONFIG, "Invalid band\n");
1216 1217 1218 1219 1220
		return NULL;
	}

	BUG_ON(mode >= ATH9K_MODE_MAX);

1221 1222
	ath_print(common, ATH_DBG_CONFIG,
		  "Choosing rate table for mode: %d\n", mode);
1223 1224 1225

	sc->cur_rate_mode = mode;
	return hw_rate_table[mode];
1226 1227
}

1228
static void ath_rc_init(struct ath_softc *sc,
S
Sujith 已提交
1229
			struct ath_rate_priv *ath_rc_priv,
1230
			struct ieee80211_supported_band *sband,
1231
			struct ieee80211_sta *sta,
1232
			const struct ath_rate_table *rate_table)
1233
{
1234
	struct ath_rateset *rateset = &ath_rc_priv->neg_rates;
1235
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1236
	u8 *ht_mcs = (u8 *)&ath_rc_priv->neg_ht_rates;
1237 1238 1239 1240
	u8 i, j, k, hi = 0, hthi = 0;

	/* Initial rate table size. Will change depending
	 * on the working rate set */
S
Sujith 已提交
1241
	ath_rc_priv->rate_table_size = RATE_TABLE_SIZE;
1242 1243

	/* Initialize thresholds according to the global rate table */
1244
	for (i = 0 ; i < ath_rc_priv->rate_table_size; i++) {
1245
		ath_rc_priv->per[i] = 0;
1246 1247 1248
	}

	/* Determine the valid rates */
1249
	ath_rc_init_valid_txmask(ath_rc_priv);
1250 1251 1252

	for (i = 0; i < WLAN_RC_PHY_MAX; i++) {
		for (j = 0; j < MAX_TX_RATE_PHY; j++)
1253 1254
			ath_rc_priv->valid_phy_rateidx[i][j] = 0;
		ath_rc_priv->valid_phy_ratecnt[i] = 0;
1255 1256 1257 1258
	}

	if (!rateset->rs_nrates) {
		/* No working rate, just initialize valid rates */
S
Sujith 已提交
1259
		hi = ath_rc_init_validrates(ath_rc_priv, rate_table,
1260
					    ath_rc_priv->ht_cap);
1261 1262
	} else {
		/* Use intersection of working rates and valid rates */
S
Sujith 已提交
1263
		hi = ath_rc_setvalid_rates(ath_rc_priv, rate_table,
1264
					   rateset, ath_rc_priv->ht_cap);
1265
		if (ath_rc_priv->ht_cap & WLAN_RC_HT_FLAG) {
S
Sujith 已提交
1266
			hthi = ath_rc_setvalid_htrates(ath_rc_priv,
1267 1268 1269
						       rate_table,
						       ht_mcs,
						       ath_rc_priv->ht_cap);
1270 1271 1272 1273
		}
		hi = A_MAX(hi, hthi);
	}

1274 1275
	ath_rc_priv->rate_table_size = hi + 1;
	ath_rc_priv->rate_max_phy = 0;
1276
	BUG_ON(ath_rc_priv->rate_table_size > RATE_TABLE_SIZE);
1277 1278

	for (i = 0, k = 0; i < WLAN_RC_PHY_MAX; i++) {
1279 1280 1281
		for (j = 0; j < ath_rc_priv->valid_phy_ratecnt[i]; j++) {
			ath_rc_priv->valid_rate_index[k++] =
				ath_rc_priv->valid_phy_rateidx[i][j];
1282 1283
		}

S
Sujith 已提交
1284
		if (!ath_rc_valid_phyrate(i, rate_table->initial_ratemax, 1)
1285
		    || !ath_rc_priv->valid_phy_ratecnt[i])
1286 1287
			continue;

1288
		ath_rc_priv->rate_max_phy = ath_rc_priv->valid_phy_rateidx[i][j-1];
1289
	}
1290 1291
	BUG_ON(ath_rc_priv->rate_table_size > RATE_TABLE_SIZE);
	BUG_ON(k > RATE_TABLE_SIZE);
1292

1293 1294 1295
	ath_rc_priv->max_valid_rate = k;
	ath_rc_sort_validrates(rate_table, ath_rc_priv);
	ath_rc_priv->rate_max_phy = ath_rc_priv->valid_rate_index[k-4];
S
Sujith 已提交
1296
	sc->cur_rate_table = rate_table;
1297

1298 1299 1300
	ath_print(common, ATH_DBG_CONFIG,
		  "RC Initialized with capabilities: 0x%x\n",
		  ath_rc_priv->ht_cap);
1301 1302
}

1303
static u8 ath_rc_build_ht_caps(struct ath_softc *sc, struct ieee80211_sta *sta,
1304
			       bool is_cw40, bool is_sgi)
1305 1306 1307
{
	u8 caps = 0;

1308
	if (sta->ht_cap.ht_supported) {
1309
		caps = WLAN_RC_HT_FLAG;
1310 1311 1312
		if (sta->ht_cap.mcs.rx_mask[1] && sta->ht_cap.mcs.rx_mask[2])
			caps |= WLAN_RC_TS_FLAG | WLAN_RC_DS_FLAG;
		else if (sta->ht_cap.mcs.rx_mask[1])
1313
			caps |= WLAN_RC_DS_FLAG;
1314 1315
		if (is_cw40)
			caps |= WLAN_RC_40_FLAG;
1316
		if (is_sgi)
1317 1318 1319 1320 1321 1322
			caps |= WLAN_RC_SGI_FLAG;
	}

	return caps;
}

1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338
static bool ath_tx_aggr_check(struct ath_softc *sc, struct ath_node *an,
			      u8 tidno)
{
	struct ath_atx_tid *txtid;

	if (!(sc->sc_flags & SC_OP_TXAGGR))
		return false;

	txtid = ATH_AN_2_TID(an, tidno);

	if (!(txtid->state & (AGGR_ADDBA_COMPLETE | AGGR_ADDBA_PROGRESS)))
			return true;
	return false;
}


1339 1340 1341 1342
/***********************************/
/* mac80211 Rate Control callbacks */
/***********************************/

1343 1344
static void ath_tx_status(void *priv, struct ieee80211_supported_band *sband,
			  struct ieee80211_sta *sta, void *priv_sta,
1345 1346 1347
			  struct sk_buff *skb)
{
	struct ath_softc *sc = priv;
S
Sujith 已提交
1348
	struct ath_rate_priv *ath_rc_priv = priv_sta;
1349 1350
	struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
	struct ieee80211_hdr *hdr;
F
Felix Fietkau 已提交
1351 1352
	int final_ts_idx = 0, tx_status = 0, is_underrun = 0;
	int long_retry = 0;
1353
	__le16 fc;
F
Felix Fietkau 已提交
1354
	int i;
1355 1356 1357

	hdr = (struct ieee80211_hdr *)skb->data;
	fc = hdr->frame_control;
F
Felix Fietkau 已提交
1358 1359 1360 1361 1362 1363 1364 1365
	for (i = 0; i < IEEE80211_TX_MAX_RATES; i++) {
		struct ieee80211_tx_rate *rate = &tx_info->status.rates[i];
		if (!rate->count)
			break;

		final_ts_idx = i;
		long_retry = rate->count - 1;
	}
1366

1367 1368 1369 1370 1371 1372
	if (!priv_sta || !ieee80211_is_data(fc))
		return;

	/* This packet was aggregated but doesn't carry status info */
	if ((tx_info->flags & IEEE80211_TX_CTL_AMPDU) &&
	    !(tx_info->flags & IEEE80211_TX_STAT_AMPDU))
F
Felix Fietkau 已提交
1373
		return;
1374

F
Felix Fietkau 已提交
1375 1376
	if (tx_info->flags & IEEE80211_TX_STAT_TX_FILTERED)
		return;
1377

1378 1379 1380 1381 1382 1383
	if (!(tx_info->flags & IEEE80211_TX_STAT_AMPDU)) {
		tx_info->status.ampdu_ack_len =
			(tx_info->flags & IEEE80211_TX_STAT_ACK ? 1 : 0);
		tx_info->status.ampdu_len = 1;
	}

S
Sujith 已提交
1384
	/*
1385 1386 1387 1388 1389 1390 1391 1392
	 * If an underrun error is seen assume it as an excessive retry only
	 * if max frame trigger level has been reached (2 KB for singel stream,
	 * and 4 KB for dual stream). Adjust the long retry as if the frame was
	 * tried hw->max_rate_tries times to affect how ratectrl updates PER for
	 * the failed rate. In case of congestion on the bus penalizing these
	 * type of underruns should help hardware actually transmit new frames
	 * successfully by eventually preferring slower rates. This itself
	 * should also alleviate congestion on the bus.
S
Sujith 已提交
1393
	 */
F
Felix Fietkau 已提交
1394 1395
	if ((tx_info->pad[0] & ATH_TX_INFO_UNDERRUN) &&
	    (sc->sc_ah->tx_trig_level >= ath_rc_priv->tx_triglevel_max)) {
S
Sujith 已提交
1396 1397 1398 1399
		tx_status = 1;
		is_underrun = 1;
	}

F
Felix Fietkau 已提交
1400
	if (tx_info->pad[0] & ATH_TX_INFO_XRETRY)
S
Sujith 已提交
1401 1402 1403
		tx_status = 1;

	ath_rc_tx_status(sc, ath_rc_priv, tx_info, final_ts_idx, tx_status,
F
Felix Fietkau 已提交
1404
			 (is_underrun) ? sc->hw->max_rate_tries : long_retry);
S
Sujith 已提交
1405

S
Sujith 已提交
1406
	/* Check if aggregation has to be enabled for this tid */
1407 1408
	if (conf_is_ht(&sc->hw->conf) &&
	    !(skb->protocol == cpu_to_be16(ETH_P_PAE))) {
S
Sujith 已提交
1409 1410 1411 1412 1413 1414 1415 1416 1417
		if (ieee80211_is_data_qos(fc)) {
			u8 *qc, tid;
			struct ath_node *an;

			qc = ieee80211_get_qos_ctl(hdr);
			tid = qc[0] & 0xf;
			an = (struct ath_node *)sta->drv_priv;

			if(ath_tx_aggr_check(sc, an, tid))
1418
				ieee80211_start_tx_ba_session(sta, tid);
S
Sujith 已提交
1419 1420
		}
	}
1421

1422 1423
	ath_debug_stat_rc(sc, ath_rc_get_rateindex(sc->cur_rate_table,
		&tx_info->status.rates[final_ts_idx]));
1424 1425
}

1426 1427
static void ath_rate_init(void *priv, struct ieee80211_supported_band *sband,
                          struct ieee80211_sta *sta, void *priv_sta)
1428
{
1429
	struct ath_softc *sc = priv;
S
Sujith 已提交
1430
	struct ath_rate_priv *ath_rc_priv = priv_sta;
1431
	const struct ath_rate_table *rate_table;
1432
	bool is_cw40, is_sgi = false;
1433 1434
	int i, j = 0;

S
Sujith 已提交
1435 1436 1437 1438 1439 1440 1441 1442
	for (i = 0; i < sband->n_bitrates; i++) {
		if (sta->supp_rates[sband->band] & BIT(i)) {
			ath_rc_priv->neg_rates.rs_rates[j]
				= (sband->bitrates[i].bitrate * 2) / 10;
			j++;
		}
	}
	ath_rc_priv->neg_rates.rs_nrates = j;
1443

1444
	if (sta->ht_cap.ht_supported) {
S
Sujith 已提交
1445
		for (i = 0, j = 0; i < 77; i++) {
J
Johannes Berg 已提交
1446
			if (sta->ht_cap.mcs.rx_mask[i/8] & (1<<(i%8)))
S
Sujith 已提交
1447
				ath_rc_priv->neg_ht_rates.rs_rates[j++] = i;
1448 1449 1450
			if (j == ATH_RATE_MAX)
				break;
		}
S
Sujith 已提交
1451
		ath_rc_priv->neg_ht_rates.rs_nrates = j;
1452
	}
S
Sujith 已提交
1453

1454
	is_cw40 = sta->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40;
1455 1456 1457 1458 1459

	if (is_cw40)
		is_sgi = sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40;
	else if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_SGI_20)
		is_sgi = sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20;
1460 1461 1462 1463

	/* Choose rate table first */

	if ((sc->sc_ah->opmode == NL80211_IFTYPE_STATION) ||
1464
	    (sc->sc_ah->opmode == NL80211_IFTYPE_MESH_POINT) ||
1465 1466
	    (sc->sc_ah->opmode == NL80211_IFTYPE_ADHOC)) {
		rate_table = ath_choose_rate_table(sc, sband->band,
1467 1468 1469
		                      sta->ht_cap.ht_supported, is_cw40);
	} else {
		rate_table = hw_rate_table[sc->cur_rate_mode];
1470 1471
	}

1472
	ath_rc_priv->ht_cap = ath_rc_build_ht_caps(sc, sta, is_cw40, is_sgi);
1473 1474 1475 1476 1477
	ath_rc_init(sc, priv_sta, sband, sta, rate_table);
}

static void ath_rate_update(void *priv, struct ieee80211_supported_band *sband,
			    struct ieee80211_sta *sta, void *priv_sta,
1478
			    u32 changed, enum nl80211_channel_type oper_chan_type)
1479 1480 1481
{
	struct ath_softc *sc = priv;
	struct ath_rate_priv *ath_rc_priv = priv_sta;
1482
	const struct ath_rate_table *rate_table = NULL;
1483
	bool oper_cw40 = false, oper_sgi;
1484 1485
	bool local_cw40 = (ath_rc_priv->ht_cap & WLAN_RC_40_FLAG) ?
		true : false;
1486
	bool local_sgi = (ath_rc_priv->ht_cap & WLAN_RC_SGI_FLAG) ?
1487 1488 1489 1490 1491 1492 1493 1494
		true : false;

	/* FIXME: Handle AP mode later when we support CWM */

	if (changed & IEEE80211_RC_HT_CHANGED) {
		if (sc->sc_ah->opmode != NL80211_IFTYPE_STATION)
			return;

1495 1496
		if (oper_chan_type == NL80211_CHAN_HT40MINUS ||
		    oper_chan_type == NL80211_CHAN_HT40PLUS)
1497 1498
			oper_cw40 = true;

1499 1500 1501 1502 1503 1504 1505 1506
		if (oper_cw40)
			oper_sgi = (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40) ?
				   true : false;
		else if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_SGI_20)
			oper_sgi = (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20) ?
				   true : false;
		else
			oper_sgi = false;
1507

1508
		if ((local_cw40 != oper_cw40) || (local_sgi != oper_sgi)) {
1509 1510 1511
			rate_table = ath_choose_rate_table(sc, sband->band,
						   sta->ht_cap.ht_supported,
						   oper_cw40);
1512
			ath_rc_priv->ht_cap = ath_rc_build_ht_caps(sc, sta,
1513
						   oper_cw40, oper_sgi);
1514 1515
			ath_rc_init(sc, priv_sta, sband, sta, rate_table);

1516 1517 1518
			ath_print(ath9k_hw_common(sc->sc_ah), ATH_DBG_CONFIG,
				  "Operating HT Bandwidth changed to: %d\n",
				  sc->hw->conf.channel_type);
1519
			sc->cur_rate_table = hw_rate_table[sc->cur_rate_mode];
1520 1521
		}
	}
1522 1523
}

1524
static void *ath_rate_alloc(struct ieee80211_hw *hw, struct dentry *debugfsdir)
1525
{
1526 1527
	struct ath_wiphy *aphy = hw->priv;
	return aphy->sc;
1528 1529 1530 1531 1532 1533 1534
}

static void ath_rate_free(void *priv)
{
	return;
}

1535
static void *ath_rate_alloc_sta(void *priv, struct ieee80211_sta *sta, gfp_t gfp)
1536 1537
{
	struct ath_softc *sc = priv;
S
Sujith 已提交
1538
	struct ath_rate_priv *rate_priv;
1539

S
Sujith 已提交
1540
	rate_priv = kzalloc(sizeof(struct ath_rate_priv), gfp);
1541
	if (!rate_priv) {
1542 1543
		ath_print(ath9k_hw_common(sc->sc_ah), ATH_DBG_FATAL,
			  "Unable to allocate private rc structure\n");
1544 1545
		return NULL;
	}
S
Sujith 已提交
1546

1547
	rate_priv->tx_triglevel_max = sc->sc_ah->caps.tx_triglevel_max;
S
Sujith 已提交
1548

1549 1550 1551
	return rate_priv;
}

1552 1553
static void ath_rate_free_sta(void *priv, struct ieee80211_sta *sta,
			      void *priv_sta)
1554
{
S
Sujith 已提交
1555
	struct ath_rate_priv *rate_priv = priv_sta;
S
Sujith 已提交
1556
	kfree(rate_priv);
1557 1558 1559 1560 1561 1562 1563 1564
}

static struct rate_control_ops ath_rate_ops = {
	.module = NULL,
	.name = "ath9k_rate_control",
	.tx_status = ath_tx_status,
	.get_rate = ath_get_rate,
	.rate_init = ath_rate_init,
1565
	.rate_update = ath_rate_update,
1566 1567 1568
	.alloc = ath_rate_alloc,
	.free = ath_rate_free,
	.alloc_sta = ath_rate_alloc_sta,
1569
	.free_sta = ath_rate_free_sta,
1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580
};

int ath_rate_control_register(void)
{
	return ieee80211_rate_control_register(&ath_rate_ops);
}

void ath_rate_control_unregister(void)
{
	ieee80211_rate_control_unregister(&ath_rate_ops);
}