blob: be837a0d2517f7edb627077f598296aca8724f33 [file] [log] [blame]
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001/**
2 * This file contains ioctl functions
3 */
4#include <linux/ctype.h>
5#include <linux/delay.h>
6#include <linux/if.h>
7#include <linux/if_arp.h>
8#include <linux/wireless.h>
9#include <linux/bitops.h>
10
John W. Linville7e272fc2008-09-24 18:13:14 -040011#include <net/lib80211.h>
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020012#include <net/iw_handler.h>
13
14#include "host.h"
15#include "radiotap.h"
16#include "decl.h"
17#include "defs.h"
18#include "dev.h"
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020019#include "wext.h"
Holger Schurig245bf202008-04-02 16:27:42 +020020#include "scan.h"
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020021#include "assoc.h"
Dan Williams8e3c91b2007-12-11 15:50:59 -050022#include "cmd.h"
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020023
24
Holger Schurig69f90322007-11-23 15:43:44 +010025static inline void lbs_postpone_association_work(struct lbs_private *priv)
Holger Schurig9f9dac22007-10-26 10:12:14 +020026{
David Woodhouseaa21c002007-12-08 20:04:36 +000027 if (priv->surpriseremoved)
Holger Schurig9f9dac22007-10-26 10:12:14 +020028 return;
29 cancel_delayed_work(&priv->assoc_work);
30 queue_delayed_work(priv->work_thread, &priv->assoc_work, HZ / 2);
31}
32
Javier Cardona9c31fd62008-09-11 15:32:50 -070033static inline void lbs_do_association_work(struct lbs_private *priv)
34{
35 if (priv->surpriseremoved)
36 return;
37 cancel_delayed_work(&priv->assoc_work);
38 queue_delayed_work(priv->work_thread, &priv->assoc_work, 0);
39}
40
Holger Schurig69f90322007-11-23 15:43:44 +010041static inline void lbs_cancel_association_work(struct lbs_private *priv)
Holger Schurig9f9dac22007-10-26 10:12:14 +020042{
43 cancel_delayed_work(&priv->assoc_work);
David Woodhouseaa21c002007-12-08 20:04:36 +000044 kfree(priv->pending_assoc_req);
45 priv->pending_assoc_req = NULL;
Holger Schurig9f9dac22007-10-26 10:12:14 +020046}
47
48
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020049/**
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020050 * @brief Find the channel frequency power info with specific channel
51 *
David Woodhouseaa21c002007-12-08 20:04:36 +000052 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020053 * @param band it can be BAND_A, BAND_G or BAND_B
54 * @param channel the channel for looking
55 * @return A pointer to struct chan_freq_power structure or NULL if not find.
56 */
Holger Schurig69f90322007-11-23 15:43:44 +010057struct chan_freq_power *lbs_find_cfp_by_band_and_channel(
David Woodhouseaa21c002007-12-08 20:04:36 +000058 struct lbs_private *priv,
Holger Schurig69f90322007-11-23 15:43:44 +010059 u8 band,
60 u16 channel)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020061{
62 struct chan_freq_power *cfp = NULL;
63 struct region_channel *rc;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020064 int i, j;
65
David Woodhouseaa21c002007-12-08 20:04:36 +000066 for (j = 0; !cfp && (j < ARRAY_SIZE(priv->region_channel)); j++) {
67 rc = &priv->region_channel[j];
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020068
David Woodhouseaa21c002007-12-08 20:04:36 +000069 if (priv->enable11d)
70 rc = &priv->universal_channel[j];
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020071 if (!rc->valid || !rc->CFP)
72 continue;
73 if (rc->band != band)
74 continue;
75 for (i = 0; i < rc->nrcfp; i++) {
76 if (rc->CFP[i].channel == channel) {
77 cfp = &rc->CFP[i];
78 break;
79 }
80 }
81 }
82
83 if (!cfp && channel)
Holger Schurig10078322007-11-15 18:05:47 -050084 lbs_deb_wext("lbs_find_cfp_by_band_and_channel: can't find "
Holger Schurig9012b282007-05-25 11:27:16 -040085 "cfp by band %d / channel %d\n", band, channel);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020086
87 return cfp;
88}
89
90/**
91 * @brief Find the channel frequency power info with specific frequency
92 *
David Woodhouseaa21c002007-12-08 20:04:36 +000093 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -020094 * @param band it can be BAND_A, BAND_G or BAND_B
95 * @param freq the frequency for looking
96 * @return A pointer to struct chan_freq_power structure or NULL if not find.
97 */
Holger Schurig69f90322007-11-23 15:43:44 +010098static struct chan_freq_power *find_cfp_by_band_and_freq(
David Woodhouseaa21c002007-12-08 20:04:36 +000099 struct lbs_private *priv,
Holger Schurig69f90322007-11-23 15:43:44 +0100100 u8 band,
101 u32 freq)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200102{
103 struct chan_freq_power *cfp = NULL;
104 struct region_channel *rc;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200105 int i, j;
106
David Woodhouseaa21c002007-12-08 20:04:36 +0000107 for (j = 0; !cfp && (j < ARRAY_SIZE(priv->region_channel)); j++) {
108 rc = &priv->region_channel[j];
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200109
David Woodhouseaa21c002007-12-08 20:04:36 +0000110 if (priv->enable11d)
111 rc = &priv->universal_channel[j];
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200112 if (!rc->valid || !rc->CFP)
113 continue;
114 if (rc->band != band)
115 continue;
116 for (i = 0; i < rc->nrcfp; i++) {
117 if (rc->CFP[i].freq == freq) {
118 cfp = &rc->CFP[i];
119 break;
120 }
121 }
122 }
123
124 if (!cfp && freq)
Holger Schurig9012b282007-05-25 11:27:16 -0400125 lbs_deb_wext("find_cfp_by_band_and_freql: can't find cfp by "
126 "band %d / freq %d\n", band, freq);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200127
128 return cfp;
129}
130
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200131/**
Dan Williams8c512762007-08-02 11:40:45 -0400132 * @brief Copy active data rates based on adapter mode and status
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200133 *
David Woodhouseaa21c002007-12-08 20:04:36 +0000134 * @param priv A pointer to struct lbs_private structure
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200135 * @param rate The buf to return the active rates
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200136 */
David Woodhouseaa21c002007-12-08 20:04:36 +0000137static void copy_active_data_rates(struct lbs_private *priv, u8 *rates)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200138{
Holger Schurig9012b282007-05-25 11:27:16 -0400139 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200140
David Woodhouseaa21c002007-12-08 20:04:36 +0000141 if ((priv->connect_status != LBS_CONNECTED) &&
142 (priv->mesh_connect_status != LBS_CONNECTED))
Holger Schurig10078322007-11-15 18:05:47 -0500143 memcpy(rates, lbs_bg_rates, MAX_RATES);
Dan Williams8c512762007-08-02 11:40:45 -0400144 else
David Woodhouseaa21c002007-12-08 20:04:36 +0000145 memcpy(rates, priv->curbssparams.rates, MAX_RATES);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200146
Dan Williams8c512762007-08-02 11:40:45 -0400147 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200148}
149
Holger Schurig10078322007-11-15 18:05:47 -0500150static int lbs_get_name(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200151 char *cwrq, char *extra)
152{
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200153
Holger Schurig9012b282007-05-25 11:27:16 -0400154 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200155
Jean Tourrilhes9483f032007-08-02 13:16:30 -0400156 /* We could add support for 802.11n here as needed. Jean II */
157 snprintf(cwrq, IFNAMSIZ, "IEEE 802.11b/g");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200158
Holger Schurig9012b282007-05-25 11:27:16 -0400159 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200160 return 0;
161}
162
Holger Schurig10078322007-11-15 18:05:47 -0500163static int lbs_get_freq(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200164 struct iw_freq *fwrq, char *extra)
165{
Kiran Divekarab65f642009-02-19 19:32:39 -0500166 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200167 struct chan_freq_power *cfp;
168
Holger Schurig9012b282007-05-25 11:27:16 -0400169 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200170
David Woodhouseaa21c002007-12-08 20:04:36 +0000171 cfp = lbs_find_cfp_by_band_and_channel(priv, 0,
172 priv->curbssparams.channel);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200173
174 if (!cfp) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000175 if (priv->curbssparams.channel)
Holger Schurig9012b282007-05-25 11:27:16 -0400176 lbs_deb_wext("invalid channel %d\n",
David Woodhouseaa21c002007-12-08 20:04:36 +0000177 priv->curbssparams.channel);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200178 return -EINVAL;
179 }
180
181 fwrq->m = (long)cfp->freq * 100000;
182 fwrq->e = 1;
183
Holger Schurig9012b282007-05-25 11:27:16 -0400184 lbs_deb_wext("freq %u\n", fwrq->m);
185 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200186 return 0;
187}
188
Holger Schurig10078322007-11-15 18:05:47 -0500189static int lbs_get_wap(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200190 struct sockaddr *awrq, char *extra)
191{
Kiran Divekarab65f642009-02-19 19:32:39 -0500192 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200193
Holger Schurig9012b282007-05-25 11:27:16 -0400194 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200195
David Woodhouseaa21c002007-12-08 20:04:36 +0000196 if (priv->connect_status == LBS_CONNECTED) {
197 memcpy(awrq->sa_data, priv->curbssparams.bssid, ETH_ALEN);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200198 } else {
199 memset(awrq->sa_data, 0, ETH_ALEN);
200 }
201 awrq->sa_family = ARPHRD_ETHER;
202
Holger Schurig9012b282007-05-25 11:27:16 -0400203 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200204 return 0;
205}
206
Holger Schurig10078322007-11-15 18:05:47 -0500207static int lbs_set_nick(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200208 struct iw_point *dwrq, char *extra)
209{
Kiran Divekarab65f642009-02-19 19:32:39 -0500210 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200211
Holger Schurig9012b282007-05-25 11:27:16 -0400212 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200213
214 /*
215 * Check the size of the string
216 */
217
218 if (dwrq->length > 16) {
219 return -E2BIG;
220 }
221
David Woodhouseaa21c002007-12-08 20:04:36 +0000222 mutex_lock(&priv->lock);
223 memset(priv->nodename, 0, sizeof(priv->nodename));
224 memcpy(priv->nodename, extra, dwrq->length);
225 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200226
Holger Schurig9012b282007-05-25 11:27:16 -0400227 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200228 return 0;
229}
230
Holger Schurig10078322007-11-15 18:05:47 -0500231static int lbs_get_nick(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200232 struct iw_point *dwrq, char *extra)
233{
Kiran Divekarab65f642009-02-19 19:32:39 -0500234 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200235
Holger Schurig9012b282007-05-25 11:27:16 -0400236 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200237
David Woodhouseaa21c002007-12-08 20:04:36 +0000238 dwrq->length = strlen(priv->nodename);
239 memcpy(extra, priv->nodename, dwrq->length);
Holger Schurig04799fa2007-10-09 15:04:14 +0200240 extra[dwrq->length] = '\0';
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200241
Holger Schurig04799fa2007-10-09 15:04:14 +0200242 dwrq->flags = 1; /* active */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200243
Holger Schurig9012b282007-05-25 11:27:16 -0400244 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200245 return 0;
246}
247
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -0400248static int mesh_get_nick(struct net_device *dev, struct iw_request_info *info,
249 struct iw_point *dwrq, char *extra)
250{
Kiran Divekarab65f642009-02-19 19:32:39 -0500251 struct lbs_private *priv = dev->ml_priv;
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -0400252
253 lbs_deb_enter(LBS_DEB_WEXT);
254
255 /* Use nickname to indicate that mesh is on */
256
David Woodhouseaa21c002007-12-08 20:04:36 +0000257 if (priv->mesh_connect_status == LBS_CONNECTED) {
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -0400258 strncpy(extra, "Mesh", 12);
259 extra[12] = '\0';
Jean Tourrilhes9483f032007-08-02 13:16:30 -0400260 dwrq->length = strlen(extra);
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -0400261 }
262
263 else {
264 extra[0] = '\0';
Jean Tourrilhes9483f032007-08-02 13:16:30 -0400265 dwrq->length = 0;
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -0400266 }
267
268 lbs_deb_leave(LBS_DEB_WEXT);
269 return 0;
270}
Holger Schurig04799fa2007-10-09 15:04:14 +0200271
Holger Schurig10078322007-11-15 18:05:47 -0500272static int lbs_set_rts(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200273 struct iw_param *vwrq, char *extra)
274{
275 int ret = 0;
Kiran Divekarab65f642009-02-19 19:32:39 -0500276 struct lbs_private *priv = dev->ml_priv;
Dan Williams39fcf7a2008-09-10 12:49:00 -0400277 u32 val = vwrq->value;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200278
Holger Schurig9012b282007-05-25 11:27:16 -0400279 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200280
Dan Williams39fcf7a2008-09-10 12:49:00 -0400281 if (vwrq->disabled)
282 val = MRVDRV_RTS_MAX_VALUE;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200283
John W. Linville375da532008-09-15 17:25:54 -0400284 if (val > MRVDRV_RTS_MAX_VALUE) /* min rts value is 0 */
Dan Williams39fcf7a2008-09-10 12:49:00 -0400285 return -EINVAL;
286
287 ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_RTS_THRESHOLD, (u16) val);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200288
Holger Schurig9012b282007-05-25 11:27:16 -0400289 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200290 return ret;
291}
292
Holger Schurig10078322007-11-15 18:05:47 -0500293static int lbs_get_rts(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200294 struct iw_param *vwrq, char *extra)
295{
Kiran Divekarab65f642009-02-19 19:32:39 -0500296 struct lbs_private *priv = dev->ml_priv;
Dan Williams39fcf7a2008-09-10 12:49:00 -0400297 int ret = 0;
298 u16 val = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200299
Holger Schurig9012b282007-05-25 11:27:16 -0400300 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200301
Dan Williams39fcf7a2008-09-10 12:49:00 -0400302 ret = lbs_get_snmp_mib(priv, SNMP_MIB_OID_RTS_THRESHOLD, &val);
Holger Schurig9012b282007-05-25 11:27:16 -0400303 if (ret)
304 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200305
Dan Williams39fcf7a2008-09-10 12:49:00 -0400306 vwrq->value = val;
John W. Linville375da532008-09-15 17:25:54 -0400307 vwrq->disabled = val > MRVDRV_RTS_MAX_VALUE; /* min rts value is 0 */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200308 vwrq->fixed = 1;
309
Holger Schurig9012b282007-05-25 11:27:16 -0400310out:
311 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
312 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200313}
314
Holger Schurig10078322007-11-15 18:05:47 -0500315static int lbs_set_frag(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200316 struct iw_param *vwrq, char *extra)
317{
Kiran Divekarab65f642009-02-19 19:32:39 -0500318 struct lbs_private *priv = dev->ml_priv;
Dan Williams39fcf7a2008-09-10 12:49:00 -0400319 int ret = 0;
320 u32 val = vwrq->value;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200321
Holger Schurig9012b282007-05-25 11:27:16 -0400322 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200323
Dan Williams39fcf7a2008-09-10 12:49:00 -0400324 if (vwrq->disabled)
325 val = MRVDRV_FRAG_MAX_VALUE;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200326
Dan Williams39fcf7a2008-09-10 12:49:00 -0400327 if (val < MRVDRV_FRAG_MIN_VALUE || val > MRVDRV_FRAG_MAX_VALUE)
328 return -EINVAL;
329
330 ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_FRAG_THRESHOLD, (u16) val);
Holger Schurig9012b282007-05-25 11:27:16 -0400331
332 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200333 return ret;
334}
335
Holger Schurig10078322007-11-15 18:05:47 -0500336static int lbs_get_frag(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200337 struct iw_param *vwrq, char *extra)
338{
Kiran Divekarab65f642009-02-19 19:32:39 -0500339 struct lbs_private *priv = dev->ml_priv;
Dan Williams39fcf7a2008-09-10 12:49:00 -0400340 int ret = 0;
341 u16 val = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200342
Holger Schurig9012b282007-05-25 11:27:16 -0400343 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200344
Dan Williams39fcf7a2008-09-10 12:49:00 -0400345 ret = lbs_get_snmp_mib(priv, SNMP_MIB_OID_FRAG_THRESHOLD, &val);
Holger Schurig9012b282007-05-25 11:27:16 -0400346 if (ret)
347 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200348
Dan Williams39fcf7a2008-09-10 12:49:00 -0400349 vwrq->value = val;
350 vwrq->disabled = ((val < MRVDRV_FRAG_MIN_VALUE)
351 || (val > MRVDRV_FRAG_MAX_VALUE));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200352 vwrq->fixed = 1;
353
Holger Schurig9012b282007-05-25 11:27:16 -0400354out:
355 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200356 return ret;
357}
358
Holger Schurig10078322007-11-15 18:05:47 -0500359static int lbs_get_mode(struct net_device *dev,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200360 struct iw_request_info *info, u32 * uwrq, char *extra)
361{
Kiran Divekarab65f642009-02-19 19:32:39 -0500362 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200363
Holger Schurig9012b282007-05-25 11:27:16 -0400364 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200365
David Woodhouseaa21c002007-12-08 20:04:36 +0000366 *uwrq = priv->mode;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200367
Holger Schurig9012b282007-05-25 11:27:16 -0400368 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200369 return 0;
370}
371
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -0400372static int mesh_wlan_get_mode(struct net_device *dev,
373 struct iw_request_info *info, u32 * uwrq,
374 char *extra)
375{
376 lbs_deb_enter(LBS_DEB_WEXT);
377
Dan Williams39fcf7a2008-09-10 12:49:00 -0400378 *uwrq = IW_MODE_REPEAT;
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -0400379
380 lbs_deb_leave(LBS_DEB_WEXT);
381 return 0;
382}
383
Holger Schurig10078322007-11-15 18:05:47 -0500384static int lbs_get_txpow(struct net_device *dev,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200385 struct iw_request_info *info,
386 struct iw_param *vwrq, char *extra)
387{
Kiran Divekarab65f642009-02-19 19:32:39 -0500388 struct lbs_private *priv = dev->ml_priv;
Dan Williams87c8c722008-08-19 15:15:35 -0400389 s16 curlevel = 0;
Dan Williamsd5db2df2008-08-21 17:51:07 -0400390 int ret = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200391
Holger Schurig9012b282007-05-25 11:27:16 -0400392 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200393
Dan Williamsd5db2df2008-08-21 17:51:07 -0400394 if (!priv->radio_on) {
395 lbs_deb_wext("tx power off\n");
396 vwrq->value = 0;
397 vwrq->disabled = 1;
398 goto out;
399 }
400
Dan Williams87c8c722008-08-19 15:15:35 -0400401 ret = lbs_get_tx_power(priv, &curlevel, NULL, NULL);
Holger Schurig9012b282007-05-25 11:27:16 -0400402 if (ret)
403 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200404
Dan Williams87c8c722008-08-19 15:15:35 -0400405 lbs_deb_wext("tx power level %d dbm\n", curlevel);
Dan Williams87c8c722008-08-19 15:15:35 -0400406 priv->txpower_cur = curlevel;
Dan Williamsd5db2df2008-08-21 17:51:07 -0400407
Dan Williams87c8c722008-08-19 15:15:35 -0400408 vwrq->value = curlevel;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200409 vwrq->fixed = 1;
Dan Williamsd5db2df2008-08-21 17:51:07 -0400410 vwrq->disabled = 0;
411 vwrq->flags = IW_TXPOW_DBM;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200412
Holger Schurig9012b282007-05-25 11:27:16 -0400413out:
414 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
415 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200416}
417
Holger Schurig10078322007-11-15 18:05:47 -0500418static int lbs_set_retry(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200419 struct iw_param *vwrq, char *extra)
420{
Kiran Divekarab65f642009-02-19 19:32:39 -0500421 struct lbs_private *priv = dev->ml_priv;
Dan Williams39fcf7a2008-09-10 12:49:00 -0400422 int ret = 0;
423 u16 slimit = 0, llimit = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200424
Holger Schurig9012b282007-05-25 11:27:16 -0400425 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200426
Dan Williams39fcf7a2008-09-10 12:49:00 -0400427 if ((vwrq->flags & IW_RETRY_TYPE) != IW_RETRY_LIMIT)
428 return -EOPNOTSUPP;
429
430 /* The MAC has a 4-bit Total_Tx_Count register
431 Total_Tx_Count = 1 + Tx_Retry_Count */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200432#define TX_RETRY_MIN 0
433#define TX_RETRY_MAX 14
Dan Williams39fcf7a2008-09-10 12:49:00 -0400434 if (vwrq->value < TX_RETRY_MIN || vwrq->value > TX_RETRY_MAX)
435 return -EINVAL;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200436
Dan Williams39fcf7a2008-09-10 12:49:00 -0400437 /* Add 1 to convert retry count to try count */
438 if (vwrq->flags & IW_RETRY_SHORT)
439 slimit = (u16) (vwrq->value + 1);
440 else if (vwrq->flags & IW_RETRY_LONG)
441 llimit = (u16) (vwrq->value + 1);
442 else
443 slimit = llimit = (u16) (vwrq->value + 1); /* set both */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200444
Dan Williams39fcf7a2008-09-10 12:49:00 -0400445 if (llimit) {
446 ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_LONG_RETRY_LIMIT,
447 llimit);
Holger Schurig9012b282007-05-25 11:27:16 -0400448 if (ret)
449 goto out;
Dan Williams39fcf7a2008-09-10 12:49:00 -0400450 }
451
452 if (slimit) {
453 /* txretrycount follows the short retry limit */
454 priv->txretrycount = slimit;
455 ret = lbs_set_snmp_mib(priv, SNMP_MIB_OID_SHORT_RETRY_LIMIT,
456 slimit);
457 if (ret)
458 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200459 }
460
Holger Schurig9012b282007-05-25 11:27:16 -0400461out:
462 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
463 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200464}
465
Holger Schurig10078322007-11-15 18:05:47 -0500466static int lbs_get_retry(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200467 struct iw_param *vwrq, char *extra)
468{
Kiran Divekarab65f642009-02-19 19:32:39 -0500469 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200470 int ret = 0;
Dan Williams39fcf7a2008-09-10 12:49:00 -0400471 u16 val = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200472
Holger Schurig9012b282007-05-25 11:27:16 -0400473 lbs_deb_enter(LBS_DEB_WEXT);
474
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200475 vwrq->disabled = 0;
Dan Williams39fcf7a2008-09-10 12:49:00 -0400476
477 if (vwrq->flags & IW_RETRY_LONG) {
478 ret = lbs_get_snmp_mib(priv, SNMP_MIB_OID_LONG_RETRY_LIMIT, &val);
479 if (ret)
480 goto out;
481
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200482 /* Subtract 1 to convert try count to retry count */
Dan Williams39fcf7a2008-09-10 12:49:00 -0400483 vwrq->value = val - 1;
484 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
485 } else {
486 ret = lbs_get_snmp_mib(priv, SNMP_MIB_OID_SHORT_RETRY_LIMIT, &val);
487 if (ret)
488 goto out;
489
490 /* txretry count follows the short retry limit */
491 priv->txretrycount = val;
492 /* Subtract 1 to convert try count to retry count */
493 vwrq->value = val - 1;
494 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200495 }
496
Holger Schurig9012b282007-05-25 11:27:16 -0400497out:
498 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
499 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200500}
501
502static inline void sort_channels(struct iw_freq *freq, int num)
503{
504 int i, j;
505 struct iw_freq temp;
506
507 for (i = 0; i < num; i++)
508 for (j = i + 1; j < num; j++)
509 if (freq[i].i > freq[j].i) {
510 temp.i = freq[i].i;
511 temp.m = freq[i].m;
512
513 freq[i].i = freq[j].i;
514 freq[i].m = freq[j].m;
515
516 freq[j].i = temp.i;
517 freq[j].m = temp.m;
518 }
519}
520
521/* data rate listing
522 MULTI_BANDS:
523 abg a b b/g
524 Infra G(12) A(8) B(4) G(12)
525 Adhoc A+B(12) A(8) B(4) B(4)
526
527 non-MULTI_BANDS:
528 b b/g
529 Infra B(4) G(12)
530 Adhoc B(4) B(4)
531 */
532/**
533 * @brief Get Range Info
534 *
535 * @param dev A pointer to net_device structure
536 * @param info A pointer to iw_request_info structure
537 * @param vwrq A pointer to iw_param structure
538 * @param extra A pointer to extra data buf
539 * @return 0 --success, otherwise fail
540 */
Holger Schurig10078322007-11-15 18:05:47 -0500541static int lbs_get_range(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200542 struct iw_point *dwrq, char *extra)
543{
544 int i, j;
Kiran Divekarab65f642009-02-19 19:32:39 -0500545 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200546 struct iw_range *range = (struct iw_range *)extra;
547 struct chan_freq_power *cfp;
Dan Williams8c512762007-08-02 11:40:45 -0400548 u8 rates[MAX_RATES + 1];
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200549
550 u8 flag = 0;
551
Holger Schurig9012b282007-05-25 11:27:16 -0400552 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200553
554 dwrq->length = sizeof(struct iw_range);
555 memset(range, 0, sizeof(struct iw_range));
556
557 range->min_nwid = 0;
558 range->max_nwid = 0;
559
560 memset(rates, 0, sizeof(rates));
David Woodhouseaa21c002007-12-08 20:04:36 +0000561 copy_active_data_rates(priv, rates);
Dan Williams8c512762007-08-02 11:40:45 -0400562 range->num_bitrates = strnlen(rates, IW_MAX_BITRATES);
563 for (i = 0; i < range->num_bitrates; i++)
564 range->bitrate[i] = rates[i] * 500000;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200565 range->num_bitrates = i;
Holger Schurig9012b282007-05-25 11:27:16 -0400566 lbs_deb_wext("IW_MAX_BITRATES %d, num_bitrates %d\n", IW_MAX_BITRATES,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200567 range->num_bitrates);
568
569 range->num_frequency = 0;
Holger Schurig52933d82008-03-05 07:05:32 +0100570
571 range->scan_capa = IW_SCAN_CAPA_ESSID;
572
David Woodhouseaa21c002007-12-08 20:04:36 +0000573 if (priv->enable11d &&
574 (priv->connect_status == LBS_CONNECTED ||
575 priv->mesh_connect_status == LBS_CONNECTED)) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200576 u8 chan_no;
577 u8 band;
578
579 struct parsed_region_chan_11d *parsed_region_chan =
David Woodhouseaa21c002007-12-08 20:04:36 +0000580 &priv->parsed_region_chan;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200581
582 if (parsed_region_chan == NULL) {
Holger Schurig9012b282007-05-25 11:27:16 -0400583 lbs_deb_wext("11d: parsed_region_chan is NULL\n");
584 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200585 }
586 band = parsed_region_chan->band;
Holger Schurig9012b282007-05-25 11:27:16 -0400587 lbs_deb_wext("band %d, nr_char %d\n", band,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200588 parsed_region_chan->nr_chan);
589
590 for (i = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
591 && (i < parsed_region_chan->nr_chan); i++) {
592 chan_no = parsed_region_chan->chanpwr[i].chan;
Holger Schurig9012b282007-05-25 11:27:16 -0400593 lbs_deb_wext("chan_no %d\n", chan_no);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200594 range->freq[range->num_frequency].i = (long)chan_no;
595 range->freq[range->num_frequency].m =
Holger Schurige98a88d2008-03-19 14:25:58 +0100596 (long)lbs_chan_2_freq(chan_no) * 100000;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200597 range->freq[range->num_frequency].e = 1;
598 range->num_frequency++;
599 }
600 flag = 1;
601 }
602 if (!flag) {
603 for (j = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
David Woodhouseaa21c002007-12-08 20:04:36 +0000604 && (j < ARRAY_SIZE(priv->region_channel)); j++) {
605 cfp = priv->region_channel[j].CFP;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200606 for (i = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
David Woodhouseaa21c002007-12-08 20:04:36 +0000607 && priv->region_channel[j].valid
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200608 && cfp
David Woodhouseaa21c002007-12-08 20:04:36 +0000609 && (i < priv->region_channel[j].nrcfp); i++) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200610 range->freq[range->num_frequency].i =
611 (long)cfp->channel;
612 range->freq[range->num_frequency].m =
613 (long)cfp->freq * 100000;
614 range->freq[range->num_frequency].e = 1;
615 cfp++;
616 range->num_frequency++;
617 }
618 }
619 }
620
Holger Schurig9012b282007-05-25 11:27:16 -0400621 lbs_deb_wext("IW_MAX_FREQUENCIES %d, num_frequency %d\n",
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200622 IW_MAX_FREQUENCIES, range->num_frequency);
623
624 range->num_channels = range->num_frequency;
625
626 sort_channels(&range->freq[0], range->num_frequency);
627
628 /*
629 * Set an indication of the max TCP throughput in bit/s that we can
630 * expect using this interface
631 */
632 if (i > 2)
633 range->throughput = 5000 * 1000;
634 else
635 range->throughput = 1500 * 1000;
636
637 range->min_rts = MRVDRV_RTS_MIN_VALUE;
638 range->max_rts = MRVDRV_RTS_MAX_VALUE;
639 range->min_frag = MRVDRV_FRAG_MIN_VALUE;
640 range->max_frag = MRVDRV_FRAG_MAX_VALUE;
641
642 range->encoding_size[0] = 5;
643 range->encoding_size[1] = 13;
644 range->num_encoding_sizes = 2;
645 range->max_encoding_tokens = 4;
646
Holger Schurigd4ff0ef2008-03-19 14:25:18 +0100647 /*
648 * Right now we support only "iwconfig ethX power on|off"
649 */
650 range->pm_capa = IW_POWER_ON;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200651
652 /*
653 * Minimum version we recommend
654 */
655 range->we_version_source = 15;
656
657 /*
658 * Version we are compiled with
659 */
660 range->we_version_compiled = WIRELESS_EXT;
661
662 range->retry_capa = IW_RETRY_LIMIT;
663 range->retry_flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
664
665 range->min_retry = TX_RETRY_MIN;
666 range->max_retry = TX_RETRY_MAX;
667
668 /*
669 * Set the qual, level and noise range values
670 */
671 range->max_qual.qual = 100;
672 range->max_qual.level = 0;
673 range->max_qual.noise = 0;
674 range->max_qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
675
676 range->avg_qual.qual = 70;
677 /* TODO: Find real 'good' to 'bad' threshold value for RSSI */
678 range->avg_qual.level = 0;
679 range->avg_qual.noise = 0;
680 range->avg_qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
681
682 range->sensitivity = 0;
683
Dan Williams87c8c722008-08-19 15:15:35 -0400684 /* Setup the supported power level ranges */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200685 memset(range->txpower, 0, sizeof(range->txpower));
Dan Williams87c8c722008-08-19 15:15:35 -0400686 range->txpower_capa = IW_TXPOW_DBM | IW_TXPOW_RANGE;
687 range->txpower[0] = priv->txpower_min;
688 range->txpower[1] = priv->txpower_max;
689 range->num_txpower = 2;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200690
691 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
692 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
693 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
694 range->event_capa[1] = IW_EVENT_CAPA_K_1;
695
David Woodhouseaa21c002007-12-08 20:04:36 +0000696 if (priv->fwcapinfo & FW_CAPINFO_WPA) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200697 range->enc_capa = IW_ENC_CAPA_WPA
698 | IW_ENC_CAPA_WPA2
699 | IW_ENC_CAPA_CIPHER_TKIP
700 | IW_ENC_CAPA_CIPHER_CCMP;
701 }
702
Holger Schurig9012b282007-05-25 11:27:16 -0400703out:
704 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200705 return 0;
706}
707
Holger Schurig10078322007-11-15 18:05:47 -0500708static int lbs_set_power(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200709 struct iw_param *vwrq, char *extra)
710{
Kiran Divekarab65f642009-02-19 19:32:39 -0500711 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200712
Holger Schurig9012b282007-05-25 11:27:16 -0400713 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200714
Andrey Yurovskye0d61332009-06-16 13:20:01 -0700715 if (!(priv->fwcapinfo & FW_CAPINFO_PS)) {
David Woodhouseb2c57ee2007-12-17 14:41:13 -0500716 if (vwrq->disabled)
717 return 0;
718 else
719 return -EINVAL;
720 }
721
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200722 /* PS is currently supported only in Infrastructure mode
723 * Remove this check if it is to be supported in IBSS mode also
724 */
725
726 if (vwrq->disabled) {
David Woodhouseaa21c002007-12-08 20:04:36 +0000727 priv->psmode = LBS802_11POWERMODECAM;
728 if (priv->psstate != PS_STATE_FULL_POWER) {
Holger Schurig10078322007-11-15 18:05:47 -0500729 lbs_ps_wakeup(priv, CMD_OPTION_WAITFORRSP);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200730 }
731
732 return 0;
733 }
734
735 if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
Holger Schurig9012b282007-05-25 11:27:16 -0400736 lbs_deb_wext(
737 "setting power timeout is not supported\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200738 return -EINVAL;
739 } else if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
Holger Schurig9012b282007-05-25 11:27:16 -0400740 lbs_deb_wext("setting power period not supported\n");
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200741 return -EINVAL;
742 }
743
David Woodhouseaa21c002007-12-08 20:04:36 +0000744 if (priv->psmode != LBS802_11POWERMODECAM) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200745 return 0;
746 }
747
David Woodhouseaa21c002007-12-08 20:04:36 +0000748 priv->psmode = LBS802_11POWERMODEMAX_PSP;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200749
David Woodhouseaa21c002007-12-08 20:04:36 +0000750 if (priv->connect_status == LBS_CONNECTED) {
Holger Schurig10078322007-11-15 18:05:47 -0500751 lbs_ps_sleep(priv, CMD_OPTION_WAITFORRSP);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200752 }
753
Holger Schurig9012b282007-05-25 11:27:16 -0400754 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200755 return 0;
756}
757
Holger Schurig10078322007-11-15 18:05:47 -0500758static int lbs_get_power(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200759 struct iw_param *vwrq, char *extra)
760{
Kiran Divekarab65f642009-02-19 19:32:39 -0500761 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200762
Holger Schurig9012b282007-05-25 11:27:16 -0400763 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200764
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200765 vwrq->value = 0;
Holger Schurigd4ff0ef2008-03-19 14:25:18 +0100766 vwrq->flags = 0;
767 vwrq->disabled = priv->psmode == LBS802_11POWERMODECAM
768 || priv->connect_status == LBS_DISCONNECTED;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200769
Holger Schurig9012b282007-05-25 11:27:16 -0400770 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200771 return 0;
772}
773
Holger Schurig10078322007-11-15 18:05:47 -0500774static struct iw_statistics *lbs_get_wireless_stats(struct net_device *dev)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200775{
776 enum {
777 POOR = 30,
778 FAIR = 60,
779 GOOD = 80,
780 VERY_GOOD = 90,
781 EXCELLENT = 95,
782 PERFECT = 100
783 };
Kiran Divekarab65f642009-02-19 19:32:39 -0500784 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200785 u32 rssi_qual;
786 u32 tx_qual;
787 u32 quality = 0;
788 int stats_valid = 0;
789 u8 rssi;
790 u32 tx_retries;
Holger Schurigc49c3b72008-03-17 12:45:58 +0100791 struct cmd_ds_802_11_get_log log;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200792
Holger Schurig9012b282007-05-25 11:27:16 -0400793 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200794
David Woodhouseaa21c002007-12-08 20:04:36 +0000795 priv->wstats.status = priv->mode;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200796
797 /* If we're not associated, all quality values are meaningless */
David Woodhouseaa21c002007-12-08 20:04:36 +0000798 if ((priv->connect_status != LBS_CONNECTED) &&
799 (priv->mesh_connect_status != LBS_CONNECTED))
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200800 goto out;
801
802 /* Quality by RSSI */
803 priv->wstats.qual.level =
David Woodhouseaa21c002007-12-08 20:04:36 +0000804 CAL_RSSI(priv->SNR[TYPE_BEACON][TYPE_NOAVG],
805 priv->NF[TYPE_BEACON][TYPE_NOAVG]);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200806
David Woodhouseaa21c002007-12-08 20:04:36 +0000807 if (priv->NF[TYPE_BEACON][TYPE_NOAVG] == 0) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200808 priv->wstats.qual.noise = MRVDRV_NF_DEFAULT_SCAN_VALUE;
809 } else {
810 priv->wstats.qual.noise =
David Woodhouseaa21c002007-12-08 20:04:36 +0000811 CAL_NF(priv->NF[TYPE_BEACON][TYPE_NOAVG]);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200812 }
813
Holger Schurig9012b282007-05-25 11:27:16 -0400814 lbs_deb_wext("signal level %#x\n", priv->wstats.qual.level);
815 lbs_deb_wext("noise %#x\n", priv->wstats.qual.noise);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200816
817 rssi = priv->wstats.qual.level - priv->wstats.qual.noise;
818 if (rssi < 15)
819 rssi_qual = rssi * POOR / 10;
820 else if (rssi < 20)
821 rssi_qual = (rssi - 15) * (FAIR - POOR) / 5 + POOR;
822 else if (rssi < 30)
823 rssi_qual = (rssi - 20) * (GOOD - FAIR) / 5 + FAIR;
824 else if (rssi < 40)
825 rssi_qual = (rssi - 30) * (VERY_GOOD - GOOD) /
826 10 + GOOD;
827 else
828 rssi_qual = (rssi - 40) * (PERFECT - VERY_GOOD) /
829 10 + VERY_GOOD;
830 quality = rssi_qual;
831
832 /* Quality by TX errors */
Stephen Hemmingerbbfc6b72009-03-20 19:36:36 +0000833 priv->wstats.discard.retries = dev->stats.tx_errors;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200834
Holger Schurigc49c3b72008-03-17 12:45:58 +0100835 memset(&log, 0, sizeof(log));
836 log.hdr.size = cpu_to_le16(sizeof(log));
837 lbs_cmd_with_response(priv, CMD_802_11_GET_LOG, &log);
838
839 tx_retries = le32_to_cpu(log.retry);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200840
841 if (tx_retries > 75)
842 tx_qual = (90 - tx_retries) * POOR / 15;
843 else if (tx_retries > 70)
844 tx_qual = (75 - tx_retries) * (FAIR - POOR) / 5 + POOR;
845 else if (tx_retries > 65)
846 tx_qual = (70 - tx_retries) * (GOOD - FAIR) / 5 + FAIR;
847 else if (tx_retries > 50)
848 tx_qual = (65 - tx_retries) * (VERY_GOOD - GOOD) /
849 15 + GOOD;
850 else
851 tx_qual = (50 - tx_retries) *
852 (PERFECT - VERY_GOOD) / 50 + VERY_GOOD;
853 quality = min(quality, tx_qual);
854
Holger Schurigc49c3b72008-03-17 12:45:58 +0100855 priv->wstats.discard.code = le32_to_cpu(log.wepundecryptable);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200856 priv->wstats.discard.retries = tx_retries;
Holger Schurigc49c3b72008-03-17 12:45:58 +0100857 priv->wstats.discard.misc = le32_to_cpu(log.ackfailure);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200858
859 /* Calculate quality */
Holger Schurigcad9d9b2007-08-02 13:07:15 -0400860 priv->wstats.qual.qual = min_t(u8, quality, 100);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200861 priv->wstats.qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
862 stats_valid = 1;
863
864 /* update stats asynchronously for future calls */
Holger Schurig10078322007-11-15 18:05:47 -0500865 lbs_prepare_and_send_command(priv, CMD_802_11_RSSI, 0,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200866 0, 0, NULL);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200867out:
868 if (!stats_valid) {
869 priv->wstats.miss.beacon = 0;
870 priv->wstats.discard.retries = 0;
871 priv->wstats.qual.qual = 0;
872 priv->wstats.qual.level = 0;
873 priv->wstats.qual.noise = 0;
874 priv->wstats.qual.updated = IW_QUAL_ALL_UPDATED;
875 priv->wstats.qual.updated |= IW_QUAL_NOISE_INVALID |
876 IW_QUAL_QUAL_INVALID | IW_QUAL_LEVEL_INVALID;
877 }
878
Holger Schurig9012b282007-05-25 11:27:16 -0400879 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200880 return &priv->wstats;
881
882
883}
884
Holger Schurig10078322007-11-15 18:05:47 -0500885static int lbs_set_freq(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200886 struct iw_freq *fwrq, char *extra)
887{
Dan Williamsef9a2642007-05-25 16:46:33 -0400888 int ret = -EINVAL;
Kiran Divekarab65f642009-02-19 19:32:39 -0500889 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200890 struct chan_freq_power *cfp;
Dan Williamsef9a2642007-05-25 16:46:33 -0400891 struct assoc_request * assoc_req;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200892
Holger Schurig9012b282007-05-25 11:27:16 -0400893 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200894
David Woodhouseaa21c002007-12-08 20:04:36 +0000895 mutex_lock(&priv->lock);
896 assoc_req = lbs_get_association_request(priv);
Dan Williamsef9a2642007-05-25 16:46:33 -0400897 if (!assoc_req) {
898 ret = -ENOMEM;
899 goto out;
900 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200901
Dan Williamsef9a2642007-05-25 16:46:33 -0400902 /* If setting by frequency, convert to a channel */
903 if (fwrq->e == 1) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200904 long f = fwrq->m / 100000;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200905
David Woodhouseaa21c002007-12-08 20:04:36 +0000906 cfp = find_cfp_by_band_and_freq(priv, 0, f);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200907 if (!cfp) {
Holger Schurig9012b282007-05-25 11:27:16 -0400908 lbs_deb_wext("invalid freq %ld\n", f);
Dan Williamsef9a2642007-05-25 16:46:33 -0400909 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200910 }
911
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200912 fwrq->e = 0;
Dan Williamsef9a2642007-05-25 16:46:33 -0400913 fwrq->m = (int) cfp->channel;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200914 }
915
Dan Williamsef9a2642007-05-25 16:46:33 -0400916 /* Setting by channel number */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200917 if (fwrq->m > 1000 || fwrq->e > 0) {
Dan Williamsef9a2642007-05-25 16:46:33 -0400918 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200919 }
920
David Woodhouseaa21c002007-12-08 20:04:36 +0000921 cfp = lbs_find_cfp_by_band_and_channel(priv, 0, fwrq->m);
Dan Williamsef9a2642007-05-25 16:46:33 -0400922 if (!cfp) {
923 goto out;
924 }
925
926 assoc_req->channel = fwrq->m;
927 ret = 0;
928
Holger Schurig9012b282007-05-25 11:27:16 -0400929out:
Dan Williamsef9a2642007-05-25 16:46:33 -0400930 if (ret == 0) {
931 set_bit(ASSOC_FLAG_CHANNEL, &assoc_req->flags);
Holger Schurig10078322007-11-15 18:05:47 -0500932 lbs_postpone_association_work(priv);
Dan Williamsef9a2642007-05-25 16:46:33 -0400933 } else {
Holger Schurig10078322007-11-15 18:05:47 -0500934 lbs_cancel_association_work(priv);
Dan Williamsef9a2642007-05-25 16:46:33 -0400935 }
David Woodhouseaa21c002007-12-08 20:04:36 +0000936 mutex_unlock(&priv->lock);
Dan Williamsef9a2642007-05-25 16:46:33 -0400937
938 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
939 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200940}
941
David Woodhouse823eaa22007-12-11 19:56:28 -0500942static int lbs_mesh_set_freq(struct net_device *dev,
943 struct iw_request_info *info,
944 struct iw_freq *fwrq, char *extra)
945{
Kiran Divekarab65f642009-02-19 19:32:39 -0500946 struct lbs_private *priv = dev->ml_priv;
David Woodhouse823eaa22007-12-11 19:56:28 -0500947 struct chan_freq_power *cfp;
948 int ret = -EINVAL;
949
950 lbs_deb_enter(LBS_DEB_WEXT);
951
952 /* If setting by frequency, convert to a channel */
953 if (fwrq->e == 1) {
954 long f = fwrq->m / 100000;
955
956 cfp = find_cfp_by_band_and_freq(priv, 0, f);
957 if (!cfp) {
958 lbs_deb_wext("invalid freq %ld\n", f);
959 goto out;
960 }
961
962 fwrq->e = 0;
963 fwrq->m = (int) cfp->channel;
964 }
965
966 /* Setting by channel number */
967 if (fwrq->m > 1000 || fwrq->e > 0) {
968 goto out;
969 }
970
971 cfp = lbs_find_cfp_by_band_and_channel(priv, 0, fwrq->m);
972 if (!cfp) {
973 goto out;
974 }
975
976 if (fwrq->m != priv->curbssparams.channel) {
977 lbs_deb_wext("mesh channel change forces eth disconnect\n");
978 if (priv->mode == IW_MODE_INFRA)
Dan Williams191bb402008-08-21 17:46:18 -0400979 lbs_cmd_80211_deauthenticate(priv,
980 priv->curbssparams.bssid,
981 WLAN_REASON_DEAUTH_LEAVING);
David Woodhouse823eaa22007-12-11 19:56:28 -0500982 else if (priv->mode == IW_MODE_ADHOC)
Dan Williamsf5fe1fd2008-08-21 21:46:59 -0400983 lbs_adhoc_stop(priv);
David Woodhouse823eaa22007-12-11 19:56:28 -0500984 }
Javier Cardonaedaea5c2008-05-17 00:55:10 -0700985 lbs_mesh_config(priv, CMD_ACT_MESH_CONFIG_START, fwrq->m);
David Woodhouse86062132007-12-13 00:32:36 -0500986 lbs_update_channel(priv);
David Woodhouse823eaa22007-12-11 19:56:28 -0500987 ret = 0;
988
989out:
990 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
991 return ret;
992}
993
Holger Schurig10078322007-11-15 18:05:47 -0500994static int lbs_set_rate(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -0200995 struct iw_param *vwrq, char *extra)
996{
Kiran Divekarab65f642009-02-19 19:32:39 -0500997 struct lbs_private *priv = dev->ml_priv;
Dan Williams8e3c91b2007-12-11 15:50:59 -0500998 u8 new_rate = 0;
Dan Williams8c512762007-08-02 11:40:45 -0400999 int ret = -EINVAL;
1000 u8 rates[MAX_RATES + 1];
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001001
Holger Schurig9012b282007-05-25 11:27:16 -04001002 lbs_deb_enter(LBS_DEB_WEXT);
Holger Schurig9012b282007-05-25 11:27:16 -04001003 lbs_deb_wext("vwrq->value %d\n", vwrq->value);
Javier Cardona85319f92008-05-24 10:59:49 +01001004 lbs_deb_wext("vwrq->fixed %d\n", vwrq->fixed);
1005
1006 if (vwrq->fixed && vwrq->value == -1)
1007 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001008
Dan Williams8c512762007-08-02 11:40:45 -04001009 /* Auto rate? */
Javier Cardona85319f92008-05-24 10:59:49 +01001010 priv->enablehwauto = !vwrq->fixed;
1011
1012 if (vwrq->value == -1)
David Woodhouseaa21c002007-12-08 20:04:36 +00001013 priv->cur_rate = 0;
Javier Cardona85319f92008-05-24 10:59:49 +01001014 else {
Dan Williams8c512762007-08-02 11:40:45 -04001015 if (vwrq->value % 100000)
1016 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001017
Javier Cardona85319f92008-05-24 10:59:49 +01001018 new_rate = vwrq->value / 500000;
1019 priv->cur_rate = new_rate;
1020 /* the rest is only needed for lbs_set_data_rate() */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001021 memset(rates, 0, sizeof(rates));
David Woodhouseaa21c002007-12-08 20:04:36 +00001022 copy_active_data_rates(priv, rates);
Dan Williams8c512762007-08-02 11:40:45 -04001023 if (!memchr(rates, new_rate, sizeof(rates))) {
1024 lbs_pr_alert("fixed data rate 0x%X out of range\n",
1025 new_rate);
1026 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001027 }
Anna Neal3ed6e082008-09-26 11:34:35 -04001028 if (priv->fwrelease < 0x09000000) {
1029 ret = lbs_set_power_adapt_cfg(priv, 0,
1030 POW_ADAPT_DEFAULT_P0,
1031 POW_ADAPT_DEFAULT_P1,
1032 POW_ADAPT_DEFAULT_P2);
1033 if (ret)
1034 goto out;
1035 }
1036 ret = lbs_set_tpc_cfg(priv, 0, TPC_DEFAULT_P0, TPC_DEFAULT_P1,
1037 TPC_DEFAULT_P2, 1);
1038 if (ret)
1039 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001040 }
1041
Javier Cardona85319f92008-05-24 10:59:49 +01001042 /* Try the newer command first (Firmware Spec 5.1 and above) */
1043 ret = lbs_cmd_802_11_rate_adapt_rateset(priv, CMD_ACT_SET);
1044
1045 /* Fallback to older version */
1046 if (ret)
1047 ret = lbs_set_data_rate(priv, new_rate);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001048
Dan Williams8c512762007-08-02 11:40:45 -04001049out:
Holger Schurig9012b282007-05-25 11:27:16 -04001050 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001051 return ret;
1052}
1053
Holger Schurig10078322007-11-15 18:05:47 -05001054static int lbs_get_rate(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001055 struct iw_param *vwrq, char *extra)
1056{
Kiran Divekarab65f642009-02-19 19:32:39 -05001057 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001058
Holger Schurig9012b282007-05-25 11:27:16 -04001059 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001060
David Woodhouseaa21c002007-12-08 20:04:36 +00001061 if (priv->connect_status == LBS_CONNECTED) {
1062 vwrq->value = priv->cur_rate * 500000;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001063
Javier Cardona85319f92008-05-24 10:59:49 +01001064 if (priv->enablehwauto)
Dan Williams8c512762007-08-02 11:40:45 -04001065 vwrq->fixed = 0;
1066 else
1067 vwrq->fixed = 1;
1068
1069 } else {
1070 vwrq->fixed = 0;
1071 vwrq->value = 0;
1072 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001073
Holger Schurig9012b282007-05-25 11:27:16 -04001074 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001075 return 0;
1076}
1077
Holger Schurig10078322007-11-15 18:05:47 -05001078static int lbs_set_mode(struct net_device *dev,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001079 struct iw_request_info *info, u32 * uwrq, char *extra)
1080{
1081 int ret = 0;
Kiran Divekarab65f642009-02-19 19:32:39 -05001082 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001083 struct assoc_request * assoc_req;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001084
Holger Schurig9012b282007-05-25 11:27:16 -04001085 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001086
Dan Williams0dc5a292007-05-10 22:58:02 -04001087 if ( (*uwrq != IW_MODE_ADHOC)
1088 && (*uwrq != IW_MODE_INFRA)
1089 && (*uwrq != IW_MODE_AUTO)) {
Holger Schurig9012b282007-05-25 11:27:16 -04001090 lbs_deb_wext("Invalid mode: 0x%x\n", *uwrq);
Dan Williams0dc5a292007-05-10 22:58:02 -04001091 ret = -EINVAL;
1092 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001093 }
1094
David Woodhouseaa21c002007-12-08 20:04:36 +00001095 mutex_lock(&priv->lock);
1096 assoc_req = lbs_get_association_request(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001097 if (!assoc_req) {
1098 ret = -ENOMEM;
Holger Schurig10078322007-11-15 18:05:47 -05001099 lbs_cancel_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001100 } else {
Dan Williams0dc5a292007-05-10 22:58:02 -04001101 assoc_req->mode = *uwrq;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001102 set_bit(ASSOC_FLAG_MODE, &assoc_req->flags);
Holger Schurig10078322007-11-15 18:05:47 -05001103 lbs_postpone_association_work(priv);
Holger Schurig9012b282007-05-25 11:27:16 -04001104 lbs_deb_wext("Switching to mode: 0x%x\n", *uwrq);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001105 }
David Woodhouseaa21c002007-12-08 20:04:36 +00001106 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001107
Dan Williams0dc5a292007-05-10 22:58:02 -04001108out:
Holger Schurig9012b282007-05-25 11:27:16 -04001109 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001110 return ret;
1111}
1112
1113
1114/**
1115 * @brief Get Encryption key
1116 *
1117 * @param dev A pointer to net_device structure
1118 * @param info A pointer to iw_request_info structure
1119 * @param vwrq A pointer to iw_param structure
1120 * @param extra A pointer to extra data buf
1121 * @return 0 --success, otherwise fail
1122 */
Holger Schurig10078322007-11-15 18:05:47 -05001123static int lbs_get_encode(struct net_device *dev,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001124 struct iw_request_info *info,
1125 struct iw_point *dwrq, u8 * extra)
1126{
Kiran Divekarab65f642009-02-19 19:32:39 -05001127 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001128 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
1129
Holger Schurig9012b282007-05-25 11:27:16 -04001130 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001131
Holger Schurig9012b282007-05-25 11:27:16 -04001132 lbs_deb_wext("flags 0x%x, index %d, length %d, wep_tx_keyidx %d\n",
David Woodhouseaa21c002007-12-08 20:04:36 +00001133 dwrq->flags, index, dwrq->length, priv->wep_tx_keyidx);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001134
1135 dwrq->flags = 0;
1136
1137 /* Authentication method */
David Woodhouseaa21c002007-12-08 20:04:36 +00001138 switch (priv->secinfo.auth_mode) {
Dan Williams6affe782007-05-10 22:56:42 -04001139 case IW_AUTH_ALG_OPEN_SYSTEM:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001140 dwrq->flags = IW_ENCODE_OPEN;
1141 break;
1142
Dan Williams6affe782007-05-10 22:56:42 -04001143 case IW_AUTH_ALG_SHARED_KEY:
1144 case IW_AUTH_ALG_LEAP:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001145 dwrq->flags = IW_ENCODE_RESTRICTED;
1146 break;
1147 default:
1148 dwrq->flags = IW_ENCODE_DISABLED | IW_ENCODE_OPEN;
1149 break;
1150 }
1151
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001152 memset(extra, 0, 16);
1153
David Woodhouseaa21c002007-12-08 20:04:36 +00001154 mutex_lock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001155
1156 /* Default to returning current transmit key */
1157 if (index < 0)
David Woodhouseaa21c002007-12-08 20:04:36 +00001158 index = priv->wep_tx_keyidx;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001159
David Woodhouseaa21c002007-12-08 20:04:36 +00001160 if ((priv->wep_keys[index].len) && priv->secinfo.wep_enabled) {
1161 memcpy(extra, priv->wep_keys[index].key,
1162 priv->wep_keys[index].len);
1163 dwrq->length = priv->wep_keys[index].len;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001164
1165 dwrq->flags |= (index + 1);
1166 /* Return WEP enabled */
1167 dwrq->flags &= ~IW_ENCODE_DISABLED;
David Woodhouseaa21c002007-12-08 20:04:36 +00001168 } else if ((priv->secinfo.WPAenabled)
1169 || (priv->secinfo.WPA2enabled)) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001170 /* return WPA enabled */
1171 dwrq->flags &= ~IW_ENCODE_DISABLED;
David Woodhousec12bdc42007-12-07 19:32:12 +00001172 dwrq->flags |= IW_ENCODE_NOKEY;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001173 } else {
1174 dwrq->flags |= IW_ENCODE_DISABLED;
1175 }
1176
David Woodhouseaa21c002007-12-08 20:04:36 +00001177 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001178
Joe Perches0795af52007-10-03 17:59:30 -07001179 lbs_deb_wext("key: %02x:%02x:%02x:%02x:%02x:%02x, keylen %d\n",
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001180 extra[0], extra[1], extra[2],
1181 extra[3], extra[4], extra[5], dwrq->length);
1182
Holger Schurig9012b282007-05-25 11:27:16 -04001183 lbs_deb_wext("return flags 0x%x\n", dwrq->flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001184
Holger Schurig9012b282007-05-25 11:27:16 -04001185 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001186 return 0;
1187}
1188
1189/**
1190 * @brief Set Encryption key (internal)
1191 *
1192 * @param priv A pointer to private card structure
1193 * @param key_material A pointer to key material
1194 * @param key_length length of key material
1195 * @param index key index to set
1196 * @param set_tx_key Force set TX key (1 = yes, 0 = no)
1197 * @return 0 --success, otherwise fail
1198 */
Holger Schurig10078322007-11-15 18:05:47 -05001199static int lbs_set_wep_key(struct assoc_request *assoc_req,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001200 const char *key_material,
1201 u16 key_length,
1202 u16 index,
1203 int set_tx_key)
1204{
Holger Schurig9012b282007-05-25 11:27:16 -04001205 int ret = 0;
Dan Williams1443b652007-08-02 10:45:55 -04001206 struct enc_key *pkey;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001207
Holger Schurig9012b282007-05-25 11:27:16 -04001208 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001209
1210 /* Paranoid validation of key index */
1211 if (index > 3) {
Holger Schurig9012b282007-05-25 11:27:16 -04001212 ret = -EINVAL;
1213 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001214 }
1215
1216 /* validate max key length */
1217 if (key_length > KEY_LEN_WEP_104) {
Holger Schurig9012b282007-05-25 11:27:16 -04001218 ret = -EINVAL;
1219 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001220 }
1221
1222 pkey = &assoc_req->wep_keys[index];
1223
1224 if (key_length > 0) {
Dan Williams1443b652007-08-02 10:45:55 -04001225 memset(pkey, 0, sizeof(struct enc_key));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001226 pkey->type = KEY_TYPE_ID_WEP;
1227
1228 /* Standardize the key length */
1229 pkey->len = (key_length > KEY_LEN_WEP_40) ?
1230 KEY_LEN_WEP_104 : KEY_LEN_WEP_40;
1231 memcpy(pkey->key, key_material, key_length);
1232 }
1233
1234 if (set_tx_key) {
1235 /* Ensure the chosen key is valid */
1236 if (!pkey->len) {
Holger Schurig9012b282007-05-25 11:27:16 -04001237 lbs_deb_wext("key not set, so cannot enable it\n");
1238 ret = -EINVAL;
1239 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001240 }
1241 assoc_req->wep_tx_keyidx = index;
1242 }
1243
Dan Williams889c05b2007-05-10 22:57:23 -04001244 assoc_req->secinfo.wep_enabled = 1;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001245
Holger Schurig9012b282007-05-25 11:27:16 -04001246out:
1247 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1248 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001249}
1250
1251static int validate_key_index(u16 def_index, u16 raw_index,
1252 u16 *out_index, u16 *is_default)
1253{
1254 if (!out_index || !is_default)
1255 return -EINVAL;
1256
1257 /* Verify index if present, otherwise use default TX key index */
1258 if (raw_index > 0) {
1259 if (raw_index > 4)
1260 return -EINVAL;
1261 *out_index = raw_index - 1;
1262 } else {
1263 *out_index = def_index;
1264 *is_default = 1;
1265 }
1266 return 0;
1267}
1268
1269static void disable_wep(struct assoc_request *assoc_req)
1270{
1271 int i;
1272
Dan Williams90a42212007-05-25 23:01:24 -04001273 lbs_deb_enter(LBS_DEB_WEXT);
1274
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001275 /* Set Open System auth mode */
Dan Williams6affe782007-05-10 22:56:42 -04001276 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001277
1278 /* Clear WEP keys and mark WEP as disabled */
Dan Williams889c05b2007-05-10 22:57:23 -04001279 assoc_req->secinfo.wep_enabled = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001280 for (i = 0; i < 4; i++)
1281 assoc_req->wep_keys[i].len = 0;
1282
1283 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1284 set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
Dan Williams90a42212007-05-25 23:01:24 -04001285
1286 lbs_deb_leave(LBS_DEB_WEXT);
1287}
1288
1289static void disable_wpa(struct assoc_request *assoc_req)
1290{
1291 lbs_deb_enter(LBS_DEB_WEXT);
1292
Dan Williams1443b652007-08-02 10:45:55 -04001293 memset(&assoc_req->wpa_mcast_key, 0, sizeof (struct enc_key));
Dan Williams90a42212007-05-25 23:01:24 -04001294 assoc_req->wpa_mcast_key.flags = KEY_INFO_WPA_MCAST;
1295 set_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags);
1296
Dan Williams1443b652007-08-02 10:45:55 -04001297 memset(&assoc_req->wpa_unicast_key, 0, sizeof (struct enc_key));
Dan Williams90a42212007-05-25 23:01:24 -04001298 assoc_req->wpa_unicast_key.flags = KEY_INFO_WPA_UNICAST;
1299 set_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags);
1300
1301 assoc_req->secinfo.WPAenabled = 0;
1302 assoc_req->secinfo.WPA2enabled = 0;
1303 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1304
1305 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001306}
1307
1308/**
1309 * @brief Set Encryption key
1310 *
1311 * @param dev A pointer to net_device structure
1312 * @param info A pointer to iw_request_info structure
1313 * @param vwrq A pointer to iw_param structure
1314 * @param extra A pointer to extra data buf
1315 * @return 0 --success, otherwise fail
1316 */
Holger Schurig10078322007-11-15 18:05:47 -05001317static int lbs_set_encode(struct net_device *dev,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001318 struct iw_request_info *info,
1319 struct iw_point *dwrq, char *extra)
1320{
1321 int ret = 0;
Kiran Divekarab65f642009-02-19 19:32:39 -05001322 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001323 struct assoc_request * assoc_req;
1324 u16 is_default = 0, index = 0, set_tx_key = 0;
1325
Holger Schurig9012b282007-05-25 11:27:16 -04001326 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001327
David Woodhouseaa21c002007-12-08 20:04:36 +00001328 mutex_lock(&priv->lock);
1329 assoc_req = lbs_get_association_request(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001330 if (!assoc_req) {
1331 ret = -ENOMEM;
1332 goto out;
1333 }
1334
1335 if (dwrq->flags & IW_ENCODE_DISABLED) {
1336 disable_wep (assoc_req);
Dan Williams90a42212007-05-25 23:01:24 -04001337 disable_wpa (assoc_req);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001338 goto out;
1339 }
1340
1341 ret = validate_key_index(assoc_req->wep_tx_keyidx,
1342 (dwrq->flags & IW_ENCODE_INDEX),
1343 &index, &is_default);
1344 if (ret) {
1345 ret = -EINVAL;
1346 goto out;
1347 }
1348
1349 /* If WEP isn't enabled, or if there is no key data but a valid
1350 * index, set the TX key.
1351 */
Dan Williams889c05b2007-05-10 22:57:23 -04001352 if (!assoc_req->secinfo.wep_enabled || (dwrq->length == 0 && !is_default))
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001353 set_tx_key = 1;
1354
Holger Schurig10078322007-11-15 18:05:47 -05001355 ret = lbs_set_wep_key(assoc_req, extra, dwrq->length, index, set_tx_key);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001356 if (ret)
1357 goto out;
1358
1359 if (dwrq->length)
1360 set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
1361 if (set_tx_key)
1362 set_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags);
1363
1364 if (dwrq->flags & IW_ENCODE_RESTRICTED) {
Dan Williams6affe782007-05-10 22:56:42 -04001365 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001366 } else if (dwrq->flags & IW_ENCODE_OPEN) {
Dan Williams6affe782007-05-10 22:56:42 -04001367 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001368 }
1369
1370out:
1371 if (ret == 0) {
1372 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
Holger Schurig10078322007-11-15 18:05:47 -05001373 lbs_postpone_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001374 } else {
Holger Schurig10078322007-11-15 18:05:47 -05001375 lbs_cancel_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001376 }
David Woodhouseaa21c002007-12-08 20:04:36 +00001377 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001378
Holger Schurig9012b282007-05-25 11:27:16 -04001379 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001380 return ret;
1381}
1382
1383/**
1384 * @brief Get Extended Encryption key (WPA/802.1x and WEP)
1385 *
1386 * @param dev A pointer to net_device structure
1387 * @param info A pointer to iw_request_info structure
1388 * @param vwrq A pointer to iw_param structure
1389 * @param extra A pointer to extra data buf
1390 * @return 0 on success, otherwise failure
1391 */
Holger Schurig10078322007-11-15 18:05:47 -05001392static int lbs_get_encodeext(struct net_device *dev,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001393 struct iw_request_info *info,
1394 struct iw_point *dwrq,
1395 char *extra)
1396{
1397 int ret = -EINVAL;
Kiran Divekarab65f642009-02-19 19:32:39 -05001398 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001399 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1400 int index, max_key_len;
1401
Holger Schurig9012b282007-05-25 11:27:16 -04001402 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001403
1404 max_key_len = dwrq->length - sizeof(*ext);
1405 if (max_key_len < 0)
1406 goto out;
1407
1408 index = dwrq->flags & IW_ENCODE_INDEX;
1409 if (index) {
1410 if (index < 1 || index > 4)
1411 goto out;
1412 index--;
1413 } else {
David Woodhouseaa21c002007-12-08 20:04:36 +00001414 index = priv->wep_tx_keyidx;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001415 }
1416
Roel Kluinf59d9782007-10-26 21:51:26 +02001417 if (!(ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) &&
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001418 ext->alg != IW_ENCODE_ALG_WEP) {
David Woodhouseaa21c002007-12-08 20:04:36 +00001419 if (index != 0 || priv->mode != IW_MODE_INFRA)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001420 goto out;
1421 }
1422
1423 dwrq->flags = index + 1;
1424 memset(ext, 0, sizeof(*ext));
1425
David Woodhouseaa21c002007-12-08 20:04:36 +00001426 if ( !priv->secinfo.wep_enabled
1427 && !priv->secinfo.WPAenabled
1428 && !priv->secinfo.WPA2enabled) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001429 ext->alg = IW_ENCODE_ALG_NONE;
1430 ext->key_len = 0;
1431 dwrq->flags |= IW_ENCODE_DISABLED;
1432 } else {
1433 u8 *key = NULL;
1434
David Woodhouseaa21c002007-12-08 20:04:36 +00001435 if ( priv->secinfo.wep_enabled
1436 && !priv->secinfo.WPAenabled
1437 && !priv->secinfo.WPA2enabled) {
Dan Williams90a42212007-05-25 23:01:24 -04001438 /* WEP */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001439 ext->alg = IW_ENCODE_ALG_WEP;
David Woodhouseaa21c002007-12-08 20:04:36 +00001440 ext->key_len = priv->wep_keys[index].len;
1441 key = &priv->wep_keys[index].key[0];
1442 } else if ( !priv->secinfo.wep_enabled
1443 && (priv->secinfo.WPAenabled ||
1444 priv->secinfo.WPA2enabled)) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001445 /* WPA */
Dan Williams1443b652007-08-02 10:45:55 -04001446 struct enc_key * pkey = NULL;
Dan Williams90a42212007-05-25 23:01:24 -04001447
David Woodhouseaa21c002007-12-08 20:04:36 +00001448 if ( priv->wpa_mcast_key.len
1449 && (priv->wpa_mcast_key.flags & KEY_INFO_WPA_ENABLED))
1450 pkey = &priv->wpa_mcast_key;
1451 else if ( priv->wpa_unicast_key.len
1452 && (priv->wpa_unicast_key.flags & KEY_INFO_WPA_ENABLED))
1453 pkey = &priv->wpa_unicast_key;
Dan Williams90a42212007-05-25 23:01:24 -04001454
1455 if (pkey) {
1456 if (pkey->type == KEY_TYPE_ID_AES) {
1457 ext->alg = IW_ENCODE_ALG_CCMP;
1458 } else {
1459 ext->alg = IW_ENCODE_ALG_TKIP;
1460 }
1461 ext->key_len = pkey->len;
1462 key = &pkey->key[0];
1463 } else {
1464 ext->alg = IW_ENCODE_ALG_TKIP;
1465 ext->key_len = 0;
1466 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001467 } else {
1468 goto out;
1469 }
1470
1471 if (ext->key_len > max_key_len) {
1472 ret = -E2BIG;
1473 goto out;
1474 }
1475
1476 if (ext->key_len)
1477 memcpy(ext->key, key, ext->key_len);
1478 else
1479 dwrq->flags |= IW_ENCODE_NOKEY;
1480 dwrq->flags |= IW_ENCODE_ENABLED;
1481 }
1482 ret = 0;
1483
1484out:
Holger Schurig9012b282007-05-25 11:27:16 -04001485 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001486 return ret;
1487}
1488
1489/**
1490 * @brief Set Encryption key Extended (WPA/802.1x and WEP)
1491 *
1492 * @param dev A pointer to net_device structure
1493 * @param info A pointer to iw_request_info structure
1494 * @param vwrq A pointer to iw_param structure
1495 * @param extra A pointer to extra data buf
1496 * @return 0 --success, otherwise fail
1497 */
Holger Schurig10078322007-11-15 18:05:47 -05001498static int lbs_set_encodeext(struct net_device *dev,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001499 struct iw_request_info *info,
1500 struct iw_point *dwrq,
1501 char *extra)
1502{
1503 int ret = 0;
Kiran Divekarab65f642009-02-19 19:32:39 -05001504 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001505 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1506 int alg = ext->alg;
1507 struct assoc_request * assoc_req;
1508
Holger Schurig9012b282007-05-25 11:27:16 -04001509 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001510
David Woodhouseaa21c002007-12-08 20:04:36 +00001511 mutex_lock(&priv->lock);
1512 assoc_req = lbs_get_association_request(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001513 if (!assoc_req) {
1514 ret = -ENOMEM;
1515 goto out;
1516 }
1517
1518 if ((alg == IW_ENCODE_ALG_NONE) || (dwrq->flags & IW_ENCODE_DISABLED)) {
1519 disable_wep (assoc_req);
Dan Williams90a42212007-05-25 23:01:24 -04001520 disable_wpa (assoc_req);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001521 } else if (alg == IW_ENCODE_ALG_WEP) {
1522 u16 is_default = 0, index, set_tx_key = 0;
1523
1524 ret = validate_key_index(assoc_req->wep_tx_keyidx,
1525 (dwrq->flags & IW_ENCODE_INDEX),
1526 &index, &is_default);
1527 if (ret)
1528 goto out;
1529
1530 /* If WEP isn't enabled, or if there is no key data but a valid
1531 * index, or if the set-TX-key flag was passed, set the TX key.
1532 */
Dan Williams889c05b2007-05-10 22:57:23 -04001533 if ( !assoc_req->secinfo.wep_enabled
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001534 || (dwrq->length == 0 && !is_default)
1535 || (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY))
1536 set_tx_key = 1;
1537
1538 /* Copy key to driver */
Holger Schurig10078322007-11-15 18:05:47 -05001539 ret = lbs_set_wep_key(assoc_req, ext->key, ext->key_len, index,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001540 set_tx_key);
1541 if (ret)
1542 goto out;
1543
1544 if (dwrq->flags & IW_ENCODE_RESTRICTED) {
Dan Williams6affe782007-05-10 22:56:42 -04001545 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001546 } else if (dwrq->flags & IW_ENCODE_OPEN) {
Dan Williams6affe782007-05-10 22:56:42 -04001547 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001548 }
1549
1550 /* Mark the various WEP bits as modified */
1551 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1552 if (dwrq->length)
1553 set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
1554 if (set_tx_key)
1555 set_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001556 } else if ((alg == IW_ENCODE_ALG_TKIP) || (alg == IW_ENCODE_ALG_CCMP)) {
Dan Williams1443b652007-08-02 10:45:55 -04001557 struct enc_key * pkey;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001558
1559 /* validate key length */
1560 if (((alg == IW_ENCODE_ALG_TKIP)
1561 && (ext->key_len != KEY_LEN_WPA_TKIP))
1562 || ((alg == IW_ENCODE_ALG_CCMP)
1563 && (ext->key_len != KEY_LEN_WPA_AES))) {
Joe Perches8376e7a2007-11-19 17:48:27 -08001564 lbs_deb_wext("invalid size %d for key of alg "
Holger Schurig9012b282007-05-25 11:27:16 -04001565 "type %d\n",
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001566 ext->key_len,
1567 alg);
1568 ret = -EINVAL;
1569 goto out;
1570 }
1571
Dan Williams90a42212007-05-25 23:01:24 -04001572 if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001573 pkey = &assoc_req->wpa_mcast_key;
Dan Williams90a42212007-05-25 23:01:24 -04001574 set_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags);
1575 } else {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001576 pkey = &assoc_req->wpa_unicast_key;
Dan Williams90a42212007-05-25 23:01:24 -04001577 set_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags);
1578 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001579
Dan Williams1443b652007-08-02 10:45:55 -04001580 memset(pkey, 0, sizeof (struct enc_key));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001581 memcpy(pkey->key, ext->key, ext->key_len);
1582 pkey->len = ext->key_len;
Dan Williams90a42212007-05-25 23:01:24 -04001583 if (pkey->len)
1584 pkey->flags |= KEY_INFO_WPA_ENABLED;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001585
Dan Williams90a42212007-05-25 23:01:24 -04001586 /* Do this after zeroing key structure */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001587 if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
1588 pkey->flags |= KEY_INFO_WPA_MCAST;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001589 } else {
1590 pkey->flags |= KEY_INFO_WPA_UNICAST;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001591 }
1592
Dan Williams90a42212007-05-25 23:01:24 -04001593 if (alg == IW_ENCODE_ALG_TKIP) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001594 pkey->type = KEY_TYPE_ID_TKIP;
Dan Williams90a42212007-05-25 23:01:24 -04001595 } else if (alg == IW_ENCODE_ALG_CCMP) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001596 pkey->type = KEY_TYPE_ID_AES;
Dan Williams90a42212007-05-25 23:01:24 -04001597 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001598
1599 /* If WPA isn't enabled yet, do that now */
1600 if ( assoc_req->secinfo.WPAenabled == 0
1601 && assoc_req->secinfo.WPA2enabled == 0) {
1602 assoc_req->secinfo.WPAenabled = 1;
1603 assoc_req->secinfo.WPA2enabled = 1;
1604 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
1605 }
1606
Javier Cardona9c31fd62008-09-11 15:32:50 -07001607 /* Only disable wep if necessary: can't waste time here. */
1608 if (priv->mac_control & CMD_ACT_MAC_WEP_ENABLE)
1609 disable_wep(assoc_req);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001610 }
1611
1612out:
Javier Cardona9c40fc52008-09-16 18:08:39 -07001613 if (ret == 0) {
1614 /* 802.1x and WPA rekeying must happen as quickly as possible,
1615 * especially during the 4-way handshake; thus if in
1616 * infrastructure mode, and either (a) 802.1x is enabled or
1617 * (b) WPA is being used, set the key right away.
1618 */
1619 if (assoc_req->mode == IW_MODE_INFRA &&
1620 ((assoc_req->secinfo.key_mgmt & IW_AUTH_KEY_MGMT_802_1X) ||
1621 (assoc_req->secinfo.key_mgmt & IW_AUTH_KEY_MGMT_PSK) ||
1622 assoc_req->secinfo.WPAenabled ||
1623 assoc_req->secinfo.WPA2enabled)) {
1624 lbs_do_association_work(priv);
1625 } else
1626 lbs_postpone_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001627 } else {
Holger Schurig10078322007-11-15 18:05:47 -05001628 lbs_cancel_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001629 }
David Woodhouseaa21c002007-12-08 20:04:36 +00001630 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001631
Holger Schurig9012b282007-05-25 11:27:16 -04001632 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001633 return ret;
1634}
1635
1636
Holger Schurig10078322007-11-15 18:05:47 -05001637static int lbs_set_genie(struct net_device *dev,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001638 struct iw_request_info *info,
1639 struct iw_point *dwrq,
1640 char *extra)
1641{
Kiran Divekarab65f642009-02-19 19:32:39 -05001642 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001643 int ret = 0;
1644 struct assoc_request * assoc_req;
1645
Holger Schurig9012b282007-05-25 11:27:16 -04001646 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001647
David Woodhouseaa21c002007-12-08 20:04:36 +00001648 mutex_lock(&priv->lock);
1649 assoc_req = lbs_get_association_request(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001650 if (!assoc_req) {
1651 ret = -ENOMEM;
1652 goto out;
1653 }
1654
1655 if (dwrq->length > MAX_WPA_IE_LEN ||
1656 (dwrq->length && extra == NULL)) {
1657 ret = -EINVAL;
1658 goto out;
1659 }
1660
1661 if (dwrq->length) {
1662 memcpy(&assoc_req->wpa_ie[0], extra, dwrq->length);
1663 assoc_req->wpa_ie_len = dwrq->length;
1664 } else {
David Woodhouseaa21c002007-12-08 20:04:36 +00001665 memset(&assoc_req->wpa_ie[0], 0, sizeof(priv->wpa_ie));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001666 assoc_req->wpa_ie_len = 0;
1667 }
1668
1669out:
1670 if (ret == 0) {
1671 set_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags);
Holger Schurig10078322007-11-15 18:05:47 -05001672 lbs_postpone_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001673 } else {
Holger Schurig10078322007-11-15 18:05:47 -05001674 lbs_cancel_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001675 }
David Woodhouseaa21c002007-12-08 20:04:36 +00001676 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001677
Holger Schurig9012b282007-05-25 11:27:16 -04001678 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001679 return ret;
1680}
1681
Holger Schurig10078322007-11-15 18:05:47 -05001682static int lbs_get_genie(struct net_device *dev,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001683 struct iw_request_info *info,
1684 struct iw_point *dwrq,
1685 char *extra)
1686{
Holger Schurig9012b282007-05-25 11:27:16 -04001687 int ret = 0;
Kiran Divekarab65f642009-02-19 19:32:39 -05001688 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001689
Holger Schurig9012b282007-05-25 11:27:16 -04001690 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001691
David Woodhouseaa21c002007-12-08 20:04:36 +00001692 if (priv->wpa_ie_len == 0) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001693 dwrq->length = 0;
Holger Schurig9012b282007-05-25 11:27:16 -04001694 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001695 }
1696
David Woodhouseaa21c002007-12-08 20:04:36 +00001697 if (dwrq->length < priv->wpa_ie_len) {
Holger Schurig9012b282007-05-25 11:27:16 -04001698 ret = -E2BIG;
1699 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001700 }
1701
David Woodhouseaa21c002007-12-08 20:04:36 +00001702 dwrq->length = priv->wpa_ie_len;
1703 memcpy(extra, &priv->wpa_ie[0], priv->wpa_ie_len);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001704
Holger Schurig9012b282007-05-25 11:27:16 -04001705out:
1706 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1707 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001708}
1709
1710
Holger Schurig10078322007-11-15 18:05:47 -05001711static int lbs_set_auth(struct net_device *dev,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001712 struct iw_request_info *info,
1713 struct iw_param *dwrq,
1714 char *extra)
1715{
Kiran Divekarab65f642009-02-19 19:32:39 -05001716 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001717 struct assoc_request * assoc_req;
1718 int ret = 0;
1719 int updated = 0;
1720
Holger Schurig9012b282007-05-25 11:27:16 -04001721 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001722
David Woodhouseaa21c002007-12-08 20:04:36 +00001723 mutex_lock(&priv->lock);
1724 assoc_req = lbs_get_association_request(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001725 if (!assoc_req) {
1726 ret = -ENOMEM;
1727 goto out;
1728 }
1729
1730 switch (dwrq->flags & IW_AUTH_INDEX) {
Maithili Hinge2c8d5102009-07-31 20:02:19 -07001731 case IW_AUTH_PRIVACY_INVOKED:
1732 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001733 case IW_AUTH_TKIP_COUNTERMEASURES:
1734 case IW_AUTH_CIPHER_PAIRWISE:
1735 case IW_AUTH_CIPHER_GROUP:
Dan Williams90a42212007-05-25 23:01:24 -04001736 case IW_AUTH_DROP_UNENCRYPTED:
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001737 /*
1738 * libertas does not use these parameters
1739 */
1740 break;
1741
Javier Cardona9c40fc52008-09-16 18:08:39 -07001742 case IW_AUTH_KEY_MGMT:
1743 assoc_req->secinfo.key_mgmt = dwrq->value;
1744 updated = 1;
1745 break;
1746
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001747 case IW_AUTH_WPA_VERSION:
1748 if (dwrq->value & IW_AUTH_WPA_VERSION_DISABLED) {
1749 assoc_req->secinfo.WPAenabled = 0;
1750 assoc_req->secinfo.WPA2enabled = 0;
Dan Williams90a42212007-05-25 23:01:24 -04001751 disable_wpa (assoc_req);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001752 }
1753 if (dwrq->value & IW_AUTH_WPA_VERSION_WPA) {
1754 assoc_req->secinfo.WPAenabled = 1;
Dan Williams889c05b2007-05-10 22:57:23 -04001755 assoc_req->secinfo.wep_enabled = 0;
Dan Williams6affe782007-05-10 22:56:42 -04001756 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001757 }
1758 if (dwrq->value & IW_AUTH_WPA_VERSION_WPA2) {
1759 assoc_req->secinfo.WPA2enabled = 1;
Dan Williams889c05b2007-05-10 22:57:23 -04001760 assoc_req->secinfo.wep_enabled = 0;
Dan Williams6affe782007-05-10 22:56:42 -04001761 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001762 }
1763 updated = 1;
1764 break;
1765
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001766 case IW_AUTH_80211_AUTH_ALG:
1767 if (dwrq->value & IW_AUTH_ALG_SHARED_KEY) {
Dan Williams6affe782007-05-10 22:56:42 -04001768 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001769 } else if (dwrq->value & IW_AUTH_ALG_OPEN_SYSTEM) {
Dan Williams6affe782007-05-10 22:56:42 -04001770 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001771 } else if (dwrq->value & IW_AUTH_ALG_LEAP) {
Dan Williams6affe782007-05-10 22:56:42 -04001772 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_LEAP;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001773 } else {
1774 ret = -EINVAL;
1775 }
1776 updated = 1;
1777 break;
1778
1779 case IW_AUTH_WPA_ENABLED:
1780 if (dwrq->value) {
1781 if (!assoc_req->secinfo.WPAenabled &&
1782 !assoc_req->secinfo.WPA2enabled) {
1783 assoc_req->secinfo.WPAenabled = 1;
1784 assoc_req->secinfo.WPA2enabled = 1;
Dan Williams889c05b2007-05-10 22:57:23 -04001785 assoc_req->secinfo.wep_enabled = 0;
Dan Williams6affe782007-05-10 22:56:42 -04001786 assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001787 }
1788 } else {
1789 assoc_req->secinfo.WPAenabled = 0;
1790 assoc_req->secinfo.WPA2enabled = 0;
Dan Williams90a42212007-05-25 23:01:24 -04001791 disable_wpa (assoc_req);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001792 }
1793 updated = 1;
1794 break;
1795
1796 default:
1797 ret = -EOPNOTSUPP;
1798 break;
1799 }
1800
1801out:
1802 if (ret == 0) {
1803 if (updated)
1804 set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
Holger Schurig10078322007-11-15 18:05:47 -05001805 lbs_postpone_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001806 } else if (ret != -EOPNOTSUPP) {
Holger Schurig10078322007-11-15 18:05:47 -05001807 lbs_cancel_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001808 }
David Woodhouseaa21c002007-12-08 20:04:36 +00001809 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001810
Holger Schurig9012b282007-05-25 11:27:16 -04001811 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001812 return ret;
1813}
1814
Holger Schurig10078322007-11-15 18:05:47 -05001815static int lbs_get_auth(struct net_device *dev,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001816 struct iw_request_info *info,
1817 struct iw_param *dwrq,
1818 char *extra)
1819{
Holger Schurig9012b282007-05-25 11:27:16 -04001820 int ret = 0;
Kiran Divekarab65f642009-02-19 19:32:39 -05001821 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001822
Holger Schurig9012b282007-05-25 11:27:16 -04001823 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001824
1825 switch (dwrq->flags & IW_AUTH_INDEX) {
Javier Cardona9c40fc52008-09-16 18:08:39 -07001826 case IW_AUTH_KEY_MGMT:
1827 dwrq->value = priv->secinfo.key_mgmt;
1828 break;
1829
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001830 case IW_AUTH_WPA_VERSION:
1831 dwrq->value = 0;
David Woodhouseaa21c002007-12-08 20:04:36 +00001832 if (priv->secinfo.WPAenabled)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001833 dwrq->value |= IW_AUTH_WPA_VERSION_WPA;
David Woodhouseaa21c002007-12-08 20:04:36 +00001834 if (priv->secinfo.WPA2enabled)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001835 dwrq->value |= IW_AUTH_WPA_VERSION_WPA2;
1836 if (!dwrq->value)
1837 dwrq->value |= IW_AUTH_WPA_VERSION_DISABLED;
1838 break;
1839
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001840 case IW_AUTH_80211_AUTH_ALG:
David Woodhouseaa21c002007-12-08 20:04:36 +00001841 dwrq->value = priv->secinfo.auth_mode;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001842 break;
1843
1844 case IW_AUTH_WPA_ENABLED:
David Woodhouseaa21c002007-12-08 20:04:36 +00001845 if (priv->secinfo.WPAenabled && priv->secinfo.WPA2enabled)
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001846 dwrq->value = 1;
1847 break;
1848
1849 default:
Holger Schurig9012b282007-05-25 11:27:16 -04001850 ret = -EOPNOTSUPP;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001851 }
1852
Holger Schurig9012b282007-05-25 11:27:16 -04001853 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
1854 return ret;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001855}
1856
1857
Holger Schurig10078322007-11-15 18:05:47 -05001858static int lbs_set_txpow(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001859 struct iw_param *vwrq, char *extra)
1860{
1861 int ret = 0;
Kiran Divekarab65f642009-02-19 19:32:39 -05001862 struct lbs_private *priv = dev->ml_priv;
Dan Williams87c8c722008-08-19 15:15:35 -04001863 s16 dbm = (s16) vwrq->value;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001864
Holger Schurig9012b282007-05-25 11:27:16 -04001865 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001866
1867 if (vwrq->disabled) {
Dan Williamsd5db2df2008-08-21 17:51:07 -04001868 lbs_set_radio(priv, RADIO_PREAMBLE_AUTO, 0);
Dan Williams87c8c722008-08-19 15:15:35 -04001869 goto out;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001870 }
1871
Dan Williams87c8c722008-08-19 15:15:35 -04001872 if (vwrq->fixed == 0) {
Anna Neal0112c9e2008-09-11 11:17:25 -07001873 /* User requests automatic tx power control, however there are
1874 * many auto tx settings. For now use firmware defaults until
1875 * we come up with a good way to expose these to the user. */
1876 if (priv->fwrelease < 0x09000000) {
1877 ret = lbs_set_power_adapt_cfg(priv, 1,
1878 POW_ADAPT_DEFAULT_P0,
1879 POW_ADAPT_DEFAULT_P1,
1880 POW_ADAPT_DEFAULT_P2);
1881 if (ret)
1882 goto out;
1883 }
1884 ret = lbs_set_tpc_cfg(priv, 0, TPC_DEFAULT_P0, TPC_DEFAULT_P1,
1885 TPC_DEFAULT_P2, 1);
1886 if (ret)
1887 goto out;
Dan Williams87c8c722008-08-19 15:15:35 -04001888 dbm = priv->txpower_max;
1889 } else {
1890 /* Userspace check in iwrange if it should use dBm or mW,
1891 * therefore this should never happen... Jean II */
1892 if ((vwrq->flags & IW_TXPOW_TYPE) != IW_TXPOW_DBM) {
1893 ret = -EOPNOTSUPP;
1894 goto out;
1895 }
1896
Anna Neal0112c9e2008-09-11 11:17:25 -07001897 /* Validate requested power level against firmware allowed
1898 * levels */
Dan Williams87c8c722008-08-19 15:15:35 -04001899 if (priv->txpower_min && (dbm < priv->txpower_min)) {
1900 ret = -EINVAL;
1901 goto out;
1902 }
1903
1904 if (priv->txpower_max && (dbm > priv->txpower_max)) {
1905 ret = -EINVAL;
1906 goto out;
1907 }
Anna Neal0112c9e2008-09-11 11:17:25 -07001908 if (priv->fwrelease < 0x09000000) {
1909 ret = lbs_set_power_adapt_cfg(priv, 0,
1910 POW_ADAPT_DEFAULT_P0,
1911 POW_ADAPT_DEFAULT_P1,
1912 POW_ADAPT_DEFAULT_P2);
1913 if (ret)
1914 goto out;
1915 }
1916 ret = lbs_set_tpc_cfg(priv, 0, TPC_DEFAULT_P0, TPC_DEFAULT_P1,
1917 TPC_DEFAULT_P2, 1);
1918 if (ret)
1919 goto out;
Dan Williams87c8c722008-08-19 15:15:35 -04001920 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001921
Dan Williamsd5db2df2008-08-21 17:51:07 -04001922 /* If the radio was off, turn it on */
1923 if (!priv->radio_on) {
1924 ret = lbs_set_radio(priv, RADIO_PREAMBLE_AUTO, 1);
1925 if (ret)
1926 goto out;
1927 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001928
Dan Williams87c8c722008-08-19 15:15:35 -04001929 lbs_deb_wext("txpower set %d dBm\n", dbm);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001930
Dan Williams87c8c722008-08-19 15:15:35 -04001931 ret = lbs_set_tx_power(priv, dbm);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001932
Dan Williams87c8c722008-08-19 15:15:35 -04001933out:
Holger Schurig9012b282007-05-25 11:27:16 -04001934 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001935 return ret;
1936}
1937
Holger Schurig10078322007-11-15 18:05:47 -05001938static int lbs_get_essid(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001939 struct iw_point *dwrq, char *extra)
1940{
Kiran Divekarab65f642009-02-19 19:32:39 -05001941 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001942
Holger Schurig9012b282007-05-25 11:27:16 -04001943 lbs_deb_enter(LBS_DEB_WEXT);
1944
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001945 /*
1946 * Note : if dwrq->flags != 0, we should get the relevant SSID from
1947 * the SSID list...
1948 */
1949
1950 /*
1951 * Get the current SSID
1952 */
David Woodhouseaa21c002007-12-08 20:04:36 +00001953 if (priv->connect_status == LBS_CONNECTED) {
1954 memcpy(extra, priv->curbssparams.ssid,
1955 priv->curbssparams.ssid_len);
1956 extra[priv->curbssparams.ssid_len] = '\0';
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001957 } else {
1958 memset(extra, 0, 32);
David Woodhouseaa21c002007-12-08 20:04:36 +00001959 extra[priv->curbssparams.ssid_len] = '\0';
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001960 }
1961 /*
1962 * If none, we may want to get the one that was set
1963 */
1964
David Woodhouseaa21c002007-12-08 20:04:36 +00001965 dwrq->length = priv->curbssparams.ssid_len;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001966
1967 dwrq->flags = 1; /* active */
1968
Holger Schurig9012b282007-05-25 11:27:16 -04001969 lbs_deb_leave(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001970 return 0;
1971}
1972
Holger Schurig10078322007-11-15 18:05:47 -05001973static int lbs_set_essid(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001974 struct iw_point *dwrq, char *extra)
1975{
Kiran Divekarab65f642009-02-19 19:32:39 -05001976 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001977 int ret = 0;
Dan Williamsd8efea22007-05-28 23:54:55 -04001978 u8 ssid[IW_ESSID_MAX_SIZE];
1979 u8 ssid_len = 0;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001980 struct assoc_request * assoc_req;
Dan Williamsd8efea22007-05-28 23:54:55 -04001981 int in_ssid_len = dwrq->length;
John W. Linville9387b7c2008-09-30 20:59:05 -04001982 DECLARE_SSID_BUF(ssid_buf);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001983
Holger Schurig9012b282007-05-25 11:27:16 -04001984 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001985
Dan Williamsd5db2df2008-08-21 17:51:07 -04001986 if (!priv->radio_on) {
1987 ret = -EINVAL;
1988 goto out;
1989 }
1990
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001991 /* Check the size of the string */
Dan Williamsd8efea22007-05-28 23:54:55 -04001992 if (in_ssid_len > IW_ESSID_MAX_SIZE) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001993 ret = -E2BIG;
1994 goto out;
1995 }
1996
Dan Williamsd8efea22007-05-28 23:54:55 -04001997 memset(&ssid, 0, sizeof(ssid));
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02001998
Dan Williamsd8efea22007-05-28 23:54:55 -04001999 if (!dwrq->flags || !in_ssid_len) {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002000 /* "any" SSID requested; leave SSID blank */
2001 } else {
2002 /* Specific SSID requested */
Dan Williamsd8efea22007-05-28 23:54:55 -04002003 memcpy(&ssid, extra, in_ssid_len);
2004 ssid_len = in_ssid_len;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002005 }
2006
Dan Williamsd8efea22007-05-28 23:54:55 -04002007 if (!ssid_len) {
2008 lbs_deb_wext("requested any SSID\n");
2009 } else {
2010 lbs_deb_wext("requested SSID '%s'\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04002011 print_ssid(ssid_buf, ssid, ssid_len));
Dan Williamsd8efea22007-05-28 23:54:55 -04002012 }
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002013
2014out:
David Woodhouseaa21c002007-12-08 20:04:36 +00002015 mutex_lock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002016 if (ret == 0) {
2017 /* Get or create the current association request */
David Woodhouseaa21c002007-12-08 20:04:36 +00002018 assoc_req = lbs_get_association_request(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002019 if (!assoc_req) {
2020 ret = -ENOMEM;
2021 } else {
2022 /* Copy the SSID to the association request */
Dan Williamsd8efea22007-05-28 23:54:55 -04002023 memcpy(&assoc_req->ssid, &ssid, IW_ESSID_MAX_SIZE);
2024 assoc_req->ssid_len = ssid_len;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002025 set_bit(ASSOC_FLAG_SSID, &assoc_req->flags);
Holger Schurig10078322007-11-15 18:05:47 -05002026 lbs_postpone_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002027 }
2028 }
2029
2030 /* Cancel the association request if there was an error */
2031 if (ret != 0) {
Holger Schurig10078322007-11-15 18:05:47 -05002032 lbs_cancel_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002033 }
2034
David Woodhouseaa21c002007-12-08 20:04:36 +00002035 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002036
Holger Schurig9012b282007-05-25 11:27:16 -04002037 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002038 return ret;
2039}
2040
David Woodhousef5956bf2007-12-11 19:30:57 -05002041static int lbs_mesh_get_essid(struct net_device *dev,
2042 struct iw_request_info *info,
2043 struct iw_point *dwrq, char *extra)
2044{
Kiran Divekarab65f642009-02-19 19:32:39 -05002045 struct lbs_private *priv = dev->ml_priv;
David Woodhousef5956bf2007-12-11 19:30:57 -05002046
2047 lbs_deb_enter(LBS_DEB_WEXT);
2048
2049 memcpy(extra, priv->mesh_ssid, priv->mesh_ssid_len);
2050
2051 dwrq->length = priv->mesh_ssid_len;
2052
2053 dwrq->flags = 1; /* active */
2054
2055 lbs_deb_leave(LBS_DEB_WEXT);
2056 return 0;
2057}
2058
2059static int lbs_mesh_set_essid(struct net_device *dev,
2060 struct iw_request_info *info,
2061 struct iw_point *dwrq, char *extra)
2062{
Kiran Divekarab65f642009-02-19 19:32:39 -05002063 struct lbs_private *priv = dev->ml_priv;
David Woodhousef5956bf2007-12-11 19:30:57 -05002064 int ret = 0;
2065
2066 lbs_deb_enter(LBS_DEB_WEXT);
2067
Dan Williamsd5db2df2008-08-21 17:51:07 -04002068 if (!priv->radio_on) {
2069 ret = -EINVAL;
2070 goto out;
2071 }
2072
David Woodhousef5956bf2007-12-11 19:30:57 -05002073 /* Check the size of the string */
2074 if (dwrq->length > IW_ESSID_MAX_SIZE) {
2075 ret = -E2BIG;
2076 goto out;
2077 }
2078
2079 if (!dwrq->flags || !dwrq->length) {
2080 ret = -EINVAL;
2081 goto out;
2082 } else {
2083 /* Specific SSID requested */
2084 memcpy(priv->mesh_ssid, extra, dwrq->length);
2085 priv->mesh_ssid_len = dwrq->length;
2086 }
2087
Javier Cardonaedaea5c2008-05-17 00:55:10 -07002088 lbs_mesh_config(priv, CMD_ACT_MESH_CONFIG_START,
2089 priv->curbssparams.channel);
David Woodhousef5956bf2007-12-11 19:30:57 -05002090 out:
2091 lbs_deb_leave_args(LBS_DEB_WEXT, "ret %d", ret);
2092 return ret;
2093}
2094
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002095/**
2096 * @brief Connect to the AP or Ad-hoc Network with specific bssid
2097 *
2098 * @param dev A pointer to net_device structure
2099 * @param info A pointer to iw_request_info structure
2100 * @param awrq A pointer to iw_param structure
2101 * @param extra A pointer to extra data buf
2102 * @return 0 --success, otherwise fail
2103 */
Holger Schurig10078322007-11-15 18:05:47 -05002104static int lbs_set_wap(struct net_device *dev, struct iw_request_info *info,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002105 struct sockaddr *awrq, char *extra)
2106{
Kiran Divekarab65f642009-02-19 19:32:39 -05002107 struct lbs_private *priv = dev->ml_priv;
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002108 struct assoc_request * assoc_req;
2109 int ret = 0;
2110
Holger Schurig9012b282007-05-25 11:27:16 -04002111 lbs_deb_enter(LBS_DEB_WEXT);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002112
Dan Williamsd5db2df2008-08-21 17:51:07 -04002113 if (!priv->radio_on)
2114 return -EINVAL;
2115
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002116 if (awrq->sa_family != ARPHRD_ETHER)
2117 return -EINVAL;
2118
Johannes Berge1749612008-10-27 15:59:26 -07002119 lbs_deb_wext("ASSOC: WAP: sa_data %pM\n", awrq->sa_data);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002120
David Woodhouseaa21c002007-12-08 20:04:36 +00002121 mutex_lock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002122
2123 /* Get or create the current association request */
David Woodhouseaa21c002007-12-08 20:04:36 +00002124 assoc_req = lbs_get_association_request(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002125 if (!assoc_req) {
Holger Schurig10078322007-11-15 18:05:47 -05002126 lbs_cancel_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002127 ret = -ENOMEM;
2128 } else {
2129 /* Copy the BSSID to the association request */
2130 memcpy(&assoc_req->bssid, awrq->sa_data, ETH_ALEN);
2131 set_bit(ASSOC_FLAG_BSSID, &assoc_req->flags);
Holger Schurig10078322007-11-15 18:05:47 -05002132 lbs_postpone_association_work(priv);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002133 }
2134
David Woodhouseaa21c002007-12-08 20:04:36 +00002135 mutex_unlock(&priv->lock);
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002136
2137 return ret;
2138}
2139
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002140/*
2141 * iwconfig settable callbacks
2142 */
Holger Schurig10078322007-11-15 18:05:47 -05002143static const iw_handler lbs_handler[] = {
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002144 (iw_handler) NULL, /* SIOCSIWCOMMIT */
Holger Schurig10078322007-11-15 18:05:47 -05002145 (iw_handler) lbs_get_name, /* SIOCGIWNAME */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002146 (iw_handler) NULL, /* SIOCSIWNWID */
2147 (iw_handler) NULL, /* SIOCGIWNWID */
Holger Schurig10078322007-11-15 18:05:47 -05002148 (iw_handler) lbs_set_freq, /* SIOCSIWFREQ */
2149 (iw_handler) lbs_get_freq, /* SIOCGIWFREQ */
2150 (iw_handler) lbs_set_mode, /* SIOCSIWMODE */
2151 (iw_handler) lbs_get_mode, /* SIOCGIWMODE */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002152 (iw_handler) NULL, /* SIOCSIWSENS */
2153 (iw_handler) NULL, /* SIOCGIWSENS */
2154 (iw_handler) NULL, /* SIOCSIWRANGE */
Holger Schurig10078322007-11-15 18:05:47 -05002155 (iw_handler) lbs_get_range, /* SIOCGIWRANGE */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002156 (iw_handler) NULL, /* SIOCSIWPRIV */
2157 (iw_handler) NULL, /* SIOCGIWPRIV */
2158 (iw_handler) NULL, /* SIOCSIWSTATS */
2159 (iw_handler) NULL, /* SIOCGIWSTATS */
2160 iw_handler_set_spy, /* SIOCSIWSPY */
2161 iw_handler_get_spy, /* SIOCGIWSPY */
2162 iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
2163 iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
Holger Schurig10078322007-11-15 18:05:47 -05002164 (iw_handler) lbs_set_wap, /* SIOCSIWAP */
2165 (iw_handler) lbs_get_wap, /* SIOCGIWAP */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002166 (iw_handler) NULL, /* SIOCSIWMLME */
2167 (iw_handler) NULL, /* SIOCGIWAPLIST - deprecated */
Holger Schurig10078322007-11-15 18:05:47 -05002168 (iw_handler) lbs_set_scan, /* SIOCSIWSCAN */
2169 (iw_handler) lbs_get_scan, /* SIOCGIWSCAN */
2170 (iw_handler) lbs_set_essid, /* SIOCSIWESSID */
2171 (iw_handler) lbs_get_essid, /* SIOCGIWESSID */
2172 (iw_handler) lbs_set_nick, /* SIOCSIWNICKN */
2173 (iw_handler) lbs_get_nick, /* SIOCGIWNICKN */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002174 (iw_handler) NULL, /* -- hole -- */
2175 (iw_handler) NULL, /* -- hole -- */
Holger Schurig10078322007-11-15 18:05:47 -05002176 (iw_handler) lbs_set_rate, /* SIOCSIWRATE */
2177 (iw_handler) lbs_get_rate, /* SIOCGIWRATE */
2178 (iw_handler) lbs_set_rts, /* SIOCSIWRTS */
2179 (iw_handler) lbs_get_rts, /* SIOCGIWRTS */
2180 (iw_handler) lbs_set_frag, /* SIOCSIWFRAG */
2181 (iw_handler) lbs_get_frag, /* SIOCGIWFRAG */
2182 (iw_handler) lbs_set_txpow, /* SIOCSIWTXPOW */
2183 (iw_handler) lbs_get_txpow, /* SIOCGIWTXPOW */
2184 (iw_handler) lbs_set_retry, /* SIOCSIWRETRY */
2185 (iw_handler) lbs_get_retry, /* SIOCGIWRETRY */
2186 (iw_handler) lbs_set_encode, /* SIOCSIWENCODE */
2187 (iw_handler) lbs_get_encode, /* SIOCGIWENCODE */
2188 (iw_handler) lbs_set_power, /* SIOCSIWPOWER */
2189 (iw_handler) lbs_get_power, /* SIOCGIWPOWER */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002190 (iw_handler) NULL, /* -- hole -- */
2191 (iw_handler) NULL, /* -- hole -- */
Holger Schurig10078322007-11-15 18:05:47 -05002192 (iw_handler) lbs_set_genie, /* SIOCSIWGENIE */
2193 (iw_handler) lbs_get_genie, /* SIOCGIWGENIE */
2194 (iw_handler) lbs_set_auth, /* SIOCSIWAUTH */
2195 (iw_handler) lbs_get_auth, /* SIOCGIWAUTH */
2196 (iw_handler) lbs_set_encodeext,/* SIOCSIWENCODEEXT */
2197 (iw_handler) lbs_get_encodeext,/* SIOCGIWENCODEEXT */
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002198 (iw_handler) NULL, /* SIOCSIWPMKSA */
2199};
2200
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -04002201static const iw_handler mesh_wlan_handler[] = {
2202 (iw_handler) NULL, /* SIOCSIWCOMMIT */
Holger Schurig10078322007-11-15 18:05:47 -05002203 (iw_handler) lbs_get_name, /* SIOCGIWNAME */
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -04002204 (iw_handler) NULL, /* SIOCSIWNWID */
2205 (iw_handler) NULL, /* SIOCGIWNWID */
David Woodhouse823eaa22007-12-11 19:56:28 -05002206 (iw_handler) lbs_mesh_set_freq, /* SIOCSIWFREQ */
Holger Schurig10078322007-11-15 18:05:47 -05002207 (iw_handler) lbs_get_freq, /* SIOCGIWFREQ */
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -04002208 (iw_handler) NULL, /* SIOCSIWMODE */
2209 (iw_handler) mesh_wlan_get_mode, /* SIOCGIWMODE */
2210 (iw_handler) NULL, /* SIOCSIWSENS */
2211 (iw_handler) NULL, /* SIOCGIWSENS */
2212 (iw_handler) NULL, /* SIOCSIWRANGE */
Holger Schurig10078322007-11-15 18:05:47 -05002213 (iw_handler) lbs_get_range, /* SIOCGIWRANGE */
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -04002214 (iw_handler) NULL, /* SIOCSIWPRIV */
2215 (iw_handler) NULL, /* SIOCGIWPRIV */
2216 (iw_handler) NULL, /* SIOCSIWSTATS */
2217 (iw_handler) NULL, /* SIOCGIWSTATS */
2218 iw_handler_set_spy, /* SIOCSIWSPY */
2219 iw_handler_get_spy, /* SIOCGIWSPY */
2220 iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
2221 iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
2222 (iw_handler) NULL, /* SIOCSIWAP */
2223 (iw_handler) NULL, /* SIOCGIWAP */
2224 (iw_handler) NULL, /* SIOCSIWMLME */
2225 (iw_handler) NULL, /* SIOCGIWAPLIST - deprecated */
Holger Schurig10078322007-11-15 18:05:47 -05002226 (iw_handler) lbs_set_scan, /* SIOCSIWSCAN */
2227 (iw_handler) lbs_get_scan, /* SIOCGIWSCAN */
David Woodhousef5956bf2007-12-11 19:30:57 -05002228 (iw_handler) lbs_mesh_set_essid,/* SIOCSIWESSID */
2229 (iw_handler) lbs_mesh_get_essid,/* SIOCGIWESSID */
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -04002230 (iw_handler) NULL, /* SIOCSIWNICKN */
2231 (iw_handler) mesh_get_nick, /* SIOCGIWNICKN */
2232 (iw_handler) NULL, /* -- hole -- */
2233 (iw_handler) NULL, /* -- hole -- */
Holger Schurig10078322007-11-15 18:05:47 -05002234 (iw_handler) lbs_set_rate, /* SIOCSIWRATE */
2235 (iw_handler) lbs_get_rate, /* SIOCGIWRATE */
2236 (iw_handler) lbs_set_rts, /* SIOCSIWRTS */
2237 (iw_handler) lbs_get_rts, /* SIOCGIWRTS */
2238 (iw_handler) lbs_set_frag, /* SIOCSIWFRAG */
2239 (iw_handler) lbs_get_frag, /* SIOCGIWFRAG */
2240 (iw_handler) lbs_set_txpow, /* SIOCSIWTXPOW */
2241 (iw_handler) lbs_get_txpow, /* SIOCGIWTXPOW */
2242 (iw_handler) lbs_set_retry, /* SIOCSIWRETRY */
2243 (iw_handler) lbs_get_retry, /* SIOCGIWRETRY */
2244 (iw_handler) lbs_set_encode, /* SIOCSIWENCODE */
2245 (iw_handler) lbs_get_encode, /* SIOCGIWENCODE */
2246 (iw_handler) lbs_set_power, /* SIOCSIWPOWER */
2247 (iw_handler) lbs_get_power, /* SIOCGIWPOWER */
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -04002248 (iw_handler) NULL, /* -- hole -- */
2249 (iw_handler) NULL, /* -- hole -- */
Holger Schurig10078322007-11-15 18:05:47 -05002250 (iw_handler) lbs_set_genie, /* SIOCSIWGENIE */
2251 (iw_handler) lbs_get_genie, /* SIOCGIWGENIE */
2252 (iw_handler) lbs_set_auth, /* SIOCSIWAUTH */
2253 (iw_handler) lbs_get_auth, /* SIOCGIWAUTH */
2254 (iw_handler) lbs_set_encodeext,/* SIOCSIWENCODEEXT */
2255 (iw_handler) lbs_get_encodeext,/* SIOCGIWENCODEEXT */
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -04002256 (iw_handler) NULL, /* SIOCSIWPMKSA */
2257};
Holger Schurig10078322007-11-15 18:05:47 -05002258struct iw_handler_def lbs_handler_def = {
2259 .num_standard = ARRAY_SIZE(lbs_handler),
2260 .standard = (iw_handler *) lbs_handler,
2261 .get_wireless_stats = lbs_get_wireless_stats,
Marcelo Tosatti876c9d32007-02-10 12:25:27 -02002262};
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -04002263
2264struct iw_handler_def mesh_handler_def = {
Denis Chengff8ac602007-09-02 18:30:18 +08002265 .num_standard = ARRAY_SIZE(mesh_wlan_handler),
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -04002266 .standard = (iw_handler *) mesh_wlan_handler,
Holger Schurig10078322007-11-15 18:05:47 -05002267 .get_wireless_stats = lbs_get_wireless_stats,
Luis Carlos Cobo Rusf5e05b62007-05-25 23:08:34 -04002268};