1/* 2 * Copyright (C) 2002 Intersil Americas Inc. 3 * (C) 2003,2004 Aurelien Alleaume <slts@free.fr> 4 * (C) 2003 Herbert Valerio Riedel <hvr@gnu.org> 5 * (C) 2003 Luis R. Rodriguez <mcgrof@ruslug.rutgers.edu> 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License as published by 9 * the Free Software Foundation; either version 2 of the License 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 * 16 * You should have received a copy of the GNU General Public License 17 * along with this program; if not, see <http://www.gnu.org/licenses/>. 18 * 19 */ 20 21#include <linux/capability.h> 22#include <linux/module.h> 23#include <linux/kernel.h> 24#include <linux/if_arp.h> 25#include <linux/slab.h> 26#include <linux/pci.h> 27#include <linux/etherdevice.h> 28 29#include <asm/uaccess.h> 30 31#include "prismcompat.h" 32#include "isl_ioctl.h" 33#include "islpci_mgt.h" 34#include "isl_oid.h" /* additional types and defs for isl38xx fw */ 35#include "oid_mgt.h" 36 37#include <net/iw_handler.h> /* New driver API */ 38 39#define KEY_SIZE_WEP104 13 /* 104/128-bit WEP keys */ 40#define KEY_SIZE_WEP40 5 /* 40/64-bit WEP keys */ 41/* KEY_SIZE_TKIP should match isl_oid.h, struct obj_key.key[] size */ 42#define KEY_SIZE_TKIP 32 /* TKIP keys */ 43 44static void prism54_wpa_bss_ie_add(islpci_private *priv, u8 *bssid, 45 u8 *wpa_ie, size_t wpa_ie_len); 46static size_t prism54_wpa_bss_ie_get(islpci_private *priv, u8 *bssid, u8 *wpa_ie); 47static int prism54_set_wpa(struct net_device *, struct iw_request_info *, 48 __u32 *, char *); 49 50/* In 500 kbps */ 51static const unsigned char scan_rate_list[] = { 2, 4, 11, 22, 52 12, 18, 24, 36, 53 48, 72, 96, 108 }; 54 55/** 56 * prism54_mib_mode_helper - MIB change mode helper function 57 * @mib: the &struct islpci_mib object to modify 58 * @iw_mode: new mode (%IW_MODE_*) 59 * 60 * This is a helper function, hence it does not lock. Make sure 61 * caller deals with locking *if* necessary. This function sets the 62 * mode-dependent mib values and does the mapping of the Linux 63 * Wireless API modes to Device firmware modes. It also checks for 64 * correct valid Linux wireless modes. 65 */ 66static int 67prism54_mib_mode_helper(islpci_private *priv, u32 iw_mode) 68{ 69 u32 config = INL_CONFIG_MANUALRUN; 70 u32 mode, bsstype; 71 72 /* For now, just catch early the Repeater and Secondary modes here */ 73 if (iw_mode == IW_MODE_REPEAT || iw_mode == IW_MODE_SECOND) { 74 printk(KERN_DEBUG 75 "%s(): Sorry, Repeater mode and Secondary mode " 76 "are not yet supported by this driver.\n", __func__); 77 return -EINVAL; 78 } 79 80 priv->iw_mode = iw_mode; 81 82 switch (iw_mode) { 83 case IW_MODE_AUTO: 84 mode = INL_MODE_CLIENT; 85 bsstype = DOT11_BSSTYPE_ANY; 86 break; 87 case IW_MODE_ADHOC: 88 mode = INL_MODE_CLIENT; 89 bsstype = DOT11_BSSTYPE_IBSS; 90 break; 91 case IW_MODE_INFRA: 92 mode = INL_MODE_CLIENT; 93 bsstype = DOT11_BSSTYPE_INFRA; 94 break; 95 case IW_MODE_MASTER: 96 mode = INL_MODE_AP; 97 bsstype = DOT11_BSSTYPE_INFRA; 98 break; 99 case IW_MODE_MONITOR: 100 mode = INL_MODE_PROMISCUOUS; 101 bsstype = DOT11_BSSTYPE_ANY; 102 config |= INL_CONFIG_RXANNEX; 103 break; 104 default: 105 return -EINVAL; 106 } 107 108 if (init_wds) 109 config |= INL_CONFIG_WDS; 110 mgt_set(priv, DOT11_OID_BSSTYPE, &bsstype); 111 mgt_set(priv, OID_INL_CONFIG, &config); 112 mgt_set(priv, OID_INL_MODE, &mode); 113 114 return 0; 115} 116 117/** 118 * prism54_mib_init - fill MIB cache with defaults 119 * 120 * this function initializes the struct given as @mib with defaults, 121 * of which many are retrieved from the global module parameter 122 * variables. 123 */ 124 125void 126prism54_mib_init(islpci_private *priv) 127{ 128 u32 channel, authen, wep, filter, dot1x, mlme, conformance, power, mode; 129 struct obj_buffer psm_buffer = { 130 .size = PSM_BUFFER_SIZE, 131 .addr = priv->device_psm_buffer 132 }; 133 134 channel = CARD_DEFAULT_CHANNEL; 135 authen = CARD_DEFAULT_AUTHEN; 136 wep = CARD_DEFAULT_WEP; 137 filter = CARD_DEFAULT_FILTER; /* (0) Do not filter un-encrypted data */ 138 dot1x = CARD_DEFAULT_DOT1X; 139 mlme = CARD_DEFAULT_MLME_MODE; 140 conformance = CARD_DEFAULT_CONFORMANCE; 141 power = 127; 142 mode = CARD_DEFAULT_IW_MODE; 143 144 mgt_set(priv, DOT11_OID_CHANNEL, &channel); 145 mgt_set(priv, DOT11_OID_AUTHENABLE, &authen); 146 mgt_set(priv, DOT11_OID_PRIVACYINVOKED, &wep); 147 mgt_set(priv, DOT11_OID_PSMBUFFER, &psm_buffer); 148 mgt_set(priv, DOT11_OID_EXUNENCRYPTED, &filter); 149 mgt_set(priv, DOT11_OID_DOT1XENABLE, &dot1x); 150 mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlme); 151 mgt_set(priv, OID_INL_DOT11D_CONFORMANCE, &conformance); 152 mgt_set(priv, OID_INL_OUTPUTPOWER, &power); 153 154 /* This sets all of the mode-dependent values */ 155 prism54_mib_mode_helper(priv, mode); 156} 157 158/* this will be executed outside of atomic context thanks to 159 * schedule_work(), thus we can as well use sleeping semaphore 160 * locking */ 161void 162prism54_update_stats(struct work_struct *work) 163{ 164 islpci_private *priv = container_of(work, islpci_private, stats_work); 165 char *data; 166 int j; 167 struct obj_bss bss, *bss2; 168 union oid_res_t r; 169 170 mutex_lock(&priv->stats_lock); 171 172/* Noise floor. 173 * I'm not sure if the unit is dBm. 174 * Note : If we are not connected, this value seems to be irrelevant. */ 175 176 mgt_get_request(priv, DOT11_OID_NOISEFLOOR, 0, NULL, &r); 177 priv->local_iwstatistics.qual.noise = r.u; 178 179/* Get the rssi of the link. To do this we need to retrieve a bss. */ 180 181 /* First get the MAC address of the AP we are associated with. */ 182 mgt_get_request(priv, DOT11_OID_BSSID, 0, NULL, &r); 183 data = r.ptr; 184 185 /* copy this MAC to the bss */ 186 memcpy(bss.address, data, ETH_ALEN); 187 kfree(data); 188 189 /* now ask for the corresponding bss */ 190 j = mgt_get_request(priv, DOT11_OID_BSSFIND, 0, (void *) &bss, &r); 191 bss2 = r.ptr; 192 /* report the rssi and use it to calculate 193 * link quality through a signal-noise 194 * ratio */ 195 priv->local_iwstatistics.qual.level = bss2->rssi; 196 priv->local_iwstatistics.qual.qual = 197 bss2->rssi - priv->iwstatistics.qual.noise; 198 199 kfree(bss2); 200 201 /* report that the stats are new */ 202 priv->local_iwstatistics.qual.updated = 0x7; 203 204/* Rx : unable to decrypt the MPDU */ 205 mgt_get_request(priv, DOT11_OID_PRIVRXFAILED, 0, NULL, &r); 206 priv->local_iwstatistics.discard.code = r.u; 207 208/* Tx : Max MAC retries num reached */ 209 mgt_get_request(priv, DOT11_OID_MPDUTXFAILED, 0, NULL, &r); 210 priv->local_iwstatistics.discard.retries = r.u; 211 212 mutex_unlock(&priv->stats_lock); 213} 214 215struct iw_statistics * 216prism54_get_wireless_stats(struct net_device *ndev) 217{ 218 islpci_private *priv = netdev_priv(ndev); 219 220 /* If the stats are being updated return old data */ 221 if (mutex_trylock(&priv->stats_lock)) { 222 memcpy(&priv->iwstatistics, &priv->local_iwstatistics, 223 sizeof (struct iw_statistics)); 224 /* They won't be marked updated for the next time */ 225 priv->local_iwstatistics.qual.updated = 0; 226 mutex_unlock(&priv->stats_lock); 227 } else 228 priv->iwstatistics.qual.updated = 0; 229 230 /* Update our wireless stats, but do not schedule to often 231 * (max 1 HZ) */ 232 if ((priv->stats_timestamp == 0) || 233 time_after(jiffies, priv->stats_timestamp + 1 * HZ)) { 234 schedule_work(&priv->stats_work); 235 priv->stats_timestamp = jiffies; 236 } 237 238 return &priv->iwstatistics; 239} 240 241static int 242prism54_commit(struct net_device *ndev, struct iw_request_info *info, 243 char *cwrq, char *extra) 244{ 245 islpci_private *priv = netdev_priv(ndev); 246 247 /* simply re-set the last set SSID, this should commit most stuff */ 248 249 /* Commit in Monitor mode is not necessary, also setting essid 250 * in Monitor mode does not make sense and isn't allowed for this 251 * device's firmware */ 252 if (priv->iw_mode != IW_MODE_MONITOR) 253 return mgt_set_request(priv, DOT11_OID_SSID, 0, NULL); 254 return 0; 255} 256 257static int 258prism54_get_name(struct net_device *ndev, struct iw_request_info *info, 259 char *cwrq, char *extra) 260{ 261 islpci_private *priv = netdev_priv(ndev); 262 char *capabilities; 263 union oid_res_t r; 264 int rvalue; 265 266 if (islpci_get_state(priv) < PRV_STATE_INIT) { 267 strncpy(cwrq, "NOT READY!", IFNAMSIZ); 268 return 0; 269 } 270 rvalue = mgt_get_request(priv, OID_INL_PHYCAPABILITIES, 0, NULL, &r); 271 272 switch (r.u) { 273 case INL_PHYCAP_5000MHZ: 274 capabilities = "IEEE 802.11a/b/g"; 275 break; 276 case INL_PHYCAP_FAA: 277 capabilities = "IEEE 802.11b/g - FAA Support"; 278 break; 279 case INL_PHYCAP_2400MHZ: 280 default: 281 capabilities = "IEEE 802.11b/g"; /* Default */ 282 break; 283 } 284 strncpy(cwrq, capabilities, IFNAMSIZ); 285 return rvalue; 286} 287 288static int 289prism54_set_freq(struct net_device *ndev, struct iw_request_info *info, 290 struct iw_freq *fwrq, char *extra) 291{ 292 islpci_private *priv = netdev_priv(ndev); 293 int rvalue; 294 u32 c; 295 296 if (fwrq->m < 1000) 297 /* we have a channel number */ 298 c = fwrq->m; 299 else 300 c = (fwrq->e == 1) ? channel_of_freq(fwrq->m / 100000) : 0; 301 302 rvalue = c ? mgt_set_request(priv, DOT11_OID_CHANNEL, 0, &c) : -EINVAL; 303 304 /* Call commit handler */ 305 return (rvalue ? rvalue : -EINPROGRESS); 306} 307 308static int 309prism54_get_freq(struct net_device *ndev, struct iw_request_info *info, 310 struct iw_freq *fwrq, char *extra) 311{ 312 islpci_private *priv = netdev_priv(ndev); 313 union oid_res_t r; 314 int rvalue; 315 316 rvalue = mgt_get_request(priv, DOT11_OID_CHANNEL, 0, NULL, &r); 317 fwrq->i = r.u; 318 rvalue |= mgt_get_request(priv, DOT11_OID_FREQUENCY, 0, NULL, &r); 319 fwrq->m = r.u; 320 fwrq->e = 3; 321 322 return rvalue; 323} 324 325static int 326prism54_set_mode(struct net_device *ndev, struct iw_request_info *info, 327 __u32 * uwrq, char *extra) 328{ 329 islpci_private *priv = netdev_priv(ndev); 330 u32 mlmeautolevel = CARD_DEFAULT_MLME_MODE; 331 332 /* Let's see if the user passed a valid Linux Wireless mode */ 333 if (*uwrq > IW_MODE_MONITOR || *uwrq < IW_MODE_AUTO) { 334 printk(KERN_DEBUG 335 "%s: %s() You passed a non-valid init_mode.\n", 336 priv->ndev->name, __func__); 337 return -EINVAL; 338 } 339 340 down_write(&priv->mib_sem); 341 342 if (prism54_mib_mode_helper(priv, *uwrq)) { 343 up_write(&priv->mib_sem); 344 return -EOPNOTSUPP; 345 } 346 347 /* the ACL code needs an intermediate mlmeautolevel. The wpa stuff an 348 * extended one. 349 */ 350 if ((*uwrq == IW_MODE_MASTER) && (priv->acl.policy != MAC_POLICY_OPEN)) 351 mlmeautolevel = DOT11_MLME_INTERMEDIATE; 352 if (priv->wpa) 353 mlmeautolevel = DOT11_MLME_EXTENDED; 354 355 mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlmeautolevel); 356 357 if (mgt_commit(priv)) { 358 up_write(&priv->mib_sem); 359 return -EIO; 360 } 361 priv->ndev->type = (priv->iw_mode == IW_MODE_MONITOR) 362 ? priv->monitor_type : ARPHRD_ETHER; 363 up_write(&priv->mib_sem); 364 365 return 0; 366} 367 368/* Use mib cache */ 369static int 370prism54_get_mode(struct net_device *ndev, struct iw_request_info *info, 371 __u32 * uwrq, char *extra) 372{ 373 islpci_private *priv = netdev_priv(ndev); 374 375 BUG_ON((priv->iw_mode < IW_MODE_AUTO) || (priv->iw_mode > 376 IW_MODE_MONITOR)); 377 *uwrq = priv->iw_mode; 378 379 return 0; 380} 381 382/* we use DOT11_OID_EDTHRESHOLD. From what I guess the card will not try to 383 * emit data if (sensitivity > rssi - noise) (in dBm). 384 * prism54_set_sens does not seem to work. 385 */ 386 387static int 388prism54_set_sens(struct net_device *ndev, struct iw_request_info *info, 389 struct iw_param *vwrq, char *extra) 390{ 391 islpci_private *priv = netdev_priv(ndev); 392 u32 sens; 393 394 /* by default the card sets this to 20. */ 395 sens = vwrq->disabled ? 20 : vwrq->value; 396 397 return mgt_set_request(priv, DOT11_OID_EDTHRESHOLD, 0, &sens); 398} 399 400static int 401prism54_get_sens(struct net_device *ndev, struct iw_request_info *info, 402 struct iw_param *vwrq, char *extra) 403{ 404 islpci_private *priv = netdev_priv(ndev); 405 union oid_res_t r; 406 int rvalue; 407 408 rvalue = mgt_get_request(priv, DOT11_OID_EDTHRESHOLD, 0, NULL, &r); 409 410 vwrq->value = r.u; 411 vwrq->disabled = (vwrq->value == 0); 412 vwrq->fixed = 1; 413 414 return rvalue; 415} 416 417static int 418prism54_get_range(struct net_device *ndev, struct iw_request_info *info, 419 struct iw_point *dwrq, char *extra) 420{ 421 struct iw_range *range = (struct iw_range *) extra; 422 islpci_private *priv = netdev_priv(ndev); 423 u8 *data; 424 int i, m, rvalue; 425 struct obj_frequencies *freq; 426 union oid_res_t r; 427 428 memset(range, 0, sizeof (struct iw_range)); 429 dwrq->length = sizeof (struct iw_range); 430 431 /* set the wireless extension version number */ 432 range->we_version_source = SUPPORTED_WIRELESS_EXT; 433 range->we_version_compiled = WIRELESS_EXT; 434 435 /* Now the encoding capabilities */ 436 range->num_encoding_sizes = 3; 437 /* 64(40) bits WEP */ 438 range->encoding_size[0] = 5; 439 /* 128(104) bits WEP */ 440 range->encoding_size[1] = 13; 441 /* 256 bits for WPA-PSK */ 442 range->encoding_size[2] = 32; 443 /* 4 keys are allowed */ 444 range->max_encoding_tokens = 4; 445 446 /* we don't know the quality range... */ 447 range->max_qual.level = 0; 448 range->max_qual.noise = 0; 449 range->max_qual.qual = 0; 450 /* these value describe an average quality. Needs more tweaking... */ 451 range->avg_qual.level = -80; /* -80 dBm */ 452 range->avg_qual.noise = 0; /* don't know what to put here */ 453 range->avg_qual.qual = 0; 454 455 range->sensitivity = 200; 456 457 /* retry limit capabilities */ 458 range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME; 459 range->retry_flags = IW_RETRY_LIMIT; 460 range->r_time_flags = IW_RETRY_LIFETIME; 461 462 /* I don't know the range. Put stupid things here */ 463 range->min_retry = 1; 464 range->max_retry = 65535; 465 range->min_r_time = 1024; 466 range->max_r_time = 65535 * 1024; 467 468 /* txpower is supported in dBm's */ 469 range->txpower_capa = IW_TXPOW_DBM; 470 471 /* Event capability (kernel + driver) */ 472 range->event_capa[0] = (IW_EVENT_CAPA_K_0 | 473 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) | 474 IW_EVENT_CAPA_MASK(SIOCGIWAP)); 475 range->event_capa[1] = IW_EVENT_CAPA_K_1; 476 range->event_capa[4] = IW_EVENT_CAPA_MASK(IWEVCUSTOM); 477 478 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 | 479 IW_ENC_CAPA_CIPHER_TKIP; 480 481 if (islpci_get_state(priv) < PRV_STATE_INIT) 482 return 0; 483 484 /* Request the device for the supported frequencies 485 * not really relevant since some devices will report the 5 GHz band 486 * frequencies even if they don't support them. 487 */ 488 rvalue = 489 mgt_get_request(priv, DOT11_OID_SUPPORTEDFREQUENCIES, 0, NULL, &r); 490 freq = r.ptr; 491 492 range->num_channels = freq->nr; 493 range->num_frequency = freq->nr; 494 495 m = min(IW_MAX_FREQUENCIES, (int) freq->nr); 496 for (i = 0; i < m; i++) { 497 range->freq[i].m = freq->mhz[i]; 498 range->freq[i].e = 6; 499 range->freq[i].i = channel_of_freq(freq->mhz[i]); 500 } 501 kfree(freq); 502 503 rvalue |= mgt_get_request(priv, DOT11_OID_SUPPORTEDRATES, 0, NULL, &r); 504 data = r.ptr; 505 506 /* We got an array of char. It is NULL terminated. */ 507 i = 0; 508 while ((i < IW_MAX_BITRATES) && (*data != 0)) { 509 /* the result must be in bps. The card gives us 500Kbps */ 510 range->bitrate[i] = *data * 500000; 511 i++; 512 data++; 513 } 514 range->num_bitrates = i; 515 kfree(r.ptr); 516 517 return rvalue; 518} 519 520/* Set AP address*/ 521 522static int 523prism54_set_wap(struct net_device *ndev, struct iw_request_info *info, 524 struct sockaddr *awrq, char *extra) 525{ 526 islpci_private *priv = netdev_priv(ndev); 527 char bssid[6]; 528 int rvalue; 529 530 if (awrq->sa_family != ARPHRD_ETHER) 531 return -EINVAL; 532 533 /* prepare the structure for the set object */ 534 memcpy(&bssid[0], awrq->sa_data, ETH_ALEN); 535 536 /* set the bssid -- does this make sense when in AP mode? */ 537 rvalue = mgt_set_request(priv, DOT11_OID_BSSID, 0, &bssid); 538 539 return (rvalue ? rvalue : -EINPROGRESS); /* Call commit handler */ 540} 541 542/* get AP address*/ 543 544static int 545prism54_get_wap(struct net_device *ndev, struct iw_request_info *info, 546 struct sockaddr *awrq, char *extra) 547{ 548 islpci_private *priv = netdev_priv(ndev); 549 union oid_res_t r; 550 int rvalue; 551 552 rvalue = mgt_get_request(priv, DOT11_OID_BSSID, 0, NULL, &r); 553 memcpy(awrq->sa_data, r.ptr, ETH_ALEN); 554 awrq->sa_family = ARPHRD_ETHER; 555 kfree(r.ptr); 556 557 return rvalue; 558} 559 560static int 561prism54_set_scan(struct net_device *dev, struct iw_request_info *info, 562 struct iw_param *vwrq, char *extra) 563{ 564 /* hehe the device does this automagicaly */ 565 return 0; 566} 567 568/* a little helper that will translate our data into a card independent 569 * format that the Wireless Tools will understand. This was inspired by 570 * the "Aironet driver for 4500 and 4800 series cards" (GPL) 571 */ 572 573static char * 574prism54_translate_bss(struct net_device *ndev, struct iw_request_info *info, 575 char *current_ev, char *end_buf, struct obj_bss *bss, 576 char noise) 577{ 578 struct iw_event iwe; /* Temporary buffer */ 579 short cap; 580 islpci_private *priv = netdev_priv(ndev); 581 u8 wpa_ie[MAX_WPA_IE_LEN]; 582 size_t wpa_ie_len; 583 584 /* The first entry must be the MAC address */ 585 memcpy(iwe.u.ap_addr.sa_data, bss->address, ETH_ALEN); 586 iwe.u.ap_addr.sa_family = ARPHRD_ETHER; 587 iwe.cmd = SIOCGIWAP; 588 current_ev = iwe_stream_add_event(info, current_ev, end_buf, 589 &iwe, IW_EV_ADDR_LEN); 590 591 /* The following entries will be displayed in the same order we give them */ 592 593 /* The ESSID. */ 594 iwe.u.data.length = bss->ssid.length; 595 iwe.u.data.flags = 1; 596 iwe.cmd = SIOCGIWESSID; 597 current_ev = iwe_stream_add_point(info, current_ev, end_buf, 598 &iwe, bss->ssid.octets); 599 600 /* Capabilities */ 601#define CAP_ESS 0x01 602#define CAP_IBSS 0x02 603#define CAP_CRYPT 0x10 604 605 /* Mode */ 606 cap = bss->capinfo; 607 iwe.u.mode = 0; 608 if (cap & CAP_ESS) 609 iwe.u.mode = IW_MODE_MASTER; 610 else if (cap & CAP_IBSS) 611 iwe.u.mode = IW_MODE_ADHOC; 612 iwe.cmd = SIOCGIWMODE; 613 if (iwe.u.mode) 614 current_ev = iwe_stream_add_event(info, current_ev, end_buf, 615 &iwe, IW_EV_UINT_LEN); 616 617 /* Encryption capability */ 618 if (cap & CAP_CRYPT) 619 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; 620 else 621 iwe.u.data.flags = IW_ENCODE_DISABLED; 622 iwe.u.data.length = 0; 623 iwe.cmd = SIOCGIWENCODE; 624 current_ev = iwe_stream_add_point(info, current_ev, end_buf, 625 &iwe, NULL); 626 627 /* Add frequency. (short) bss->channel is the frequency in MHz */ 628 iwe.u.freq.m = bss->channel; 629 iwe.u.freq.e = 6; 630 iwe.cmd = SIOCGIWFREQ; 631 current_ev = iwe_stream_add_event(info, current_ev, end_buf, 632 &iwe, IW_EV_FREQ_LEN); 633 634 /* Add quality statistics */ 635 iwe.u.qual.level = bss->rssi; 636 iwe.u.qual.noise = noise; 637 /* do a simple SNR for quality */ 638 iwe.u.qual.qual = bss->rssi - noise; 639 iwe.cmd = IWEVQUAL; 640 current_ev = iwe_stream_add_event(info, current_ev, end_buf, 641 &iwe, IW_EV_QUAL_LEN); 642 643 /* Add WPA/RSN Information Element, if any */ 644 wpa_ie_len = prism54_wpa_bss_ie_get(priv, bss->address, wpa_ie); 645 if (wpa_ie_len > 0) { 646 iwe.cmd = IWEVGENIE; 647 iwe.u.data.length = min_t(size_t, wpa_ie_len, MAX_WPA_IE_LEN); 648 current_ev = iwe_stream_add_point(info, current_ev, end_buf, 649 &iwe, wpa_ie); 650 } 651 /* Do the bitrates */ 652 { 653 char *current_val = current_ev + iwe_stream_lcp_len(info); 654 int i; 655 int mask; 656 657 iwe.cmd = SIOCGIWRATE; 658 /* Those two flags are ignored... */ 659 iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0; 660 661 /* Parse the bitmask */ 662 mask = 0x1; 663 for(i = 0; i < sizeof(scan_rate_list); i++) { 664 if(bss->rates & mask) { 665 iwe.u.bitrate.value = (scan_rate_list[i] * 500000); 666 current_val = iwe_stream_add_value( 667 info, current_ev, current_val, 668 end_buf, &iwe, IW_EV_PARAM_LEN); 669 } 670 mask <<= 1; 671 } 672 /* Check if we added any event */ 673 if ((current_val - current_ev) > iwe_stream_lcp_len(info)) 674 current_ev = current_val; 675 } 676 677 return current_ev; 678} 679 680static int 681prism54_get_scan(struct net_device *ndev, struct iw_request_info *info, 682 struct iw_point *dwrq, char *extra) 683{ 684 islpci_private *priv = netdev_priv(ndev); 685 int i, rvalue; 686 struct obj_bsslist *bsslist; 687 u32 noise = 0; 688 char *current_ev = extra; 689 union oid_res_t r; 690 691 if (islpci_get_state(priv) < PRV_STATE_INIT) { 692 /* device is not ready, fail gently */ 693 dwrq->length = 0; 694 return 0; 695 } 696 697 /* first get the noise value. We will use it to report the link quality */ 698 rvalue = mgt_get_request(priv, DOT11_OID_NOISEFLOOR, 0, NULL, &r); 699 noise = r.u; 700 701 /* Ask the device for a list of known bss. 702 * The old API, using SIOCGIWAPLIST, had a hard limit of IW_MAX_AP=64. 703 * The new API, using SIOCGIWSCAN, is only limited by the buffer size. 704 * WE-14->WE-16, the buffer is limited to IW_SCAN_MAX_DATA bytes. 705 * Starting with WE-17, the buffer can be as big as needed. 706 * But the device won't repport anything if you change the value 707 * of IWMAX_BSS=24. */ 708 709 rvalue |= mgt_get_request(priv, DOT11_OID_BSSLIST, 0, NULL, &r); 710 bsslist = r.ptr; 711 712 /* ok now, scan the list and translate its info */ 713 for (i = 0; i < (int) bsslist->nr; i++) { 714 current_ev = prism54_translate_bss(ndev, info, current_ev, 715 extra + dwrq->length, 716 &(bsslist->bsslist[i]), 717 noise); 718 719 /* Check if there is space for one more entry */ 720 if((extra + dwrq->length - current_ev) <= IW_EV_ADDR_LEN) { 721 /* Ask user space to try again with a bigger buffer */ 722 rvalue = -E2BIG; 723 break; 724 } 725 } 726 727 kfree(bsslist); 728 dwrq->length = (current_ev - extra); 729 dwrq->flags = 0; /* todo */ 730 731 return rvalue; 732} 733 734static int 735prism54_set_essid(struct net_device *ndev, struct iw_request_info *info, 736 struct iw_point *dwrq, char *extra) 737{ 738 islpci_private *priv = netdev_priv(ndev); 739 struct obj_ssid essid; 740 741 memset(essid.octets, 0, 33); 742 743 /* Check if we were asked for `any' */ 744 if (dwrq->flags && dwrq->length) { 745 if (dwrq->length > 32) 746 return -E2BIG; 747 essid.length = dwrq->length; 748 memcpy(essid.octets, extra, dwrq->length); 749 } else 750 essid.length = 0; 751 752 if (priv->iw_mode != IW_MODE_MONITOR) 753 return mgt_set_request(priv, DOT11_OID_SSID, 0, &essid); 754 755 /* If in monitor mode, just save to mib */ 756 mgt_set(priv, DOT11_OID_SSID, &essid); 757 return 0; 758 759} 760 761static int 762prism54_get_essid(struct net_device *ndev, struct iw_request_info *info, 763 struct iw_point *dwrq, char *extra) 764{ 765 islpci_private *priv = netdev_priv(ndev); 766 struct obj_ssid *essid; 767 union oid_res_t r; 768 int rvalue; 769 770 rvalue = mgt_get_request(priv, DOT11_OID_SSID, 0, NULL, &r); 771 essid = r.ptr; 772 773 if (essid->length) { 774 dwrq->flags = 1; /* set ESSID to ON for Wireless Extensions */ 775 /* if it is too big, trunk it */ 776 dwrq->length = min((u8)IW_ESSID_MAX_SIZE, essid->length); 777 } else { 778 dwrq->flags = 0; 779 dwrq->length = 0; 780 } 781 essid->octets[dwrq->length] = '\0'; 782 memcpy(extra, essid->octets, dwrq->length); 783 kfree(essid); 784 785 return rvalue; 786} 787 788/* Provides no functionality, just completes the ioctl. In essence this is a 789 * just a cosmetic ioctl. 790 */ 791static int 792prism54_set_nick(struct net_device *ndev, struct iw_request_info *info, 793 struct iw_point *dwrq, char *extra) 794{ 795 islpci_private *priv = netdev_priv(ndev); 796 797 if (dwrq->length > IW_ESSID_MAX_SIZE) 798 return -E2BIG; 799 800 down_write(&priv->mib_sem); 801 memset(priv->nickname, 0, sizeof (priv->nickname)); 802 memcpy(priv->nickname, extra, dwrq->length); 803 up_write(&priv->mib_sem); 804 805 return 0; 806} 807 808static int 809prism54_get_nick(struct net_device *ndev, struct iw_request_info *info, 810 struct iw_point *dwrq, char *extra) 811{ 812 islpci_private *priv = netdev_priv(ndev); 813 814 dwrq->length = 0; 815 816 down_read(&priv->mib_sem); 817 dwrq->length = strlen(priv->nickname); 818 memcpy(extra, priv->nickname, dwrq->length); 819 up_read(&priv->mib_sem); 820 821 return 0; 822} 823 824/* Set the allowed Bitrates */ 825 826static int 827prism54_set_rate(struct net_device *ndev, 828 struct iw_request_info *info, 829 struct iw_param *vwrq, char *extra) 830{ 831 832 islpci_private *priv = netdev_priv(ndev); 833 u32 rate, profile; 834 char *data; 835 int ret, i; 836 union oid_res_t r; 837 838 if (vwrq->value == -1) { 839 /* auto mode. No limit. */ 840 profile = 1; 841 return mgt_set_request(priv, DOT11_OID_PROFILES, 0, &profile); 842 } 843 844 ret = mgt_get_request(priv, DOT11_OID_SUPPORTEDRATES, 0, NULL, &r); 845 if (ret) { 846 kfree(r.ptr); 847 return ret; 848 } 849 850 rate = (u32) (vwrq->value / 500000); 851 data = r.ptr; 852 i = 0; 853 854 while (data[i]) { 855 if (rate && (data[i] == rate)) { 856 break; 857 } 858 if (vwrq->value == i) { 859 break; 860 } 861 data[i] |= 0x80; 862 i++; 863 } 864 865 if (!data[i]) { 866 kfree(r.ptr); 867 return -EINVAL; 868 } 869 870 data[i] |= 0x80; 871 data[i + 1] = 0; 872 873 /* Now, check if we want a fixed or auto value */ 874 if (vwrq->fixed) { 875 data[0] = data[i]; 876 data[1] = 0; 877 } 878 879/* 880 i = 0; 881 printk("prism54 rate: "); 882 while(data[i]) { 883 printk("%u ", data[i]); 884 i++; 885 } 886 printk("0\n"); 887*/ 888 profile = -1; 889 ret = mgt_set_request(priv, DOT11_OID_PROFILES, 0, &profile); 890 ret |= mgt_set_request(priv, DOT11_OID_EXTENDEDRATES, 0, data); 891 ret |= mgt_set_request(priv, DOT11_OID_RATES, 0, data); 892 893 kfree(r.ptr); 894 895 return ret; 896} 897 898/* Get the current bit rate */ 899static int 900prism54_get_rate(struct net_device *ndev, 901 struct iw_request_info *info, 902 struct iw_param *vwrq, char *extra) 903{ 904 islpci_private *priv = netdev_priv(ndev); 905 int rvalue; 906 char *data; 907 union oid_res_t r; 908 909 /* Get the current bit rate */ 910 if ((rvalue = mgt_get_request(priv, GEN_OID_LINKSTATE, 0, NULL, &r))) 911 return rvalue; 912 vwrq->value = r.u * 500000; 913 914 /* request the device for the enabled rates */ 915 rvalue = mgt_get_request(priv, DOT11_OID_RATES, 0, NULL, &r); 916 if (rvalue) { 917 kfree(r.ptr); 918 return rvalue; 919 } 920 data = r.ptr; 921 vwrq->fixed = (data[0] != 0) && (data[1] == 0); 922 kfree(r.ptr); 923 924 return 0; 925} 926 927static int 928prism54_set_rts(struct net_device *ndev, struct iw_request_info *info, 929 struct iw_param *vwrq, char *extra) 930{ 931 islpci_private *priv = netdev_priv(ndev); 932 933 return mgt_set_request(priv, DOT11_OID_RTSTHRESH, 0, &vwrq->value); 934} 935 936static int 937prism54_get_rts(struct net_device *ndev, struct iw_request_info *info, 938 struct iw_param *vwrq, char *extra) 939{ 940 islpci_private *priv = netdev_priv(ndev); 941 union oid_res_t r; 942 int rvalue; 943 944 /* get the rts threshold */ 945 rvalue = mgt_get_request(priv, DOT11_OID_RTSTHRESH, 0, NULL, &r); 946 vwrq->value = r.u; 947 948 return rvalue; 949} 950 951static int 952prism54_set_frag(struct net_device *ndev, struct iw_request_info *info, 953 struct iw_param *vwrq, char *extra) 954{ 955 islpci_private *priv = netdev_priv(ndev); 956 957 return mgt_set_request(priv, DOT11_OID_FRAGTHRESH, 0, &vwrq->value); 958} 959 960static int 961prism54_get_frag(struct net_device *ndev, struct iw_request_info *info, 962 struct iw_param *vwrq, char *extra) 963{ 964 islpci_private *priv = netdev_priv(ndev); 965 union oid_res_t r; 966 int rvalue; 967 968 rvalue = mgt_get_request(priv, DOT11_OID_FRAGTHRESH, 0, NULL, &r); 969 vwrq->value = r.u; 970 971 return rvalue; 972} 973 974/* Here we have (min,max) = max retries for (small frames, big frames). Where 975 * big frame <=> bigger than the rts threshold 976 * small frame <=> smaller than the rts threshold 977 * This is not really the behavior expected by the wireless tool but it seems 978 * to be a common behavior in other drivers. 979 */ 980 981static int 982prism54_set_retry(struct net_device *ndev, struct iw_request_info *info, 983 struct iw_param *vwrq, char *extra) 984{ 985 islpci_private *priv = netdev_priv(ndev); 986 u32 slimit = 0, llimit = 0; /* short and long limit */ 987 u32 lifetime = 0; 988 int rvalue = 0; 989 990 if (vwrq->disabled) 991 /* we cannot disable this feature */ 992 return -EINVAL; 993 994 if (vwrq->flags & IW_RETRY_LIMIT) { 995 if (vwrq->flags & IW_RETRY_SHORT) 996 slimit = vwrq->value; 997 else if (vwrq->flags & IW_RETRY_LONG) 998 llimit = vwrq->value; 999 else { 1000 /* we are asked to set both */ 1001 slimit = vwrq->value; 1002 llimit = vwrq->value; 1003 } 1004 } 1005 if (vwrq->flags & IW_RETRY_LIFETIME) 1006 /* Wireless tools use us unit while the device uses 1024 us unit */ 1007 lifetime = vwrq->value / 1024; 1008 1009 /* now set what is requested */ 1010 if (slimit) 1011 rvalue = 1012 mgt_set_request(priv, DOT11_OID_SHORTRETRIES, 0, &slimit); 1013 if (llimit) 1014 rvalue |= 1015 mgt_set_request(priv, DOT11_OID_LONGRETRIES, 0, &llimit); 1016 if (lifetime) 1017 rvalue |= 1018 mgt_set_request(priv, DOT11_OID_MAXTXLIFETIME, 0, 1019 &lifetime); 1020 return rvalue; 1021} 1022 1023static int 1024prism54_get_retry(struct net_device *ndev, struct iw_request_info *info, 1025 struct iw_param *vwrq, char *extra) 1026{ 1027 islpci_private *priv = netdev_priv(ndev); 1028 union oid_res_t r; 1029 int rvalue = 0; 1030 vwrq->disabled = 0; /* It cannot be disabled */ 1031 1032 if ((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) { 1033 /* we are asked for the life time */ 1034 rvalue = 1035 mgt_get_request(priv, DOT11_OID_MAXTXLIFETIME, 0, NULL, &r); 1036 vwrq->value = r.u * 1024; 1037 vwrq->flags = IW_RETRY_LIFETIME; 1038 } else if ((vwrq->flags & IW_RETRY_LONG)) { 1039 /* we are asked for the long retry limit */ 1040 rvalue |= 1041 mgt_get_request(priv, DOT11_OID_LONGRETRIES, 0, NULL, &r); 1042 vwrq->value = r.u; 1043 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG; 1044 } else { 1045 /* default. get the short retry limit */ 1046 rvalue |= 1047 mgt_get_request(priv, DOT11_OID_SHORTRETRIES, 0, NULL, &r); 1048 vwrq->value = r.u; 1049 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_SHORT; 1050 } 1051 1052 return rvalue; 1053} 1054 1055static int 1056prism54_set_encode(struct net_device *ndev, struct iw_request_info *info, 1057 struct iw_point *dwrq, char *extra) 1058{ 1059 islpci_private *priv = netdev_priv(ndev); 1060 int rvalue = 0, force = 0; 1061 int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0; 1062 union oid_res_t r; 1063 1064 /* with the new API, it's impossible to get a NULL pointer. 1065 * New version of iwconfig set the IW_ENCODE_NOKEY flag 1066 * when no key is given, but older versions don't. */ 1067 1068 if (dwrq->length > 0) { 1069 /* we have a key to set */ 1070 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1; 1071 int current_index; 1072 struct obj_key key = { DOT11_PRIV_WEP, 0, "" }; 1073 1074 /* get the current key index */ 1075 rvalue = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r); 1076 current_index = r.u; 1077 /* Verify that the key is not marked as invalid */ 1078 if (!(dwrq->flags & IW_ENCODE_NOKEY)) { 1079 if (dwrq->length > KEY_SIZE_TKIP) { 1080 /* User-provided key data too big */ 1081 return -EINVAL; 1082 } 1083 if (dwrq->length > KEY_SIZE_WEP104) { 1084 /* WPA-PSK TKIP */ 1085 key.type = DOT11_PRIV_TKIP; 1086 key.length = KEY_SIZE_TKIP; 1087 } else if (dwrq->length > KEY_SIZE_WEP40) { 1088 /* WEP 104/128 */ 1089 key.length = KEY_SIZE_WEP104; 1090 } else { 1091 /* WEP 40/64 */ 1092 key.length = KEY_SIZE_WEP40; 1093 } 1094 memset(key.key, 0, sizeof (key.key)); 1095 memcpy(key.key, extra, dwrq->length); 1096 1097 if ((index < 0) || (index > 3)) 1098 /* no index provided use the current one */ 1099 index = current_index; 1100 1101 /* now send the key to the card */ 1102 rvalue |= 1103 mgt_set_request(priv, DOT11_OID_DEFKEYX, index, 1104 &key); 1105 } 1106 /* 1107 * If a valid key is set, encryption should be enabled 1108 * (user may turn it off later). 1109 * This is also how "iwconfig ethX key on" works 1110 */ 1111 if ((index == current_index) && (key.length > 0)) 1112 force = 1; 1113 } else { 1114 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1; 1115 if ((index >= 0) && (index <= 3)) { 1116 /* we want to set the key index */ 1117 rvalue |= 1118 mgt_set_request(priv, DOT11_OID_DEFKEYID, 0, 1119 &index); 1120 } else { 1121 if (!(dwrq->flags & IW_ENCODE_MODE)) { 1122 /* we cannot do anything. Complain. */ 1123 return -EINVAL; 1124 } 1125 } 1126 } 1127 /* now read the flags */ 1128 if (dwrq->flags & IW_ENCODE_DISABLED) { 1129 /* Encoding disabled, 1130 * authen = DOT11_AUTH_OS; 1131 * invoke = 0; 1132 * exunencrypt = 0; */ 1133 } 1134 if (dwrq->flags & IW_ENCODE_OPEN) 1135 /* Encode but accept non-encoded packets. No auth */ 1136 invoke = 1; 1137 if ((dwrq->flags & IW_ENCODE_RESTRICTED) || force) { 1138 /* Refuse non-encoded packets. Auth */ 1139 authen = DOT11_AUTH_BOTH; 1140 invoke = 1; 1141 exunencrypt = 1; 1142 } 1143 /* do the change if requested */ 1144 if ((dwrq->flags & IW_ENCODE_MODE) || force) { 1145 rvalue |= 1146 mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen); 1147 rvalue |= 1148 mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &invoke); 1149 rvalue |= 1150 mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0, 1151 &exunencrypt); 1152 } 1153 return rvalue; 1154} 1155 1156static int 1157prism54_get_encode(struct net_device *ndev, struct iw_request_info *info, 1158 struct iw_point *dwrq, char *extra) 1159{ 1160 islpci_private *priv = netdev_priv(ndev); 1161 struct obj_key *key; 1162 u32 devindex, index = (dwrq->flags & IW_ENCODE_INDEX) - 1; 1163 u32 authen = 0, invoke = 0, exunencrypt = 0; 1164 int rvalue; 1165 union oid_res_t r; 1166 1167 /* first get the flags */ 1168 rvalue = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r); 1169 authen = r.u; 1170 rvalue |= mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r); 1171 invoke = r.u; 1172 rvalue |= mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r); 1173 exunencrypt = r.u; 1174 1175 if (invoke && (authen == DOT11_AUTH_BOTH) && exunencrypt) 1176 dwrq->flags = IW_ENCODE_RESTRICTED; 1177 else if ((authen == DOT11_AUTH_OS) && !exunencrypt) { 1178 if (invoke) 1179 dwrq->flags = IW_ENCODE_OPEN; 1180 else 1181 dwrq->flags = IW_ENCODE_DISABLED; 1182 } else 1183 /* The card should not work in this state */ 1184 dwrq->flags = 0; 1185 1186 /* get the current device key index */ 1187 rvalue |= mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r); 1188 devindex = r.u; 1189 /* Now get the key, return it */ 1190 if (index == -1 || index > 3) 1191 /* no index provided, use the current one */ 1192 index = devindex; 1193 rvalue |= mgt_get_request(priv, DOT11_OID_DEFKEYX, index, NULL, &r); 1194 key = r.ptr; 1195 dwrq->length = key->length; 1196 memcpy(extra, key->key, dwrq->length); 1197 kfree(key); 1198 /* return the used key index */ 1199 dwrq->flags |= devindex + 1; 1200 1201 return rvalue; 1202} 1203 1204static int 1205prism54_get_txpower(struct net_device *ndev, struct iw_request_info *info, 1206 struct iw_param *vwrq, char *extra) 1207{ 1208 islpci_private *priv = netdev_priv(ndev); 1209 union oid_res_t r; 1210 int rvalue; 1211 1212 rvalue = mgt_get_request(priv, OID_INL_OUTPUTPOWER, 0, NULL, &r); 1213 /* intersil firmware operates in 0.25 dBm (1/4 dBm) */ 1214 vwrq->value = (s32) r.u / 4; 1215 vwrq->fixed = 1; 1216 /* radio is not turned of 1217 * btw: how is possible to turn off only the radio 1218 */ 1219 vwrq->disabled = 0; 1220 1221 return rvalue; 1222} 1223 1224static int 1225prism54_set_txpower(struct net_device *ndev, struct iw_request_info *info, 1226 struct iw_param *vwrq, char *extra) 1227{ 1228 islpci_private *priv = netdev_priv(ndev); 1229 s32 u = vwrq->value; 1230 1231 /* intersil firmware operates in 0.25 dBm (1/4) */ 1232 u *= 4; 1233 if (vwrq->disabled) { 1234 /* don't know how to disable radio */ 1235 printk(KERN_DEBUG 1236 "%s: %s() disabling radio is not yet supported.\n", 1237 priv->ndev->name, __func__); 1238 return -ENOTSUPP; 1239 } else if (vwrq->fixed) 1240 /* currently only fixed value is supported */ 1241 return mgt_set_request(priv, OID_INL_OUTPUTPOWER, 0, &u); 1242 else { 1243 printk(KERN_DEBUG 1244 "%s: %s() auto power will be implemented later.\n", 1245 priv->ndev->name, __func__); 1246 return -ENOTSUPP; 1247 } 1248} 1249 1250static int prism54_set_genie(struct net_device *ndev, 1251 struct iw_request_info *info, 1252 struct iw_point *data, char *extra) 1253{ 1254 islpci_private *priv = netdev_priv(ndev); 1255 int alen, ret = 0; 1256 struct obj_attachment *attach; 1257 1258 if (data->length > MAX_WPA_IE_LEN || 1259 (data->length && extra == NULL)) 1260 return -EINVAL; 1261 1262 memcpy(priv->wpa_ie, extra, data->length); 1263 priv->wpa_ie_len = data->length; 1264 1265 alen = sizeof(*attach) + priv->wpa_ie_len; 1266 attach = kzalloc(alen, GFP_KERNEL); 1267 if (attach == NULL) 1268 return -ENOMEM; 1269 1270#define WLAN_FC_TYPE_MGMT 0 1271#define WLAN_FC_STYPE_ASSOC_REQ 0 1272#define WLAN_FC_STYPE_REASSOC_REQ 2 1273 1274 /* Note: endianness is covered by mgt_set_varlen */ 1275 attach->type = (WLAN_FC_TYPE_MGMT << 2) | 1276 (WLAN_FC_STYPE_ASSOC_REQ << 4); 1277 attach->id = -1; 1278 attach->size = priv->wpa_ie_len; 1279 memcpy(attach->data, extra, priv->wpa_ie_len); 1280 1281 ret = mgt_set_varlen(priv, DOT11_OID_ATTACHMENT, attach, 1282 priv->wpa_ie_len); 1283 if (ret == 0) { 1284 attach->type = (WLAN_FC_TYPE_MGMT << 2) | 1285 (WLAN_FC_STYPE_REASSOC_REQ << 4); 1286 1287 ret = mgt_set_varlen(priv, DOT11_OID_ATTACHMENT, attach, 1288 priv->wpa_ie_len); 1289 if (ret == 0) 1290 printk(KERN_DEBUG "%s: WPA IE Attachment was set\n", 1291 ndev->name); 1292 } 1293 1294 kfree(attach); 1295 return ret; 1296} 1297 1298 1299static int prism54_get_genie(struct net_device *ndev, 1300 struct iw_request_info *info, 1301 struct iw_point *data, char *extra) 1302{ 1303 islpci_private *priv = netdev_priv(ndev); 1304 int len = priv->wpa_ie_len; 1305 1306 if (len <= 0) { 1307 data->length = 0; 1308 return 0; 1309 } 1310 1311 if (data->length < len) 1312 return -E2BIG; 1313 1314 data->length = len; 1315 memcpy(extra, priv->wpa_ie, len); 1316 1317 return 0; 1318} 1319 1320static int prism54_set_auth(struct net_device *ndev, 1321 struct iw_request_info *info, 1322 union iwreq_data *wrqu, char *extra) 1323{ 1324 islpci_private *priv = netdev_priv(ndev); 1325 struct iw_param *param = &wrqu->param; 1326 u32 mlmelevel = 0, authen = 0, dot1x = 0; 1327 u32 exunencrypt = 0, privinvoked = 0, wpa = 0; 1328 u32 old_wpa; 1329 int ret = 0; 1330 union oid_res_t r; 1331 1332 if (islpci_get_state(priv) < PRV_STATE_INIT) 1333 return 0; 1334 1335 /* first get the flags */ 1336 down_write(&priv->mib_sem); 1337 wpa = old_wpa = priv->wpa; 1338 up_write(&priv->mib_sem); 1339 ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r); 1340 authen = r.u; 1341 ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r); 1342 privinvoked = r.u; 1343 ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r); 1344 exunencrypt = r.u; 1345 ret = mgt_get_request(priv, DOT11_OID_DOT1XENABLE, 0, NULL, &r); 1346 dot1x = r.u; 1347 ret = mgt_get_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, NULL, &r); 1348 mlmelevel = r.u; 1349 1350 if (ret < 0) 1351 goto out; 1352 1353 switch (param->flags & IW_AUTH_INDEX) { 1354 case IW_AUTH_CIPHER_PAIRWISE: 1355 case IW_AUTH_CIPHER_GROUP: 1356 case IW_AUTH_KEY_MGMT: 1357 break; 1358 1359 case IW_AUTH_WPA_ENABLED: 1360 /* Do the same thing as IW_AUTH_WPA_VERSION */ 1361 if (param->value) { 1362 wpa = 1; 1363 privinvoked = 1; /* For privacy invoked */ 1364 exunencrypt = 1; /* Filter out all unencrypted frames */ 1365 dot1x = 0x01; /* To enable eap filter */ 1366 mlmelevel = DOT11_MLME_EXTENDED; 1367 authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */ 1368 } else { 1369 wpa = 0; 1370 privinvoked = 0; 1371 exunencrypt = 0; /* Do not filter un-encrypted data */ 1372 dot1x = 0; 1373 mlmelevel = DOT11_MLME_AUTO; 1374 } 1375 break; 1376 1377 case IW_AUTH_WPA_VERSION: 1378 if (param->value & IW_AUTH_WPA_VERSION_DISABLED) { 1379 wpa = 0; 1380 privinvoked = 0; 1381 exunencrypt = 0; /* Do not filter un-encrypted data */ 1382 dot1x = 0; 1383 mlmelevel = DOT11_MLME_AUTO; 1384 } else { 1385 if (param->value & IW_AUTH_WPA_VERSION_WPA) 1386 wpa = 1; 1387 else if (param->value & IW_AUTH_WPA_VERSION_WPA2) 1388 wpa = 2; 1389 privinvoked = 1; /* For privacy invoked */ 1390 exunencrypt = 1; /* Filter out all unencrypted frames */ 1391 dot1x = 0x01; /* To enable eap filter */ 1392 mlmelevel = DOT11_MLME_EXTENDED; 1393 authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */ 1394 } 1395 break; 1396 1397 case IW_AUTH_RX_UNENCRYPTED_EAPOL: 1398 /* dot1x should be the opposite of RX_UNENCRYPTED_EAPOL; 1399 * turn off dot1x when allowing receipt of unencrypted EAPOL 1400 * frames, turn on dot1x when receipt should be disallowed 1401 */ 1402 dot1x = param->value ? 0 : 0x01; 1403 break; 1404 1405 case IW_AUTH_PRIVACY_INVOKED: 1406 privinvoked = param->value ? 1 : 0; 1407 break; 1408 1409 case IW_AUTH_DROP_UNENCRYPTED: 1410 exunencrypt = param->value ? 1 : 0; 1411 break; 1412 1413 case IW_AUTH_80211_AUTH_ALG: 1414 if (param->value & IW_AUTH_ALG_SHARED_KEY) { 1415 /* Only WEP uses _SK and _BOTH */ 1416 if (wpa > 0) { 1417 ret = -EINVAL; 1418 goto out; 1419 } 1420 authen = DOT11_AUTH_SK; 1421 } else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM) { 1422 authen = DOT11_AUTH_OS; 1423 } else { 1424 ret = -EINVAL; 1425 goto out; 1426 } 1427 break; 1428 1429 default: 1430 return -EOPNOTSUPP; 1431 } 1432 1433 /* Set all the values */ 1434 down_write(&priv->mib_sem); 1435 priv->wpa = wpa; 1436 up_write(&priv->mib_sem); 1437 mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen); 1438 mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &privinvoked); 1439 mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0, &exunencrypt); 1440 mgt_set_request(priv, DOT11_OID_DOT1XENABLE, 0, &dot1x); 1441 mgt_set_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, &mlmelevel); 1442 1443out: 1444 return ret; 1445} 1446 1447static int prism54_get_auth(struct net_device *ndev, 1448 struct iw_request_info *info, 1449 union iwreq_data *wrqu, char *extra) 1450{ 1451 islpci_private *priv = netdev_priv(ndev); 1452 struct iw_param *param = &wrqu->param; 1453 u32 wpa = 0; 1454 int ret = 0; 1455 union oid_res_t r; 1456 1457 if (islpci_get_state(priv) < PRV_STATE_INIT) 1458 return 0; 1459 1460 /* first get the flags */ 1461 down_write(&priv->mib_sem); 1462 wpa = priv->wpa; 1463 up_write(&priv->mib_sem); 1464 1465 switch (param->flags & IW_AUTH_INDEX) { 1466 case IW_AUTH_CIPHER_PAIRWISE: 1467 case IW_AUTH_CIPHER_GROUP: 1468 case IW_AUTH_KEY_MGMT: 1469 /* 1470 * wpa_supplicant will control these internally 1471 */ 1472 ret = -EOPNOTSUPP; 1473 break; 1474 1475 case IW_AUTH_WPA_VERSION: 1476 switch (wpa) { 1477 case 1: 1478 param->value = IW_AUTH_WPA_VERSION_WPA; 1479 break; 1480 case 2: 1481 param->value = IW_AUTH_WPA_VERSION_WPA2; 1482 break; 1483 case 0: 1484 default: 1485 param->value = IW_AUTH_WPA_VERSION_DISABLED; 1486 break; 1487 } 1488 break; 1489 1490 case IW_AUTH_DROP_UNENCRYPTED: 1491 ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r); 1492 if (ret >= 0) 1493 param->value = r.u > 0 ? 1 : 0; 1494 break; 1495 1496 case IW_AUTH_80211_AUTH_ALG: 1497 ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r); 1498 if (ret >= 0) { 1499 switch (r.u) { 1500 case DOT11_AUTH_OS: 1501 param->value = IW_AUTH_ALG_OPEN_SYSTEM; 1502 break; 1503 case DOT11_AUTH_BOTH: 1504 case DOT11_AUTH_SK: 1505 param->value = IW_AUTH_ALG_SHARED_KEY; 1506 break; 1507 case DOT11_AUTH_NONE: 1508 default: 1509 param->value = 0; 1510 break; 1511 } 1512 } 1513 break; 1514 1515 case IW_AUTH_WPA_ENABLED: 1516 param->value = wpa > 0 ? 1 : 0; 1517 break; 1518 1519 case IW_AUTH_RX_UNENCRYPTED_EAPOL: 1520 ret = mgt_get_request(priv, DOT11_OID_DOT1XENABLE, 0, NULL, &r); 1521 if (ret >= 0) 1522 param->value = r.u > 0 ? 1 : 0; 1523 break; 1524 1525 case IW_AUTH_PRIVACY_INVOKED: 1526 ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r); 1527 if (ret >= 0) 1528 param->value = r.u > 0 ? 1 : 0; 1529 break; 1530 1531 default: 1532 return -EOPNOTSUPP; 1533 } 1534 return ret; 1535} 1536 1537static int prism54_set_encodeext(struct net_device *ndev, 1538 struct iw_request_info *info, 1539 union iwreq_data *wrqu, 1540 char *extra) 1541{ 1542 islpci_private *priv = netdev_priv(ndev); 1543 struct iw_point *encoding = &wrqu->encoding; 1544 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra; 1545 int idx, alg = ext->alg, set_key = 1; 1546 union oid_res_t r; 1547 int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0; 1548 int ret = 0; 1549 1550 if (islpci_get_state(priv) < PRV_STATE_INIT) 1551 return 0; 1552 1553 /* Determine and validate the key index */ 1554 idx = (encoding->flags & IW_ENCODE_INDEX) - 1; 1555 if (idx) { 1556 if (idx < 0 || idx > 3) 1557 return -EINVAL; 1558 } else { 1559 ret = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r); 1560 if (ret < 0) 1561 goto out; 1562 idx = r.u; 1563 } 1564 1565 if (encoding->flags & IW_ENCODE_DISABLED) 1566 alg = IW_ENCODE_ALG_NONE; 1567 1568 if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) { 1569 /* Only set transmit key index here, actual 1570 * key is set below if needed. 1571 */ 1572 ret = mgt_set_request(priv, DOT11_OID_DEFKEYID, 0, &idx); 1573 set_key = ext->key_len > 0 ? 1 : 0; 1574 } 1575 1576 if (set_key) { 1577 struct obj_key key = { DOT11_PRIV_WEP, 0, "" }; 1578 switch (alg) { 1579 case IW_ENCODE_ALG_NONE: 1580 break; 1581 case IW_ENCODE_ALG_WEP: 1582 if (ext->key_len > KEY_SIZE_WEP104) { 1583 ret = -EINVAL; 1584 goto out; 1585 } 1586 if (ext->key_len > KEY_SIZE_WEP40) 1587 key.length = KEY_SIZE_WEP104; 1588 else 1589 key.length = KEY_SIZE_WEP40; 1590 break; 1591 case IW_ENCODE_ALG_TKIP: 1592 if (ext->key_len > KEY_SIZE_TKIP) { 1593 ret = -EINVAL; 1594 goto out; 1595 } 1596 key.type = DOT11_PRIV_TKIP; 1597 key.length = KEY_SIZE_TKIP; 1598 break; 1599 default: 1600 return -EINVAL; 1601 } 1602 1603 if (key.length) { 1604 memset(key.key, 0, sizeof(key.key)); 1605 memcpy(key.key, ext->key, ext->key_len); 1606 ret = mgt_set_request(priv, DOT11_OID_DEFKEYX, idx, 1607 &key); 1608 if (ret < 0) 1609 goto out; 1610 } 1611 } 1612 1613 /* Read the flags */ 1614 if (encoding->flags & IW_ENCODE_DISABLED) { 1615 /* Encoding disabled, 1616 * authen = DOT11_AUTH_OS; 1617 * invoke = 0; 1618 * exunencrypt = 0; */ 1619 } 1620 if (encoding->flags & IW_ENCODE_OPEN) { 1621 /* Encode but accept non-encoded packets. No auth */ 1622 invoke = 1; 1623 } 1624 if (encoding->flags & IW_ENCODE_RESTRICTED) { 1625 /* Refuse non-encoded packets. Auth */ 1626 authen = DOT11_AUTH_BOTH; 1627 invoke = 1; 1628 exunencrypt = 1; 1629 } 1630 1631 /* do the change if requested */ 1632 if (encoding->flags & IW_ENCODE_MODE) { 1633 ret = mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, 1634 &authen); 1635 ret = mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, 1636 &invoke); 1637 ret = mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0, 1638 &exunencrypt); 1639 } 1640 1641out: 1642 return ret; 1643} 1644 1645 1646static int prism54_get_encodeext(struct net_device *ndev, 1647 struct iw_request_info *info, 1648 union iwreq_data *wrqu, 1649 char *extra) 1650{ 1651 islpci_private *priv = netdev_priv(ndev); 1652 struct iw_point *encoding = &wrqu->encoding; 1653 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra; 1654 int idx, max_key_len; 1655 union oid_res_t r; 1656 int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0, wpa = 0; 1657 int ret = 0; 1658 1659 if (islpci_get_state(priv) < PRV_STATE_INIT) 1660 return 0; 1661 1662 /* first get the flags */ 1663 ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r); 1664 authen = r.u; 1665 ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r); 1666 invoke = r.u; 1667 ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r); 1668 exunencrypt = r.u; 1669 if (ret < 0) 1670 goto out; 1671 1672 max_key_len = encoding->length - sizeof(*ext); 1673 if (max_key_len < 0) 1674 return -EINVAL; 1675 1676 idx = (encoding->flags & IW_ENCODE_INDEX) - 1; 1677 if (idx) { 1678 if (idx < 0 || idx > 3) 1679 return -EINVAL; 1680 } else { 1681 ret = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r); 1682 if (ret < 0) 1683 goto out; 1684 idx = r.u; 1685 } 1686 1687 encoding->flags = idx + 1; 1688 memset(ext, 0, sizeof(*ext)); 1689 1690 switch (authen) { 1691 case DOT11_AUTH_BOTH: 1692 case DOT11_AUTH_SK: 1693 wrqu->encoding.flags |= IW_ENCODE_RESTRICTED; 1694 case DOT11_AUTH_OS: 1695 default: 1696 wrqu->encoding.flags |= IW_ENCODE_OPEN; 1697 break; 1698 } 1699 1700 down_write(&priv->mib_sem); 1701 wpa = priv->wpa; 1702 up_write(&priv->mib_sem); 1703 1704 if (authen == DOT11_AUTH_OS && !exunencrypt && !invoke && !wpa) { 1705 /* No encryption */ 1706 ext->alg = IW_ENCODE_ALG_NONE; 1707 ext->key_len = 0; 1708 wrqu->encoding.flags |= IW_ENCODE_DISABLED; 1709 } else { 1710 struct obj_key *key; 1711 1712 ret = mgt_get_request(priv, DOT11_OID_DEFKEYX, idx, NULL, &r); 1713 if (ret < 0) 1714 goto out; 1715 key = r.ptr; 1716 if (max_key_len < key->length) { 1717 ret = -E2BIG; 1718 goto out; 1719 } 1720 memcpy(ext->key, key->key, key->length); 1721 ext->key_len = key->length; 1722 1723 switch (key->type) { 1724 case DOT11_PRIV_TKIP: 1725 ext->alg = IW_ENCODE_ALG_TKIP; 1726 break; 1727 default: 1728 case DOT11_PRIV_WEP: 1729 ext->alg = IW_ENCODE_ALG_WEP; 1730 break; 1731 } 1732 wrqu->encoding.flags |= IW_ENCODE_ENABLED; 1733 } 1734 1735out: 1736 return ret; 1737} 1738 1739 1740static int 1741prism54_reset(struct net_device *ndev, struct iw_request_info *info, 1742 __u32 * uwrq, char *extra) 1743{ 1744 islpci_reset(netdev_priv(ndev), 0); 1745 1746 return 0; 1747} 1748 1749static int 1750prism54_get_oid(struct net_device *ndev, struct iw_request_info *info, 1751 struct iw_point *dwrq, char *extra) 1752{ 1753 union oid_res_t r; 1754 int rvalue; 1755 enum oid_num_t n = dwrq->flags; 1756 1757 rvalue = mgt_get_request(netdev_priv(ndev), n, 0, NULL, &r); 1758 dwrq->length = mgt_response_to_str(n, &r, extra); 1759 if ((isl_oid[n].flags & OID_FLAG_TYPE) != OID_TYPE_U32) 1760 kfree(r.ptr); 1761 return rvalue; 1762} 1763 1764static int 1765prism54_set_u32(struct net_device *ndev, struct iw_request_info *info, 1766 __u32 * uwrq, char *extra) 1767{ 1768 u32 oid = uwrq[0], u = uwrq[1]; 1769 1770 return mgt_set_request(netdev_priv(ndev), oid, 0, &u); 1771} 1772 1773static int 1774prism54_set_raw(struct net_device *ndev, struct iw_request_info *info, 1775 struct iw_point *dwrq, char *extra) 1776{ 1777 u32 oid = dwrq->flags; 1778 1779 return mgt_set_request(netdev_priv(ndev), oid, 0, extra); 1780} 1781 1782void 1783prism54_acl_init(struct islpci_acl *acl) 1784{ 1785 mutex_init(&acl->lock); 1786 INIT_LIST_HEAD(&acl->mac_list); 1787 acl->size = 0; 1788 acl->policy = MAC_POLICY_OPEN; 1789} 1790 1791static void 1792prism54_clear_mac(struct islpci_acl *acl) 1793{ 1794 struct list_head *ptr, *next; 1795 struct mac_entry *entry; 1796 1797 mutex_lock(&acl->lock); 1798 1799 if (acl->size == 0) { 1800 mutex_unlock(&acl->lock); 1801 return; 1802 } 1803 1804 for (ptr = acl->mac_list.next, next = ptr->next; 1805 ptr != &acl->mac_list; ptr = next, next = ptr->next) { 1806 entry = list_entry(ptr, struct mac_entry, _list); 1807 list_del(ptr); 1808 kfree(entry); 1809 } 1810 acl->size = 0; 1811 mutex_unlock(&acl->lock); 1812} 1813 1814void 1815prism54_acl_clean(struct islpci_acl *acl) 1816{ 1817 prism54_clear_mac(acl); 1818} 1819 1820static int 1821prism54_add_mac(struct net_device *ndev, struct iw_request_info *info, 1822 struct sockaddr *awrq, char *extra) 1823{ 1824 islpci_private *priv = netdev_priv(ndev); 1825 struct islpci_acl *acl = &priv->acl; 1826 struct mac_entry *entry; 1827 struct sockaddr *addr = (struct sockaddr *) extra; 1828 1829 if (addr->sa_family != ARPHRD_ETHER) 1830 return -EOPNOTSUPP; 1831 1832 entry = kmalloc(sizeof (struct mac_entry), GFP_KERNEL); 1833 if (entry == NULL) 1834 return -ENOMEM; 1835 1836 memcpy(entry->addr, addr->sa_data, ETH_ALEN); 1837 1838 if (mutex_lock_interruptible(&acl->lock)) { 1839 kfree(entry); 1840 return -ERESTARTSYS; 1841 } 1842 list_add_tail(&entry->_list, &acl->mac_list); 1843 acl->size++; 1844 mutex_unlock(&acl->lock); 1845 1846 return 0; 1847} 1848 1849static int 1850prism54_del_mac(struct net_device *ndev, struct iw_request_info *info, 1851 struct sockaddr *awrq, char *extra) 1852{ 1853 islpci_private *priv = netdev_priv(ndev); 1854 struct islpci_acl *acl = &priv->acl; 1855 struct mac_entry *entry; 1856 struct sockaddr *addr = (struct sockaddr *) extra; 1857 1858 if (addr->sa_family != ARPHRD_ETHER) 1859 return -EOPNOTSUPP; 1860 1861 if (mutex_lock_interruptible(&acl->lock)) 1862 return -ERESTARTSYS; 1863 list_for_each_entry(entry, &acl->mac_list, _list) { 1864 if (ether_addr_equal(entry->addr, addr->sa_data)) { 1865 list_del(&entry->_list); 1866 acl->size--; 1867 kfree(entry); 1868 mutex_unlock(&acl->lock); 1869 return 0; 1870 } 1871 } 1872 mutex_unlock(&acl->lock); 1873 return -EINVAL; 1874} 1875 1876static int 1877prism54_get_mac(struct net_device *ndev, struct iw_request_info *info, 1878 struct iw_point *dwrq, char *extra) 1879{ 1880 islpci_private *priv = netdev_priv(ndev); 1881 struct islpci_acl *acl = &priv->acl; 1882 struct mac_entry *entry; 1883 struct sockaddr *dst = (struct sockaddr *) extra; 1884 1885 dwrq->length = 0; 1886 1887 if (mutex_lock_interruptible(&acl->lock)) 1888 return -ERESTARTSYS; 1889 1890 list_for_each_entry(entry, &acl->mac_list, _list) { 1891 memcpy(dst->sa_data, entry->addr, ETH_ALEN); 1892 dst->sa_family = ARPHRD_ETHER; 1893 dwrq->length++; 1894 dst++; 1895 } 1896 mutex_unlock(&acl->lock); 1897 return 0; 1898} 1899 1900/* Setting policy also clears the MAC acl, even if we don't change the default 1901 * policy 1902 */ 1903 1904static int 1905prism54_set_policy(struct net_device *ndev, struct iw_request_info *info, 1906 __u32 * uwrq, char *extra) 1907{ 1908 islpci_private *priv = netdev_priv(ndev); 1909 struct islpci_acl *acl = &priv->acl; 1910 u32 mlmeautolevel; 1911 1912 prism54_clear_mac(acl); 1913 1914 if ((*uwrq < MAC_POLICY_OPEN) || (*uwrq > MAC_POLICY_REJECT)) 1915 return -EINVAL; 1916 1917 down_write(&priv->mib_sem); 1918 1919 acl->policy = *uwrq; 1920 1921 /* the ACL code needs an intermediate mlmeautolevel */ 1922 if ((priv->iw_mode == IW_MODE_MASTER) && 1923 (acl->policy != MAC_POLICY_OPEN)) 1924 mlmeautolevel = DOT11_MLME_INTERMEDIATE; 1925 else 1926 mlmeautolevel = CARD_DEFAULT_MLME_MODE; 1927 if (priv->wpa) 1928 mlmeautolevel = DOT11_MLME_EXTENDED; 1929 mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlmeautolevel); 1930 /* restart the card with our new policy */ 1931 if (mgt_commit(priv)) { 1932 up_write(&priv->mib_sem); 1933 return -EIO; 1934 } 1935 up_write(&priv->mib_sem); 1936 1937 return 0; 1938} 1939 1940static int 1941prism54_get_policy(struct net_device *ndev, struct iw_request_info *info, 1942 __u32 * uwrq, char *extra) 1943{ 1944 islpci_private *priv = netdev_priv(ndev); 1945 struct islpci_acl *acl = &priv->acl; 1946 1947 *uwrq = acl->policy; 1948 1949 return 0; 1950} 1951 1952/* Return 1 only if client should be accepted. */ 1953 1954static int 1955prism54_mac_accept(struct islpci_acl *acl, char *mac) 1956{ 1957 struct mac_entry *entry; 1958 int res = 0; 1959 1960 if (mutex_lock_interruptible(&acl->lock)) 1961 return -ERESTARTSYS; 1962 1963 if (acl->policy == MAC_POLICY_OPEN) { 1964 mutex_unlock(&acl->lock); 1965 return 1; 1966 } 1967 1968 list_for_each_entry(entry, &acl->mac_list, _list) { 1969 if (memcmp(entry->addr, mac, ETH_ALEN) == 0) { 1970 res = 1; 1971 break; 1972 } 1973 } 1974 res = (acl->policy == MAC_POLICY_ACCEPT) ? !res : res; 1975 mutex_unlock(&acl->lock); 1976 1977 return res; 1978} 1979 1980static int 1981prism54_kick_all(struct net_device *ndev, struct iw_request_info *info, 1982 struct iw_point *dwrq, char *extra) 1983{ 1984 struct obj_mlme *mlme; 1985 int rvalue; 1986 1987 mlme = kmalloc(sizeof (struct obj_mlme), GFP_KERNEL); 1988 if (mlme == NULL) 1989 return -ENOMEM; 1990 1991 /* Tell the card to kick every client */ 1992 mlme->id = 0; 1993 rvalue = 1994 mgt_set_request(netdev_priv(ndev), DOT11_OID_DISASSOCIATE, 0, mlme); 1995 kfree(mlme); 1996 1997 return rvalue; 1998} 1999 2000static int 2001prism54_kick_mac(struct net_device *ndev, struct iw_request_info *info, 2002 struct sockaddr *awrq, char *extra) 2003{ 2004 struct obj_mlme *mlme; 2005 struct sockaddr *addr = (struct sockaddr *) extra; 2006 int rvalue; 2007 2008 if (addr->sa_family != ARPHRD_ETHER) 2009 return -EOPNOTSUPP; 2010 2011 mlme = kmalloc(sizeof (struct obj_mlme), GFP_KERNEL); 2012 if (mlme == NULL) 2013 return -ENOMEM; 2014 2015 /* Tell the card to only kick the corresponding bastard */ 2016 memcpy(mlme->address, addr->sa_data, ETH_ALEN); 2017 mlme->id = -1; 2018 rvalue = 2019 mgt_set_request(netdev_priv(ndev), DOT11_OID_DISASSOCIATE, 0, mlme); 2020 2021 kfree(mlme); 2022 2023 return rvalue; 2024} 2025 2026/* Translate a TRAP oid into a wireless event. Called in islpci_mgt_receive. */ 2027 2028static void 2029format_event(islpci_private *priv, char *dest, const char *str, 2030 const struct obj_mlme *mlme, u16 *length, int error) 2031{ 2032 int n = snprintf(dest, IW_CUSTOM_MAX, 2033 "%s %s %pM %s (%2.2X)", 2034 str, 2035 ((priv->iw_mode == IW_MODE_MASTER) ? "from" : "to"), 2036 mlme->address, 2037 (error ? (mlme->code ? " : REJECTED " : " : ACCEPTED ") 2038 : ""), mlme->code); 2039 BUG_ON(n > IW_CUSTOM_MAX); 2040 *length = n; 2041} 2042 2043static void 2044send_formatted_event(islpci_private *priv, const char *str, 2045 const struct obj_mlme *mlme, int error) 2046{ 2047 union iwreq_data wrqu; 2048 char *memptr; 2049 2050 memptr = kmalloc(IW_CUSTOM_MAX, GFP_KERNEL); 2051 if (!memptr) 2052 return; 2053 wrqu.data.pointer = memptr; 2054 wrqu.data.length = 0; 2055 format_event(priv, memptr, str, mlme, &wrqu.data.length, 2056 error); 2057 wireless_send_event(priv->ndev, IWEVCUSTOM, &wrqu, memptr); 2058 kfree(memptr); 2059} 2060 2061static void 2062send_simple_event(islpci_private *priv, const char *str) 2063{ 2064 union iwreq_data wrqu; 2065 char *memptr; 2066 int n = strlen(str); 2067 2068 memptr = kmalloc(IW_CUSTOM_MAX, GFP_KERNEL); 2069 if (!memptr) 2070 return; 2071 BUG_ON(n >= IW_CUSTOM_MAX); 2072 wrqu.data.pointer = memptr; 2073 wrqu.data.length = n; 2074 strcpy(memptr, str); 2075 wireless_send_event(priv->ndev, IWEVCUSTOM, &wrqu, memptr); 2076 kfree(memptr); 2077} 2078 2079static void 2080link_changed(struct net_device *ndev, u32 bitrate) 2081{ 2082 islpci_private *priv = netdev_priv(ndev); 2083 2084 if (bitrate) { 2085 netif_carrier_on(ndev); 2086 if (priv->iw_mode == IW_MODE_INFRA) { 2087 union iwreq_data uwrq; 2088 prism54_get_wap(ndev, NULL, (struct sockaddr *) &uwrq, 2089 NULL); 2090 wireless_send_event(ndev, SIOCGIWAP, &uwrq, NULL); 2091 } else 2092 send_simple_event(netdev_priv(ndev), 2093 "Link established"); 2094 } else { 2095 netif_carrier_off(ndev); 2096 send_simple_event(netdev_priv(ndev), "Link lost"); 2097 } 2098} 2099 2100/* Beacon/ProbeResp payload header */ 2101struct ieee80211_beacon_phdr { 2102 u8 timestamp[8]; 2103 u16 beacon_int; 2104 u16 capab_info; 2105} __packed; 2106 2107#define WLAN_EID_GENERIC 0xdd 2108static u8 wpa_oid[4] = { 0x00, 0x50, 0xf2, 1 }; 2109 2110static void 2111prism54_wpa_bss_ie_add(islpci_private *priv, u8 *bssid, 2112 u8 *wpa_ie, size_t wpa_ie_len) 2113{ 2114 struct list_head *ptr; 2115 struct islpci_bss_wpa_ie *bss = NULL; 2116 2117 if (wpa_ie_len > MAX_WPA_IE_LEN) 2118 wpa_ie_len = MAX_WPA_IE_LEN; 2119 2120 mutex_lock(&priv->wpa_lock); 2121 2122 /* try to use existing entry */ 2123 list_for_each(ptr, &priv->bss_wpa_list) { 2124 bss = list_entry(ptr, struct islpci_bss_wpa_ie, list); 2125 if (memcmp(bss->bssid, bssid, ETH_ALEN) == 0) { 2126 list_move(&bss->list, &priv->bss_wpa_list); 2127 break; 2128 } 2129 bss = NULL; 2130 } 2131 2132 if (bss == NULL) { 2133 /* add a new BSS entry; if max number of entries is already 2134 * reached, replace the least recently updated */ 2135 if (priv->num_bss_wpa >= MAX_BSS_WPA_IE_COUNT) { 2136 bss = list_entry(priv->bss_wpa_list.prev, 2137 struct islpci_bss_wpa_ie, list); 2138 list_del(&bss->list); 2139 } else { 2140 bss = kzalloc(sizeof (*bss), GFP_ATOMIC); 2141 if (bss != NULL) 2142 priv->num_bss_wpa++; 2143 } 2144 if (bss != NULL) { 2145 memcpy(bss->bssid, bssid, ETH_ALEN); 2146 list_add(&bss->list, &priv->bss_wpa_list); 2147 } 2148 } 2149 2150 if (bss != NULL) { 2151 memcpy(bss->wpa_ie, wpa_ie, wpa_ie_len); 2152 bss->wpa_ie_len = wpa_ie_len; 2153 bss->last_update = jiffies; 2154 } else { 2155 printk(KERN_DEBUG "Failed to add BSS WPA entry for " 2156 "%pM\n", bssid); 2157 } 2158 2159 /* expire old entries from WPA list */ 2160 while (priv->num_bss_wpa > 0) { 2161 bss = list_entry(priv->bss_wpa_list.prev, 2162 struct islpci_bss_wpa_ie, list); 2163 if (!time_after(jiffies, bss->last_update + 60 * HZ)) 2164 break; 2165 2166 list_del(&bss->list); 2167 priv->num_bss_wpa--; 2168 kfree(bss); 2169 } 2170 2171 mutex_unlock(&priv->wpa_lock); 2172} 2173 2174static size_t 2175prism54_wpa_bss_ie_get(islpci_private *priv, u8 *bssid, u8 *wpa_ie) 2176{ 2177 struct list_head *ptr; 2178 struct islpci_bss_wpa_ie *bss = NULL; 2179 size_t len = 0; 2180 2181 mutex_lock(&priv->wpa_lock); 2182 2183 list_for_each(ptr, &priv->bss_wpa_list) { 2184 bss = list_entry(ptr, struct islpci_bss_wpa_ie, list); 2185 if (memcmp(bss->bssid, bssid, ETH_ALEN) == 0) 2186 break; 2187 bss = NULL; 2188 } 2189 if (bss) { 2190 len = bss->wpa_ie_len; 2191 memcpy(wpa_ie, bss->wpa_ie, len); 2192 } 2193 mutex_unlock(&priv->wpa_lock); 2194 2195 return len; 2196} 2197 2198void 2199prism54_wpa_bss_ie_init(islpci_private *priv) 2200{ 2201 INIT_LIST_HEAD(&priv->bss_wpa_list); 2202 mutex_init(&priv->wpa_lock); 2203} 2204 2205void 2206prism54_wpa_bss_ie_clean(islpci_private *priv) 2207{ 2208 struct islpci_bss_wpa_ie *bss, *n; 2209 2210 list_for_each_entry_safe(bss, n, &priv->bss_wpa_list, list) { 2211 kfree(bss); 2212 } 2213} 2214 2215static void 2216prism54_process_bss_data(islpci_private *priv, u32 oid, u8 *addr, 2217 u8 *payload, size_t len) 2218{ 2219 struct ieee80211_beacon_phdr *hdr; 2220 u8 *pos, *end; 2221 2222 if (!priv->wpa) 2223 return; 2224 2225 hdr = (struct ieee80211_beacon_phdr *) payload; 2226 pos = (u8 *) (hdr + 1); 2227 end = payload + len; 2228 while (pos < end) { 2229 if (pos + 2 + pos[1] > end) { 2230 printk(KERN_DEBUG "Parsing Beacon/ProbeResp failed " 2231 "for %pM\n", addr); 2232 return; 2233 } 2234 if (pos[0] == WLAN_EID_GENERIC && pos[1] >= 4 && 2235 memcmp(pos + 2, wpa_oid, 4) == 0) { 2236 prism54_wpa_bss_ie_add(priv, addr, pos, pos[1] + 2); 2237 return; 2238 } 2239 pos += 2 + pos[1]; 2240 } 2241} 2242 2243static void 2244handle_request(islpci_private *priv, struct obj_mlme *mlme, enum oid_num_t oid) 2245{ 2246 if (((mlme->state == DOT11_STATE_AUTHING) || 2247 (mlme->state == DOT11_STATE_ASSOCING)) 2248 && mgt_mlme_answer(priv)) { 2249 /* Someone is requesting auth and we must respond. Just send back 2250 * the trap with error code set accordingly. 2251 */ 2252 mlme->code = prism54_mac_accept(&priv->acl, 2253 mlme->address) ? 0 : 1; 2254 mgt_set_request(priv, oid, 0, mlme); 2255 } 2256} 2257 2258static int 2259prism54_process_trap_helper(islpci_private *priv, enum oid_num_t oid, 2260 char *data) 2261{ 2262 struct obj_mlme *mlme = (struct obj_mlme *) data; 2263 struct obj_mlmeex *mlmeex = (struct obj_mlmeex *) data; 2264 struct obj_mlmeex *confirm; 2265 u8 wpa_ie[MAX_WPA_IE_LEN]; 2266 int wpa_ie_len; 2267 size_t len = 0; /* u16, better? */ 2268 u8 *payload = NULL, *pos = NULL; 2269 int ret; 2270 2271 /* I think all trapable objects are listed here. 2272 * Some oids have a EX version. The difference is that they are emitted 2273 * in DOT11_MLME_EXTENDED mode (set with DOT11_OID_MLMEAUTOLEVEL) 2274 * with more info. 2275 * The few events already defined by the wireless tools are not really 2276 * suited. We use the more flexible custom event facility. 2277 */ 2278 2279 if (oid >= DOT11_OID_BEACON) { 2280 len = mlmeex->size; 2281 payload = pos = mlmeex->data; 2282 } 2283 2284 /* I fear prism54_process_bss_data won't work with big endian data */ 2285 if ((oid == DOT11_OID_BEACON) || (oid == DOT11_OID_PROBE)) 2286 prism54_process_bss_data(priv, oid, mlmeex->address, 2287 payload, len); 2288 2289 mgt_le_to_cpu(isl_oid[oid].flags & OID_FLAG_TYPE, (void *) mlme); 2290 2291 switch (oid) { 2292 2293 case GEN_OID_LINKSTATE: 2294 link_changed(priv->ndev, (u32) *data); 2295 break; 2296 2297 case DOT11_OID_MICFAILURE: 2298 send_simple_event(priv, "Mic failure"); 2299 break; 2300 2301 case DOT11_OID_DEAUTHENTICATE: 2302 send_formatted_event(priv, "DeAuthenticate request", mlme, 0); 2303 break; 2304 2305 case DOT11_OID_AUTHENTICATE: 2306 handle_request(priv, mlme, oid); 2307 send_formatted_event(priv, "Authenticate request", mlme, 1); 2308 break; 2309 2310 case DOT11_OID_DISASSOCIATE: 2311 send_formatted_event(priv, "Disassociate request", mlme, 0); 2312 break; 2313 2314 case DOT11_OID_ASSOCIATE: 2315 handle_request(priv, mlme, oid); 2316 send_formatted_event(priv, "Associate request", mlme, 1); 2317 break; 2318 2319 case DOT11_OID_REASSOCIATE: 2320 handle_request(priv, mlme, oid); 2321 send_formatted_event(priv, "ReAssociate request", mlme, 1); 2322 break; 2323 2324 case DOT11_OID_BEACON: 2325 send_formatted_event(priv, 2326 "Received a beacon from an unknown AP", 2327 mlme, 0); 2328 break; 2329 2330 case DOT11_OID_PROBE: 2331 /* we received a probe from a client. */ 2332 send_formatted_event(priv, "Received a probe from client", mlme, 2333 0); 2334 break; 2335 2336 /* Note : "mlme" is actually a "struct obj_mlmeex *" here, but this 2337 * is backward compatible layout-wise with "struct obj_mlme". 2338 */ 2339 2340 case DOT11_OID_DEAUTHENTICATEEX: 2341 send_formatted_event(priv, "DeAuthenticate request", mlme, 0); 2342 break; 2343 2344 case DOT11_OID_AUTHENTICATEEX: 2345 handle_request(priv, mlme, oid); 2346 send_formatted_event(priv, "Authenticate request (ex)", mlme, 1); 2347 2348 if (priv->iw_mode != IW_MODE_MASTER 2349 && mlmeex->state != DOT11_STATE_AUTHING) 2350 break; 2351 2352 confirm = kmalloc(sizeof(struct obj_mlmeex) + 6, GFP_ATOMIC); 2353 2354 if (!confirm) 2355 break; 2356 2357 memcpy(&confirm->address, mlmeex->address, ETH_ALEN); 2358 printk(KERN_DEBUG "Authenticate from: address:\t%pM\n", 2359 mlmeex->address); 2360 confirm->id = -1; /* or mlmeex->id ? */ 2361 confirm->state = 0; /* not used */ 2362 confirm->code = 0; 2363 confirm->size = 6; 2364 confirm->data[0] = 0x00; 2365 confirm->data[1] = 0x00; 2366 confirm->data[2] = 0x02; 2367 confirm->data[3] = 0x00; 2368 confirm->data[4] = 0x00; 2369 confirm->data[5] = 0x00; 2370 2371 ret = mgt_set_varlen(priv, DOT11_OID_ASSOCIATEEX, confirm, 6); 2372 2373 kfree(confirm); 2374 if (ret) 2375 return ret; 2376 break; 2377 2378 case DOT11_OID_DISASSOCIATEEX: 2379 send_formatted_event(priv, "Disassociate request (ex)", mlme, 0); 2380 break; 2381 2382 case DOT11_OID_ASSOCIATEEX: 2383 handle_request(priv, mlme, oid); 2384 send_formatted_event(priv, "Associate request (ex)", mlme, 1); 2385 2386 if (priv->iw_mode != IW_MODE_MASTER 2387 && mlmeex->state != DOT11_STATE_ASSOCING) 2388 break; 2389 2390 confirm = kmalloc(sizeof(struct obj_mlmeex), GFP_ATOMIC); 2391 2392 if (!confirm) 2393 break; 2394 2395 memcpy(&confirm->address, mlmeex->address, ETH_ALEN); 2396 2397 confirm->id = ((struct obj_mlmeex *)mlme)->id; 2398 confirm->state = 0; /* not used */ 2399 confirm->code = 0; 2400 2401 wpa_ie_len = prism54_wpa_bss_ie_get(priv, mlmeex->address, wpa_ie); 2402 2403 if (!wpa_ie_len) { 2404 printk(KERN_DEBUG "No WPA IE found from address:\t%pM\n", 2405 mlmeex->address); 2406 kfree(confirm); 2407 break; 2408 } 2409 2410 confirm->size = wpa_ie_len; 2411 memcpy(&confirm->data, wpa_ie, wpa_ie_len); 2412 2413 mgt_set_varlen(priv, oid, confirm, wpa_ie_len); 2414 2415 kfree(confirm); 2416 2417 break; 2418 2419 case DOT11_OID_REASSOCIATEEX: 2420 handle_request(priv, mlme, oid); 2421 send_formatted_event(priv, "Reassociate request (ex)", mlme, 1); 2422 2423 if (priv->iw_mode != IW_MODE_MASTER 2424 && mlmeex->state != DOT11_STATE_ASSOCING) 2425 break; 2426 2427 confirm = kmalloc(sizeof(struct obj_mlmeex), GFP_ATOMIC); 2428 2429 if (!confirm) 2430 break; 2431 2432 memcpy(&confirm->address, mlmeex->address, ETH_ALEN); 2433 2434 confirm->id = mlmeex->id; 2435 confirm->state = 0; /* not used */ 2436 confirm->code = 0; 2437 2438 wpa_ie_len = prism54_wpa_bss_ie_get(priv, mlmeex->address, wpa_ie); 2439 2440 if (!wpa_ie_len) { 2441 printk(KERN_DEBUG "No WPA IE found from address:\t%pM\n", 2442 mlmeex->address); 2443 kfree(confirm); 2444 break; 2445 } 2446 2447 confirm->size = wpa_ie_len; 2448 memcpy(&confirm->data, wpa_ie, wpa_ie_len); 2449 2450 mgt_set_varlen(priv, oid, confirm, wpa_ie_len); 2451 2452 kfree(confirm); 2453 2454 break; 2455 2456 default: 2457 return -EINVAL; 2458 } 2459 2460 return 0; 2461} 2462 2463/* 2464 * Process a device trap. This is called via schedule_work(), outside of 2465 * interrupt context, no locks held. 2466 */ 2467void 2468prism54_process_trap(struct work_struct *work) 2469{ 2470 struct islpci_mgmtframe *frame = 2471 container_of(work, struct islpci_mgmtframe, ws); 2472 struct net_device *ndev = frame->ndev; 2473 enum oid_num_t n = mgt_oidtonum(frame->header->oid); 2474 2475 if (n != OID_NUM_LAST) 2476 prism54_process_trap_helper(netdev_priv(ndev), n, frame->data); 2477 islpci_mgt_release(frame); 2478} 2479 2480int 2481prism54_set_mac_address(struct net_device *ndev, void *addr) 2482{ 2483 islpci_private *priv = netdev_priv(ndev); 2484 int ret; 2485 2486 if (ndev->addr_len != 6) 2487 return -EINVAL; 2488 ret = mgt_set_request(priv, GEN_OID_MACADDRESS, 0, 2489 &((struct sockaddr *) addr)->sa_data); 2490 if (!ret) 2491 memcpy(priv->ndev->dev_addr, 2492 &((struct sockaddr *) addr)->sa_data, ETH_ALEN); 2493 2494 return ret; 2495} 2496 2497#define PRISM54_SET_WPA SIOCIWFIRSTPRIV+12 2498 2499static int 2500prism54_set_wpa(struct net_device *ndev, struct iw_request_info *info, 2501 __u32 * uwrq, char *extra) 2502{ 2503 islpci_private *priv = netdev_priv(ndev); 2504 u32 mlme, authen, dot1x, filter, wep; 2505 2506 if (islpci_get_state(priv) < PRV_STATE_INIT) 2507 return 0; 2508 2509 wep = 1; /* For privacy invoked */ 2510 filter = 1; /* Filter out all unencrypted frames */ 2511 dot1x = 0x01; /* To enable eap filter */ 2512 mlme = DOT11_MLME_EXTENDED; 2513 authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */ 2514 2515 down_write(&priv->mib_sem); 2516 priv->wpa = *uwrq; 2517 2518 switch (priv->wpa) { 2519 default: 2520 case 0: /* Clears/disables WPA and friends */ 2521 wep = 0; 2522 filter = 0; /* Do not filter un-encrypted data */ 2523 dot1x = 0; 2524 mlme = DOT11_MLME_AUTO; 2525 printk("%s: Disabling WPA\n", ndev->name); 2526 break; 2527 case 2: 2528 case 1: /* WPA */ 2529 printk("%s: Enabling WPA\n", ndev->name); 2530 break; 2531 } 2532 up_write(&priv->mib_sem); 2533 2534 mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen); 2535 mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &wep); 2536 mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0, &filter); 2537 mgt_set_request(priv, DOT11_OID_DOT1XENABLE, 0, &dot1x); 2538 mgt_set_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, &mlme); 2539 2540 return 0; 2541} 2542 2543static int 2544prism54_get_wpa(struct net_device *ndev, struct iw_request_info *info, 2545 __u32 * uwrq, char *extra) 2546{ 2547 islpci_private *priv = netdev_priv(ndev); 2548 *uwrq = priv->wpa; 2549 return 0; 2550} 2551 2552static int 2553prism54_set_prismhdr(struct net_device *ndev, struct iw_request_info *info, 2554 __u32 * uwrq, char *extra) 2555{ 2556 islpci_private *priv = netdev_priv(ndev); 2557 priv->monitor_type = 2558 (*uwrq ? ARPHRD_IEEE80211_PRISM : ARPHRD_IEEE80211); 2559 if (priv->iw_mode == IW_MODE_MONITOR) 2560 priv->ndev->type = priv->monitor_type; 2561 2562 return 0; 2563} 2564 2565static int 2566prism54_get_prismhdr(struct net_device *ndev, struct iw_request_info *info, 2567 __u32 * uwrq, char *extra) 2568{ 2569 islpci_private *priv = netdev_priv(ndev); 2570 *uwrq = (priv->monitor_type == ARPHRD_IEEE80211_PRISM); 2571 return 0; 2572} 2573 2574static int 2575prism54_debug_oid(struct net_device *ndev, struct iw_request_info *info, 2576 __u32 * uwrq, char *extra) 2577{ 2578 islpci_private *priv = netdev_priv(ndev); 2579 2580 priv->priv_oid = *uwrq; 2581 printk("%s: oid 0x%08X\n", ndev->name, *uwrq); 2582 2583 return 0; 2584} 2585 2586static int 2587prism54_debug_get_oid(struct net_device *ndev, struct iw_request_info *info, 2588 struct iw_point *data, char *extra) 2589{ 2590 islpci_private *priv = netdev_priv(ndev); 2591 struct islpci_mgmtframe *response; 2592 int ret = -EIO; 2593 2594 printk("%s: get_oid 0x%08X\n", ndev->name, priv->priv_oid); 2595 data->length = 0; 2596 2597 if (islpci_get_state(priv) >= PRV_STATE_INIT) { 2598 ret = 2599 islpci_mgt_transaction(priv->ndev, PIMFOR_OP_GET, 2600 priv->priv_oid, extra, 256, 2601 &response); 2602 printk("%s: ret: %i\n", ndev->name, ret); 2603 if (ret || !response 2604 || response->header->operation == PIMFOR_OP_ERROR) { 2605 if (response) { 2606 islpci_mgt_release(response); 2607 } 2608 printk("%s: EIO\n", ndev->name); 2609 ret = -EIO; 2610 } 2611 if (!ret) { 2612 data->length = response->header->length; 2613 memcpy(extra, response->data, data->length); 2614 islpci_mgt_release(response); 2615 printk("%s: len: %i\n", ndev->name, data->length); 2616 } 2617 } 2618 2619 return ret; 2620} 2621 2622static int 2623prism54_debug_set_oid(struct net_device *ndev, struct iw_request_info *info, 2624 struct iw_point *data, char *extra) 2625{ 2626 islpci_private *priv = netdev_priv(ndev); 2627 struct islpci_mgmtframe *response; 2628 int ret = 0, response_op = PIMFOR_OP_ERROR; 2629 2630 printk("%s: set_oid 0x%08X\tlen: %d\n", ndev->name, priv->priv_oid, 2631 data->length); 2632 2633 if (islpci_get_state(priv) >= PRV_STATE_INIT) { 2634 ret = 2635 islpci_mgt_transaction(priv->ndev, PIMFOR_OP_SET, 2636 priv->priv_oid, extra, data->length, 2637 &response); 2638 printk("%s: ret: %i\n", ndev->name, ret); 2639 if (ret || !response 2640 || response->header->operation == PIMFOR_OP_ERROR) { 2641 if (response) { 2642 islpci_mgt_release(response); 2643 } 2644 printk("%s: EIO\n", ndev->name); 2645 ret = -EIO; 2646 } 2647 if (!ret) { 2648 response_op = response->header->operation; 2649 printk("%s: response_op: %i\n", ndev->name, 2650 response_op); 2651 islpci_mgt_release(response); 2652 } 2653 } 2654 2655 return (ret ? ret : -EINPROGRESS); 2656} 2657 2658static int 2659prism54_set_spy(struct net_device *ndev, 2660 struct iw_request_info *info, 2661 union iwreq_data *uwrq, char *extra) 2662{ 2663 islpci_private *priv = netdev_priv(ndev); 2664 u32 u; 2665 enum oid_num_t oid = OID_INL_CONFIG; 2666 2667 down_write(&priv->mib_sem); 2668 mgt_get(priv, OID_INL_CONFIG, &u); 2669 2670 if ((uwrq->data.length == 0) && (priv->spy_data.spy_number > 0)) 2671 /* disable spy */ 2672 u &= ~INL_CONFIG_RXANNEX; 2673 else if ((uwrq->data.length > 0) && (priv->spy_data.spy_number == 0)) 2674 /* enable spy */ 2675 u |= INL_CONFIG_RXANNEX; 2676 2677 mgt_set(priv, OID_INL_CONFIG, &u); 2678 mgt_commit_list(priv, &oid, 1); 2679 up_write(&priv->mib_sem); 2680 2681 return iw_handler_set_spy(ndev, info, uwrq, extra); 2682} 2683 2684static const iw_handler prism54_handler[] = { 2685 (iw_handler) prism54_commit, /* SIOCSIWCOMMIT */ 2686 (iw_handler) prism54_get_name, /* SIOCGIWNAME */ 2687 (iw_handler) NULL, /* SIOCSIWNWID */ 2688 (iw_handler) NULL, /* SIOCGIWNWID */ 2689 (iw_handler) prism54_set_freq, /* SIOCSIWFREQ */ 2690 (iw_handler) prism54_get_freq, /* SIOCGIWFREQ */ 2691 (iw_handler) prism54_set_mode, /* SIOCSIWMODE */ 2692 (iw_handler) prism54_get_mode, /* SIOCGIWMODE */ 2693 (iw_handler) prism54_set_sens, /* SIOCSIWSENS */ 2694 (iw_handler) prism54_get_sens, /* SIOCGIWSENS */ 2695 (iw_handler) NULL, /* SIOCSIWRANGE */ 2696 (iw_handler) prism54_get_range, /* SIOCGIWRANGE */ 2697 (iw_handler) NULL, /* SIOCSIWPRIV */ 2698 (iw_handler) NULL, /* SIOCGIWPRIV */ 2699 (iw_handler) NULL, /* SIOCSIWSTATS */ 2700 (iw_handler) NULL, /* SIOCGIWSTATS */ 2701 prism54_set_spy, /* SIOCSIWSPY */ 2702 iw_handler_get_spy, /* SIOCGIWSPY */ 2703 iw_handler_set_thrspy, /* SIOCSIWTHRSPY */ 2704 iw_handler_get_thrspy, /* SIOCGIWTHRSPY */ 2705 (iw_handler) prism54_set_wap, /* SIOCSIWAP */ 2706 (iw_handler) prism54_get_wap, /* SIOCGIWAP */ 2707 (iw_handler) NULL, /* -- hole -- */ 2708 (iw_handler) NULL, /* SIOCGIWAPLIST deprecated */ 2709 (iw_handler) prism54_set_scan, /* SIOCSIWSCAN */ 2710 (iw_handler) prism54_get_scan, /* SIOCGIWSCAN */ 2711 (iw_handler) prism54_set_essid, /* SIOCSIWESSID */ 2712 (iw_handler) prism54_get_essid, /* SIOCGIWESSID */ 2713 (iw_handler) prism54_set_nick, /* SIOCSIWNICKN */ 2714 (iw_handler) prism54_get_nick, /* SIOCGIWNICKN */ 2715 (iw_handler) NULL, /* -- hole -- */ 2716 (iw_handler) NULL, /* -- hole -- */ 2717 (iw_handler) prism54_set_rate, /* SIOCSIWRATE */ 2718 (iw_handler) prism54_get_rate, /* SIOCGIWRATE */ 2719 (iw_handler) prism54_set_rts, /* SIOCSIWRTS */ 2720 (iw_handler) prism54_get_rts, /* SIOCGIWRTS */ 2721 (iw_handler) prism54_set_frag, /* SIOCSIWFRAG */ 2722 (iw_handler) prism54_get_frag, /* SIOCGIWFRAG */ 2723 (iw_handler) prism54_set_txpower, /* SIOCSIWTXPOW */ 2724 (iw_handler) prism54_get_txpower, /* SIOCGIWTXPOW */ 2725 (iw_handler) prism54_set_retry, /* SIOCSIWRETRY */ 2726 (iw_handler) prism54_get_retry, /* SIOCGIWRETRY */ 2727 (iw_handler) prism54_set_encode, /* SIOCSIWENCODE */ 2728 (iw_handler) prism54_get_encode, /* SIOCGIWENCODE */ 2729 (iw_handler) NULL, /* SIOCSIWPOWER */ 2730 (iw_handler) NULL, /* SIOCGIWPOWER */ 2731 NULL, /* -- hole -- */ 2732 NULL, /* -- hole -- */ 2733 (iw_handler) prism54_set_genie, /* SIOCSIWGENIE */ 2734 (iw_handler) prism54_get_genie, /* SIOCGIWGENIE */ 2735 (iw_handler) prism54_set_auth, /* SIOCSIWAUTH */ 2736 (iw_handler) prism54_get_auth, /* SIOCGIWAUTH */ 2737 (iw_handler) prism54_set_encodeext, /* SIOCSIWENCODEEXT */ 2738 (iw_handler) prism54_get_encodeext, /* SIOCGIWENCODEEXT */ 2739 NULL, /* SIOCSIWPMKSA */ 2740}; 2741 2742/* The low order bit identify a SET (0) or a GET (1) ioctl. */ 2743 2744#define PRISM54_RESET SIOCIWFIRSTPRIV 2745#define PRISM54_GET_POLICY SIOCIWFIRSTPRIV+1 2746#define PRISM54_SET_POLICY SIOCIWFIRSTPRIV+2 2747#define PRISM54_GET_MAC SIOCIWFIRSTPRIV+3 2748#define PRISM54_ADD_MAC SIOCIWFIRSTPRIV+4 2749 2750#define PRISM54_DEL_MAC SIOCIWFIRSTPRIV+6 2751 2752#define PRISM54_KICK_MAC SIOCIWFIRSTPRIV+8 2753 2754#define PRISM54_KICK_ALL SIOCIWFIRSTPRIV+10 2755 2756#define PRISM54_GET_WPA SIOCIWFIRSTPRIV+11 2757#define PRISM54_SET_WPA SIOCIWFIRSTPRIV+12 2758 2759#define PRISM54_DBG_OID SIOCIWFIRSTPRIV+14 2760#define PRISM54_DBG_GET_OID SIOCIWFIRSTPRIV+15 2761#define PRISM54_DBG_SET_OID SIOCIWFIRSTPRIV+16 2762 2763#define PRISM54_GET_OID SIOCIWFIRSTPRIV+17 2764#define PRISM54_SET_OID_U32 SIOCIWFIRSTPRIV+18 2765#define PRISM54_SET_OID_STR SIOCIWFIRSTPRIV+20 2766#define PRISM54_SET_OID_ADDR SIOCIWFIRSTPRIV+22 2767 2768#define PRISM54_GET_PRISMHDR SIOCIWFIRSTPRIV+23 2769#define PRISM54_SET_PRISMHDR SIOCIWFIRSTPRIV+24 2770 2771#define IWPRIV_SET_U32(n,x) { n, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x } 2772#define IWPRIV_SET_SSID(n,x) { n, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x } 2773#define IWPRIV_SET_ADDR(n,x) { n, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x } 2774#define IWPRIV_GET(n,x) { n, 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | PRIV_STR_SIZE, "g_"x } 2775 2776#define IWPRIV_U32(n,x) IWPRIV_SET_U32(n,x), IWPRIV_GET(n,x) 2777#define IWPRIV_SSID(n,x) IWPRIV_SET_SSID(n,x), IWPRIV_GET(n,x) 2778#define IWPRIV_ADDR(n,x) IWPRIV_SET_ADDR(n,x), IWPRIV_GET(n,x) 2779 2780/* Note : limited to 128 private ioctls (wireless tools 26) */ 2781 2782static const struct iw_priv_args prism54_private_args[] = { 2783/*{ cmd, set_args, get_args, name } */ 2784 {PRISM54_RESET, 0, 0, "reset"}, 2785 {PRISM54_GET_PRISMHDR, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2786 "get_prismhdr"}, 2787 {PRISM54_SET_PRISMHDR, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, 2788 "set_prismhdr"}, 2789 {PRISM54_GET_POLICY, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2790 "getPolicy"}, 2791 {PRISM54_SET_POLICY, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, 2792 "setPolicy"}, 2793 {PRISM54_GET_MAC, 0, IW_PRIV_TYPE_ADDR | 64, "getMac"}, 2794 {PRISM54_ADD_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, 2795 "addMac"}, 2796 {PRISM54_DEL_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, 2797 "delMac"}, 2798 {PRISM54_KICK_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, 2799 "kickMac"}, 2800 {PRISM54_KICK_ALL, 0, 0, "kickAll"}, 2801 {PRISM54_GET_WPA, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2802 "get_wpa"}, 2803 {PRISM54_SET_WPA, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, 2804 "set_wpa"}, 2805 {PRISM54_DBG_OID, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, 2806 "dbg_oid"}, 2807 {PRISM54_DBG_GET_OID, 0, IW_PRIV_TYPE_BYTE | 256, "dbg_get_oid"}, 2808 {PRISM54_DBG_SET_OID, IW_PRIV_TYPE_BYTE | 256, 0, "dbg_set_oid"}, 2809 /* --- sub-ioctls handlers --- */ 2810 {PRISM54_GET_OID, 2811 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | PRIV_STR_SIZE, ""}, 2812 {PRISM54_SET_OID_U32, 2813 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, ""}, 2814 {PRISM54_SET_OID_STR, 2815 IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 1, 0, ""}, 2816 {PRISM54_SET_OID_ADDR, 2817 IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, ""}, 2818 /* --- sub-ioctls definitions --- */ 2819 IWPRIV_ADDR(GEN_OID_MACADDRESS, "addr"), 2820 IWPRIV_GET(GEN_OID_LINKSTATE, "linkstate"), 2821 IWPRIV_U32(DOT11_OID_BSSTYPE, "bsstype"), 2822 IWPRIV_ADDR(DOT11_OID_BSSID, "bssid"), 2823 IWPRIV_U32(DOT11_OID_STATE, "state"), 2824 IWPRIV_U32(DOT11_OID_AID, "aid"), 2825 2826 IWPRIV_SSID(DOT11_OID_SSIDOVERRIDE, "ssidoverride"), 2827 2828 IWPRIV_U32(DOT11_OID_MEDIUMLIMIT, "medlimit"), 2829 IWPRIV_U32(DOT11_OID_BEACONPERIOD, "beacon"), 2830 IWPRIV_U32(DOT11_OID_DTIMPERIOD, "dtimperiod"), 2831 2832 IWPRIV_U32(DOT11_OID_AUTHENABLE, "authenable"), 2833 IWPRIV_U32(DOT11_OID_PRIVACYINVOKED, "privinvok"), 2834 IWPRIV_U32(DOT11_OID_EXUNENCRYPTED, "exunencrypt"), 2835 2836 IWPRIV_U32(DOT11_OID_REKEYTHRESHOLD, "rekeythresh"), 2837 2838 IWPRIV_U32(DOT11_OID_MAXTXLIFETIME, "maxtxlife"), 2839 IWPRIV_U32(DOT11_OID_MAXRXLIFETIME, "maxrxlife"), 2840 IWPRIV_U32(DOT11_OID_ALOFT_FIXEDRATE, "fixedrate"), 2841 IWPRIV_U32(DOT11_OID_MAXFRAMEBURST, "frameburst"), 2842 IWPRIV_U32(DOT11_OID_PSM, "psm"), 2843 2844 IWPRIV_U32(DOT11_OID_BRIDGELOCAL, "bridge"), 2845 IWPRIV_U32(DOT11_OID_CLIENTS, "clients"), 2846 IWPRIV_U32(DOT11_OID_CLIENTSASSOCIATED, "clientassoc"), 2847 IWPRIV_U32(DOT11_OID_DOT1XENABLE, "dot1xenable"), 2848 IWPRIV_U32(DOT11_OID_ANTENNARX, "rxant"), 2849 IWPRIV_U32(DOT11_OID_ANTENNATX, "txant"), 2850 IWPRIV_U32(DOT11_OID_ANTENNADIVERSITY, "antdivers"), 2851 IWPRIV_U32(DOT11_OID_EDTHRESHOLD, "edthresh"), 2852 IWPRIV_U32(DOT11_OID_PREAMBLESETTINGS, "preamble"), 2853 IWPRIV_GET(DOT11_OID_RATES, "rates"), 2854 IWPRIV_U32(DOT11_OID_OUTPUTPOWER, ".11outpower"), 2855 IWPRIV_GET(DOT11_OID_SUPPORTEDRATES, "supprates"), 2856 IWPRIV_GET(DOT11_OID_SUPPORTEDFREQUENCIES, "suppfreq"), 2857 2858 IWPRIV_U32(DOT11_OID_NOISEFLOOR, "noisefloor"), 2859 IWPRIV_GET(DOT11_OID_FREQUENCYACTIVITY, "freqactivity"), 2860 IWPRIV_U32(DOT11_OID_NONERPPROTECTION, "nonerpprotec"), 2861 IWPRIV_U32(DOT11_OID_PROFILES, "profile"), 2862 IWPRIV_GET(DOT11_OID_EXTENDEDRATES, "extrates"), 2863 IWPRIV_U32(DOT11_OID_MLMEAUTOLEVEL, "mlmelevel"), 2864 2865 IWPRIV_GET(DOT11_OID_BSSS, "bsss"), 2866 IWPRIV_GET(DOT11_OID_BSSLIST, "bsslist"), 2867 IWPRIV_U32(OID_INL_MODE, "mode"), 2868 IWPRIV_U32(OID_INL_CONFIG, "config"), 2869 IWPRIV_U32(OID_INL_DOT11D_CONFORMANCE, ".11dconform"), 2870 IWPRIV_GET(OID_INL_PHYCAPABILITIES, "phycapa"), 2871 IWPRIV_U32(OID_INL_OUTPUTPOWER, "outpower"), 2872}; 2873 2874static const iw_handler prism54_private_handler[] = { 2875 (iw_handler) prism54_reset, 2876 (iw_handler) prism54_get_policy, 2877 (iw_handler) prism54_set_policy, 2878 (iw_handler) prism54_get_mac, 2879 (iw_handler) prism54_add_mac, 2880 (iw_handler) NULL, 2881 (iw_handler) prism54_del_mac, 2882 (iw_handler) NULL, 2883 (iw_handler) prism54_kick_mac, 2884 (iw_handler) NULL, 2885 (iw_handler) prism54_kick_all, 2886 (iw_handler) prism54_get_wpa, 2887 (iw_handler) prism54_set_wpa, 2888 (iw_handler) NULL, 2889 (iw_handler) prism54_debug_oid, 2890 (iw_handler) prism54_debug_get_oid, 2891 (iw_handler) prism54_debug_set_oid, 2892 (iw_handler) prism54_get_oid, 2893 (iw_handler) prism54_set_u32, 2894 (iw_handler) NULL, 2895 (iw_handler) prism54_set_raw, 2896 (iw_handler) NULL, 2897 (iw_handler) prism54_set_raw, 2898 (iw_handler) prism54_get_prismhdr, 2899 (iw_handler) prism54_set_prismhdr, 2900}; 2901 2902const struct iw_handler_def prism54_handler_def = { 2903 .num_standard = ARRAY_SIZE(prism54_handler), 2904 .num_private = ARRAY_SIZE(prism54_private_handler), 2905 .num_private_args = ARRAY_SIZE(prism54_private_args), 2906 .standard = (iw_handler *) prism54_handler, 2907 .private = (iw_handler *) prism54_private_handler, 2908 .private_args = (struct iw_priv_args *) prism54_private_args, 2909 .get_wireless_stats = prism54_get_wireless_stats, 2910}; 2911