Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

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