rc.c 50.1 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
static int ath_rc_get_rateindex(const struct ath_rate_table *rate_table,
				struct ieee80211_tx_rate *rate);

384
static void ath_rc_sort_validrates(const struct ath_rate_table *rate_table,
S
Sujith 已提交
385
				   struct ath_rate_priv *ath_rc_priv)
386 387 388
{
	u8 i, j, idx, idx_next;

389
	for (i = ath_rc_priv->max_valid_rate - 1; i > 0; i--) {
390
		for (j = 0; j <= i-1; j++) {
391 392
			idx = ath_rc_priv->valid_rate_index[j];
			idx_next = ath_rc_priv->valid_rate_index[j+1];
393 394 395

			if (rate_table->info[idx].ratekbps >
				rate_table->info[idx_next].ratekbps) {
396 397
				ath_rc_priv->valid_rate_index[j] = idx_next;
				ath_rc_priv->valid_rate_index[j+1] = idx;
398 399 400 401 402
			}
		}
	}
}

403
static void ath_rc_init_valid_rate_idx(struct ath_rate_priv *ath_rc_priv)
404 405 406
{
	u8 i;

407
	for (i = 0; i < ath_rc_priv->rate_table_size; i++)
S
Sujith 已提交
408
		ath_rc_priv->valid_rate_index[i] = 0;
409 410
}

411
static inline void ath_rc_set_valid_rate_idx(struct ath_rate_priv *ath_rc_priv,
412 413
					   u8 index, int valid_tx_rate)
{
414
	BUG_ON(index > ath_rc_priv->rate_table_size);
415
	ath_rc_priv->valid_rate_index[index] = !!valid_tx_rate;
416 417
}

418 419 420 421 422
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)
423 424 425
{
	u8 i;

426 427 428
	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 已提交
429
			return 1;
430 431 432 433 434
		}
	}

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

S
Sujith 已提交
436
	return 0;
437 438 439 440 441 442
}

/* Return true only for single stream */

static int ath_rc_valid_phyrate(u32 phy, u32 capflag, int ignore_cw)
{
443
	if (WLAN_RC_PHY_HT(phy) && !(capflag & WLAN_RC_HT_FLAG))
S
Sujith 已提交
444
		return 0;
445
	if (WLAN_RC_PHY_DS(phy) && !(capflag & WLAN_RC_DS_FLAG))
S
Sujith 已提交
446
		return 0;
447 448
	if (WLAN_RC_PHY_TS(phy) && !(capflag & WLAN_RC_TS_FLAG))
		return 0;
449
	if (WLAN_RC_PHY_SGI(phy) && !(capflag & WLAN_RC_SGI_FLAG))
S
Sujith 已提交
450
		return 0;
451 452
	if (!ignore_cw && WLAN_RC_PHY_HT(phy))
		if (WLAN_RC_PHY_40(phy) && !(capflag & WLAN_RC_40_FLAG))
S
Sujith 已提交
453 454
			return 0;
	return 1;
455 456 457
}

static inline int
458 459 460
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)
461 462 463
{
	int8_t i;

464 465 466
	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 已提交
467
			return 1;
468 469
		}
	}
S
Sujith 已提交
470

S
Sujith 已提交
471
	return 0;
472 473
}

S
Sujith 已提交
474
static u8 ath_rc_init_validrates(struct ath_rate_priv *ath_rc_priv,
475
				 const struct ath_rate_table *rate_table,
S
Sujith 已提交
476
				 u32 capflag)
477 478 479 480
{
	u8 i, hi = 0;

	for (i = 0; i < rate_table->rate_cnt; i++) {
481
		if (rate_table->info[i].rate_flags & RC_LEGACY) {
482 483 484
			u32 phy = rate_table->info[i].phy;
			u8 valid_rate_count = 0;

S
Sujith 已提交
485
			if (!ath_rc_valid_phyrate(phy, capflag, 0))
486 487
				continue;

488
			valid_rate_count = ath_rc_priv->valid_phy_ratecnt[phy];
489

490 491
			ath_rc_priv->valid_phy_rateidx[phy][valid_rate_count] = i;
			ath_rc_priv->valid_phy_ratecnt[phy] += 1;
492
			ath_rc_set_valid_rate_idx(ath_rc_priv, i, 1);
493
			hi = i;
494 495
		}
	}
S
Sujith 已提交
496

497 498 499
	return hi;
}

S
Sujith 已提交
500
static u8 ath_rc_setvalid_rates(struct ath_rate_priv *ath_rc_priv,
501
				const struct ath_rate_table *rate_table,
S
Sujith 已提交
502 503
				struct ath_rateset *rateset,
				u32 capflag)
504 505 506 507 508 509 510
{
	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;
511
			u16 rate_flags = rate_table->info[j].rate_flags;
S
Sujith 已提交
512 513
			u8 rate = rateset->rs_rates[i];
			u8 dot11rate = rate_table->info[j].dot11rate;
514 515 516

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

519
			if ((rate == dot11rate) &&
520 521 522
			    (rate_flags & WLAN_RC_CAP_MODE(capflag)) ==
			    WLAN_RC_CAP_MODE(capflag) &&
			    (rate_flags & WLAN_RC_CAP_STREAM(capflag)) &&
S
Sujith 已提交
523
			    !WLAN_RC_PHY_HT(phy)) {
524 525
				u8 valid_rate_count = 0;

S
Sujith 已提交
526
				if (!ath_rc_valid_phyrate(phy, capflag, 0))
527 528 529
					continue;

				valid_rate_count =
530
					ath_rc_priv->valid_phy_ratecnt[phy];
531

532
				ath_rc_priv->valid_phy_rateidx[phy]
533
					[valid_rate_count] = j;
534
				ath_rc_priv->valid_phy_ratecnt[phy] += 1;
535
				ath_rc_set_valid_rate_idx(ath_rc_priv, j, 1);
536 537 538 539
				hi = A_MAX(hi, j);
			}
		}
	}
S
Sujith 已提交
540

541 542 543
	return hi;
}

S
Sujith 已提交
544
static u8 ath_rc_setvalid_htrates(struct ath_rate_priv *ath_rc_priv,
545
				  const struct ath_rate_table *rate_table,
S
Sujith 已提交
546
				  u8 *mcs_set, u32 capflag)
547
{
S
Sujith 已提交
548 549
	struct ath_rateset *rateset = (struct ath_rateset *)mcs_set;

550 551 552
	u8 i, j, hi = 0;

	/* Use intersection of working rates and valid rates */
S
Sujith 已提交
553
	for (i = 0; i < rateset->rs_nrates; i++) {
554 555
		for (j = 0; j < rate_table->rate_cnt; j++) {
			u32 phy = rate_table->info[j].phy;
556
			u16 rate_flags = rate_table->info[j].rate_flags;
S
Sujith 已提交
557 558
			u8 rate = rateset->rs_rates[i];
			u8 dot11rate = rate_table->info[j].dot11rate;
559

560
			if ((rate != dot11rate) || !WLAN_RC_PHY_HT(phy) ||
561 562
			    !(rate_flags & WLAN_RC_CAP_STREAM(capflag)) ||
			    !WLAN_RC_PHY_HT_VALID(rate_flags, capflag))
563 564
				continue;

S
Sujith 已提交
565
			if (!ath_rc_valid_phyrate(phy, capflag, 0))
566 567
				continue;

568 569 570
			ath_rc_priv->valid_phy_rateidx[phy]
				[ath_rc_priv->valid_phy_ratecnt[phy]] = j;
			ath_rc_priv->valid_phy_ratecnt[phy] += 1;
571
			ath_rc_set_valid_rate_idx(ath_rc_priv, j, 1);
572 573 574 575
			hi = A_MAX(hi, j);
		}
	}

S
Sujith 已提交
576
	return hi;
577 578
}

579 580 581 582 583
/* 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)
584
{
585
	u32 best_thruput, this_thruput, now_msec;
586
	u8 rate, next_rate, best_rate, maxindex, minindex;
587
	int8_t index = 0;
588 589

	now_msec = jiffies_to_msecs(jiffies);
590
	*is_probing = 0;
591
	best_thruput = 0;
592
	maxindex = ath_rc_priv->max_valid_rate-1;
593 594 595 596 597 598 599 600 601 602
	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;

603 604
		rate = ath_rc_priv->valid_rate_index[index];
		if (rate > ath_rc_priv->rate_max_phy)
605 606 607 608 609 610 611 612 613 614 615 616 617
			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.
		 */
618
		per_thres = ath_rc_priv->per[rate];
619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637
		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 已提交
638
	if (rate >= ath_rc_priv->rate_max_phy) {
639
		rate = ath_rc_priv->rate_max_phy;
640 641 642

		/* Probe the next allowed phy state */
		if (ath_rc_get_nextvalid_txrate(rate_table,
S
Sujith 已提交
643
					ath_rc_priv, rate, &next_rate) &&
644
		    (now_msec - ath_rc_priv->probe_time >
645
		     rate_table->probe_interval) &&
646
		    (ath_rc_priv->hw_maxretry_pktcnt >= 1)) {
647
			rate = next_rate;
648 649 650
			ath_rc_priv->probe_rate = rate;
			ath_rc_priv->probe_time = now_msec;
			ath_rc_priv->hw_maxretry_pktcnt = 0;
S
Sujith 已提交
651
			*is_probing = 1;
652 653 654
		}
	}

655 656
	if (rate > (ath_rc_priv->rate_table_size - 1))
		rate = ath_rc_priv->rate_table_size - 1;
657

658 659 660 661 662 663
	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)))
664 665
		return rate;

666
	if (RC_SS_OR_LEGACY(rate_table->info[rate].rate_flags))
667 668 669 670 671 672
		return rate;

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

	rate = ath_rc_priv->valid_rate_index[0];
673 674 675 676

	return rate;
}

677
static void ath_rc_rate_set_series(const struct ath_rate_table *rate_table,
S
Sujith 已提交
678
				   struct ieee80211_tx_rate *rate,
679
				   struct ieee80211_tx_rate_control *txrc,
S
Sujith 已提交
680
				   u8 tries, u8 rix, int rtsctsenable)
681
{
S
Sujith 已提交
682
	rate->count = tries;
683
	rate->idx = rate_table->info[rix].ratecode;
S
Sujith 已提交
684

685 686 687
	if (txrc->short_preamble)
		rate->flags |= IEEE80211_TX_RC_USE_SHORT_PREAMBLE;
	if (txrc->rts || rtsctsenable)
S
Sujith 已提交
688
		rate->flags |= IEEE80211_TX_RC_USE_RTS_CTS;
689 690

	if (WLAN_RC_PHY_HT(rate_table->info[rix].phy)) {
S
Sujith 已提交
691
		rate->flags |= IEEE80211_TX_RC_MCS;
692 693 694 695 696
		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;
	}
697 698
}

699
static void ath_rc_rate_set_rtscts(struct ath_softc *sc,
700
				   const struct ath_rate_table *rate_table,
701 702 703 704 705 706 707 708
				   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)) {
709
			rix = ath_rc_get_rateindex(rate_table, &rates[i]);
710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734
			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;
}

735 736
static void ath_get_rate(void *priv, struct ieee80211_sta *sta, void *priv_sta,
			 struct ieee80211_tx_rate_control *txrc)
737
{
738 739
	struct ath_softc *sc = priv;
	struct ath_rate_priv *ath_rc_priv = priv_sta;
740
	const struct ath_rate_table *rate_table;
S
Sujith 已提交
741 742
	struct sk_buff *skb = txrc->skb;
	struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
S
Sujith 已提交
743
	struct ieee80211_tx_rate *rates = tx_info->control.rates;
744 745
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
	__le16 fc = hdr->frame_control;
746
	u8 try_per_rate, i = 0, rix;
S
Sujith 已提交
747
	int is_probe = 0;
748

749 750 751
	if (rate_control_send_low(sta, priv_sta, txrc))
		return;

752 753 754 755
	/*
	 * For Multi Rate Retry we use a different number of
	 * retry attempt counts. This ends up looking like this:
	 *
756 757 758 759
	 * MRR[0] = 4
	 * MRR[1] = 4
	 * MRR[2] = 4
	 * MRR[3] = 8
760 761
	 *
	 */
762
	try_per_rate = 4;
763

764
	rate_table = ath_rc_priv->rate_table;
765
	rix = ath_rc_get_highest_rix(sc, ath_rc_priv, rate_table, &is_probe);
766

L
Luis R. Rodriguez 已提交
767 768 769 770 771 772 773 774 775
	/*
	 * 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;

776 777 778 779
	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 已提交
780
	if (is_probe) {
781 782
		/* set one try for probe rates. For the
		 * probes don't enable rts */
783
		ath_rc_rate_set_series(rate_table, &rates[i++], txrc,
784
				       1, rix, 0);
785 786 787 788

		/* Get the next tried/allowed rate. No RTS for the next series
		 * after the probe rate
		 */
789
		ath_rc_get_lower_rix(rate_table, ath_rc_priv, rix, &rix);
790
		ath_rc_rate_set_series(rate_table, &rates[i++], txrc,
791
				       try_per_rate, rix, 0);
792 793

		tx_info->flags |= IEEE80211_TX_CTL_RATE_CTRL_PROBE;
794 795
	} else {
		/* Set the choosen rate. No RTS for first series entry. */
796
		ath_rc_rate_set_series(rate_table, &rates[i++], txrc,
797
				       try_per_rate, rix, 0);
798 799 800
	}

	/* Fill in the other rates for multirate retry */
S
Sujith 已提交
801
	for ( ; i < 4; i++) {
802 803
		/* Use twice the number of tries for the last MRR segment. */
		if (i + 1 == 4)
804
			try_per_rate = 8;
805

806
		ath_rc_get_lower_rix(rate_table, ath_rc_priv, rix, &rix);
807
		/* All other rates in the series have RTS enabled */
808
		ath_rc_rate_set_series(rate_table, &rates[i], txrc,
809
				       try_per_rate, rix, 1);
810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826
	}

	/*
	 * 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.
	 */
827
	if ((sc->hw->conf.channel->band == IEEE80211_BAND_2GHZ) &&
828
	    (conf_is_ht(&sc->hw->conf))) {
S
Sujith 已提交
829
		u8 dot11rate = rate_table->info[rix].dot11rate;
830 831 832
		u8 phy = rate_table->info[rix].phy;
		if (i == 4 &&
		    ((dot11rate == 2 && phy == WLAN_RC_PHY_HT_40_SS) ||
S
Sujith 已提交
833
		     (dot11rate == 3 && phy == WLAN_RC_PHY_HT_20_SS))) {
S
Sujith 已提交
834 835
			rates[3].idx = rates[2].idx;
			rates[3].flags = rates[2].flags;
836 837
		}
	}
838 839 840 841 842 843 844 845

	/*
	 * 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
	 */
846 847
	if (ieee80211_has_morefrags(fc) ||
	    (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_FRAG)) {
848 849 850 851 852 853 854
		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);
855 856
}

857
static void ath_rc_update_per(struct ath_softc *sc,
858
			      const struct ath_rate_table *rate_table,
S
Sujith 已提交
859
			      struct ath_rate_priv *ath_rc_priv,
F
Felix Fietkau 已提交
860
				  struct ieee80211_tx_info *tx_info,
S
Sujith 已提交
861 862
			      int tx_rate, int xretries, int retries,
			      u32 now_msec)
863
{
F
Felix Fietkau 已提交
864
	int count, n_bad_frames;
865
	u8 last_per;
J
Joe Perches 已提交
866
	static const u32 nretry_to_per_lookup[10] = {
867 868 869 870 871 872 873 874 875 876 877 878
		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
	};

879
	last_per = ath_rc_priv->per[tx_rate];
F
Felix Fietkau 已提交
880
	n_bad_frames = tx_info->status.ampdu_len - tx_info->status.ampdu_ack_len;
881 882 883

	if (xretries) {
		if (xretries == 1) {
884 885 886
			ath_rc_priv->per[tx_rate] += 30;
			if (ath_rc_priv->per[tx_rate] > 100)
				ath_rc_priv->per[tx_rate] = 100;
887 888
		} else {
			/* xretries == 2 */
889
			count = ARRAY_SIZE(nretry_to_per_lookup);
890 891
			if (retries >= count)
				retries = count - 1;
S
Sujith 已提交
892

893
			/* new_PER = 7/8*old_PER + 1/8*(currentPER) */
894
			ath_rc_priv->per[tx_rate] =
S
Sujith 已提交
895
				(u8)(last_per - (last_per >> 3) + (100 >> 3));
896 897 898 899
		}

		/* xretries == 1 or 2 */

900 901
		if (ath_rc_priv->probe_rate == tx_rate)
			ath_rc_priv->probe_rate = 0;
902

S
Sujith 已提交
903
	} else { /* xretries == 0 */
904
		count = ARRAY_SIZE(nretry_to_per_lookup);
905 906
		if (retries >= count)
			retries = count - 1;
S
Sujith 已提交
907

F
Felix Fietkau 已提交
908
		if (n_bad_frames) {
S
Sujith 已提交
909
			/* new_PER = 7/8*old_PER + 1/8*(currentPER)
910 911 912 913 914 915 916 917 918 919 920
			 * 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 已提交
921 922
			if (tx_info->status.ampdu_len > 0) {
				int n_frames, n_bad_tries;
S
Sujith 已提交
923 924
				u8 cur_per, new_per;

F
Felix Fietkau 已提交
925 926 927 928
				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 已提交
929
				new_per = (u8)(last_per - (last_per >> 3) + cur_per);
930
				ath_rc_priv->per[tx_rate] = new_per;
S
Sujith 已提交
931
			}
932
		} else {
933
			ath_rc_priv->per[tx_rate] =
S
Sujith 已提交
934 935
				(u8)(last_per - (last_per >> 3) +
				     (nretry_to_per_lookup[retries] >> 3));
936 937 938 939 940 941 942
		}


		/*
		 * If we got at most one retry then increase the max rate if
		 * this was a probe.  Otherwise, ignore the probe.
		 */
943
		if (ath_rc_priv->probe_rate && ath_rc_priv->probe_rate == tx_rate) {
F
Felix Fietkau 已提交
944
			if (retries > 0 || 2 * n_bad_frames > tx_info->status.ampdu_len) {
945 946 947 948 949 950 951
				/*
				 * 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.
				 */
952
				ath_rc_priv->probe_rate = 0;
953 954 955
			} else {
				u8 probe_rate = 0;

S
Sujith 已提交
956 957
				ath_rc_priv->rate_max_phy =
					ath_rc_priv->probe_rate;
958
				probe_rate = ath_rc_priv->probe_rate;
959

960 961
				if (ath_rc_priv->per[probe_rate] > 30)
					ath_rc_priv->per[probe_rate] = 20;
962

963
				ath_rc_priv->probe_rate = 0;
964 965 966 967 968

				/*
				 * Since this probe succeeded, we allow the next
				 * probe twice as soon.  This allows the maxRate
				 * to move up faster if the probes are
969
				 * successful.
970
				 */
S
Sujith 已提交
971 972
				ath_rc_priv->probe_time =
					now_msec - rate_table->probe_interval / 2;
973 974 975 976 977 978 979 980
			}
		}

		if (retries > 0) {
			/*
			 * Don't update anything.  We don't know if
			 * this was because of collisions or poor signal.
			 */
981
			ath_rc_priv->hw_maxretry_pktcnt = 0;
982 983 984 985 986
		} else {
			/*
			 * It worked with no retries. First ignore bogus (small)
			 * rssi_ack values.
			 */
987 988 989
			if (tx_rate == ath_rc_priv->rate_max_phy &&
			    ath_rc_priv->hw_maxretry_pktcnt < 255) {
				ath_rc_priv->hw_maxretry_pktcnt++;
990 991 992 993
			}

		}
	}
S
Sujith 已提交
994 995
}

996 997 998 999 1000 1001 1002 1003 1004 1005
static void ath_debug_stat_retries(struct ath_rate_priv *rc, int rix,
				   int xretries, int retries, u8 per)
{
	struct ath_rc_stats *stats = &rc->rcstats[rix];

	stats->xretries += xretries;
	stats->retries += retries;
	stats->per = per;
}

S
Sujith 已提交
1006 1007 1008 1009 1010
/* 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 已提交
1011
			     struct ieee80211_tx_info *tx_info,
S
Sujith 已提交
1012 1013 1014 1015 1016
			     int tx_rate, int xretries, int retries)
{
	u32 now_msec = jiffies_to_msecs(jiffies);
	int rate;
	u8 last_per;
1017
	const struct ath_rate_table *rate_table = ath_rc_priv->rate_table;
S
Sujith 已提交
1018 1019 1020 1021
	int size = ath_rc_priv->rate_table_size;

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

1023
	last_per = ath_rc_priv->per[tx_rate];
S
Sujith 已提交
1024 1025

	/* Update PER first */
1026 1027 1028
	ath_rc_update_per(sc, rate_table, ath_rc_priv,
			  tx_info, tx_rate, xretries,
			  retries, now_msec);
1029 1030 1031 1032 1033

	/*
	 * If this rate looks bad (high PER) then stop using it for
	 * a while (except if we are probing).
	 */
1034
	if (ath_rc_priv->per[tx_rate] >= 55 && tx_rate > 0 &&
S
Sujith 已提交
1035
	    rate_table->info[tx_rate].ratekbps <=
1036
	    rate_table->info[ath_rc_priv->rate_max_phy].ratekbps) {
1037 1038
		ath_rc_get_lower_rix(rate_table, ath_rc_priv,
				     (u8)tx_rate, &ath_rc_priv->rate_max_phy);
1039 1040

		/* Don't probe for a little while. */
1041
		ath_rc_priv->probe_time = now_msec;
1042 1043 1044 1045
	}

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

1049 1050 1051 1052
			if (ath_rc_priv->per[rate] >
			    ath_rc_priv->per[rate+1]) {
				ath_rc_priv->per[rate] =
					ath_rc_priv->per[rate+1];
1053 1054 1055 1056 1057
			}
		}
	}

	/* Maintain monotonicity for rates above the current rate */
S
Sujith 已提交
1058
	for (rate = tx_rate; rate < size - 1; rate++) {
1059 1060 1061 1062
		if (ath_rc_priv->per[rate+1] <
		    ath_rc_priv->per[rate])
			ath_rc_priv->per[rate+1] =
				ath_rc_priv->per[rate];
1063 1064 1065 1066
	}

	/* Every so often, we reduce the thresholds
	 * and PER (different for CCK and OFDM). */
1067
	if (now_msec - ath_rc_priv->per_down_time >=
1068
	    rate_table->probe_interval) {
S
Sujith 已提交
1069
		for (rate = 0; rate < size; rate++) {
1070 1071
			ath_rc_priv->per[rate] =
				7 * ath_rc_priv->per[rate] / 8;
1072 1073
		}

1074
		ath_rc_priv->per_down_time = now_msec;
1075
	}
S
Sujith 已提交
1076

1077
	ath_debug_stat_retries(ath_rc_priv, tx_rate, xretries, retries,
1078
			       ath_rc_priv->per[tx_rate]);
1079

S
Sujith 已提交
1080 1081
}

1082
static int ath_rc_get_rateindex(const struct ath_rate_table *rate_table,
S
Sujith 已提交
1083 1084
				struct ieee80211_tx_rate *rate)
{
1085
	int rix = 0, i = 0;
J
Joe Perches 已提交
1086
	static const int mcs_rix_off[] = { 7, 15, 20, 21, 22, 23 };
S
Sujith 已提交
1087

1088 1089 1090
	if (!(rate->flags & IEEE80211_TX_RC_MCS))
		return rate->idx;

R
roel 已提交
1091
	while (i < ARRAY_SIZE(mcs_rix_off) && rate->idx > mcs_rix_off[i]) {
1092 1093 1094 1095 1096
		rix++; i++;
	}

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

S
Sujith 已提交
1097 1098
	if ((rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH) &&
	    (rate->flags & IEEE80211_TX_RC_SHORT_GI))
1099
		rix = rate_table->info[rix].ht_index;
S
Sujith 已提交
1100
	else if (rate->flags & IEEE80211_TX_RC_SHORT_GI)
1101
		rix = rate_table->info[rix].sgi_index;
S
Sujith 已提交
1102
	else if (rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
1103
		rix = rate_table->info[rix].cw40index;
S
Sujith 已提交
1104 1105

	return rix;
1106 1107
}

S
Sujith 已提交
1108 1109 1110 1111
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)
1112
{
1113
	const struct ath_rate_table *rate_table;
S
Sujith 已提交
1114
	struct ieee80211_tx_rate *rates = tx_info->status.rates;
1115
	u8 flags;
S
Sujith 已提交
1116
	u32 i = 0, rix;
1117

1118
	rate_table = ath_rc_priv->rate_table;
1119 1120 1121 1122 1123 1124 1125

	/*
	 * 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 已提交
1126 1127 1128 1129
		for (i = 0; i < final_ts_idx ; i++) {
			if (rates[i].count != 0 && (rates[i].idx >= 0)) {
				flags = rates[i].flags;

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

S
Sujith 已提交
1133
				if ((flags & IEEE80211_TX_RC_40_MHZ_WIDTH) &&
S
Sujith 已提交
1134
				    !(ath_rc_priv->ht_cap & WLAN_RC_40_FLAG))
1135
					return;
S
Sujith 已提交
1136

S
Sujith 已提交
1137
				rix = ath_rc_get_rateindex(rate_table, &rates[i]);
F
Felix Fietkau 已提交
1138 1139
				ath_rc_update_ht(sc, ath_rc_priv, tx_info,
						rix, xretries ? 1 : 2,
S
Sujith 已提交
1140
						rates[i].count);
1141 1142 1143 1144 1145 1146 1147 1148 1149
			}
		}
	} 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 已提交
1150
		if (rates[0].count == 1 && xretries == 1)
1151 1152 1153
			xretries = 2;
	}

S
Sujith 已提交
1154 1155
	flags = rates[i].flags;

1156
	/* If HT40 and we have switched mode from 40 to 20 => don't update */
S
Sujith 已提交
1157
	if ((flags & IEEE80211_TX_RC_40_MHZ_WIDTH) &&
S
Sujith 已提交
1158
	    !(ath_rc_priv->ht_cap & WLAN_RC_40_FLAG))
1159 1160
		return;

S
Sujith 已提交
1161
	rix = ath_rc_get_rateindex(rate_table, &rates[i]);
F
Felix Fietkau 已提交
1162
	ath_rc_update_ht(sc, ath_rc_priv, tx_info, rix, xretries, long_retry);
1163 1164
}

1165 1166 1167
static const
struct ath_rate_table *ath_choose_rate_table(struct ath_softc *sc,
					     enum ieee80211_band band,
1168
					     bool is_ht)
1169
{
1170
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1171 1172 1173 1174

	switch(band) {
	case IEEE80211_BAND_2GHZ:
		if (is_ht)
1175 1176
			return &ar5416_11ng_ratetable;
		return &ar5416_11g_ratetable;
1177 1178
	case IEEE80211_BAND_5GHZ:
		if (is_ht)
1179 1180
			return &ar5416_11na_ratetable;
		return &ar5416_11a_ratetable;
1181
	default:
J
Joe Perches 已提交
1182
		ath_dbg(common, ATH_DBG_CONFIG, "Invalid band\n");
1183 1184 1185 1186
		return NULL;
	}
}

1187
static void ath_rc_init(struct ath_softc *sc,
S
Sujith 已提交
1188
			struct ath_rate_priv *ath_rc_priv,
1189
			struct ieee80211_supported_band *sband,
1190
			struct ieee80211_sta *sta,
1191
			const struct ath_rate_table *rate_table)
1192
{
1193
	struct ath_rateset *rateset = &ath_rc_priv->neg_rates;
1194
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1195
	u8 *ht_mcs = (u8 *)&ath_rc_priv->neg_ht_rates;
1196 1197 1198 1199
	u8 i, j, k, hi = 0, hthi = 0;

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

	/* Initialize thresholds according to the global rate table */
1203
	for (i = 0 ; i < ath_rc_priv->rate_table_size; i++) {
1204
		ath_rc_priv->per[i] = 0;
1205 1206 1207
	}

	/* Determine the valid rates */
1208
	ath_rc_init_valid_rate_idx(ath_rc_priv);
1209 1210 1211

	for (i = 0; i < WLAN_RC_PHY_MAX; i++) {
		for (j = 0; j < MAX_TX_RATE_PHY; j++)
1212 1213
			ath_rc_priv->valid_phy_rateidx[i][j] = 0;
		ath_rc_priv->valid_phy_ratecnt[i] = 0;
1214 1215 1216 1217
	}

	if (!rateset->rs_nrates) {
		/* No working rate, just initialize valid rates */
S
Sujith 已提交
1218
		hi = ath_rc_init_validrates(ath_rc_priv, rate_table,
1219
					    ath_rc_priv->ht_cap);
1220 1221
	} else {
		/* Use intersection of working rates and valid rates */
S
Sujith 已提交
1222
		hi = ath_rc_setvalid_rates(ath_rc_priv, rate_table,
1223
					   rateset, ath_rc_priv->ht_cap);
1224
		if (ath_rc_priv->ht_cap & WLAN_RC_HT_FLAG) {
S
Sujith 已提交
1225
			hthi = ath_rc_setvalid_htrates(ath_rc_priv,
1226 1227 1228
						       rate_table,
						       ht_mcs,
						       ath_rc_priv->ht_cap);
1229 1230 1231 1232
		}
		hi = A_MAX(hi, hthi);
	}

1233 1234
	ath_rc_priv->rate_table_size = hi + 1;
	ath_rc_priv->rate_max_phy = 0;
1235
	BUG_ON(ath_rc_priv->rate_table_size > RATE_TABLE_SIZE);
1236 1237

	for (i = 0, k = 0; i < WLAN_RC_PHY_MAX; i++) {
1238 1239 1240
		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];
1241 1242
		}

S
Sujith 已提交
1243
		if (!ath_rc_valid_phyrate(i, rate_table->initial_ratemax, 1)
1244
		    || !ath_rc_priv->valid_phy_ratecnt[i])
1245 1246
			continue;

1247
		ath_rc_priv->rate_max_phy = ath_rc_priv->valid_phy_rateidx[i][j-1];
1248
	}
1249 1250
	BUG_ON(ath_rc_priv->rate_table_size > RATE_TABLE_SIZE);
	BUG_ON(k > RATE_TABLE_SIZE);
1251

1252 1253 1254
	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];
1255
	ath_rc_priv->rate_table = rate_table;
1256

J
Joe Perches 已提交
1257 1258 1259
	ath_dbg(common, ATH_DBG_CONFIG,
		"RC Initialized with capabilities: 0x%x\n",
		ath_rc_priv->ht_cap);
1260 1261
}

1262
static u8 ath_rc_build_ht_caps(struct ath_softc *sc, struct ieee80211_sta *sta,
1263
			       bool is_cw40, bool is_sgi)
1264 1265 1266
{
	u8 caps = 0;

1267
	if (sta->ht_cap.ht_supported) {
1268
		caps = WLAN_RC_HT_FLAG;
1269 1270 1271
		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])
1272
			caps |= WLAN_RC_DS_FLAG;
1273 1274
		if (is_cw40)
			caps |= WLAN_RC_40_FLAG;
1275
		if (is_sgi)
1276 1277 1278 1279 1280 1281
			caps |= WLAN_RC_SGI_FLAG;
	}

	return caps;
}

1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297
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;
}


1298 1299 1300 1301
/***********************************/
/* mac80211 Rate Control callbacks */
/***********************************/

1302 1303 1304 1305 1306 1307 1308 1309 1310
static void ath_debug_stat_rc(struct ath_rate_priv *rc, int final_rate)
{
	struct ath_rc_stats *stats;

	stats = &rc->rcstats[final_rate];
	stats->success++;
}


1311 1312
static void ath_tx_status(void *priv, struct ieee80211_supported_band *sband,
			  struct ieee80211_sta *sta, void *priv_sta,
1313 1314 1315
			  struct sk_buff *skb)
{
	struct ath_softc *sc = priv;
S
Sujith 已提交
1316
	struct ath_rate_priv *ath_rc_priv = priv_sta;
1317 1318
	struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
	struct ieee80211_hdr *hdr;
1319
	int final_ts_idx = 0, tx_status = 0;
F
Felix Fietkau 已提交
1320
	int long_retry = 0;
1321
	__le16 fc;
F
Felix Fietkau 已提交
1322
	int i;
1323 1324 1325

	hdr = (struct ieee80211_hdr *)skb->data;
	fc = hdr->frame_control;
1326
	for (i = 0; i < sc->hw->max_rates; i++) {
F
Felix Fietkau 已提交
1327 1328 1329 1330 1331 1332 1333
		struct ieee80211_tx_rate *rate = &tx_info->status.rates[i];
		if (!rate->count)
			break;

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

1335 1336 1337 1338 1339 1340
	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 已提交
1341
		return;
1342

F
Felix Fietkau 已提交
1343 1344
	if (tx_info->flags & IEEE80211_TX_STAT_TX_FILTERED)
		return;
1345

1346 1347 1348 1349 1350 1351
	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;
	}

1352
	if (!(tx_info->flags & IEEE80211_TX_STAT_ACK))
S
Sujith 已提交
1353 1354 1355
		tx_status = 1;

	ath_rc_tx_status(sc, ath_rc_priv, tx_info, final_ts_idx, tx_status,
1356
			 long_retry);
S
Sujith 已提交
1357

S
Sujith 已提交
1358
	/* Check if aggregation has to be enabled for this tid */
1359 1360
	if (conf_is_ht(&sc->hw->conf) &&
	    !(skb->protocol == cpu_to_be16(ETH_P_PAE))) {
1361 1362
		if (ieee80211_is_data_qos(fc) &&
		    skb_get_queue_mapping(skb) != IEEE80211_AC_VO) {
S
Sujith 已提交
1363 1364 1365 1366 1367 1368 1369 1370
			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))
1371
				ieee80211_start_tx_ba_session(sta, tid, 0);
S
Sujith 已提交
1372 1373
		}
	}
1374

1375 1376 1377
	ath_debug_stat_rc(ath_rc_priv,
		ath_rc_get_rateindex(ath_rc_priv->rate_table,
			&tx_info->status.rates[final_ts_idx]));
1378 1379
}

1380 1381
static void ath_rate_init(void *priv, struct ieee80211_supported_band *sband,
                          struct ieee80211_sta *sta, void *priv_sta)
1382
{
1383
	struct ath_softc *sc = priv;
S
Sujith 已提交
1384
	struct ath_rate_priv *ath_rc_priv = priv_sta;
1385
	const struct ath_rate_table *rate_table;
1386
	bool is_cw40, is_sgi = false;
1387 1388
	int i, j = 0;

S
Sujith 已提交
1389 1390 1391 1392 1393 1394 1395 1396
	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;
1397

1398
	if (sta->ht_cap.ht_supported) {
S
Sujith 已提交
1399
		for (i = 0, j = 0; i < 77; i++) {
J
Johannes Berg 已提交
1400
			if (sta->ht_cap.mcs.rx_mask[i/8] & (1<<(i%8)))
S
Sujith 已提交
1401
				ath_rc_priv->neg_ht_rates.rs_rates[j++] = i;
1402 1403 1404
			if (j == ATH_RATE_MAX)
				break;
		}
S
Sujith 已提交
1405
		ath_rc_priv->neg_ht_rates.rs_nrates = j;
1406
	}
S
Sujith 已提交
1407

1408
	is_cw40 = !!(sta->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40);
1409 1410

	if (is_cw40)
1411
		is_sgi = !!(sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40);
1412
	else if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_SGI_20)
1413
		is_sgi = !!(sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20);
1414 1415 1416

	/* Choose rate table first */

1417
	rate_table = ath_choose_rate_table(sc, sband->band,
1418
	                      sta->ht_cap.ht_supported);
1419

1420
	ath_rc_priv->ht_cap = ath_rc_build_ht_caps(sc, sta, is_cw40, is_sgi);
1421 1422 1423 1424 1425
	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,
1426
			    u32 changed, enum nl80211_channel_type oper_chan_type)
1427 1428 1429
{
	struct ath_softc *sc = priv;
	struct ath_rate_priv *ath_rc_priv = priv_sta;
1430
	const struct ath_rate_table *rate_table = NULL;
1431
	bool oper_cw40 = false, oper_sgi;
1432 1433
	bool local_cw40 = !!(ath_rc_priv->ht_cap & WLAN_RC_40_FLAG);
	bool local_sgi = !!(ath_rc_priv->ht_cap & WLAN_RC_SGI_FLAG);
1434 1435 1436 1437 1438 1439 1440

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

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

1441 1442
		if (oper_chan_type == NL80211_CHAN_HT40MINUS ||
		    oper_chan_type == NL80211_CHAN_HT40PLUS)
1443 1444
			oper_cw40 = true;

1445 1446 1447 1448 1449 1450 1451 1452
		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;
1453

1454
		if ((local_cw40 != oper_cw40) || (local_sgi != oper_sgi)) {
1455
			rate_table = ath_choose_rate_table(sc, sband->band,
1456
						   sta->ht_cap.ht_supported);
1457
			ath_rc_priv->ht_cap = ath_rc_build_ht_caps(sc, sta,
1458
						   oper_cw40, oper_sgi);
1459 1460
			ath_rc_init(sc, priv_sta, sband, sta, rate_table);

J
Joe Perches 已提交
1461 1462 1463
			ath_dbg(ath9k_hw_common(sc->sc_ah), ATH_DBG_CONFIG,
				"Operating HT Bandwidth changed to: %d\n",
				sc->hw->conf.channel_type);
1464 1465
		}
	}
1466 1467
}

1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555
#ifdef CONFIG_ATH9K_DEBUGFS

static int ath9k_debugfs_open(struct inode *inode, struct file *file)
{
	file->private_data = inode->i_private;
	return 0;
}

static ssize_t read_file_rcstat(struct file *file, char __user *user_buf,
				size_t count, loff_t *ppos)
{
	struct ath_rate_priv *rc = file->private_data;
	char *buf;
	unsigned int len = 0, max;
	int i = 0;
	ssize_t retval;

	if (rc->rate_table == NULL)
		return 0;

	max = 80 + rc->rate_table->rate_cnt * 1024 + 1;
	buf = kmalloc(max, GFP_KERNEL);
	if (buf == NULL)
		return -ENOMEM;

	len += sprintf(buf, "%6s %6s %6s "
		       "%10s %10s %10s %10s\n",
		       "HT", "MCS", "Rate",
		       "Success", "Retries", "XRetries", "PER");

	for (i = 0; i < rc->rate_table->rate_cnt; i++) {
		u32 ratekbps = rc->rate_table->info[i].ratekbps;
		struct ath_rc_stats *stats = &rc->rcstats[i];
		char mcs[5];
		char htmode[5];
		int used_mcs = 0, used_htmode = 0;

		if (WLAN_RC_PHY_HT(rc->rate_table->info[i].phy)) {
			used_mcs = snprintf(mcs, 5, "%d",
				rc->rate_table->info[i].ratecode);

			if (WLAN_RC_PHY_40(rc->rate_table->info[i].phy))
				used_htmode = snprintf(htmode, 5, "HT40");
			else if (WLAN_RC_PHY_20(rc->rate_table->info[i].phy))
				used_htmode = snprintf(htmode, 5, "HT20");
			else
				used_htmode = snprintf(htmode, 5, "????");
		}

		mcs[used_mcs] = '\0';
		htmode[used_htmode] = '\0';

		len += snprintf(buf + len, max - len,
			"%6s %6s %3u.%d: "
			"%10u %10u %10u %10u\n",
			htmode,
			mcs,
			ratekbps / 1000,
			(ratekbps % 1000) / 100,
			stats->success,
			stats->retries,
			stats->xretries,
			stats->per);
	}

	if (len > max)
		len = max;

	retval = simple_read_from_buffer(user_buf, count, ppos, buf, len);
	kfree(buf);
	return retval;
}

static const struct file_operations fops_rcstat = {
	.read = read_file_rcstat,
	.open = ath9k_debugfs_open,
	.owner = THIS_MODULE
};

static void ath_rate_add_sta_debugfs(void *priv, void *priv_sta,
				     struct dentry *dir)
{
	struct ath_rate_priv *rc = priv_sta;
	debugfs_create_file("rc_stats", S_IRUGO, dir, rc, &fops_rcstat);
}

#endif /* CONFIG_ATH9K_DEBUGFS */

1556
static void *ath_rate_alloc(struct ieee80211_hw *hw, struct dentry *debugfsdir)
1557
{
1558
	return hw->priv;
1559 1560 1561 1562 1563 1564 1565
}

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

1566
static void *ath_rate_alloc_sta(void *priv, struct ieee80211_sta *sta, gfp_t gfp)
1567 1568
{
	struct ath_softc *sc = priv;
S
Sujith 已提交
1569
	struct ath_rate_priv *rate_priv;
1570

S
Sujith 已提交
1571
	rate_priv = kzalloc(sizeof(struct ath_rate_priv), gfp);
1572
	if (!rate_priv) {
1573 1574
		ath_err(ath9k_hw_common(sc->sc_ah),
			"Unable to allocate private rc structure\n");
1575 1576
		return NULL;
	}
S
Sujith 已提交
1577

1578 1579 1580
	return rate_priv;
}

1581 1582
static void ath_rate_free_sta(void *priv, struct ieee80211_sta *sta,
			      void *priv_sta)
1583
{
S
Sujith 已提交
1584
	struct ath_rate_priv *rate_priv = priv_sta;
S
Sujith 已提交
1585
	kfree(rate_priv);
1586 1587 1588 1589 1590 1591 1592 1593
}

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,
1594
	.rate_update = ath_rate_update,
1595 1596 1597
	.alloc = ath_rate_alloc,
	.free = ath_rate_free,
	.alloc_sta = ath_rate_alloc_sta,
1598
	.free_sta = ath_rate_free_sta,
1599 1600 1601
#ifdef CONFIG_ATH9K_DEBUGFS
	.add_sta_debugfs = ath_rate_add_sta_debugfs,
#endif
1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612
};

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);
}