1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Driver for KeyStream 11b/g wireless LAN 4 * 5 * Copyright (C) 2005-2008 KeyStream Corp. 6 * Copyright (C) 2009 Renesas Technology Corp. 7 */ 8 9 #include <linux/atomic.h> 10 #include <linux/completion.h> 11 #include <linux/if_arp.h> 12 #include <linux/netdevice.h> 13 #include <linux/timer.h> 14 #include <linux/uaccess.h> 15 16 static int wep_on_off; 17 #define WEP_OFF 0 18 #define WEP_ON_64BIT 1 19 #define WEP_ON_128BIT 2 20 21 #include "ks_wlan.h" 22 #include "ks_hostif.h" 23 #include "ks_wlan_ioctl.h" 24 25 /* Include Wireless Extension definition and check version */ 26 #include <linux/wireless.h> 27 #define WIRELESS_SPY /* enable iwspy support */ 28 #include <net/iw_handler.h> /* New driver API */ 29 30 /* Frequency list (map channels to frequencies) */ 31 static const long frequency_list[] = { 32 2412, 2417, 2422, 2427, 2432, 2437, 2442, 33 2447, 2452, 2457, 2462, 2467, 2472, 2484 34 }; 35 36 /* A few details needed for WEP (Wireless Equivalent Privacy) */ 37 #define MAX_KEY_SIZE 13 /* 128 (?) bits */ 38 #define MIN_KEY_SIZE 5 /* 40 bits RC4 - WEP */ 39 struct wep_key { 40 u16 len; 41 u8 key[16]; /* 40-bit and 104-bit keys */ 42 }; 43 44 /* 45 * function prototypes 46 */ 47 static int ks_wlan_open(struct net_device *dev); 48 static void ks_wlan_tx_timeout(struct net_device *dev, unsigned int txqueue); 49 static netdev_tx_t ks_wlan_start_xmit(struct sk_buff *skb, struct net_device *dev); 50 static int ks_wlan_close(struct net_device *dev); 51 static void ks_wlan_set_rx_mode(struct net_device *dev); 52 static struct net_device_stats *ks_wlan_get_stats(struct net_device *dev); 53 static int ks_wlan_set_mac_address(struct net_device *dev, void *addr); 54 static int ks_wlan_netdev_ioctl(struct net_device *dev, struct ifreq *rq, 55 int cmd); 56 57 static atomic_t update_phyinfo; 58 static struct timer_list update_phyinfo_timer; 59 static 60 int ks_wlan_update_phy_information(struct ks_wlan_private *priv) 61 { 62 struct iw_statistics *wstats = &priv->wstats; 63 64 netdev_dbg(priv->net_dev, "in_interrupt = %ld\n", in_interrupt()); 65 66 if (priv->dev_state < DEVICE_STATE_READY) 67 return -EBUSY; /* not finished initialize */ 68 69 if (atomic_read(&update_phyinfo)) 70 return -EPERM; 71 72 /* The status */ 73 wstats->status = priv->reg.operation_mode; /* Operation mode */ 74 75 /* Signal quality and co. But where is the noise level ??? */ 76 hostif_sme_enqueue(priv, SME_PHY_INFO_REQUEST); 77 78 /* interruptible_sleep_on_timeout(&priv->confirm_wait, HZ/2); */ 79 if (!wait_for_completion_interruptible_timeout 80 (&priv->confirm_wait, HZ / 2)) { 81 netdev_dbg(priv->net_dev, "wait time out!!\n"); 82 } 83 84 atomic_inc(&update_phyinfo); 85 update_phyinfo_timer.expires = jiffies + HZ; /* 1sec */ 86 add_timer(&update_phyinfo_timer); 87 88 return 0; 89 } 90 91 static 92 void ks_wlan_update_phyinfo_timeout(struct timer_list *unused) 93 { 94 pr_debug("in_interrupt = %ld\n", in_interrupt()); 95 atomic_set(&update_phyinfo, 0); 96 } 97 98 int ks_wlan_setup_parameter(struct ks_wlan_private *priv, 99 unsigned int commit_flag) 100 { 101 hostif_sme_enqueue(priv, SME_STOP_REQUEST); 102 103 if (commit_flag & SME_RTS) 104 hostif_sme_enqueue(priv, SME_RTS_THRESHOLD_REQUEST); 105 if (commit_flag & SME_FRAG) 106 hostif_sme_enqueue(priv, SME_FRAGMENTATION_THRESHOLD_REQUEST); 107 108 if (commit_flag & SME_WEP_INDEX) 109 hostif_sme_enqueue(priv, SME_WEP_INDEX_REQUEST); 110 if (commit_flag & SME_WEP_VAL1) 111 hostif_sme_enqueue(priv, SME_WEP_KEY1_REQUEST); 112 if (commit_flag & SME_WEP_VAL2) 113 hostif_sme_enqueue(priv, SME_WEP_KEY2_REQUEST); 114 if (commit_flag & SME_WEP_VAL3) 115 hostif_sme_enqueue(priv, SME_WEP_KEY3_REQUEST); 116 if (commit_flag & SME_WEP_VAL4) 117 hostif_sme_enqueue(priv, SME_WEP_KEY4_REQUEST); 118 if (commit_flag & SME_WEP_FLAG) 119 hostif_sme_enqueue(priv, SME_WEP_FLAG_REQUEST); 120 121 if (commit_flag & SME_RSN) { 122 hostif_sme_enqueue(priv, SME_RSN_ENABLED_REQUEST); 123 hostif_sme_enqueue(priv, SME_RSN_MODE_REQUEST); 124 } 125 if (commit_flag & SME_RSN_MULTICAST) 126 hostif_sme_enqueue(priv, SME_RSN_MCAST_REQUEST); 127 if (commit_flag & SME_RSN_UNICAST) 128 hostif_sme_enqueue(priv, SME_RSN_UCAST_REQUEST); 129 if (commit_flag & SME_RSN_AUTH) 130 hostif_sme_enqueue(priv, SME_RSN_AUTH_REQUEST); 131 132 hostif_sme_enqueue(priv, SME_MODE_SET_REQUEST); 133 134 hostif_sme_enqueue(priv, SME_START_REQUEST); 135 136 return 0; 137 } 138 139 /* 140 * Initial Wireless Extension code for Ks_Wlannet driver by : 141 * Jean Tourrilhes <jt@hpl.hp.com> - HPL - 17 November 00 142 * Conversion to new driver API by : 143 * Jean Tourrilhes <jt@hpl.hp.com> - HPL - 26 March 02 144 * Javier also did a good amount of work here, adding some new extensions 145 * and fixing my code. Let's just say that without him this code just 146 * would not work at all... - Jean II 147 */ 148 149 static int ks_wlan_get_name(struct net_device *dev, 150 struct iw_request_info *info, 151 union iwreq_data *cwrq, 152 char *extra) 153 { 154 struct ks_wlan_private *priv = netdev_priv(dev); 155 156 if (priv->sleep_mode == SLP_SLEEP) 157 return -EPERM; 158 159 /* for SLEEP MODE */ 160 if (priv->dev_state < DEVICE_STATE_READY) 161 strscpy(cwrq->name, "NOT READY!", sizeof(cwrq->name)); 162 else if (priv->reg.phy_type == D_11B_ONLY_MODE) 163 strscpy(cwrq->name, "IEEE 802.11b", sizeof(cwrq->name)); 164 else if (priv->reg.phy_type == D_11G_ONLY_MODE) 165 strscpy(cwrq->name, "IEEE 802.11g", sizeof(cwrq->name)); 166 else 167 strscpy(cwrq->name, "IEEE 802.11b/g", sizeof(cwrq->name)); 168 169 return 0; 170 } 171 172 static int ks_wlan_set_freq(struct net_device *dev, 173 struct iw_request_info *info, 174 union iwreq_data *fwrq, char *extra) 175 { 176 struct ks_wlan_private *priv = netdev_priv(dev); 177 int channel; 178 179 if (priv->sleep_mode == SLP_SLEEP) 180 return -EPERM; 181 182 /* for SLEEP MODE */ 183 /* If setting by frequency, convert to a channel */ 184 if ((fwrq->freq.e == 1) && 185 (fwrq->freq.m >= 241200000) && (fwrq->freq.m <= 248700000)) { 186 int f = fwrq->freq.m / 100000; 187 int c = 0; 188 189 while ((c < 14) && (f != frequency_list[c])) 190 c++; 191 /* Hack to fall through... */ 192 fwrq->freq.e = 0; 193 fwrq->freq.m = c + 1; 194 } 195 /* Setting by channel number */ 196 if ((fwrq->freq.m > 1000) || (fwrq->freq.e > 0)) 197 return -EOPNOTSUPP; 198 199 channel = fwrq->freq.m; 200 /* We should do a better check than that, 201 * based on the card capability !!! 202 */ 203 if ((channel < 1) || (channel > 14)) { 204 netdev_dbg(dev, "%s: New channel value of %d is invalid!\n", 205 dev->name, fwrq->freq.m); 206 return -EINVAL; 207 } 208 209 /* Yes ! We can set it !!! */ 210 priv->reg.channel = (u8)(channel); 211 priv->need_commit |= SME_MODE_SET; 212 213 return -EINPROGRESS; /* Call commit handler */ 214 } 215 216 static int ks_wlan_get_freq(struct net_device *dev, 217 struct iw_request_info *info, 218 union iwreq_data *fwrq, char *extra) 219 { 220 struct ks_wlan_private *priv = netdev_priv(dev); 221 int f; 222 223 if (priv->sleep_mode == SLP_SLEEP) 224 return -EPERM; 225 226 /* for SLEEP MODE */ 227 if (is_connect_status(priv->connect_status)) 228 f = (int)priv->current_ap.channel; 229 else 230 f = (int)priv->reg.channel; 231 232 fwrq->freq.m = frequency_list[f - 1] * 100000; 233 fwrq->freq.e = 1; 234 235 return 0; 236 } 237 238 static int ks_wlan_set_essid(struct net_device *dev, 239 struct iw_request_info *info, 240 union iwreq_data *dwrq, char *extra) 241 { 242 struct ks_wlan_private *priv = netdev_priv(dev); 243 size_t len; 244 245 if (priv->sleep_mode == SLP_SLEEP) 246 return -EPERM; 247 248 /* for SLEEP MODE */ 249 /* Check if we asked for `any' */ 250 if (!dwrq->essid.flags) { 251 /* Just send an empty SSID list */ 252 memset(priv->reg.ssid.body, 0, sizeof(priv->reg.ssid.body)); 253 priv->reg.ssid.size = 0; 254 } else { 255 len = dwrq->essid.length; 256 /* iwconfig uses nul termination in SSID.. */ 257 if (len > 0 && extra[len - 1] == '\0') 258 len--; 259 260 /* Check the size of the string */ 261 if (len > IW_ESSID_MAX_SIZE) 262 return -EINVAL; 263 264 /* Set the SSID */ 265 memset(priv->reg.ssid.body, 0, sizeof(priv->reg.ssid.body)); 266 memcpy(priv->reg.ssid.body, extra, len); 267 priv->reg.ssid.size = len; 268 } 269 /* Write it to the card */ 270 priv->need_commit |= SME_MODE_SET; 271 272 ks_wlan_setup_parameter(priv, priv->need_commit); 273 priv->need_commit = 0; 274 return 0; 275 } 276 277 static int ks_wlan_get_essid(struct net_device *dev, 278 struct iw_request_info *info, 279 union iwreq_data *dwrq, char *extra) 280 { 281 struct ks_wlan_private *priv = netdev_priv(dev); 282 283 if (priv->sleep_mode == SLP_SLEEP) 284 return -EPERM; 285 286 /* for SLEEP MODE */ 287 /* Note : if dwrq->flags != 0, we should 288 * get the relevant SSID from the SSID list... 289 */ 290 if (priv->reg.ssid.size != 0) { 291 /* Get the current SSID */ 292 memcpy(extra, priv->reg.ssid.body, priv->reg.ssid.size); 293 294 /* If none, we may want to get the one that was set */ 295 296 /* Push it out ! */ 297 dwrq->essid.length = priv->reg.ssid.size; 298 dwrq->essid.flags = 1; /* active */ 299 } else { 300 dwrq->essid.length = 0; 301 dwrq->essid.flags = 0; /* ANY */ 302 } 303 304 return 0; 305 } 306 307 static int ks_wlan_set_wap(struct net_device *dev, struct iw_request_info *info, 308 union iwreq_data *awrq, char *extra) 309 { 310 struct ks_wlan_private *priv = netdev_priv(dev); 311 312 if (priv->sleep_mode == SLP_SLEEP) 313 return -EPERM; 314 315 /* for SLEEP MODE */ 316 if (priv->reg.operation_mode != MODE_ADHOC && 317 priv->reg.operation_mode != MODE_INFRASTRUCTURE) { 318 eth_zero_addr(priv->reg.bssid); 319 return -EOPNOTSUPP; 320 } 321 322 ether_addr_copy(priv->reg.bssid, awrq->ap_addr.sa_data); 323 if (is_valid_ether_addr((u8 *)priv->reg.bssid)) 324 priv->need_commit |= SME_MODE_SET; 325 326 netdev_dbg(dev, "bssid = %pM\n", priv->reg.bssid); 327 328 /* Write it to the card */ 329 if (priv->need_commit) { 330 priv->need_commit |= SME_MODE_SET; 331 return -EINPROGRESS; /* Call commit handler */ 332 } 333 return 0; 334 } 335 336 static int ks_wlan_get_wap(struct net_device *dev, struct iw_request_info *info, 337 union iwreq_data *awrq, char *extra) 338 { 339 struct ks_wlan_private *priv = netdev_priv(dev); 340 341 if (priv->sleep_mode == SLP_SLEEP) 342 return -EPERM; 343 344 /* for SLEEP MODE */ 345 if (is_connect_status(priv->connect_status)) 346 ether_addr_copy(awrq->ap_addr.sa_data, priv->current_ap.bssid); 347 else 348 eth_zero_addr(awrq->ap_addr.sa_data); 349 350 awrq->ap_addr.sa_family = ARPHRD_ETHER; 351 352 return 0; 353 } 354 355 static int ks_wlan_set_nick(struct net_device *dev, 356 struct iw_request_info *info, 357 union iwreq_data *dwrq, char *extra) 358 { 359 struct ks_wlan_private *priv = netdev_priv(dev); 360 361 if (priv->sleep_mode == SLP_SLEEP) 362 return -EPERM; 363 364 /* for SLEEP MODE */ 365 /* Check the size of the string */ 366 if (dwrq->data.length > 16 + 1) 367 return -E2BIG; 368 369 memset(priv->nick, 0, sizeof(priv->nick)); 370 memcpy(priv->nick, extra, dwrq->data.length); 371 372 return -EINPROGRESS; /* Call commit handler */ 373 } 374 375 static int ks_wlan_get_nick(struct net_device *dev, 376 struct iw_request_info *info, 377 union iwreq_data *dwrq, char *extra) 378 { 379 struct ks_wlan_private *priv = netdev_priv(dev); 380 381 if (priv->sleep_mode == SLP_SLEEP) 382 return -EPERM; 383 384 /* for SLEEP MODE */ 385 strncpy(extra, priv->nick, 16); 386 extra[16] = '\0'; 387 dwrq->data.length = strlen(extra) + 1; 388 389 return 0; 390 } 391 392 static int ks_wlan_set_rate(struct net_device *dev, 393 struct iw_request_info *info, 394 union iwreq_data *vwrq, char *extra) 395 { 396 struct ks_wlan_private *priv = netdev_priv(dev); 397 int i = 0; 398 399 if (priv->sleep_mode == SLP_SLEEP) 400 return -EPERM; 401 402 /* for SLEEP MODE */ 403 if (priv->reg.phy_type == D_11B_ONLY_MODE) { 404 if (vwrq->bitrate.fixed == 1) { 405 switch (vwrq->bitrate.value) { 406 case 11000000: 407 case 5500000: 408 priv->reg.rate_set.body[0] = 409 (u8)(vwrq->bitrate.value / 500000); 410 break; 411 case 2000000: 412 case 1000000: 413 priv->reg.rate_set.body[0] = 414 ((u8)(vwrq->bitrate.value / 500000)) | 415 BASIC_RATE; 416 break; 417 default: 418 return -EINVAL; 419 } 420 priv->reg.tx_rate = TX_RATE_FIXED; 421 priv->reg.rate_set.size = 1; 422 } else { /* vwrq->fixed == 0 */ 423 if (vwrq->bitrate.value > 0) { 424 switch (vwrq->bitrate.value) { 425 case 11000000: 426 priv->reg.rate_set.body[3] = 427 TX_RATE_11M; 428 i++; 429 fallthrough; 430 case 5500000: 431 priv->reg.rate_set.body[2] = TX_RATE_5M; 432 i++; 433 fallthrough; 434 case 2000000: 435 priv->reg.rate_set.body[1] = 436 TX_RATE_2M | BASIC_RATE; 437 i++; 438 fallthrough; 439 case 1000000: 440 priv->reg.rate_set.body[0] = 441 TX_RATE_1M | BASIC_RATE; 442 i++; 443 break; 444 default: 445 return -EINVAL; 446 } 447 priv->reg.tx_rate = TX_RATE_MANUAL_AUTO; 448 priv->reg.rate_set.size = i; 449 } else { 450 priv->reg.rate_set.body[3] = TX_RATE_11M; 451 priv->reg.rate_set.body[2] = TX_RATE_5M; 452 priv->reg.rate_set.body[1] = 453 TX_RATE_2M | BASIC_RATE; 454 priv->reg.rate_set.body[0] = 455 TX_RATE_1M | BASIC_RATE; 456 priv->reg.tx_rate = TX_RATE_FULL_AUTO; 457 priv->reg.rate_set.size = 4; 458 } 459 } 460 } else { /* D_11B_ONLY_MODE or D_11BG_COMPATIBLE_MODE */ 461 if (vwrq->bitrate.fixed == 1) { 462 switch (vwrq->bitrate.value) { 463 case 54000000: 464 case 48000000: 465 case 36000000: 466 case 18000000: 467 case 9000000: 468 priv->reg.rate_set.body[0] = 469 (u8)(vwrq->bitrate.value / 500000); 470 break; 471 case 24000000: 472 case 12000000: 473 case 11000000: 474 case 6000000: 475 case 5500000: 476 case 2000000: 477 case 1000000: 478 priv->reg.rate_set.body[0] = 479 ((u8)(vwrq->bitrate.value / 500000)) | 480 BASIC_RATE; 481 break; 482 default: 483 return -EINVAL; 484 } 485 priv->reg.tx_rate = TX_RATE_FIXED; 486 priv->reg.rate_set.size = 1; 487 } else { /* vwrq->fixed == 0 */ 488 if (vwrq->bitrate.value > 0) { 489 switch (vwrq->bitrate.value) { 490 case 54000000: 491 priv->reg.rate_set.body[11] = 492 TX_RATE_54M; 493 i++; 494 fallthrough; 495 case 48000000: 496 priv->reg.rate_set.body[10] = 497 TX_RATE_48M; 498 i++; 499 fallthrough; 500 case 36000000: 501 priv->reg.rate_set.body[9] = 502 TX_RATE_36M; 503 i++; 504 fallthrough; 505 case 24000000: 506 case 18000000: 507 case 12000000: 508 case 11000000: 509 case 9000000: 510 case 6000000: 511 if (vwrq->bitrate.value == 24000000) { 512 priv->reg.rate_set.body[8] = 513 TX_RATE_18M; 514 i++; 515 priv->reg.rate_set.body[7] = 516 TX_RATE_9M; 517 i++; 518 priv->reg.rate_set.body[6] = 519 TX_RATE_24M | BASIC_RATE; 520 i++; 521 priv->reg.rate_set.body[5] = 522 TX_RATE_12M | BASIC_RATE; 523 i++; 524 priv->reg.rate_set.body[4] = 525 TX_RATE_6M | BASIC_RATE; 526 i++; 527 priv->reg.rate_set.body[3] = 528 TX_RATE_11M | BASIC_RATE; 529 i++; 530 } else if (vwrq->bitrate.value == 18000000) { 531 priv->reg.rate_set.body[7] = 532 TX_RATE_18M; 533 i++; 534 priv->reg.rate_set.body[6] = 535 TX_RATE_9M; 536 i++; 537 priv->reg.rate_set.body[5] = 538 TX_RATE_12M | BASIC_RATE; 539 i++; 540 priv->reg.rate_set.body[4] = 541 TX_RATE_6M | BASIC_RATE; 542 i++; 543 priv->reg.rate_set.body[3] = 544 TX_RATE_11M | BASIC_RATE; 545 i++; 546 } else if (vwrq->bitrate.value == 12000000) { 547 priv->reg.rate_set.body[6] = 548 TX_RATE_9M; 549 i++; 550 priv->reg.rate_set.body[5] = 551 TX_RATE_12M | BASIC_RATE; 552 i++; 553 priv->reg.rate_set.body[4] = 554 TX_RATE_6M | BASIC_RATE; 555 i++; 556 priv->reg.rate_set.body[3] = 557 TX_RATE_11M | BASIC_RATE; 558 i++; 559 } else if (vwrq->bitrate.value == 11000000) { 560 priv->reg.rate_set.body[5] = 561 TX_RATE_9M; 562 i++; 563 priv->reg.rate_set.body[4] = 564 TX_RATE_6M | BASIC_RATE; 565 i++; 566 priv->reg.rate_set.body[3] = 567 TX_RATE_11M | BASIC_RATE; 568 i++; 569 } else if (vwrq->bitrate.value == 9000000) { 570 priv->reg.rate_set.body[4] = 571 TX_RATE_9M; 572 i++; 573 priv->reg.rate_set.body[3] = 574 TX_RATE_6M | BASIC_RATE; 575 i++; 576 } else { /* vwrq->value == 6000000 */ 577 priv->reg.rate_set.body[3] = 578 TX_RATE_6M | BASIC_RATE; 579 i++; 580 } 581 fallthrough; 582 case 5500000: 583 priv->reg.rate_set.body[2] = 584 TX_RATE_5M | BASIC_RATE; 585 i++; 586 fallthrough; 587 case 2000000: 588 priv->reg.rate_set.body[1] = 589 TX_RATE_2M | BASIC_RATE; 590 i++; 591 fallthrough; 592 case 1000000: 593 priv->reg.rate_set.body[0] = 594 TX_RATE_1M | BASIC_RATE; 595 i++; 596 break; 597 default: 598 return -EINVAL; 599 } 600 priv->reg.tx_rate = TX_RATE_MANUAL_AUTO; 601 priv->reg.rate_set.size = i; 602 } else { 603 priv->reg.rate_set.body[11] = TX_RATE_54M; 604 priv->reg.rate_set.body[10] = TX_RATE_48M; 605 priv->reg.rate_set.body[9] = TX_RATE_36M; 606 priv->reg.rate_set.body[8] = TX_RATE_18M; 607 priv->reg.rate_set.body[7] = TX_RATE_9M; 608 priv->reg.rate_set.body[6] = 609 TX_RATE_24M | BASIC_RATE; 610 priv->reg.rate_set.body[5] = 611 TX_RATE_12M | BASIC_RATE; 612 priv->reg.rate_set.body[4] = 613 TX_RATE_6M | BASIC_RATE; 614 priv->reg.rate_set.body[3] = 615 TX_RATE_11M | BASIC_RATE; 616 priv->reg.rate_set.body[2] = 617 TX_RATE_5M | BASIC_RATE; 618 priv->reg.rate_set.body[1] = 619 TX_RATE_2M | BASIC_RATE; 620 priv->reg.rate_set.body[0] = 621 TX_RATE_1M | BASIC_RATE; 622 priv->reg.tx_rate = TX_RATE_FULL_AUTO; 623 priv->reg.rate_set.size = 12; 624 } 625 } 626 } 627 628 priv->need_commit |= SME_MODE_SET; 629 630 return -EINPROGRESS; /* Call commit handler */ 631 } 632 633 static int ks_wlan_get_rate(struct net_device *dev, 634 struct iw_request_info *info, 635 union iwreq_data *vwrq, char *extra) 636 { 637 struct ks_wlan_private *priv = netdev_priv(dev); 638 639 netdev_dbg(dev, "in_interrupt = %ld update_phyinfo = %d\n", 640 in_interrupt(), atomic_read(&update_phyinfo)); 641 642 if (priv->sleep_mode == SLP_SLEEP) 643 return -EPERM; 644 645 /* for SLEEP MODE */ 646 if (!atomic_read(&update_phyinfo)) 647 ks_wlan_update_phy_information(priv); 648 649 vwrq->bitrate.value = ((priv->current_rate) & RATE_MASK) * 500000; 650 vwrq->bitrate.fixed = (priv->reg.tx_rate == TX_RATE_FIXED) ? 1 : 0; 651 652 return 0; 653 } 654 655 static int ks_wlan_set_rts(struct net_device *dev, struct iw_request_info *info, 656 union iwreq_data *vwrq, char *extra) 657 { 658 struct ks_wlan_private *priv = netdev_priv(dev); 659 int rthr = vwrq->rts.value; 660 661 if (priv->sleep_mode == SLP_SLEEP) 662 return -EPERM; 663 664 /* for SLEEP MODE */ 665 if (vwrq->rts.disabled) 666 rthr = 2347; 667 if ((rthr < 0) || (rthr > 2347)) 668 return -EINVAL; 669 670 priv->reg.rts = rthr; 671 priv->need_commit |= SME_RTS; 672 673 return -EINPROGRESS; /* Call commit handler */ 674 } 675 676 static int ks_wlan_get_rts(struct net_device *dev, struct iw_request_info *info, 677 union iwreq_data *vwrq, char *extra) 678 { 679 struct ks_wlan_private *priv = netdev_priv(dev); 680 681 if (priv->sleep_mode == SLP_SLEEP) 682 return -EPERM; 683 684 /* for SLEEP MODE */ 685 vwrq->rts.value = priv->reg.rts; 686 vwrq->rts.disabled = (vwrq->rts.value >= 2347); 687 vwrq->rts.fixed = 1; 688 689 return 0; 690 } 691 692 static int ks_wlan_set_frag(struct net_device *dev, 693 struct iw_request_info *info, 694 union iwreq_data *vwrq, char *extra) 695 { 696 struct ks_wlan_private *priv = netdev_priv(dev); 697 int fthr = vwrq->frag.value; 698 699 if (priv->sleep_mode == SLP_SLEEP) 700 return -EPERM; 701 702 /* for SLEEP MODE */ 703 if (vwrq->frag.disabled) 704 fthr = 2346; 705 if ((fthr < 256) || (fthr > 2346)) 706 return -EINVAL; 707 708 fthr &= ~0x1; /* Get an even value - is it really needed ??? */ 709 priv->reg.fragment = fthr; 710 priv->need_commit |= SME_FRAG; 711 712 return -EINPROGRESS; /* Call commit handler */ 713 } 714 715 static int ks_wlan_get_frag(struct net_device *dev, 716 struct iw_request_info *info, 717 union iwreq_data *vwrq, char *extra) 718 { 719 struct ks_wlan_private *priv = netdev_priv(dev); 720 721 if (priv->sleep_mode == SLP_SLEEP) 722 return -EPERM; 723 724 /* for SLEEP MODE */ 725 vwrq->frag.value = priv->reg.fragment; 726 vwrq->frag.disabled = (vwrq->frag.value >= 2346); 727 vwrq->frag.fixed = 1; 728 729 return 0; 730 } 731 732 static int ks_wlan_set_mode(struct net_device *dev, 733 struct iw_request_info *info, 734 union iwreq_data *uwrq, char *extra) 735 { 736 struct ks_wlan_private *priv = netdev_priv(dev); 737 738 if (priv->sleep_mode == SLP_SLEEP) 739 return -EPERM; 740 741 if (uwrq->mode != IW_MODE_ADHOC && 742 uwrq->mode != IW_MODE_INFRA) 743 return -EINVAL; 744 745 priv->reg.operation_mode = (uwrq->mode == IW_MODE_ADHOC) ? 746 MODE_ADHOC : MODE_INFRASTRUCTURE; 747 priv->need_commit |= SME_MODE_SET; 748 749 return -EINPROGRESS; /* Call commit handler */ 750 } 751 752 static int ks_wlan_get_mode(struct net_device *dev, 753 struct iw_request_info *info, 754 union iwreq_data *uwrq, char *extra) 755 { 756 struct ks_wlan_private *priv = netdev_priv(dev); 757 758 if (priv->sleep_mode == SLP_SLEEP) 759 return -EPERM; 760 761 /* If not managed, assume it's ad-hoc */ 762 uwrq->mode = (priv->reg.operation_mode == MODE_INFRASTRUCTURE) ? 763 IW_MODE_INFRA : IW_MODE_ADHOC; 764 765 return 0; 766 } 767 768 static int ks_wlan_set_encode(struct net_device *dev, 769 struct iw_request_info *info, 770 union iwreq_data *dwrq, char *extra) 771 { 772 struct ks_wlan_private *priv = netdev_priv(dev); 773 struct iw_point *enc = &dwrq->encoding; 774 struct wep_key key; 775 int index = (enc->flags & IW_ENCODE_INDEX); 776 777 if (priv->sleep_mode == SLP_SLEEP) 778 return -EPERM; 779 780 if (enc->length > MAX_KEY_SIZE) 781 return -EINVAL; 782 783 /* for SLEEP MODE */ 784 if ((index < 0) || (index > 4)) 785 return -EINVAL; 786 787 index = (index == 0) ? priv->reg.wep_index : (index - 1); 788 789 /* Is WEP supported ? */ 790 /* Basic checking: do we have a key to set ? */ 791 if (enc->length > 0) { 792 key.len = (enc->length > MIN_KEY_SIZE) ? 793 MAX_KEY_SIZE : MIN_KEY_SIZE; 794 priv->reg.privacy_invoked = 0x01; 795 priv->need_commit |= SME_WEP_FLAG; 796 wep_on_off = (enc->length > MIN_KEY_SIZE) ? 797 WEP_ON_128BIT : WEP_ON_64BIT; 798 /* Check if the key is not marked as invalid */ 799 if (enc->flags & IW_ENCODE_NOKEY) 800 return 0; 801 802 /* Cleanup */ 803 memset(key.key, 0, MAX_KEY_SIZE); 804 /* Copy the key in the driver */ 805 if (copy_from_user(key.key, enc->pointer, enc->length)) { 806 key.len = 0; 807 return -EFAULT; 808 } 809 /* Send the key to the card */ 810 priv->reg.wep_key[index].size = key.len; 811 memcpy(&priv->reg.wep_key[index].val[0], &key.key[0], 812 priv->reg.wep_key[index].size); 813 priv->need_commit |= (SME_WEP_VAL1 << index); 814 priv->reg.wep_index = index; 815 priv->need_commit |= SME_WEP_INDEX; 816 } else { 817 if (enc->flags & IW_ENCODE_DISABLED) { 818 priv->reg.wep_key[0].size = 0; 819 priv->reg.wep_key[1].size = 0; 820 priv->reg.wep_key[2].size = 0; 821 priv->reg.wep_key[3].size = 0; 822 priv->reg.privacy_invoked = 0x00; 823 if (priv->reg.authenticate_type == AUTH_TYPE_SHARED_KEY) 824 priv->need_commit |= SME_MODE_SET; 825 826 priv->reg.authenticate_type = AUTH_TYPE_OPEN_SYSTEM; 827 wep_on_off = WEP_OFF; 828 priv->need_commit |= SME_WEP_FLAG; 829 } else { 830 /* set_wep_key(priv, index, 0, 0, 1); xxx */ 831 if (priv->reg.wep_key[index].size == 0) 832 return -EINVAL; 833 priv->reg.wep_index = index; 834 priv->need_commit |= SME_WEP_INDEX; 835 } 836 } 837 838 /* Commit the changes if needed */ 839 if (enc->flags & IW_ENCODE_MODE) 840 priv->need_commit |= SME_WEP_FLAG; 841 842 if (enc->flags & IW_ENCODE_OPEN) { 843 if (priv->reg.authenticate_type == AUTH_TYPE_SHARED_KEY) 844 priv->need_commit |= SME_MODE_SET; 845 846 priv->reg.authenticate_type = AUTH_TYPE_OPEN_SYSTEM; 847 } else if (enc->flags & IW_ENCODE_RESTRICTED) { 848 if (priv->reg.authenticate_type == AUTH_TYPE_OPEN_SYSTEM) 849 priv->need_commit |= SME_MODE_SET; 850 851 priv->reg.authenticate_type = AUTH_TYPE_SHARED_KEY; 852 } 853 if (priv->need_commit) { 854 ks_wlan_setup_parameter(priv, priv->need_commit); 855 priv->need_commit = 0; 856 } 857 return 0; 858 } 859 860 static int ks_wlan_get_encode(struct net_device *dev, 861 struct iw_request_info *info, 862 union iwreq_data *dwrq, char *extra) 863 { 864 struct ks_wlan_private *priv = netdev_priv(dev); 865 struct iw_point *enc = &dwrq->encoding; 866 int index = (enc->flags & IW_ENCODE_INDEX) - 1; 867 868 if (priv->sleep_mode == SLP_SLEEP) 869 return -EPERM; 870 871 /* for SLEEP MODE */ 872 enc->flags = IW_ENCODE_DISABLED; 873 874 /* Check encryption mode */ 875 switch (priv->reg.authenticate_type) { 876 case AUTH_TYPE_OPEN_SYSTEM: 877 enc->flags = IW_ENCODE_OPEN; 878 break; 879 case AUTH_TYPE_SHARED_KEY: 880 enc->flags = IW_ENCODE_RESTRICTED; 881 break; 882 } 883 884 /* Which key do we want ? -1 -> tx index */ 885 if ((index < 0) || (index >= 4)) 886 index = priv->reg.wep_index; 887 if (priv->reg.privacy_invoked) { 888 enc->flags &= ~IW_ENCODE_DISABLED; 889 /* dwrq->flags |= IW_ENCODE_NOKEY; */ 890 } 891 enc->flags |= index + 1; 892 /* Copy the key to the user buffer */ 893 if (index >= 0 && index < 4) { 894 enc->length = (priv->reg.wep_key[index].size <= 16) ? 895 priv->reg.wep_key[index].size : 0; 896 memcpy(extra, priv->reg.wep_key[index].val, enc->length); 897 } 898 899 return 0; 900 } 901 902 static int ks_wlan_get_range(struct net_device *dev, 903 struct iw_request_info *info, 904 union iwreq_data *dwrq, char *extra) 905 { 906 struct ks_wlan_private *priv = netdev_priv(dev); 907 struct iw_range *range = (struct iw_range *)extra; 908 int i, k; 909 910 if (priv->sleep_mode == SLP_SLEEP) 911 return -EPERM; 912 913 /* for SLEEP MODE */ 914 dwrq->data.length = sizeof(struct iw_range); 915 memset(range, 0, sizeof(*range)); 916 range->min_nwid = 0x0000; 917 range->max_nwid = 0x0000; 918 range->num_channels = 14; 919 /* Should be based on cap_rid.country to give only 920 * what the current card support 921 */ 922 k = 0; 923 for (i = 0; i < 13; i++) { /* channel 1 -- 13 */ 924 range->freq[k].i = i + 1; /* List index */ 925 range->freq[k].m = frequency_list[i] * 100000; 926 range->freq[k++].e = 1; /* Values in table in MHz -> * 10^5 * 10 */ 927 } 928 range->num_frequency = k; 929 if (priv->reg.phy_type == D_11B_ONLY_MODE || 930 priv->reg.phy_type == D_11BG_COMPATIBLE_MODE) { /* channel 14 */ 931 range->freq[13].i = 14; /* List index */ 932 range->freq[13].m = frequency_list[13] * 100000; 933 range->freq[13].e = 1; /* Values in table in MHz -> * 10^5 * 10 */ 934 range->num_frequency = 14; 935 } 936 937 /* Hum... Should put the right values there */ 938 range->max_qual.qual = 100; 939 range->max_qual.level = 256 - 128; /* 0 dBm? */ 940 range->max_qual.noise = 256 - 128; 941 range->sensitivity = 1; 942 943 if (priv->reg.phy_type == D_11B_ONLY_MODE) { 944 range->bitrate[0] = 1e6; 945 range->bitrate[1] = 2e6; 946 range->bitrate[2] = 5.5e6; 947 range->bitrate[3] = 11e6; 948 range->num_bitrates = 4; 949 } else { /* D_11G_ONLY_MODE or D_11BG_COMPATIBLE_MODE */ 950 range->bitrate[0] = 1e6; 951 range->bitrate[1] = 2e6; 952 range->bitrate[2] = 5.5e6; 953 range->bitrate[3] = 11e6; 954 955 range->bitrate[4] = 6e6; 956 range->bitrate[5] = 9e6; 957 range->bitrate[6] = 12e6; 958 if (IW_MAX_BITRATES < 9) { 959 range->bitrate[7] = 54e6; 960 range->num_bitrates = 8; 961 } else { 962 range->bitrate[7] = 18e6; 963 range->bitrate[8] = 24e6; 964 range->bitrate[9] = 36e6; 965 range->bitrate[10] = 48e6; 966 range->bitrate[11] = 54e6; 967 968 range->num_bitrates = 12; 969 } 970 } 971 972 /* Set an indication of the max TCP throughput 973 * in bit/s that we can expect using this interface. 974 * May be use for QoS stuff... Jean II 975 */ 976 if (i > 2) 977 range->throughput = 5000 * 1000; 978 else 979 range->throughput = 1500 * 1000; 980 981 range->min_rts = 0; 982 range->max_rts = 2347; 983 range->min_frag = 256; 984 range->max_frag = 2346; 985 986 range->encoding_size[0] = 5; /* WEP: RC4 40 bits */ 987 range->encoding_size[1] = 13; /* WEP: RC4 ~128 bits */ 988 range->num_encoding_sizes = 2; 989 range->max_encoding_tokens = 4; 990 991 /* power management not support */ 992 range->pmp_flags = IW_POWER_ON; 993 range->pmt_flags = IW_POWER_ON; 994 range->pm_capa = 0; 995 996 /* Transmit Power - values are in dBm( or mW) */ 997 range->txpower[0] = -256; 998 range->num_txpower = 1; 999 range->txpower_capa = IW_TXPOW_DBM; 1000 /* range->txpower_capa = IW_TXPOW_MWATT; */ 1001 1002 range->we_version_source = 21; 1003 range->we_version_compiled = WIRELESS_EXT; 1004 1005 range->retry_capa = IW_RETRY_ON; 1006 range->retry_flags = IW_RETRY_ON; 1007 range->r_time_flags = IW_RETRY_ON; 1008 1009 /* Experimental measurements - boundary 11/5.5 Mb/s 1010 * 1011 * Note : with or without the (local->rssi), results 1012 * are somewhat different. - Jean II 1013 */ 1014 range->avg_qual.qual = 50; 1015 range->avg_qual.level = 186; /* -70 dBm */ 1016 range->avg_qual.noise = 0; 1017 1018 /* Event capability (kernel + driver) */ 1019 range->event_capa[0] = (IW_EVENT_CAPA_K_0 | 1020 IW_EVENT_CAPA_MASK(SIOCGIWAP) | 1021 IW_EVENT_CAPA_MASK(SIOCGIWSCAN)); 1022 range->event_capa[1] = IW_EVENT_CAPA_K_1; 1023 range->event_capa[4] = (IW_EVENT_CAPA_MASK(IWEVCUSTOM) | 1024 IW_EVENT_CAPA_MASK(IWEVMICHAELMICFAILURE)); 1025 1026 /* encode extension (WPA) capability */ 1027 range->enc_capa = (IW_ENC_CAPA_WPA | 1028 IW_ENC_CAPA_WPA2 | 1029 IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP); 1030 return 0; 1031 } 1032 1033 static int ks_wlan_set_power(struct net_device *dev, 1034 struct iw_request_info *info, 1035 union iwreq_data *vwrq, char *extra) 1036 { 1037 struct ks_wlan_private *priv = netdev_priv(dev); 1038 1039 if (priv->sleep_mode == SLP_SLEEP) 1040 return -EPERM; 1041 1042 if (vwrq->power.disabled) { 1043 priv->reg.power_mgmt = POWER_MGMT_ACTIVE; 1044 } else { 1045 if (priv->reg.operation_mode != MODE_INFRASTRUCTURE) 1046 return -EINVAL; 1047 priv->reg.power_mgmt = POWER_MGMT_SAVE1; 1048 } 1049 1050 hostif_sme_enqueue(priv, SME_POW_MNGMT_REQUEST); 1051 1052 return 0; 1053 } 1054 1055 static int ks_wlan_get_power(struct net_device *dev, 1056 struct iw_request_info *info, 1057 union iwreq_data *vwrq, char *extra) 1058 { 1059 struct ks_wlan_private *priv = netdev_priv(dev); 1060 1061 if (priv->sleep_mode == SLP_SLEEP) 1062 return -EPERM; 1063 /* for SLEEP MODE */ 1064 vwrq->power.disabled = (priv->reg.power_mgmt <= 0); 1065 1066 return 0; 1067 } 1068 1069 static int ks_wlan_get_iwstats(struct net_device *dev, 1070 struct iw_request_info *info, 1071 union iwreq_data *vwrq, char *extra) 1072 { 1073 struct ks_wlan_private *priv = netdev_priv(dev); 1074 1075 if (priv->sleep_mode == SLP_SLEEP) 1076 return -EPERM; 1077 /* for SLEEP MODE */ 1078 vwrq->qual.qual = 0; /* not supported */ 1079 vwrq->qual.level = priv->wstats.qual.level; 1080 vwrq->qual.noise = 0; /* not supported */ 1081 vwrq->qual.updated = 0; 1082 1083 return 0; 1084 } 1085 1086 /* Note : this is deprecated in favor of IWSCAN */ 1087 static int ks_wlan_get_aplist(struct net_device *dev, 1088 struct iw_request_info *info, 1089 union iwreq_data *dwrq, char *extra) 1090 { 1091 struct ks_wlan_private *priv = netdev_priv(dev); 1092 struct sockaddr *address = (struct sockaddr *)extra; 1093 struct iw_quality qual[LOCAL_APLIST_MAX]; 1094 int i; 1095 1096 if (priv->sleep_mode == SLP_SLEEP) 1097 return -EPERM; 1098 /* for SLEEP MODE */ 1099 for (i = 0; i < priv->aplist.size; i++) { 1100 ether_addr_copy(address[i].sa_data, priv->aplist.ap[i].bssid); 1101 address[i].sa_family = ARPHRD_ETHER; 1102 qual[i].level = 256 - priv->aplist.ap[i].rssi; 1103 qual[i].qual = priv->aplist.ap[i].sq; 1104 qual[i].noise = 0; /* invalid noise value */ 1105 qual[i].updated = 7; 1106 } 1107 if (i) { 1108 dwrq->data.flags = 1; /* Should be define'd */ 1109 memcpy(extra + sizeof(struct sockaddr) * i, 1110 &qual, sizeof(struct iw_quality) * i); 1111 } 1112 dwrq->data.length = i; 1113 1114 return 0; 1115 } 1116 1117 static int ks_wlan_set_scan(struct net_device *dev, 1118 struct iw_request_info *info, 1119 union iwreq_data *wrqu, char *extra) 1120 { 1121 struct ks_wlan_private *priv = netdev_priv(dev); 1122 struct iw_scan_req *req = NULL; 1123 int len; 1124 1125 if (priv->sleep_mode == SLP_SLEEP) 1126 return -EPERM; 1127 1128 /* for SLEEP MODE */ 1129 /* specified SSID SCAN */ 1130 if (wrqu->data.length == sizeof(struct iw_scan_req) && 1131 wrqu->data.flags & IW_SCAN_THIS_ESSID) { 1132 req = (struct iw_scan_req *)extra; 1133 len = min_t(int, req->essid_len, IW_ESSID_MAX_SIZE); 1134 priv->scan_ssid_len = len; 1135 memcpy(priv->scan_ssid, req->essid, len); 1136 } else { 1137 priv->scan_ssid_len = 0; 1138 } 1139 1140 priv->sme_i.sme_flag |= SME_AP_SCAN; 1141 hostif_sme_enqueue(priv, SME_BSS_SCAN_REQUEST); 1142 1143 /* At this point, just return to the user. */ 1144 1145 return 0; 1146 } 1147 1148 static char *ks_wlan_add_leader_event(const char *rsn_leader, char *end_buf, 1149 char *current_ev, struct rsn_ie *rsn, 1150 struct iw_event *iwe, 1151 struct iw_request_info *info) 1152 { 1153 char buffer[RSN_IE_BODY_MAX * 2 + 30]; 1154 char *pbuf; 1155 int i; 1156 1157 pbuf = &buffer[0]; 1158 memset(iwe, 0, sizeof(*iwe)); 1159 iwe->cmd = IWEVCUSTOM; 1160 memcpy(buffer, rsn_leader, sizeof(rsn_leader) - 1); 1161 iwe->u.data.length += sizeof(rsn_leader) - 1; 1162 pbuf += sizeof(rsn_leader) - 1; 1163 pbuf += sprintf(pbuf, "%02x", rsn->id); 1164 pbuf += sprintf(pbuf, "%02x", rsn->size); 1165 iwe->u.data.length += 4; 1166 1167 for (i = 0; i < rsn->size; i++) 1168 pbuf += sprintf(pbuf, "%02x", rsn->body[i]); 1169 1170 iwe->u.data.length += rsn->size * 2; 1171 1172 return iwe_stream_add_point(info, current_ev, end_buf, iwe, &buffer[0]); 1173 } 1174 1175 /* 1176 * Translate scan data returned from the card to a card independent 1177 * format that the Wireless Tools will understand - Jean II 1178 */ 1179 static inline char *ks_wlan_translate_scan(struct net_device *dev, 1180 struct iw_request_info *info, 1181 char *current_ev, char *end_buf, 1182 struct local_ap *ap) 1183 { 1184 /* struct ks_wlan_private *priv = (struct ks_wlan_private *)dev->priv; */ 1185 static const char rsn_leader[] = "rsn_ie="; 1186 static const char wpa_leader[] = "wpa_ie="; 1187 struct iw_event iwe; /* Temporary buffer */ 1188 u16 capabilities; 1189 char *current_val; /* For rates */ 1190 int i; 1191 1192 /* First entry *MUST* be the AP MAC address */ 1193 iwe.cmd = SIOCGIWAP; 1194 iwe.u.ap_addr.sa_family = ARPHRD_ETHER; 1195 ether_addr_copy(iwe.u.ap_addr.sa_data, ap->bssid); 1196 current_ev = iwe_stream_add_event(info, current_ev, 1197 end_buf, &iwe, IW_EV_ADDR_LEN); 1198 1199 /* Other entries will be displayed in the order we give them */ 1200 1201 /* Add the ESSID */ 1202 iwe.u.data.length = ap->ssid.size; 1203 if (iwe.u.data.length > 32) 1204 iwe.u.data.length = 32; 1205 iwe.cmd = SIOCGIWESSID; 1206 iwe.u.data.flags = 1; 1207 current_ev = iwe_stream_add_point(info, current_ev, 1208 end_buf, &iwe, ap->ssid.body); 1209 1210 /* Add mode */ 1211 iwe.cmd = SIOCGIWMODE; 1212 capabilities = ap->capability; 1213 if (capabilities & (WLAN_CAPABILITY_ESS | WLAN_CAPABILITY_IBSS)) { 1214 iwe.u.mode = (capabilities & WLAN_CAPABILITY_ESS) ? 1215 IW_MODE_INFRA : IW_MODE_ADHOC; 1216 current_ev = iwe_stream_add_event(info, current_ev, 1217 end_buf, &iwe, IW_EV_UINT_LEN); 1218 } 1219 1220 /* Add frequency */ 1221 iwe.cmd = SIOCGIWFREQ; 1222 iwe.u.freq.m = ap->channel; 1223 iwe.u.freq.m = frequency_list[iwe.u.freq.m - 1] * 100000; 1224 iwe.u.freq.e = 1; 1225 current_ev = iwe_stream_add_event(info, current_ev, 1226 end_buf, &iwe, IW_EV_FREQ_LEN); 1227 1228 /* Add quality statistics */ 1229 iwe.cmd = IWEVQUAL; 1230 iwe.u.qual.level = 256 - ap->rssi; 1231 iwe.u.qual.qual = ap->sq; 1232 iwe.u.qual.noise = 0; /* invalid noise value */ 1233 current_ev = iwe_stream_add_event(info, current_ev, end_buf, 1234 &iwe, IW_EV_QUAL_LEN); 1235 1236 /* Add encryption capability */ 1237 iwe.cmd = SIOCGIWENCODE; 1238 iwe.u.data.flags = (capabilities & WLAN_CAPABILITY_PRIVACY) ? 1239 (IW_ENCODE_ENABLED | IW_ENCODE_NOKEY) : 1240 IW_ENCODE_DISABLED; 1241 iwe.u.data.length = 0; 1242 current_ev = iwe_stream_add_point(info, current_ev, end_buf, 1243 &iwe, ap->ssid.body); 1244 1245 /* 1246 * Rate : stuffing multiple values in a single event 1247 * require a bit more of magic - Jean II 1248 */ 1249 current_val = current_ev + IW_EV_LCP_LEN; 1250 1251 iwe.cmd = SIOCGIWRATE; 1252 1253 /* These two flags are ignored... */ 1254 iwe.u.bitrate.fixed = 0; 1255 iwe.u.bitrate.disabled = 0; 1256 1257 /* Max 16 values */ 1258 for (i = 0; i < 16; i++) { 1259 /* NULL terminated */ 1260 if (i >= ap->rate_set.size) 1261 break; 1262 /* Bit rate given in 500 kb/s units (+ 0x80) */ 1263 iwe.u.bitrate.value = ((ap->rate_set.body[i] & 0x7f) * 500000); 1264 /* Add new value to event */ 1265 current_val = iwe_stream_add_value(info, current_ev, 1266 current_val, end_buf, &iwe, 1267 IW_EV_PARAM_LEN); 1268 } 1269 /* Check if we added any event */ 1270 if ((current_val - current_ev) > IW_EV_LCP_LEN) 1271 current_ev = current_val; 1272 1273 if (ap->rsn_ie.id == RSN_INFO_ELEM_ID && ap->rsn_ie.size != 0) 1274 current_ev = ks_wlan_add_leader_event(rsn_leader, end_buf, 1275 current_ev, &ap->rsn_ie, 1276 &iwe, info); 1277 1278 if (ap->wpa_ie.id == WPA_INFO_ELEM_ID && ap->wpa_ie.size != 0) 1279 current_ev = ks_wlan_add_leader_event(wpa_leader, end_buf, 1280 current_ev, &ap->wpa_ie, 1281 &iwe, info); 1282 1283 /* 1284 * The other data in the scan result are not really 1285 * interesting, so for now drop it - Jean II 1286 */ 1287 return current_ev; 1288 } 1289 1290 static int ks_wlan_get_scan(struct net_device *dev, 1291 struct iw_request_info *info, 1292 union iwreq_data *dwrq, char *extra) 1293 { 1294 struct ks_wlan_private *priv = netdev_priv(dev); 1295 int i; 1296 char *current_ev = extra; 1297 1298 if (priv->sleep_mode == SLP_SLEEP) 1299 return -EPERM; 1300 /* for SLEEP MODE */ 1301 if (priv->sme_i.sme_flag & SME_AP_SCAN) 1302 return -EAGAIN; 1303 1304 if (priv->aplist.size == 0) { 1305 /* Client error, no scan results... 1306 * The caller need to restart the scan. 1307 */ 1308 return -ENODATA; 1309 } 1310 1311 /* Read and parse all entries */ 1312 for (i = 0; i < priv->aplist.size; i++) { 1313 if ((extra + dwrq->data.length) - current_ev <= IW_EV_ADDR_LEN) { 1314 dwrq->data.length = 0; 1315 return -E2BIG; 1316 } 1317 /* Translate to WE format this entry */ 1318 current_ev = ks_wlan_translate_scan(dev, info, current_ev, 1319 extra + dwrq->data.length, 1320 &priv->aplist.ap[i]); 1321 } 1322 /* Length of data */ 1323 dwrq->data.length = (current_ev - extra); 1324 dwrq->data.flags = 0; 1325 1326 return 0; 1327 } 1328 1329 /* called after a bunch of SET operations */ 1330 static int ks_wlan_config_commit(struct net_device *dev, 1331 struct iw_request_info *info, 1332 union iwreq_data *zwrq, 1333 char *extra) 1334 { 1335 struct ks_wlan_private *priv = netdev_priv(dev); 1336 1337 if (!priv->need_commit) 1338 return 0; 1339 1340 ks_wlan_setup_parameter(priv, priv->need_commit); 1341 priv->need_commit = 0; 1342 return 0; 1343 } 1344 1345 /* set association ie params */ 1346 static int ks_wlan_set_genie(struct net_device *dev, 1347 struct iw_request_info *info, 1348 union iwreq_data *dwrq, char *extra) 1349 { 1350 struct ks_wlan_private *priv = netdev_priv(dev); 1351 1352 if (priv->sleep_mode == SLP_SLEEP) 1353 return -EPERM; 1354 /* for SLEEP MODE */ 1355 return 0; 1356 // return -EOPNOTSUPP; 1357 } 1358 1359 static int ks_wlan_set_auth_mode(struct net_device *dev, 1360 struct iw_request_info *info, 1361 union iwreq_data *vwrq, char *extra) 1362 { 1363 struct ks_wlan_private *priv = netdev_priv(dev); 1364 struct iw_param *param = &vwrq->param; 1365 int index = (param->flags & IW_AUTH_INDEX); 1366 int value = param->value; 1367 1368 if (priv->sleep_mode == SLP_SLEEP) 1369 return -EPERM; 1370 /* for SLEEP MODE */ 1371 switch (index) { 1372 case IW_AUTH_WPA_VERSION: /* 0 */ 1373 switch (value) { 1374 case IW_AUTH_WPA_VERSION_DISABLED: 1375 priv->wpa.version = value; 1376 if (priv->wpa.rsn_enabled) 1377 priv->wpa.rsn_enabled = false; 1378 priv->need_commit |= SME_RSN; 1379 break; 1380 case IW_AUTH_WPA_VERSION_WPA: 1381 case IW_AUTH_WPA_VERSION_WPA2: 1382 priv->wpa.version = value; 1383 if (!(priv->wpa.rsn_enabled)) 1384 priv->wpa.rsn_enabled = true; 1385 priv->need_commit |= SME_RSN; 1386 break; 1387 default: 1388 return -EOPNOTSUPP; 1389 } 1390 break; 1391 case IW_AUTH_CIPHER_PAIRWISE: /* 1 */ 1392 switch (value) { 1393 case IW_AUTH_CIPHER_NONE: 1394 if (priv->reg.privacy_invoked) { 1395 priv->reg.privacy_invoked = 0x00; 1396 priv->need_commit |= SME_WEP_FLAG; 1397 } 1398 break; 1399 case IW_AUTH_CIPHER_WEP40: 1400 case IW_AUTH_CIPHER_TKIP: 1401 case IW_AUTH_CIPHER_CCMP: 1402 case IW_AUTH_CIPHER_WEP104: 1403 if (!priv->reg.privacy_invoked) { 1404 priv->reg.privacy_invoked = 0x01; 1405 priv->need_commit |= SME_WEP_FLAG; 1406 } 1407 priv->wpa.pairwise_suite = value; 1408 priv->need_commit |= SME_RSN_UNICAST; 1409 break; 1410 default: 1411 return -EOPNOTSUPP; 1412 } 1413 break; 1414 case IW_AUTH_CIPHER_GROUP: /* 2 */ 1415 switch (value) { 1416 case IW_AUTH_CIPHER_NONE: 1417 if (priv->reg.privacy_invoked) { 1418 priv->reg.privacy_invoked = 0x00; 1419 priv->need_commit |= SME_WEP_FLAG; 1420 } 1421 break; 1422 case IW_AUTH_CIPHER_WEP40: 1423 case IW_AUTH_CIPHER_TKIP: 1424 case IW_AUTH_CIPHER_CCMP: 1425 case IW_AUTH_CIPHER_WEP104: 1426 if (!priv->reg.privacy_invoked) { 1427 priv->reg.privacy_invoked = 0x01; 1428 priv->need_commit |= SME_WEP_FLAG; 1429 } 1430 priv->wpa.group_suite = value; 1431 priv->need_commit |= SME_RSN_MULTICAST; 1432 break; 1433 default: 1434 return -EOPNOTSUPP; 1435 } 1436 break; 1437 case IW_AUTH_KEY_MGMT: /* 3 */ 1438 switch (value) { 1439 case IW_AUTH_KEY_MGMT_802_1X: 1440 case IW_AUTH_KEY_MGMT_PSK: 1441 case 0: /* NONE or 802_1X_NO_WPA */ 1442 case 4: /* WPA_NONE */ 1443 priv->wpa.key_mgmt_suite = value; 1444 priv->need_commit |= SME_RSN_AUTH; 1445 break; 1446 default: 1447 return -EOPNOTSUPP; 1448 } 1449 break; 1450 case IW_AUTH_80211_AUTH_ALG: /* 6 */ 1451 switch (value) { 1452 case IW_AUTH_ALG_OPEN_SYSTEM: 1453 priv->wpa.auth_alg = value; 1454 priv->reg.authenticate_type = AUTH_TYPE_OPEN_SYSTEM; 1455 break; 1456 case IW_AUTH_ALG_SHARED_KEY: 1457 priv->wpa.auth_alg = value; 1458 priv->reg.authenticate_type = AUTH_TYPE_SHARED_KEY; 1459 break; 1460 case IW_AUTH_ALG_LEAP: 1461 default: 1462 return -EOPNOTSUPP; 1463 } 1464 priv->need_commit |= SME_MODE_SET; 1465 break; 1466 case IW_AUTH_WPA_ENABLED: /* 7 */ 1467 priv->wpa.wpa_enabled = value; 1468 break; 1469 case IW_AUTH_PRIVACY_INVOKED: /* 10 */ 1470 if ((value && !priv->reg.privacy_invoked) || 1471 (!value && priv->reg.privacy_invoked)) { 1472 priv->reg.privacy_invoked = value ? 0x01 : 0x00; 1473 priv->need_commit |= SME_WEP_FLAG; 1474 } 1475 break; 1476 case IW_AUTH_RX_UNENCRYPTED_EAPOL: /* 4 */ 1477 case IW_AUTH_TKIP_COUNTERMEASURES: /* 5 */ 1478 case IW_AUTH_DROP_UNENCRYPTED: /* 8 */ 1479 case IW_AUTH_ROAMING_CONTROL: /* 9 */ 1480 default: 1481 break; 1482 } 1483 1484 /* return -EINPROGRESS; */ 1485 if (priv->need_commit) { 1486 ks_wlan_setup_parameter(priv, priv->need_commit); 1487 priv->need_commit = 0; 1488 } 1489 return 0; 1490 } 1491 1492 static int ks_wlan_get_auth_mode(struct net_device *dev, 1493 struct iw_request_info *info, 1494 union iwreq_data *vwrq, char *extra) 1495 { 1496 struct ks_wlan_private *priv = netdev_priv(dev); 1497 struct iw_param *param = &vwrq->param; 1498 int index = (param->flags & IW_AUTH_INDEX); 1499 1500 if (priv->sleep_mode == SLP_SLEEP) 1501 return -EPERM; 1502 1503 /* for SLEEP MODE */ 1504 /* WPA (not used ?? wpa_supplicant) */ 1505 switch (index) { 1506 case IW_AUTH_WPA_VERSION: 1507 param->value = priv->wpa.version; 1508 break; 1509 case IW_AUTH_CIPHER_PAIRWISE: 1510 param->value = priv->wpa.pairwise_suite; 1511 break; 1512 case IW_AUTH_CIPHER_GROUP: 1513 param->value = priv->wpa.group_suite; 1514 break; 1515 case IW_AUTH_KEY_MGMT: 1516 param->value = priv->wpa.key_mgmt_suite; 1517 break; 1518 case IW_AUTH_80211_AUTH_ALG: 1519 param->value = priv->wpa.auth_alg; 1520 break; 1521 case IW_AUTH_WPA_ENABLED: 1522 param->value = priv->wpa.rsn_enabled; 1523 break; 1524 case IW_AUTH_RX_UNENCRYPTED_EAPOL: /* OK??? */ 1525 case IW_AUTH_TKIP_COUNTERMEASURES: 1526 case IW_AUTH_DROP_UNENCRYPTED: 1527 default: 1528 /* return -EOPNOTSUPP; */ 1529 break; 1530 } 1531 return 0; 1532 } 1533 1534 /* set encoding token & mode (WPA)*/ 1535 static int ks_wlan_set_encode_ext(struct net_device *dev, 1536 struct iw_request_info *info, 1537 union iwreq_data *dwrq, char *extra) 1538 { 1539 struct ks_wlan_private *priv = netdev_priv(dev); 1540 struct iw_encode_ext *enc; 1541 int index = dwrq->encoding.flags & IW_ENCODE_INDEX; 1542 unsigned int commit = 0; 1543 struct wpa_key *key; 1544 1545 enc = (struct iw_encode_ext *)extra; 1546 if (!enc) 1547 return -EINVAL; 1548 1549 if (priv->sleep_mode == SLP_SLEEP) 1550 return -EPERM; 1551 1552 /* for SLEEP MODE */ 1553 if (index < 1 || index > 4) 1554 return -EINVAL; 1555 index--; 1556 key = &priv->wpa.key[index]; 1557 1558 if (dwrq->encoding.flags & IW_ENCODE_DISABLED) 1559 key->key_len = 0; 1560 1561 key->ext_flags = enc->ext_flags; 1562 if (enc->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) { 1563 priv->wpa.txkey = index; 1564 commit |= SME_WEP_INDEX; 1565 } else if (enc->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) { 1566 memcpy(&key->rx_seq[0], &enc->rx_seq[0], IW_ENCODE_SEQ_MAX_SIZE); 1567 } 1568 1569 ether_addr_copy(&key->addr.sa_data[0], &enc->addr.sa_data[0]); 1570 1571 switch (enc->alg) { 1572 case IW_ENCODE_ALG_NONE: 1573 if (priv->reg.privacy_invoked) { 1574 priv->reg.privacy_invoked = 0x00; 1575 commit |= SME_WEP_FLAG; 1576 } 1577 key->key_len = 0; 1578 1579 break; 1580 case IW_ENCODE_ALG_WEP: 1581 case IW_ENCODE_ALG_CCMP: 1582 if (!priv->reg.privacy_invoked) { 1583 priv->reg.privacy_invoked = 0x01; 1584 commit |= SME_WEP_FLAG; 1585 } 1586 if (enc->key_len) { 1587 memcpy(&key->key_val[0], &enc->key[0], enc->key_len); 1588 key->key_len = enc->key_len; 1589 commit |= (SME_WEP_VAL1 << index); 1590 } 1591 break; 1592 case IW_ENCODE_ALG_TKIP: 1593 if (!priv->reg.privacy_invoked) { 1594 priv->reg.privacy_invoked = 0x01; 1595 commit |= SME_WEP_FLAG; 1596 } 1597 if (enc->key_len == 32) { 1598 memcpy(&key->key_val[0], &enc->key[0], enc->key_len - 16); 1599 key->key_len = enc->key_len - 16; 1600 if (priv->wpa.key_mgmt_suite == 4) { /* WPA_NONE */ 1601 memcpy(&key->tx_mic_key[0], &enc->key[16], 8); 1602 memcpy(&key->rx_mic_key[0], &enc->key[16], 8); 1603 } else { 1604 memcpy(&key->tx_mic_key[0], &enc->key[16], 8); 1605 memcpy(&key->rx_mic_key[0], &enc->key[24], 8); 1606 } 1607 commit |= (SME_WEP_VAL1 << index); 1608 } 1609 break; 1610 default: 1611 return -EINVAL; 1612 } 1613 key->alg = enc->alg; 1614 1615 if (commit) { 1616 if (commit & SME_WEP_INDEX) 1617 hostif_sme_enqueue(priv, SME_SET_TXKEY); 1618 if (commit & SME_WEP_VAL_MASK) 1619 hostif_sme_enqueue(priv, SME_SET_KEY1 + index); 1620 if (commit & SME_WEP_FLAG) 1621 hostif_sme_enqueue(priv, SME_WEP_FLAG_REQUEST); 1622 } 1623 1624 return 0; 1625 } 1626 1627 /* get encoding token & mode (WPA)*/ 1628 static int ks_wlan_get_encode_ext(struct net_device *dev, 1629 struct iw_request_info *info, 1630 union iwreq_data *dwrq, char *extra) 1631 { 1632 struct ks_wlan_private *priv = netdev_priv(dev); 1633 1634 if (priv->sleep_mode == SLP_SLEEP) 1635 return -EPERM; 1636 1637 /* for SLEEP MODE */ 1638 /* WPA (not used ?? wpa_supplicant) 1639 * struct ks_wlan_private *priv = (struct ks_wlan_private *)dev->priv; 1640 * struct iw_encode_ext *enc; 1641 * enc = (struct iw_encode_ext *)extra; 1642 * int index = dwrq->flags & IW_ENCODE_INDEX; 1643 * WPA (not used ?? wpa_supplicant) 1644 */ 1645 return 0; 1646 } 1647 1648 static int ks_wlan_set_pmksa(struct net_device *dev, 1649 struct iw_request_info *info, 1650 union iwreq_data *dwrq, char *extra) 1651 { 1652 struct ks_wlan_private *priv = netdev_priv(dev); 1653 struct iw_pmksa *pmksa; 1654 int i; 1655 struct pmk *pmk; 1656 struct list_head *ptr; 1657 1658 if (priv->sleep_mode == SLP_SLEEP) 1659 return -EPERM; 1660 1661 /* for SLEEP MODE */ 1662 if (!extra) 1663 return -EINVAL; 1664 1665 pmksa = (struct iw_pmksa *)extra; 1666 1667 switch (pmksa->cmd) { 1668 case IW_PMKSA_ADD: 1669 if (list_empty(&priv->pmklist.head)) { 1670 for (i = 0; i < PMK_LIST_MAX; i++) { 1671 pmk = &priv->pmklist.pmk[i]; 1672 if (is_zero_ether_addr(pmk->bssid)) 1673 break; 1674 } 1675 ether_addr_copy(pmk->bssid, pmksa->bssid.sa_data); 1676 memcpy(pmk->pmkid, pmksa->pmkid, IW_PMKID_LEN); 1677 list_add(&pmk->list, &priv->pmklist.head); 1678 priv->pmklist.size++; 1679 break; 1680 } 1681 /* search cache data */ 1682 list_for_each(ptr, &priv->pmklist.head) { 1683 pmk = list_entry(ptr, struct pmk, list); 1684 if (ether_addr_equal(pmksa->bssid.sa_data, pmk->bssid)) { 1685 memcpy(pmk->pmkid, pmksa->pmkid, IW_PMKID_LEN); 1686 list_move(&pmk->list, &priv->pmklist.head); 1687 break; 1688 } 1689 } 1690 /* not find address. */ 1691 if (ptr != &priv->pmklist.head) 1692 break; 1693 /* new cache data */ 1694 if (priv->pmklist.size < PMK_LIST_MAX) { 1695 for (i = 0; i < PMK_LIST_MAX; i++) { 1696 pmk = &priv->pmklist.pmk[i]; 1697 if (is_zero_ether_addr(pmk->bssid)) 1698 break; 1699 } 1700 ether_addr_copy(pmk->bssid, pmksa->bssid.sa_data); 1701 memcpy(pmk->pmkid, pmksa->pmkid, IW_PMKID_LEN); 1702 list_add(&pmk->list, &priv->pmklist.head); 1703 priv->pmklist.size++; 1704 } else { /* overwrite old cache data */ 1705 pmk = list_entry(priv->pmklist.head.prev, struct pmk, 1706 list); 1707 ether_addr_copy(pmk->bssid, pmksa->bssid.sa_data); 1708 memcpy(pmk->pmkid, pmksa->pmkid, IW_PMKID_LEN); 1709 list_move(&pmk->list, &priv->pmklist.head); 1710 } 1711 break; 1712 case IW_PMKSA_REMOVE: 1713 if (list_empty(&priv->pmklist.head)) 1714 return -EINVAL; 1715 /* search cache data */ 1716 list_for_each(ptr, &priv->pmklist.head) { 1717 pmk = list_entry(ptr, struct pmk, list); 1718 if (ether_addr_equal(pmksa->bssid.sa_data, pmk->bssid)) { 1719 eth_zero_addr(pmk->bssid); 1720 memset(pmk->pmkid, 0, IW_PMKID_LEN); 1721 list_del_init(&pmk->list); 1722 break; 1723 } 1724 } 1725 /* not find address. */ 1726 if (ptr == &priv->pmklist.head) 1727 return 0; 1728 break; 1729 case IW_PMKSA_FLUSH: 1730 memset(&priv->pmklist, 0, sizeof(priv->pmklist)); 1731 INIT_LIST_HEAD(&priv->pmklist.head); 1732 for (i = 0; i < PMK_LIST_MAX; i++) 1733 INIT_LIST_HEAD(&priv->pmklist.pmk[i].list); 1734 break; 1735 default: 1736 return -EINVAL; 1737 } 1738 1739 hostif_sme_enqueue(priv, SME_SET_PMKSA); 1740 return 0; 1741 } 1742 1743 static struct iw_statistics *ks_get_wireless_stats(struct net_device *dev) 1744 { 1745 struct ks_wlan_private *priv = netdev_priv(dev); 1746 struct iw_statistics *wstats = &priv->wstats; 1747 1748 if (!atomic_read(&update_phyinfo)) 1749 return (priv->dev_state < DEVICE_STATE_READY) ? NULL : wstats; 1750 1751 /* 1752 * Packets discarded in the wireless adapter due to wireless 1753 * specific problems 1754 */ 1755 wstats->discard.nwid = 0; /* Rx invalid nwid */ 1756 wstats->discard.code = 0; /* Rx invalid crypt */ 1757 wstats->discard.fragment = 0; /* Rx invalid frag */ 1758 wstats->discard.retries = 0; /* Tx excessive retries */ 1759 wstats->discard.misc = 0; /* Invalid misc */ 1760 wstats->miss.beacon = 0; /* Missed beacon */ 1761 1762 return wstats; 1763 } 1764 1765 static int ks_wlan_set_stop_request(struct net_device *dev, 1766 struct iw_request_info *info, __u32 *uwrq, 1767 char *extra) 1768 { 1769 struct ks_wlan_private *priv = netdev_priv(dev); 1770 1771 if (priv->sleep_mode == SLP_SLEEP) 1772 return -EPERM; 1773 1774 /* for SLEEP MODE */ 1775 if (!(*uwrq)) 1776 return -EINVAL; 1777 1778 hostif_sme_enqueue(priv, SME_STOP_REQUEST); 1779 return 0; 1780 } 1781 1782 #include <linux/ieee80211.h> 1783 static int ks_wlan_set_mlme(struct net_device *dev, 1784 struct iw_request_info *info, 1785 union iwreq_data *dwrq, char *extra) 1786 { 1787 struct ks_wlan_private *priv = netdev_priv(dev); 1788 struct iw_mlme *mlme = (struct iw_mlme *)extra; 1789 __u32 mode = 1; 1790 1791 if (priv->sleep_mode == SLP_SLEEP) 1792 return -EPERM; 1793 1794 if (mlme->cmd != IW_MLME_DEAUTH && 1795 mlme->cmd != IW_MLME_DISASSOC) 1796 return -EOPNOTSUPP; 1797 1798 if (mlme->cmd == IW_MLME_DEAUTH && 1799 mlme->reason_code == WLAN_REASON_MIC_FAILURE) 1800 return 0; 1801 1802 return ks_wlan_set_stop_request(dev, NULL, &mode, NULL); 1803 } 1804 1805 static int ks_wlan_get_firmware_version(struct net_device *dev, 1806 struct iw_request_info *info, 1807 struct iw_point *dwrq, char *extra) 1808 { 1809 struct ks_wlan_private *priv = netdev_priv(dev); 1810 1811 dwrq->length = priv->version_size + 1; 1812 strscpy(extra, priv->firmware_version, dwrq->length); 1813 return 0; 1814 } 1815 1816 static int ks_wlan_set_preamble(struct net_device *dev, 1817 struct iw_request_info *info, __u32 *uwrq, 1818 char *extra) 1819 { 1820 struct ks_wlan_private *priv = netdev_priv(dev); 1821 1822 if (priv->sleep_mode == SLP_SLEEP) 1823 return -EPERM; 1824 1825 /* for SLEEP MODE */ 1826 if (*uwrq != LONG_PREAMBLE && *uwrq != SHORT_PREAMBLE) 1827 return -EINVAL; 1828 1829 priv->reg.preamble = *uwrq; 1830 priv->need_commit |= SME_MODE_SET; 1831 return -EINPROGRESS; /* Call commit handler */ 1832 } 1833 1834 static int ks_wlan_get_preamble(struct net_device *dev, 1835 struct iw_request_info *info, __u32 *uwrq, 1836 char *extra) 1837 { 1838 struct ks_wlan_private *priv = netdev_priv(dev); 1839 1840 if (priv->sleep_mode == SLP_SLEEP) 1841 return -EPERM; 1842 1843 /* for SLEEP MODE */ 1844 *uwrq = priv->reg.preamble; 1845 return 0; 1846 } 1847 1848 static int ks_wlan_set_power_mgmt(struct net_device *dev, 1849 struct iw_request_info *info, __u32 *uwrq, 1850 char *extra) 1851 { 1852 struct ks_wlan_private *priv = netdev_priv(dev); 1853 1854 if (priv->sleep_mode == SLP_SLEEP) 1855 return -EPERM; 1856 1857 if (*uwrq != POWER_MGMT_ACTIVE && 1858 *uwrq != POWER_MGMT_SAVE1 && 1859 *uwrq != POWER_MGMT_SAVE2) 1860 return -EINVAL; 1861 1862 if ((*uwrq == POWER_MGMT_SAVE1 || *uwrq == POWER_MGMT_SAVE2) && 1863 (priv->reg.operation_mode != MODE_INFRASTRUCTURE)) 1864 return -EINVAL; 1865 1866 priv->reg.power_mgmt = *uwrq; 1867 hostif_sme_enqueue(priv, SME_POW_MNGMT_REQUEST); 1868 1869 return 0; 1870 } 1871 1872 static int ks_wlan_get_power_mgmt(struct net_device *dev, 1873 struct iw_request_info *info, __u32 *uwrq, 1874 char *extra) 1875 { 1876 struct ks_wlan_private *priv = netdev_priv(dev); 1877 1878 if (priv->sleep_mode == SLP_SLEEP) 1879 return -EPERM; 1880 1881 /* for SLEEP MODE */ 1882 *uwrq = priv->reg.power_mgmt; 1883 return 0; 1884 } 1885 1886 static int ks_wlan_set_scan_type(struct net_device *dev, 1887 struct iw_request_info *info, __u32 *uwrq, 1888 char *extra) 1889 { 1890 struct ks_wlan_private *priv = netdev_priv(dev); 1891 1892 if (priv->sleep_mode == SLP_SLEEP) 1893 return -EPERM; 1894 /* for SLEEP MODE */ 1895 1896 if (*uwrq != ACTIVE_SCAN && *uwrq != PASSIVE_SCAN) 1897 return -EINVAL; 1898 1899 priv->reg.scan_type = *uwrq; 1900 return 0; 1901 } 1902 1903 static int ks_wlan_get_scan_type(struct net_device *dev, 1904 struct iw_request_info *info, __u32 *uwrq, 1905 char *extra) 1906 { 1907 struct ks_wlan_private *priv = netdev_priv(dev); 1908 1909 if (priv->sleep_mode == SLP_SLEEP) 1910 return -EPERM; 1911 /* for SLEEP MODE */ 1912 *uwrq = priv->reg.scan_type; 1913 return 0; 1914 } 1915 1916 static int ks_wlan_set_beacon_lost(struct net_device *dev, 1917 struct iw_request_info *info, __u32 *uwrq, 1918 char *extra) 1919 { 1920 struct ks_wlan_private *priv = netdev_priv(dev); 1921 1922 if (priv->sleep_mode == SLP_SLEEP) 1923 return -EPERM; 1924 /* for SLEEP MODE */ 1925 if (*uwrq > BEACON_LOST_COUNT_MAX) 1926 return -EINVAL; 1927 1928 priv->reg.beacon_lost_count = *uwrq; 1929 1930 if (priv->reg.operation_mode == MODE_INFRASTRUCTURE) { 1931 priv->need_commit |= SME_MODE_SET; 1932 return -EINPROGRESS; /* Call commit handler */ 1933 } 1934 1935 return 0; 1936 } 1937 1938 static int ks_wlan_get_beacon_lost(struct net_device *dev, 1939 struct iw_request_info *info, __u32 *uwrq, 1940 char *extra) 1941 { 1942 struct ks_wlan_private *priv = netdev_priv(dev); 1943 1944 if (priv->sleep_mode == SLP_SLEEP) 1945 return -EPERM; 1946 /* for SLEEP MODE */ 1947 *uwrq = priv->reg.beacon_lost_count; 1948 return 0; 1949 } 1950 1951 static int ks_wlan_set_phy_type(struct net_device *dev, 1952 struct iw_request_info *info, __u32 *uwrq, 1953 char *extra) 1954 { 1955 struct ks_wlan_private *priv = netdev_priv(dev); 1956 1957 if (priv->sleep_mode == SLP_SLEEP) 1958 return -EPERM; 1959 1960 if (*uwrq != D_11B_ONLY_MODE && 1961 *uwrq != D_11G_ONLY_MODE && 1962 *uwrq != D_11BG_COMPATIBLE_MODE) 1963 return -EINVAL; 1964 1965 /* for SLEEP MODE */ 1966 priv->reg.phy_type = *uwrq; 1967 priv->need_commit |= SME_MODE_SET; 1968 return -EINPROGRESS; /* Call commit handler */ 1969 } 1970 1971 static int ks_wlan_get_phy_type(struct net_device *dev, 1972 struct iw_request_info *info, __u32 *uwrq, 1973 char *extra) 1974 { 1975 struct ks_wlan_private *priv = netdev_priv(dev); 1976 1977 if (priv->sleep_mode == SLP_SLEEP) 1978 return -EPERM; 1979 /* for SLEEP MODE */ 1980 *uwrq = priv->reg.phy_type; 1981 return 0; 1982 } 1983 1984 static int ks_wlan_set_cts_mode(struct net_device *dev, 1985 struct iw_request_info *info, __u32 *uwrq, 1986 char *extra) 1987 { 1988 struct ks_wlan_private *priv = netdev_priv(dev); 1989 1990 if (priv->sleep_mode == SLP_SLEEP) 1991 return -EPERM; 1992 /* for SLEEP MODE */ 1993 if (*uwrq != CTS_MODE_FALSE && *uwrq != CTS_MODE_TRUE) 1994 return -EINVAL; 1995 1996 priv->reg.cts_mode = (*uwrq == CTS_MODE_FALSE) ? *uwrq : 1997 (priv->reg.phy_type == D_11G_ONLY_MODE || 1998 priv->reg.phy_type == D_11BG_COMPATIBLE_MODE) ? 1999 *uwrq : !*uwrq; 2000 2001 priv->need_commit |= SME_MODE_SET; 2002 return -EINPROGRESS; /* Call commit handler */ 2003 } 2004 2005 static int ks_wlan_get_cts_mode(struct net_device *dev, 2006 struct iw_request_info *info, __u32 *uwrq, 2007 char *extra) 2008 { 2009 struct ks_wlan_private *priv = netdev_priv(dev); 2010 2011 if (priv->sleep_mode == SLP_SLEEP) 2012 return -EPERM; 2013 /* for SLEEP MODE */ 2014 *uwrq = priv->reg.cts_mode; 2015 return 0; 2016 } 2017 2018 static int ks_wlan_set_sleep_mode(struct net_device *dev, 2019 struct iw_request_info *info, 2020 __u32 *uwrq, char *extra) 2021 { 2022 struct ks_wlan_private *priv = netdev_priv(dev); 2023 2024 if (*uwrq != SLP_SLEEP && 2025 *uwrq != SLP_ACTIVE) { 2026 netdev_err(dev, "SET_SLEEP_MODE %d error\n", *uwrq); 2027 return -EINVAL; 2028 } 2029 2030 priv->sleep_mode = *uwrq; 2031 netdev_info(dev, "SET_SLEEP_MODE %d\n", priv->sleep_mode); 2032 2033 if (*uwrq == SLP_SLEEP) 2034 hostif_sme_enqueue(priv, SME_STOP_REQUEST); 2035 2036 hostif_sme_enqueue(priv, SME_SLEEP_REQUEST); 2037 2038 return 0; 2039 } 2040 2041 static int ks_wlan_get_sleep_mode(struct net_device *dev, 2042 struct iw_request_info *info, 2043 __u32 *uwrq, char *extra) 2044 { 2045 struct ks_wlan_private *priv = netdev_priv(dev); 2046 2047 *uwrq = priv->sleep_mode; 2048 2049 return 0; 2050 } 2051 2052 static int ks_wlan_set_wps_enable(struct net_device *dev, 2053 struct iw_request_info *info, __u32 *uwrq, 2054 char *extra) 2055 { 2056 struct ks_wlan_private *priv = netdev_priv(dev); 2057 2058 if (priv->sleep_mode == SLP_SLEEP) 2059 return -EPERM; 2060 /* for SLEEP MODE */ 2061 if (*uwrq != 0 && *uwrq != 1) 2062 return -EINVAL; 2063 2064 priv->wps.wps_enabled = *uwrq; 2065 hostif_sme_enqueue(priv, SME_WPS_ENABLE_REQUEST); 2066 2067 return 0; 2068 } 2069 2070 static int ks_wlan_get_wps_enable(struct net_device *dev, 2071 struct iw_request_info *info, __u32 *uwrq, 2072 char *extra) 2073 { 2074 struct ks_wlan_private *priv = netdev_priv(dev); 2075 2076 if (priv->sleep_mode == SLP_SLEEP) 2077 return -EPERM; 2078 /* for SLEEP MODE */ 2079 *uwrq = priv->wps.wps_enabled; 2080 netdev_info(dev, "return=%d\n", *uwrq); 2081 2082 return 0; 2083 } 2084 2085 static int ks_wlan_set_wps_probe_req(struct net_device *dev, 2086 struct iw_request_info *info, 2087 struct iw_point *dwrq, char *extra) 2088 { 2089 u8 *p = extra; 2090 unsigned char len; 2091 struct ks_wlan_private *priv = netdev_priv(dev); 2092 2093 if (priv->sleep_mode == SLP_SLEEP) 2094 return -EPERM; 2095 2096 /* length check */ 2097 if (p[1] + 2 != dwrq->length || dwrq->length > 256) 2098 return -EINVAL; 2099 2100 priv->wps.ielen = p[1] + 2 + 1; /* IE header + IE + sizeof(len) */ 2101 len = p[1] + 2; /* IE header + IE */ 2102 2103 memcpy(priv->wps.ie, &len, sizeof(len)); 2104 p = memcpy(priv->wps.ie + 1, p, len); 2105 2106 netdev_dbg(dev, "%d(%#x): %02X %02X %02X %02X ... %02X %02X %02X\n", 2107 priv->wps.ielen, priv->wps.ielen, p[0], p[1], p[2], p[3], 2108 p[priv->wps.ielen - 3], p[priv->wps.ielen - 2], 2109 p[priv->wps.ielen - 1]); 2110 2111 hostif_sme_enqueue(priv, SME_WPS_PROBE_REQUEST); 2112 2113 return 0; 2114 } 2115 2116 static int ks_wlan_set_tx_gain(struct net_device *dev, 2117 struct iw_request_info *info, __u32 *uwrq, 2118 char *extra) 2119 { 2120 struct ks_wlan_private *priv = netdev_priv(dev); 2121 2122 if (priv->sleep_mode == SLP_SLEEP) 2123 return -EPERM; 2124 /* for SLEEP MODE */ 2125 if (*uwrq > 0xFF) 2126 return -EINVAL; 2127 2128 priv->gain.tx_gain = (u8)*uwrq; 2129 priv->gain.tx_mode = (priv->gain.tx_gain < 0xFF) ? 1 : 0; 2130 hostif_sme_enqueue(priv, SME_SET_GAIN); 2131 return 0; 2132 } 2133 2134 static int ks_wlan_get_tx_gain(struct net_device *dev, 2135 struct iw_request_info *info, __u32 *uwrq, 2136 char *extra) 2137 { 2138 struct ks_wlan_private *priv = netdev_priv(dev); 2139 2140 if (priv->sleep_mode == SLP_SLEEP) 2141 return -EPERM; 2142 /* for SLEEP MODE */ 2143 *uwrq = priv->gain.tx_gain; 2144 hostif_sme_enqueue(priv, SME_GET_GAIN); 2145 return 0; 2146 } 2147 2148 static int ks_wlan_set_rx_gain(struct net_device *dev, 2149 struct iw_request_info *info, __u32 *uwrq, 2150 char *extra) 2151 { 2152 struct ks_wlan_private *priv = netdev_priv(dev); 2153 2154 if (priv->sleep_mode == SLP_SLEEP) 2155 return -EPERM; 2156 /* for SLEEP MODE */ 2157 if (*uwrq > 0xFF) 2158 return -EINVAL; 2159 2160 priv->gain.rx_gain = (u8)*uwrq; 2161 priv->gain.rx_mode = (priv->gain.rx_gain < 0xFF) ? 1 : 0; 2162 hostif_sme_enqueue(priv, SME_SET_GAIN); 2163 return 0; 2164 } 2165 2166 static int ks_wlan_get_rx_gain(struct net_device *dev, 2167 struct iw_request_info *info, __u32 *uwrq, 2168 char *extra) 2169 { 2170 struct ks_wlan_private *priv = netdev_priv(dev); 2171 2172 if (priv->sleep_mode == SLP_SLEEP) 2173 return -EPERM; 2174 /* for SLEEP MODE */ 2175 *uwrq = priv->gain.rx_gain; 2176 hostif_sme_enqueue(priv, SME_GET_GAIN); 2177 return 0; 2178 } 2179 2180 static int ks_wlan_get_eeprom_cksum(struct net_device *dev, 2181 struct iw_request_info *info, __u32 *uwrq, 2182 char *extra) 2183 { 2184 struct ks_wlan_private *priv = netdev_priv(dev); 2185 2186 *uwrq = priv->eeprom_checksum; 2187 return 0; 2188 } 2189 2190 static void print_hif_event(struct net_device *dev, int event) 2191 { 2192 switch (event) { 2193 case HIF_DATA_REQ: 2194 netdev_info(dev, "HIF_DATA_REQ\n"); 2195 break; 2196 case HIF_DATA_IND: 2197 netdev_info(dev, "HIF_DATA_IND\n"); 2198 break; 2199 case HIF_MIB_GET_REQ: 2200 netdev_info(dev, "HIF_MIB_GET_REQ\n"); 2201 break; 2202 case HIF_MIB_GET_CONF: 2203 netdev_info(dev, "HIF_MIB_GET_CONF\n"); 2204 break; 2205 case HIF_MIB_SET_REQ: 2206 netdev_info(dev, "HIF_MIB_SET_REQ\n"); 2207 break; 2208 case HIF_MIB_SET_CONF: 2209 netdev_info(dev, "HIF_MIB_SET_CONF\n"); 2210 break; 2211 case HIF_POWER_MGMT_REQ: 2212 netdev_info(dev, "HIF_POWER_MGMT_REQ\n"); 2213 break; 2214 case HIF_POWER_MGMT_CONF: 2215 netdev_info(dev, "HIF_POWER_MGMT_CONF\n"); 2216 break; 2217 case HIF_START_REQ: 2218 netdev_info(dev, "HIF_START_REQ\n"); 2219 break; 2220 case HIF_START_CONF: 2221 netdev_info(dev, "HIF_START_CONF\n"); 2222 break; 2223 case HIF_CONNECT_IND: 2224 netdev_info(dev, "HIF_CONNECT_IND\n"); 2225 break; 2226 case HIF_STOP_REQ: 2227 netdev_info(dev, "HIF_STOP_REQ\n"); 2228 break; 2229 case HIF_STOP_CONF: 2230 netdev_info(dev, "HIF_STOP_CONF\n"); 2231 break; 2232 case HIF_PS_ADH_SET_REQ: 2233 netdev_info(dev, "HIF_PS_ADH_SET_REQ\n"); 2234 break; 2235 case HIF_PS_ADH_SET_CONF: 2236 netdev_info(dev, "HIF_PS_ADH_SET_CONF\n"); 2237 break; 2238 case HIF_INFRA_SET_REQ: 2239 netdev_info(dev, "HIF_INFRA_SET_REQ\n"); 2240 break; 2241 case HIF_INFRA_SET_CONF: 2242 netdev_info(dev, "HIF_INFRA_SET_CONF\n"); 2243 break; 2244 case HIF_ADH_SET_REQ: 2245 netdev_info(dev, "HIF_ADH_SET_REQ\n"); 2246 break; 2247 case HIF_ADH_SET_CONF: 2248 netdev_info(dev, "HIF_ADH_SET_CONF\n"); 2249 break; 2250 case HIF_AP_SET_REQ: 2251 netdev_info(dev, "HIF_AP_SET_REQ\n"); 2252 break; 2253 case HIF_AP_SET_CONF: 2254 netdev_info(dev, "HIF_AP_SET_CONF\n"); 2255 break; 2256 case HIF_ASSOC_INFO_IND: 2257 netdev_info(dev, "HIF_ASSOC_INFO_IND\n"); 2258 break; 2259 case HIF_MIC_FAILURE_REQ: 2260 netdev_info(dev, "HIF_MIC_FAILURE_REQ\n"); 2261 break; 2262 case HIF_MIC_FAILURE_CONF: 2263 netdev_info(dev, "HIF_MIC_FAILURE_CONF\n"); 2264 break; 2265 case HIF_SCAN_REQ: 2266 netdev_info(dev, "HIF_SCAN_REQ\n"); 2267 break; 2268 case HIF_SCAN_CONF: 2269 netdev_info(dev, "HIF_SCAN_CONF\n"); 2270 break; 2271 case HIF_PHY_INFO_REQ: 2272 netdev_info(dev, "HIF_PHY_INFO_REQ\n"); 2273 break; 2274 case HIF_PHY_INFO_CONF: 2275 netdev_info(dev, "HIF_PHY_INFO_CONF\n"); 2276 break; 2277 case HIF_SLEEP_REQ: 2278 netdev_info(dev, "HIF_SLEEP_REQ\n"); 2279 break; 2280 case HIF_SLEEP_CONF: 2281 netdev_info(dev, "HIF_SLEEP_CONF\n"); 2282 break; 2283 case HIF_PHY_INFO_IND: 2284 netdev_info(dev, "HIF_PHY_INFO_IND\n"); 2285 break; 2286 case HIF_SCAN_IND: 2287 netdev_info(dev, "HIF_SCAN_IND\n"); 2288 break; 2289 case HIF_INFRA_SET2_REQ: 2290 netdev_info(dev, "HIF_INFRA_SET2_REQ\n"); 2291 break; 2292 case HIF_INFRA_SET2_CONF: 2293 netdev_info(dev, "HIF_INFRA_SET2_CONF\n"); 2294 break; 2295 case HIF_ADH_SET2_REQ: 2296 netdev_info(dev, "HIF_ADH_SET2_REQ\n"); 2297 break; 2298 case HIF_ADH_SET2_CONF: 2299 netdev_info(dev, "HIF_ADH_SET2_CONF\n"); 2300 } 2301 } 2302 2303 /* get host command history */ 2304 static int ks_wlan_hostt(struct net_device *dev, struct iw_request_info *info, 2305 __u32 *uwrq, char *extra) 2306 { 2307 int i, event; 2308 struct ks_wlan_private *priv = netdev_priv(dev); 2309 2310 for (i = 63; i >= 0; i--) { 2311 event = 2312 priv->hostt.buff[(priv->hostt.qtail - 1 - i) % 2313 SME_EVENT_BUFF_SIZE]; 2314 print_hif_event(dev, event); 2315 } 2316 return 0; 2317 } 2318 2319 /* Structures to export the Wireless Handlers */ 2320 2321 static const struct iw_priv_args ks_wlan_private_args[] = { 2322 /*{ cmd, set_args, get_args, name[16] } */ 2323 {KS_WLAN_GET_FIRM_VERSION, IW_PRIV_TYPE_NONE, 2324 IW_PRIV_TYPE_CHAR | (128 + 1), "GetFirmwareVer"}, 2325 {KS_WLAN_SET_WPS_ENABLE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2326 IW_PRIV_TYPE_NONE, "SetWPSEnable"}, 2327 {KS_WLAN_GET_WPS_ENABLE, IW_PRIV_TYPE_NONE, 2328 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetW"}, 2329 {KS_WLAN_SET_WPS_PROBE_REQ, IW_PRIV_TYPE_BYTE | 2047, IW_PRIV_TYPE_NONE, 2330 "SetWPSProbeReq"}, 2331 {KS_WLAN_SET_PREAMBLE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2332 IW_PRIV_TYPE_NONE, "SetPreamble"}, 2333 {KS_WLAN_GET_PREAMBLE, IW_PRIV_TYPE_NONE, 2334 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetPreamble"}, 2335 {KS_WLAN_SET_POWER_SAVE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2336 IW_PRIV_TYPE_NONE, "SetPowerSave"}, 2337 {KS_WLAN_GET_POWER_SAVE, IW_PRIV_TYPE_NONE, 2338 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetPowerSave"}, 2339 {KS_WLAN_SET_SCAN_TYPE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2340 IW_PRIV_TYPE_NONE, "SetScanType"}, 2341 {KS_WLAN_GET_SCAN_TYPE, IW_PRIV_TYPE_NONE, 2342 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetScanType"}, 2343 {KS_WLAN_SET_RX_GAIN, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2344 IW_PRIV_TYPE_NONE, "SetRxGain"}, 2345 {KS_WLAN_GET_RX_GAIN, IW_PRIV_TYPE_NONE, 2346 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetRxGain"}, 2347 {KS_WLAN_HOSTT, IW_PRIV_TYPE_NONE, IW_PRIV_TYPE_CHAR | (128 + 1), 2348 "hostt"}, 2349 {KS_WLAN_SET_BEACON_LOST, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2350 IW_PRIV_TYPE_NONE, "SetBeaconLost"}, 2351 {KS_WLAN_GET_BEACON_LOST, IW_PRIV_TYPE_NONE, 2352 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetBeaconLost"}, 2353 {KS_WLAN_SET_SLEEP_MODE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2354 IW_PRIV_TYPE_NONE, "SetSleepMode"}, 2355 {KS_WLAN_GET_SLEEP_MODE, IW_PRIV_TYPE_NONE, 2356 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetSleepMode"}, 2357 {KS_WLAN_SET_TX_GAIN, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2358 IW_PRIV_TYPE_NONE, "SetTxGain"}, 2359 {KS_WLAN_GET_TX_GAIN, IW_PRIV_TYPE_NONE, 2360 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetTxGain"}, 2361 {KS_WLAN_SET_PHY_TYPE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2362 IW_PRIV_TYPE_NONE, "SetPhyType"}, 2363 {KS_WLAN_GET_PHY_TYPE, IW_PRIV_TYPE_NONE, 2364 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetPhyType"}, 2365 {KS_WLAN_SET_CTS_MODE, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 2366 IW_PRIV_TYPE_NONE, "SetCtsMode"}, 2367 {KS_WLAN_GET_CTS_MODE, IW_PRIV_TYPE_NONE, 2368 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetCtsMode"}, 2369 {KS_WLAN_GET_EEPROM_CKSUM, IW_PRIV_TYPE_NONE, 2370 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "GetChecksum"}, 2371 }; 2372 2373 static const iw_handler ks_wlan_handler[] = { 2374 IW_HANDLER(SIOCSIWCOMMIT, ks_wlan_config_commit), 2375 IW_HANDLER(SIOCGIWNAME, ks_wlan_get_name), 2376 IW_HANDLER(SIOCSIWFREQ, ks_wlan_set_freq), 2377 IW_HANDLER(SIOCGIWFREQ, ks_wlan_get_freq), 2378 IW_HANDLER(SIOCSIWMODE, ks_wlan_set_mode), 2379 IW_HANDLER(SIOCGIWMODE, ks_wlan_get_mode), 2380 IW_HANDLER(SIOCGIWRANGE, ks_wlan_get_range), 2381 IW_HANDLER(SIOCGIWSTATS, ks_wlan_get_iwstats), 2382 IW_HANDLER(SIOCSIWAP, ks_wlan_set_wap), 2383 IW_HANDLER(SIOCGIWAP, ks_wlan_get_wap), 2384 IW_HANDLER(SIOCSIWMLME, ks_wlan_set_mlme), 2385 IW_HANDLER(SIOCGIWAPLIST, ks_wlan_get_aplist), 2386 IW_HANDLER(SIOCSIWSCAN, ks_wlan_set_scan), 2387 IW_HANDLER(SIOCGIWSCAN, ks_wlan_get_scan), 2388 IW_HANDLER(SIOCSIWESSID, ks_wlan_set_essid), 2389 IW_HANDLER(SIOCGIWESSID, ks_wlan_get_essid), 2390 IW_HANDLER(SIOCSIWNICKN, ks_wlan_set_nick), 2391 IW_HANDLER(SIOCGIWNICKN, ks_wlan_get_nick), 2392 IW_HANDLER(SIOCSIWRATE, ks_wlan_set_rate), 2393 IW_HANDLER(SIOCGIWRATE, ks_wlan_get_rate), 2394 IW_HANDLER(SIOCSIWRTS, ks_wlan_set_rts), 2395 IW_HANDLER(SIOCGIWRTS, ks_wlan_get_rts), 2396 IW_HANDLER(SIOCSIWFRAG, ks_wlan_set_frag), 2397 IW_HANDLER(SIOCGIWFRAG, ks_wlan_get_frag), 2398 IW_HANDLER(SIOCSIWENCODE, ks_wlan_set_encode), 2399 IW_HANDLER(SIOCGIWENCODE, ks_wlan_get_encode), 2400 IW_HANDLER(SIOCSIWPOWER, ks_wlan_set_power), 2401 IW_HANDLER(SIOCGIWPOWER, ks_wlan_get_power), 2402 IW_HANDLER(SIOCSIWGENIE, ks_wlan_set_genie), 2403 IW_HANDLER(SIOCSIWAUTH, ks_wlan_set_auth_mode), 2404 IW_HANDLER(SIOCGIWAUTH, ks_wlan_get_auth_mode), 2405 IW_HANDLER(SIOCSIWENCODEEXT, ks_wlan_set_encode_ext), 2406 IW_HANDLER(SIOCGIWENCODEEXT, ks_wlan_get_encode_ext), 2407 IW_HANDLER(SIOCSIWPMKSA, ks_wlan_set_pmksa), 2408 }; 2409 2410 /* private_handler */ 2411 static const iw_handler ks_wlan_private_handler[] = { 2412 (iw_handler)NULL, /* 0 */ 2413 (iw_handler)NULL, /* 1, KS_WLAN_GET_DRIVER_VERSION */ 2414 (iw_handler)NULL, /* 2 */ 2415 (iw_handler)ks_wlan_get_firmware_version,/* 3 KS_WLAN_GET_FIRM_VERSION */ 2416 (iw_handler)ks_wlan_set_wps_enable, /* 4 KS_WLAN_SET_WPS_ENABLE */ 2417 (iw_handler)ks_wlan_get_wps_enable, /* 5 KS_WLAN_GET_WPS_ENABLE */ 2418 (iw_handler)ks_wlan_set_wps_probe_req, /* 6 KS_WLAN_SET_WPS_PROBE_REQ */ 2419 (iw_handler)ks_wlan_get_eeprom_cksum, /* 7 KS_WLAN_GET_CONNECT */ 2420 (iw_handler)ks_wlan_set_preamble, /* 8 KS_WLAN_SET_PREAMBLE */ 2421 (iw_handler)ks_wlan_get_preamble, /* 9 KS_WLAN_GET_PREAMBLE */ 2422 (iw_handler)ks_wlan_set_power_mgmt, /* 10 KS_WLAN_SET_POWER_SAVE */ 2423 (iw_handler)ks_wlan_get_power_mgmt, /* 11 KS_WLAN_GET_POWER_SAVE */ 2424 (iw_handler)ks_wlan_set_scan_type, /* 12 KS_WLAN_SET_SCAN_TYPE */ 2425 (iw_handler)ks_wlan_get_scan_type, /* 13 KS_WLAN_GET_SCAN_TYPE */ 2426 (iw_handler)ks_wlan_set_rx_gain, /* 14 KS_WLAN_SET_RX_GAIN */ 2427 (iw_handler)ks_wlan_get_rx_gain, /* 15 KS_WLAN_GET_RX_GAIN */ 2428 (iw_handler)ks_wlan_hostt, /* 16 KS_WLAN_HOSTT */ 2429 (iw_handler)NULL, /* 17 */ 2430 (iw_handler)ks_wlan_set_beacon_lost, /* 18 KS_WLAN_SET_BECAN_LOST */ 2431 (iw_handler)ks_wlan_get_beacon_lost, /* 19 KS_WLAN_GET_BECAN_LOST */ 2432 (iw_handler)ks_wlan_set_tx_gain, /* 20 KS_WLAN_SET_TX_GAIN */ 2433 (iw_handler)ks_wlan_get_tx_gain, /* 21 KS_WLAN_GET_TX_GAIN */ 2434 (iw_handler)ks_wlan_set_phy_type, /* 22 KS_WLAN_SET_PHY_TYPE */ 2435 (iw_handler)ks_wlan_get_phy_type, /* 23 KS_WLAN_GET_PHY_TYPE */ 2436 (iw_handler)ks_wlan_set_cts_mode, /* 24 KS_WLAN_SET_CTS_MODE */ 2437 (iw_handler)ks_wlan_get_cts_mode, /* 25 KS_WLAN_GET_CTS_MODE */ 2438 (iw_handler)NULL, /* 26 */ 2439 (iw_handler)NULL, /* 27 */ 2440 (iw_handler)ks_wlan_set_sleep_mode, /* 28 KS_WLAN_SET_SLEEP_MODE */ 2441 (iw_handler)ks_wlan_get_sleep_mode, /* 29 KS_WLAN_GET_SLEEP_MODE */ 2442 (iw_handler)NULL, /* 30 */ 2443 (iw_handler)NULL, /* 31 */ 2444 }; 2445 2446 static const struct iw_handler_def ks_wlan_handler_def = { 2447 .num_standard = ARRAY_SIZE(ks_wlan_handler), 2448 .num_private = ARRAY_SIZE(ks_wlan_private_handler), 2449 .num_private_args = ARRAY_SIZE(ks_wlan_private_args), 2450 .standard = ks_wlan_handler, 2451 .private = ks_wlan_private_handler, 2452 .private_args = ks_wlan_private_args, 2453 .get_wireless_stats = ks_get_wireless_stats, 2454 }; 2455 2456 static int ks_wlan_netdev_ioctl(struct net_device *dev, struct ifreq *rq, 2457 int cmd) 2458 { 2459 int ret; 2460 struct iwreq *wrq = (struct iwreq *)rq; 2461 2462 switch (cmd) { 2463 case SIOCIWFIRSTPRIV + 20: /* KS_WLAN_SET_STOP_REQ */ 2464 ret = ks_wlan_set_stop_request(dev, NULL, &wrq->u.mode, NULL); 2465 break; 2466 // All other calls are currently unsupported 2467 default: 2468 ret = -EOPNOTSUPP; 2469 } 2470 2471 return ret; 2472 } 2473 2474 static 2475 struct net_device_stats *ks_wlan_get_stats(struct net_device *dev) 2476 { 2477 struct ks_wlan_private *priv = netdev_priv(dev); 2478 2479 if (priv->dev_state < DEVICE_STATE_READY) 2480 return NULL; /* not finished initialize */ 2481 2482 return &priv->nstats; 2483 } 2484 2485 static 2486 int ks_wlan_set_mac_address(struct net_device *dev, void *addr) 2487 { 2488 struct ks_wlan_private *priv = netdev_priv(dev); 2489 struct sockaddr *mac_addr = (struct sockaddr *)addr; 2490 2491 if (netif_running(dev)) 2492 return -EBUSY; 2493 eth_hw_addr_set(dev, mac_addr->sa_data); 2494 ether_addr_copy(priv->eth_addr, mac_addr->sa_data); 2495 2496 priv->mac_address_valid = false; 2497 hostif_sme_enqueue(priv, SME_MACADDRESS_SET_REQUEST); 2498 netdev_info(dev, "ks_wlan: MAC ADDRESS = %pM\n", priv->eth_addr); 2499 return 0; 2500 } 2501 2502 static 2503 void ks_wlan_tx_timeout(struct net_device *dev, unsigned int txqueue) 2504 { 2505 struct ks_wlan_private *priv = netdev_priv(dev); 2506 2507 netdev_dbg(dev, "head(%d) tail(%d)!!\n", priv->tx_dev.qhead, 2508 priv->tx_dev.qtail); 2509 if (!netif_queue_stopped(dev)) 2510 netif_stop_queue(dev); 2511 priv->nstats.tx_errors++; 2512 netif_wake_queue(dev); 2513 } 2514 2515 static 2516 netdev_tx_t ks_wlan_start_xmit(struct sk_buff *skb, struct net_device *dev) 2517 { 2518 struct ks_wlan_private *priv = netdev_priv(dev); 2519 int ret; 2520 2521 netdev_dbg(dev, "in_interrupt()=%ld\n", in_interrupt()); 2522 2523 if (!skb) { 2524 netdev_err(dev, "ks_wlan: skb == NULL!!!\n"); 2525 return 0; 2526 } 2527 if (priv->dev_state < DEVICE_STATE_READY) { 2528 dev_kfree_skb(skb); 2529 return 0; /* not finished initialize */ 2530 } 2531 2532 if (netif_running(dev)) 2533 netif_stop_queue(dev); 2534 2535 ret = hostif_data_request(priv, skb); 2536 netif_trans_update(dev); 2537 2538 if (ret) 2539 netdev_err(dev, "hostif_data_request error: =%d\n", ret); 2540 2541 return 0; 2542 } 2543 2544 void send_packet_complete(struct ks_wlan_private *priv, struct sk_buff *skb) 2545 { 2546 priv->nstats.tx_packets++; 2547 2548 if (netif_queue_stopped(priv->net_dev)) 2549 netif_wake_queue(priv->net_dev); 2550 2551 if (skb) { 2552 priv->nstats.tx_bytes += skb->len; 2553 dev_kfree_skb(skb); 2554 } 2555 } 2556 2557 /* 2558 * Set or clear the multicast filter for this adaptor. 2559 * This routine is not state sensitive and need not be SMP locked. 2560 */ 2561 static 2562 void ks_wlan_set_rx_mode(struct net_device *dev) 2563 { 2564 struct ks_wlan_private *priv = netdev_priv(dev); 2565 2566 if (priv->dev_state < DEVICE_STATE_READY) 2567 return; /* not finished initialize */ 2568 hostif_sme_enqueue(priv, SME_MULTICAST_REQUEST); 2569 } 2570 2571 static 2572 int ks_wlan_open(struct net_device *dev) 2573 { 2574 struct ks_wlan_private *priv = netdev_priv(dev); 2575 2576 priv->cur_rx = 0; 2577 2578 if (!priv->mac_address_valid) { 2579 netdev_err(dev, "ks_wlan : %s Not READY !!\n", dev->name); 2580 return -EBUSY; 2581 } 2582 netif_start_queue(dev); 2583 2584 return 0; 2585 } 2586 2587 static 2588 int ks_wlan_close(struct net_device *dev) 2589 { 2590 netif_stop_queue(dev); 2591 2592 return 0; 2593 } 2594 2595 /* Operational parameters that usually are not changed. */ 2596 /* Time in jiffies before concluding the transmitter is hung. */ 2597 #define TX_TIMEOUT (3 * HZ) 2598 static const unsigned char dummy_addr[] = { 2599 0x00, 0x0b, 0xe3, 0x00, 0x00, 0x00 2600 }; 2601 2602 static const struct net_device_ops ks_wlan_netdev_ops = { 2603 .ndo_start_xmit = ks_wlan_start_xmit, 2604 .ndo_open = ks_wlan_open, 2605 .ndo_stop = ks_wlan_close, 2606 .ndo_do_ioctl = ks_wlan_netdev_ioctl, 2607 .ndo_set_mac_address = ks_wlan_set_mac_address, 2608 .ndo_get_stats = ks_wlan_get_stats, 2609 .ndo_tx_timeout = ks_wlan_tx_timeout, 2610 .ndo_set_rx_mode = ks_wlan_set_rx_mode, 2611 }; 2612 2613 int ks_wlan_net_start(struct net_device *dev) 2614 { 2615 struct ks_wlan_private *priv; 2616 /* int rc; */ 2617 2618 priv = netdev_priv(dev); 2619 priv->mac_address_valid = false; 2620 priv->is_device_open = true; 2621 priv->need_commit = 0; 2622 /* phy information update timer */ 2623 atomic_set(&update_phyinfo, 0); 2624 timer_setup(&update_phyinfo_timer, ks_wlan_update_phyinfo_timeout, 0); 2625 2626 /* dummy address set */ 2627 ether_addr_copy(priv->eth_addr, dummy_addr); 2628 eth_hw_addr_set(dev, priv->eth_addr); 2629 2630 /* The ks_wlan-specific entries in the device structure. */ 2631 dev->netdev_ops = &ks_wlan_netdev_ops; 2632 dev->wireless_handlers = &ks_wlan_handler_def; 2633 dev->watchdog_timeo = TX_TIMEOUT; 2634 2635 netif_carrier_off(dev); 2636 2637 return 0; 2638 } 2639 2640 int ks_wlan_net_stop(struct net_device *dev) 2641 { 2642 struct ks_wlan_private *priv = netdev_priv(dev); 2643 2644 priv->is_device_open = false; 2645 del_timer_sync(&update_phyinfo_timer); 2646 2647 if (netif_running(dev)) 2648 netif_stop_queue(dev); 2649 2650 return 0; 2651 } 2652 2653 /** 2654 * is_connect_status() - return true if status is 'connected' 2655 * @status: high bit is used as FORCE_DISCONNECT, low bits used for 2656 * connect status. 2657 */ 2658 bool is_connect_status(u32 status) 2659 { 2660 return (status & CONNECT_STATUS_MASK) == CONNECT_STATUS; 2661 } 2662 2663 /** 2664 * is_disconnect_status() - return true if status is 'disconnected' 2665 * @status: high bit is used as FORCE_DISCONNECT, low bits used for 2666 * disconnect status. 2667 */ 2668 bool is_disconnect_status(u32 status) 2669 { 2670 return (status & CONNECT_STATUS_MASK) == DISCONNECT_STATUS; 2671 } 2672