cfg80211 API for channels/bitrates, mac80211 and driver conversion
[GitHub/LineageOS/android_kernel_samsung_universal7580.git] / net / mac80211 / rc80211_simple.c
CommitLineData
f0706e82
JB
1/*
2 * Copyright 2002-2005, Instant802 Networks, Inc.
3 * Copyright 2005, Devicescape Software, Inc.
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
8 */
9
f0706e82
JB
10#include <linux/init.h>
11#include <linux/netdevice.h>
12#include <linux/types.h>
13#include <linux/slab.h>
14#include <linux/skbuff.h>
15#include <linux/compiler.h>
4b475898 16#include <linux/module.h>
f0706e82
JB
17
18#include <net/mac80211.h>
19#include "ieee80211_i.h"
20#include "ieee80211_rate.h"
e9f207f0 21#include "debugfs.h"
f0706e82
JB
22
23
24/* This is a minimal implementation of TX rate controlling that can be used
25 * as the default when no improved mechanisms are available. */
26
1abbe498
MN
27#define RATE_CONTROL_NUM_DOWN 20
28#define RATE_CONTROL_NUM_UP 15
f0706e82
JB
29
30#define RATE_CONTROL_EMERG_DEC 2
31#define RATE_CONTROL_INTERVAL (HZ / 20)
32#define RATE_CONTROL_MIN_TX 10
33
f0706e82
JB
34static void rate_control_rate_inc(struct ieee80211_local *local,
35 struct sta_info *sta)
36{
37 struct ieee80211_sub_if_data *sdata;
8318d78a
JB
38 struct ieee80211_supported_band *sband;
39 int i = sta->txrate_idx;
f0706e82
JB
40 int maxrate;
41
42 sdata = IEEE80211_DEV_TO_SUB_IF(sta->dev);
43 if (sdata->bss && sdata->bss->force_unicast_rateidx > -1) {
44 /* forced unicast rate - do not change STA rate */
45 return;
46 }
47
8318d78a 48 sband = local->hw.wiphy->bands[local->hw.conf.channel->band];
f0706e82
JB
49 maxrate = sdata->bss ? sdata->bss->max_ratectrl_rateidx : -1;
50
8318d78a
JB
51 if (i > sband->n_bitrates)
52 i = sband->n_bitrates - 2;
f0706e82 53
8318d78a 54 while (i + 1 < sband->n_bitrates) {
f0706e82 55 i++;
8318d78a 56 if (rate_supported(sta, sband->band, i) &&
f0706e82 57 (maxrate < 0 || i <= maxrate)) {
8318d78a 58 sta->txrate_idx = i;
f0706e82
JB
59 break;
60 }
61 }
62}
63
64
65static void rate_control_rate_dec(struct ieee80211_local *local,
66 struct sta_info *sta)
67{
68 struct ieee80211_sub_if_data *sdata;
8318d78a
JB
69 struct ieee80211_supported_band *sband;
70 int i = sta->txrate_idx;
f0706e82
JB
71
72 sdata = IEEE80211_DEV_TO_SUB_IF(sta->dev);
73 if (sdata->bss && sdata->bss->force_unicast_rateidx > -1) {
74 /* forced unicast rate - do not change STA rate */
75 return;
76 }
77
8318d78a
JB
78 sband = local->hw.wiphy->bands[local->hw.conf.channel->band];
79 if (i > sband->n_bitrates)
80 i = sband->n_bitrates;
f0706e82
JB
81
82 while (i > 0) {
83 i--;
8318d78a
JB
84 if (rate_supported(sta, sband->band, i)) {
85 sta->txrate_idx = i;
f0706e82
JB
86 break;
87 }
88 }
89}
90
f0706e82
JB
91struct global_rate_control {
92 int dummy;
93};
94
95struct sta_rate_control {
96 unsigned long last_rate_change;
97 u32 tx_num_failures;
98 u32 tx_num_xmit;
99
100 unsigned long avg_rate_update;
101 u32 tx_avg_rate_sum;
102 u32 tx_avg_rate_num;
e9f207f0
JB
103
104#ifdef CONFIG_MAC80211_DEBUGFS
105 struct dentry *tx_avg_rate_sum_dentry;
106 struct dentry *tx_avg_rate_num_dentry;
107#endif
f0706e82
JB
108};
109
110
111static void rate_control_simple_tx_status(void *priv, struct net_device *dev,
112 struct sk_buff *skb,
113 struct ieee80211_tx_status *status)
114{
115 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
116 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
117 struct sta_info *sta;
118 struct sta_rate_control *srctrl;
119
120 sta = sta_info_get(local, hdr->addr1);
121
122 if (!sta)
123 return;
124
125 srctrl = sta->rate_ctrl_priv;
126 srctrl->tx_num_xmit++;
127 if (status->excessive_retries) {
f0706e82
JB
128 srctrl->tx_num_failures++;
129 sta->tx_retry_failed++;
130 sta->tx_num_consecutive_failures++;
131 sta->tx_num_mpdu_fail++;
132 } else {
133 sta->last_ack_rssi[0] = sta->last_ack_rssi[1];
134 sta->last_ack_rssi[1] = sta->last_ack_rssi[2];
135 sta->last_ack_rssi[2] = status->ack_signal;
136 sta->tx_num_consecutive_failures = 0;
137 sta->tx_num_mpdu_ok++;
138 }
139 sta->tx_retry_count += status->retry_count;
140 sta->tx_num_mpdu_fail += status->retry_count;
141
142 if (time_after(jiffies,
143 srctrl->last_rate_change + RATE_CONTROL_INTERVAL) &&
144 srctrl->tx_num_xmit > RATE_CONTROL_MIN_TX) {
145 u32 per_failed;
146 srctrl->last_rate_change = jiffies;
147
148 per_failed = (100 * sta->tx_num_mpdu_fail) /
149 (sta->tx_num_mpdu_fail + sta->tx_num_mpdu_ok);
150 /* TODO: calculate average per_failed to make adjusting
151 * parameters easier */
152#if 0
153 if (net_ratelimit()) {
154 printk(KERN_DEBUG "MPDU fail=%d ok=%d per_failed=%d\n",
155 sta->tx_num_mpdu_fail, sta->tx_num_mpdu_ok,
156 per_failed);
157 }
158#endif
159
3ef8bed4
JB
160 /*
161 * XXX: Make these configurable once we have an
162 * interface to the rate control algorithms
163 */
164 if (per_failed > RATE_CONTROL_NUM_DOWN) {
f0706e82 165 rate_control_rate_dec(local, sta);
3ef8bed4 166 } else if (per_failed < RATE_CONTROL_NUM_UP) {
f0706e82
JB
167 rate_control_rate_inc(local, sta);
168 }
8318d78a 169 srctrl->tx_avg_rate_sum += status->control.tx_rate->bitrate;
f0706e82
JB
170 srctrl->tx_avg_rate_num++;
171 srctrl->tx_num_failures = 0;
172 srctrl->tx_num_xmit = 0;
173 } else if (sta->tx_num_consecutive_failures >=
174 RATE_CONTROL_EMERG_DEC) {
175 rate_control_rate_dec(local, sta);
176 }
177
178 if (srctrl->avg_rate_update + 60 * HZ < jiffies) {
179 srctrl->avg_rate_update = jiffies;
180 if (srctrl->tx_avg_rate_num > 0) {
181#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
0795af57
JP
182 DECLARE_MAC_BUF(mac);
183 printk(KERN_DEBUG "%s: STA %s Average rate: "
f0706e82 184 "%d (%d/%d)\n",
0795af57 185 dev->name, print_mac(mac, sta->addr),
f0706e82
JB
186 srctrl->tx_avg_rate_sum /
187 srctrl->tx_avg_rate_num,
188 srctrl->tx_avg_rate_sum,
189 srctrl->tx_avg_rate_num);
190#endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
191 srctrl->tx_avg_rate_sum = 0;
192 srctrl->tx_avg_rate_num = 0;
193 }
194 }
195
196 sta_info_put(sta);
197}
198
199
1abbe498 200static void
f0706e82 201rate_control_simple_get_rate(void *priv, struct net_device *dev,
8318d78a 202 struct ieee80211_supported_band *sband,
f0706e82 203 struct sk_buff *skb,
1abbe498 204 struct rate_selection *sel)
f0706e82
JB
205{
206 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
f0706e82 207 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
2bc454b0 208 struct ieee80211_sub_if_data *sdata;
f0706e82 209 struct sta_info *sta;
1abbe498 210 int rateidx;
2bc454b0 211 u16 fc;
f0706e82
JB
212
213 sta = sta_info_get(local, hdr->addr1);
214
2bc454b0
MW
215 /* Send management frames and broadcast/multicast data using lowest
216 * rate. */
217 fc = le16_to_cpu(hdr->frame_control);
218 if ((fc & IEEE80211_FCTL_FTYPE) != IEEE80211_FTYPE_DATA ||
219 is_multicast_ether_addr(hdr->addr1) || !sta) {
8318d78a 220 sel->rate = rate_lowest(local, sband, sta);
2bc454b0
MW
221 if (sta)
222 sta_info_put(sta);
1abbe498
MN
223 return;
224 }
f0706e82 225
2bc454b0
MW
226 /* If a forced rate is in effect, select it. */
227 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
228 if (sdata->bss && sdata->bss->force_unicast_rateidx > -1)
8318d78a 229 sta->txrate_idx = sdata->bss->force_unicast_rateidx;
2bc454b0 230
8318d78a 231 rateidx = sta->txrate_idx;
f0706e82 232
8318d78a
JB
233 if (rateidx >= sband->n_bitrates)
234 rateidx = sband->n_bitrates - 1;
f0706e82 235
8318d78a 236 sta->last_txrate_idx = rateidx;
2bc454b0 237
f0706e82
JB
238 sta_info_put(sta);
239
8318d78a 240 sel->rate = &sband->bitrates[rateidx];
f0706e82
JB
241}
242
243
244static void rate_control_simple_rate_init(void *priv, void *priv_sta,
245 struct ieee80211_local *local,
246 struct sta_info *sta)
247{
8318d78a
JB
248 struct ieee80211_supported_band *sband;
249
250 sband = local->hw.wiphy->bands[local->hw.conf.channel->band];
251
eef6caf8
LF
252 /* TODO: This routine should consider using RSSI from previous packets
253 * as we need to have IEEE 802.1X auth succeed immediately after assoc..
254 * Until that method is implemented, we will use the lowest supported rate
255 * as a workaround, */
8318d78a 256 sta->txrate_idx = rate_lowest_index(local, sband, sta);
f0706e82
JB
257}
258
259
260static void * rate_control_simple_alloc(struct ieee80211_local *local)
261{
262 struct global_rate_control *rctrl;
263
264 rctrl = kzalloc(sizeof(*rctrl), GFP_ATOMIC);
265
266 return rctrl;
267}
268
269
270static void rate_control_simple_free(void *priv)
271{
272 struct global_rate_control *rctrl = priv;
273 kfree(rctrl);
274}
275
276
277static void rate_control_simple_clear(void *priv)
278{
279}
280
281
282static void * rate_control_simple_alloc_sta(void *priv, gfp_t gfp)
283{
284 struct sta_rate_control *rctrl;
285
286 rctrl = kzalloc(sizeof(*rctrl), gfp);
287
288 return rctrl;
289}
290
291
292static void rate_control_simple_free_sta(void *priv, void *priv_sta)
293{
294 struct sta_rate_control *rctrl = priv_sta;
295 kfree(rctrl);
296}
297
e9f207f0
JB
298#ifdef CONFIG_MAC80211_DEBUGFS
299
300static int open_file_generic(struct inode *inode, struct file *file)
301{
302 file->private_data = inode->i_private;
303 return 0;
304}
305
306static ssize_t sta_tx_avg_rate_sum_read(struct file *file,
307 char __user *userbuf,
308 size_t count, loff_t *ppos)
309{
310 struct sta_rate_control *srctrl = file->private_data;
311 char buf[20];
312
313 sprintf(buf, "%d\n", srctrl->tx_avg_rate_sum);
314 return simple_read_from_buffer(userbuf, count, ppos, buf, strlen(buf));
315}
316
317static const struct file_operations sta_tx_avg_rate_sum_ops = {
318 .read = sta_tx_avg_rate_sum_read,
319 .open = open_file_generic,
320};
321
322static ssize_t sta_tx_avg_rate_num_read(struct file *file,
323 char __user *userbuf,
324 size_t count, loff_t *ppos)
325{
326 struct sta_rate_control *srctrl = file->private_data;
327 char buf[20];
328
329 sprintf(buf, "%d\n", srctrl->tx_avg_rate_num);
330 return simple_read_from_buffer(userbuf, count, ppos, buf, strlen(buf));
331}
332
333static const struct file_operations sta_tx_avg_rate_num_ops = {
334 .read = sta_tx_avg_rate_num_read,
335 .open = open_file_generic,
336};
337
338static void rate_control_simple_add_sta_debugfs(void *priv, void *priv_sta,
339 struct dentry *dir)
340{
341 struct sta_rate_control *srctrl = priv_sta;
342
343 srctrl->tx_avg_rate_num_dentry =
344 debugfs_create_file("rc_simple_sta_tx_avg_rate_num", 0400,
345 dir, srctrl, &sta_tx_avg_rate_num_ops);
346 srctrl->tx_avg_rate_sum_dentry =
347 debugfs_create_file("rc_simple_sta_tx_avg_rate_sum", 0400,
348 dir, srctrl, &sta_tx_avg_rate_sum_ops);
349}
350
351static void rate_control_simple_remove_sta_debugfs(void *priv, void *priv_sta)
352{
353 struct sta_rate_control *srctrl = priv_sta;
354
355 debugfs_remove(srctrl->tx_avg_rate_sum_dentry);
356 debugfs_remove(srctrl->tx_avg_rate_num_dentry);
357}
358#endif
f0706e82 359
4b475898 360static struct rate_control_ops mac80211_rcsimple = {
f0706e82
JB
361 .name = "simple",
362 .tx_status = rate_control_simple_tx_status,
363 .get_rate = rate_control_simple_get_rate,
364 .rate_init = rate_control_simple_rate_init,
365 .clear = rate_control_simple_clear,
366 .alloc = rate_control_simple_alloc,
367 .free = rate_control_simple_free,
368 .alloc_sta = rate_control_simple_alloc_sta,
369 .free_sta = rate_control_simple_free_sta,
e9f207f0
JB
370#ifdef CONFIG_MAC80211_DEBUGFS
371 .add_sta_debugfs = rate_control_simple_add_sta_debugfs,
372 .remove_sta_debugfs = rate_control_simple_remove_sta_debugfs,
373#endif
f0706e82 374};
4b475898
JB
375
376MODULE_LICENSE("GPL");
377MODULE_DESCRIPTION("Simple rate control algorithm");
378
379int __init rc80211_simple_init(void)
380{
381 return ieee80211_rate_control_register(&mac80211_rcsimple);
382}
383
f0b9205c 384void rc80211_simple_exit(void)
4b475898
JB
385{
386 ieee80211_rate_control_unregister(&mac80211_rcsimple);
387}
388
389#ifdef CONFIG_MAC80211_RC_SIMPLE_MODULE
390module_init(rc80211_simple_init);
391module_exit(rc80211_simple_exit);
392#endif