1 // SPDX-License-Identifier: GPL-2.0-only 2 /*============================================================================= 3 * 4 * A PCMCIA client driver for the Raylink wireless LAN card. 5 * The starting point for this module was the skeleton.c in the 6 * PCMCIA 2.9.12 package written by David Hinds, dahinds@users.sourceforge.net 7 * 8 * Copyright (c) 1998 Corey Thomas (corey@world.std.com) 9 * 10 * Changes: 11 * Arnaldo Carvalho de Melo <acme@conectiva.com.br> - 08/08/2000 12 * - reorganize kmallocs in ray_attach, checking all for failure 13 * and releasing the previous allocations if one fails 14 * 15 * Daniele Bellucci <bellucda@tiscali.it> - 07/10/2003 16 * - Audit copy_to_user in ioctl(SIOCGIWESSID) 17 * 18 =============================================================================*/ 19 20 #include <linux/module.h> 21 #include <linux/kernel.h> 22 #include <linux/proc_fs.h> 23 #include <linux/ptrace.h> 24 #include <linux/seq_file.h> 25 #include <linux/string.h> 26 #include <linux/timer.h> 27 #include <linux/init.h> 28 #include <linux/netdevice.h> 29 #include <linux/etherdevice.h> 30 #include <linux/if_arp.h> 31 #include <linux/ioport.h> 32 #include <linux/skbuff.h> 33 #include <linux/ieee80211.h> 34 35 #include <pcmcia/cistpl.h> 36 #include <pcmcia/cisreg.h> 37 #include <pcmcia/ds.h> 38 39 #include <linux/wireless.h> 40 #include <net/iw_handler.h> 41 42 #include <asm/io.h> 43 #include <asm/byteorder.h> 44 #include <linux/uaccess.h> 45 46 /* Warning : these stuff will slow down the driver... */ 47 #define WIRELESS_SPY /* Enable spying addresses */ 48 /* Definitions we need for spy */ 49 typedef struct iw_statistics iw_stats; 50 typedef u_char mac_addr[ETH_ALEN]; /* Hardware address */ 51 52 #include "rayctl.h" 53 #include "ray_cs.h" 54 55 56 /** Prototypes based on PCMCIA skeleton driver *******************************/ 57 static int ray_config(struct pcmcia_device *link); 58 static void ray_release(struct pcmcia_device *link); 59 static void ray_detach(struct pcmcia_device *p_dev); 60 61 /***** Prototypes indicated by device structure ******************************/ 62 static int ray_dev_close(struct net_device *dev); 63 static int ray_dev_config(struct net_device *dev, struct ifmap *map); 64 static struct net_device_stats *ray_get_stats(struct net_device *dev); 65 static int ray_dev_init(struct net_device *dev); 66 67 static int ray_open(struct net_device *dev); 68 static netdev_tx_t ray_dev_start_xmit(struct sk_buff *skb, 69 struct net_device *dev); 70 static void set_multicast_list(struct net_device *dev); 71 static void ray_update_multi_list(struct net_device *dev, int all); 72 static int translate_frame(ray_dev_t *local, struct tx_msg __iomem *ptx, 73 unsigned char *data, int len); 74 static void ray_build_header(ray_dev_t *local, struct tx_msg __iomem *ptx, 75 UCHAR msg_type, unsigned char *data); 76 static void untranslate(ray_dev_t *local, struct sk_buff *skb, int len); 77 static iw_stats *ray_get_wireless_stats(struct net_device *dev); 78 static const struct iw_handler_def ray_handler_def; 79 80 /***** Prototypes for raylink functions **************************************/ 81 static void authenticate(ray_dev_t *local); 82 static int build_auth_frame(ray_dev_t *local, UCHAR *dest, int auth_type); 83 static void authenticate_timeout(struct timer_list *t); 84 static int get_free_ccs(ray_dev_t *local); 85 static int get_free_tx_ccs(ray_dev_t *local); 86 static void init_startup_params(ray_dev_t *local); 87 static int parse_addr(char *in_str, UCHAR *out); 88 static int ray_hw_xmit(unsigned char *data, int len, struct net_device *dev, UCHAR type); 89 static int ray_init(struct net_device *dev); 90 static int interrupt_ecf(ray_dev_t *local, int ccs); 91 static void ray_reset(struct net_device *dev); 92 static void ray_update_parm(struct net_device *dev, UCHAR objid, UCHAR *value, int len); 93 static void verify_dl_startup(struct timer_list *t); 94 95 /* Prototypes for interrpt time functions **********************************/ 96 static irqreturn_t ray_interrupt(int reg, void *dev_id); 97 static void clear_interrupt(ray_dev_t *local); 98 static void rx_deauthenticate(ray_dev_t *local, struct rcs __iomem *prcs, 99 unsigned int pkt_addr, int rx_len); 100 static int copy_from_rx_buff(ray_dev_t *local, UCHAR *dest, int pkt_addr, int len); 101 static void ray_rx(struct net_device *dev, ray_dev_t *local, struct rcs __iomem *prcs); 102 static void release_frag_chain(ray_dev_t *local, struct rcs __iomem *prcs); 103 static void rx_authenticate(ray_dev_t *local, struct rcs __iomem *prcs, 104 unsigned int pkt_addr, int rx_len); 105 static void rx_data(struct net_device *dev, struct rcs __iomem *prcs, 106 unsigned int pkt_addr, int rx_len); 107 static void associate(ray_dev_t *local); 108 109 /* Card command functions */ 110 static int dl_startup_params(struct net_device *dev); 111 static void join_net(struct timer_list *t); 112 static void start_net(struct timer_list *t); 113 114 /*===========================================================================*/ 115 /* Parameters that can be set with 'insmod' */ 116 117 /* ADHOC=0, Infrastructure=1 */ 118 static int net_type = ADHOC; 119 120 /* Hop dwell time in Kus (1024 us units defined by 802.11) */ 121 static int hop_dwell = 128; 122 123 /* Beacon period in Kus */ 124 static int beacon_period = 256; 125 126 /* power save mode (0 = off, 1 = save power) */ 127 static int psm; 128 129 /* String for network's Extended Service Set ID. 32 Characters max */ 130 static char *essid; 131 132 /* Default to encapsulation unless translation requested */ 133 static bool translate = true; 134 135 static int country = USA; 136 137 static int sniffer; 138 139 static int bc; 140 141 /* 48 bit physical card address if overriding card's real physical 142 * address is required. Since IEEE 802.11 addresses are 48 bits 143 * like ethernet, an int can't be used, so a string is used. To 144 * allow use of addresses starting with a decimal digit, the first 145 * character must be a letter and will be ignored. This letter is 146 * followed by up to 12 hex digits which are the address. If less 147 * than 12 digits are used, the address will be left filled with 0's. 148 * Note that bit 0 of the first byte is the broadcast bit, and evil 149 * things will happen if it is not 0 in a card address. 150 */ 151 static char *phy_addr = NULL; 152 153 static unsigned int ray_mem_speed = 500; 154 155 /* WARNING: THIS DRIVER IS NOT CAPABLE OF HANDLING MULTIPLE DEVICES! */ 156 static struct pcmcia_device *this_device = NULL; 157 158 MODULE_AUTHOR("Corey Thomas <corey@world.std.com>"); 159 MODULE_DESCRIPTION("Raylink/WebGear wireless LAN driver"); 160 MODULE_LICENSE("GPL"); 161 162 module_param(net_type, int, 0); 163 module_param(hop_dwell, int, 0); 164 module_param(beacon_period, int, 0); 165 module_param(psm, int, 0); 166 module_param(essid, charp, 0); 167 module_param(translate, bool, 0); 168 module_param(country, int, 0); 169 module_param(sniffer, int, 0); 170 module_param(bc, int, 0); 171 module_param(phy_addr, charp, 0); 172 module_param(ray_mem_speed, int, 0); 173 174 static const UCHAR b5_default_startup_parms[] = { 175 0, 0, /* Adhoc station */ 176 'L', 'I', 'N', 'U', 'X', 0, 0, 0, /* 32 char ESSID */ 177 0, 0, 0, 0, 0, 0, 0, 0, 178 0, 0, 0, 0, 0, 0, 0, 0, 179 0, 0, 0, 0, 0, 0, 0, 0, 180 1, 0, /* Active scan, CA Mode */ 181 0, 0, 0, 0, 0, 0, /* No default MAC addr */ 182 0x7f, 0xff, /* Frag threshold */ 183 0x00, 0x80, /* Hop time 128 Kus */ 184 0x01, 0x00, /* Beacon period 256 Kus */ 185 0x01, 0x07, 0xa3, /* DTIM, retries, ack timeout */ 186 0x1d, 0x82, 0x4e, /* SIFS, DIFS, PIFS */ 187 0x7f, 0xff, /* RTS threshold */ 188 0x04, 0xe2, 0x38, 0xA4, /* scan_dwell, max_scan_dwell */ 189 0x05, /* assoc resp timeout thresh */ 190 0x08, 0x02, 0x08, /* adhoc, infra, super cycle max */ 191 0, /* Promiscuous mode */ 192 0x0c, 0x0bd, /* Unique word */ 193 0x32, /* Slot time */ 194 0xff, 0xff, /* roam-low snr, low snr count */ 195 0x05, 0xff, /* Infra, adhoc missed bcn thresh */ 196 0x01, 0x0b, 0x4f, /* USA, hop pattern, hop pat length */ 197 /* b4 - b5 differences start here */ 198 0x00, 0x3f, /* CW max */ 199 0x00, 0x0f, /* CW min */ 200 0x04, 0x08, /* Noise gain, limit offset */ 201 0x28, 0x28, /* det rssi, med busy offsets */ 202 7, /* det sync thresh */ 203 0, 2, 2, /* test mode, min, max */ 204 0, /* allow broadcast SSID probe resp */ 205 0, 0, /* privacy must start, can join */ 206 2, 0, 0, 0, 0, 0, 0, 0 /* basic rate set */ 207 }; 208 209 static const UCHAR b4_default_startup_parms[] = { 210 0, 0, /* Adhoc station */ 211 'L', 'I', 'N', 'U', 'X', 0, 0, 0, /* 32 char ESSID */ 212 0, 0, 0, 0, 0, 0, 0, 0, 213 0, 0, 0, 0, 0, 0, 0, 0, 214 0, 0, 0, 0, 0, 0, 0, 0, 215 1, 0, /* Active scan, CA Mode */ 216 0, 0, 0, 0, 0, 0, /* No default MAC addr */ 217 0x7f, 0xff, /* Frag threshold */ 218 0x02, 0x00, /* Hop time */ 219 0x00, 0x01, /* Beacon period */ 220 0x01, 0x07, 0xa3, /* DTIM, retries, ack timeout */ 221 0x1d, 0x82, 0xce, /* SIFS, DIFS, PIFS */ 222 0x7f, 0xff, /* RTS threshold */ 223 0xfb, 0x1e, 0xc7, 0x5c, /* scan_dwell, max_scan_dwell */ 224 0x05, /* assoc resp timeout thresh */ 225 0x04, 0x02, 0x4, /* adhoc, infra, super cycle max */ 226 0, /* Promiscuous mode */ 227 0x0c, 0x0bd, /* Unique word */ 228 0x4e, /* Slot time (TBD seems wrong) */ 229 0xff, 0xff, /* roam-low snr, low snr count */ 230 0x05, 0xff, /* Infra, adhoc missed bcn thresh */ 231 0x01, 0x0b, 0x4e, /* USA, hop pattern, hop pat length */ 232 /* b4 - b5 differences start here */ 233 0x3f, 0x0f, /* CW max, min */ 234 0x04, 0x08, /* Noise gain, limit offset */ 235 0x28, 0x28, /* det rssi, med busy offsets */ 236 7, /* det sync thresh */ 237 0, 2, 2, /* test mode, min, max */ 238 0, /* rx/tx delay */ 239 0, 0, 0, 0, 0, 0, /* current BSS id */ 240 0 /* hop set */ 241 }; 242 243 /*===========================================================================*/ 244 static const u8 eth2_llc[] = { 0xaa, 0xaa, 3, 0, 0, 0 }; 245 246 static const char hop_pattern_length[] = { 1, 247 USA_HOP_MOD, EUROPE_HOP_MOD, 248 JAPAN_HOP_MOD, KOREA_HOP_MOD, 249 SPAIN_HOP_MOD, FRANCE_HOP_MOD, 250 ISRAEL_HOP_MOD, AUSTRALIA_HOP_MOD, 251 JAPAN_TEST_HOP_MOD 252 }; 253 254 static const char rcsid[] = 255 "Raylink/WebGear wireless LAN - Corey <Thomas corey@world.std.com>"; 256 257 static const struct net_device_ops ray_netdev_ops = { 258 .ndo_init = ray_dev_init, 259 .ndo_open = ray_open, 260 .ndo_stop = ray_dev_close, 261 .ndo_start_xmit = ray_dev_start_xmit, 262 .ndo_set_config = ray_dev_config, 263 .ndo_get_stats = ray_get_stats, 264 .ndo_set_rx_mode = set_multicast_list, 265 .ndo_set_mac_address = eth_mac_addr, 266 .ndo_validate_addr = eth_validate_addr, 267 }; 268 269 static int ray_probe(struct pcmcia_device *p_dev) 270 { 271 ray_dev_t *local; 272 struct net_device *dev; 273 int ret; 274 275 dev_dbg(&p_dev->dev, "ray_attach()\n"); 276 277 /* Allocate space for private device-specific data */ 278 dev = alloc_etherdev(sizeof(ray_dev_t)); 279 if (!dev) 280 return -ENOMEM; 281 282 local = netdev_priv(dev); 283 local->finder = p_dev; 284 285 /* The io structure describes IO port mapping. None used here */ 286 p_dev->resource[0]->end = 0; 287 p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8; 288 289 /* General socket configuration */ 290 p_dev->config_flags |= CONF_ENABLE_IRQ; 291 p_dev->config_index = 1; 292 293 p_dev->priv = dev; 294 295 local->finder = p_dev; 296 local->card_status = CARD_INSERTED; 297 local->authentication_state = UNAUTHENTICATED; 298 local->num_multi = 0; 299 dev_dbg(&p_dev->dev, "ray_attach p_dev = %p, dev = %p, local = %p, intr = %p\n", 300 p_dev, dev, local, &ray_interrupt); 301 302 /* Raylink entries in the device structure */ 303 dev->netdev_ops = &ray_netdev_ops; 304 dev->wireless_handlers = &ray_handler_def; 305 #ifdef WIRELESS_SPY 306 local->wireless_data.spy_data = &local->spy_data; 307 dev->wireless_data = &local->wireless_data; 308 #endif /* WIRELESS_SPY */ 309 310 311 dev_dbg(&p_dev->dev, "ray_cs ray_attach calling ether_setup.)\n"); 312 netif_stop_queue(dev); 313 314 timer_setup(&local->timer, NULL, 0); 315 316 this_device = p_dev; 317 ret = ray_config(p_dev); 318 if (ret) 319 goto err_free_dev; 320 321 return 0; 322 323 err_free_dev: 324 free_netdev(dev); 325 return ret; 326 } 327 328 static void ray_detach(struct pcmcia_device *link) 329 { 330 struct net_device *dev; 331 332 dev_dbg(&link->dev, "ray_detach\n"); 333 334 this_device = NULL; 335 dev = link->priv; 336 337 ray_release(link); 338 339 if (link->priv) { 340 unregister_netdev(dev); 341 free_netdev(dev); 342 } 343 dev_dbg(&link->dev, "ray_cs ray_detach ending\n"); 344 } /* ray_detach */ 345 346 #define MAX_TUPLE_SIZE 128 347 static int ray_config(struct pcmcia_device *link) 348 { 349 int ret = 0; 350 int i; 351 struct net_device *dev = (struct net_device *)link->priv; 352 ray_dev_t *local = netdev_priv(dev); 353 354 dev_dbg(&link->dev, "ray_config\n"); 355 356 /* Determine card type and firmware version */ 357 printk(KERN_INFO "ray_cs Detected: %s%s%s%s\n", 358 link->prod_id[0] ? link->prod_id[0] : " ", 359 link->prod_id[1] ? link->prod_id[1] : " ", 360 link->prod_id[2] ? link->prod_id[2] : " ", 361 link->prod_id[3] ? link->prod_id[3] : " "); 362 363 /* Now allocate an interrupt line. Note that this does not 364 actually assign a handler to the interrupt. 365 */ 366 ret = pcmcia_request_irq(link, ray_interrupt); 367 if (ret) 368 goto failed; 369 dev->irq = link->irq; 370 371 ret = pcmcia_enable_device(link); 372 if (ret) 373 goto failed; 374 375 /*** Set up 32k window for shared memory (transmit and control) ************/ 376 link->resource[2]->flags |= WIN_DATA_WIDTH_8 | WIN_MEMORY_TYPE_CM | WIN_ENABLE | WIN_USE_WAIT; 377 link->resource[2]->start = 0; 378 link->resource[2]->end = 0x8000; 379 ret = pcmcia_request_window(link, link->resource[2], ray_mem_speed); 380 if (ret) 381 goto failed; 382 ret = pcmcia_map_mem_page(link, link->resource[2], 0); 383 if (ret) 384 goto failed; 385 local->sram = ioremap(link->resource[2]->start, 386 resource_size(link->resource[2])); 387 if (!local->sram) 388 goto failed; 389 390 /*** Set up 16k window for shared memory (receive buffer) ***************/ 391 link->resource[3]->flags |= 392 WIN_DATA_WIDTH_8 | WIN_MEMORY_TYPE_CM | WIN_ENABLE | WIN_USE_WAIT; 393 link->resource[3]->start = 0; 394 link->resource[3]->end = 0x4000; 395 ret = pcmcia_request_window(link, link->resource[3], ray_mem_speed); 396 if (ret) 397 goto failed; 398 ret = pcmcia_map_mem_page(link, link->resource[3], 0x8000); 399 if (ret) 400 goto failed; 401 local->rmem = ioremap(link->resource[3]->start, 402 resource_size(link->resource[3])); 403 if (!local->rmem) 404 goto failed; 405 406 /*** Set up window for attribute memory ***********************************/ 407 link->resource[4]->flags |= 408 WIN_DATA_WIDTH_8 | WIN_MEMORY_TYPE_AM | WIN_ENABLE | WIN_USE_WAIT; 409 link->resource[4]->start = 0; 410 link->resource[4]->end = 0x1000; 411 ret = pcmcia_request_window(link, link->resource[4], ray_mem_speed); 412 if (ret) 413 goto failed; 414 ret = pcmcia_map_mem_page(link, link->resource[4], 0); 415 if (ret) 416 goto failed; 417 local->amem = ioremap(link->resource[4]->start, 418 resource_size(link->resource[4])); 419 if (!local->amem) 420 goto failed; 421 422 dev_dbg(&link->dev, "ray_config sram=%p\n", local->sram); 423 dev_dbg(&link->dev, "ray_config rmem=%p\n", local->rmem); 424 dev_dbg(&link->dev, "ray_config amem=%p\n", local->amem); 425 if (ray_init(dev) < 0) { 426 ray_release(link); 427 return -ENODEV; 428 } 429 430 SET_NETDEV_DEV(dev, &link->dev); 431 i = register_netdev(dev); 432 if (i != 0) { 433 printk("ray_config register_netdev() failed\n"); 434 ray_release(link); 435 return i; 436 } 437 438 printk(KERN_INFO "%s: RayLink, irq %d, hw_addr %pM\n", 439 dev->name, dev->irq, dev->dev_addr); 440 441 return 0; 442 443 failed: 444 ray_release(link); 445 return -ENODEV; 446 } /* ray_config */ 447 448 static inline struct ccs __iomem *ccs_base(ray_dev_t *dev) 449 { 450 return dev->sram + CCS_BASE; 451 } 452 453 static inline struct rcs __iomem *rcs_base(ray_dev_t *dev) 454 { 455 /* 456 * This looks nonsensical, since there is a separate 457 * RCS_BASE. But the difference between a "struct rcs" 458 * and a "struct ccs" ends up being in the _index_ off 459 * the base, so the base pointer is the same for both 460 * ccs/rcs. 461 */ 462 return dev->sram + CCS_BASE; 463 } 464 465 /*===========================================================================*/ 466 static int ray_init(struct net_device *dev) 467 { 468 int i; 469 struct ccs __iomem *pccs; 470 ray_dev_t *local = netdev_priv(dev); 471 struct pcmcia_device *link = local->finder; 472 dev_dbg(&link->dev, "ray_init(0x%p)\n", dev); 473 if (!(pcmcia_dev_present(link))) { 474 dev_dbg(&link->dev, "ray_init - device not present\n"); 475 return -1; 476 } 477 478 local->net_type = net_type; 479 local->sta_type = TYPE_STA; 480 481 /* Copy the startup results to local memory */ 482 memcpy_fromio(&local->startup_res, local->sram + ECF_TO_HOST_BASE, 483 sizeof(struct startup_res_6)); 484 485 /* Check Power up test status and get mac address from card */ 486 if (local->startup_res.startup_word != 0x80) { 487 printk(KERN_INFO "ray_init ERROR card status = %2x\n", 488 local->startup_res.startup_word); 489 local->card_status = CARD_INIT_ERROR; 490 return -1; 491 } 492 493 local->fw_ver = local->startup_res.firmware_version[0]; 494 local->fw_bld = local->startup_res.firmware_version[1]; 495 local->fw_var = local->startup_res.firmware_version[2]; 496 dev_dbg(&link->dev, "ray_init firmware version %d.%d\n", local->fw_ver, 497 local->fw_bld); 498 499 local->tib_length = 0x20; 500 if ((local->fw_ver == 5) && (local->fw_bld >= 30)) 501 local->tib_length = local->startup_res.tib_length; 502 dev_dbg(&link->dev, "ray_init tib_length = 0x%02x\n", local->tib_length); 503 /* Initialize CCS's to buffer free state */ 504 pccs = ccs_base(local); 505 for (i = 0; i < NUMBER_OF_CCS; i++) { 506 writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status); 507 } 508 init_startup_params(local); 509 510 /* copy mac address to startup parameters */ 511 if (!parse_addr(phy_addr, local->sparm.b4.a_mac_addr)) { 512 memcpy(&local->sparm.b4.a_mac_addr, 513 &local->startup_res.station_addr, ADDRLEN); 514 } 515 516 clear_interrupt(local); /* Clear any interrupt from the card */ 517 local->card_status = CARD_AWAITING_PARAM; 518 dev_dbg(&link->dev, "ray_init ending\n"); 519 return 0; 520 } /* ray_init */ 521 522 /*===========================================================================*/ 523 /* Download startup parameters to the card and command it to read them */ 524 static int dl_startup_params(struct net_device *dev) 525 { 526 int ccsindex; 527 ray_dev_t *local = netdev_priv(dev); 528 struct ccs __iomem *pccs; 529 struct pcmcia_device *link = local->finder; 530 531 dev_dbg(&link->dev, "dl_startup_params entered\n"); 532 if (!(pcmcia_dev_present(link))) { 533 dev_dbg(&link->dev, "ray_cs dl_startup_params - device not present\n"); 534 return -1; 535 } 536 537 /* Copy parameters to host to ECF area */ 538 if (local->fw_ver == 0x55) 539 memcpy_toio(local->sram + HOST_TO_ECF_BASE, &local->sparm.b4, 540 sizeof(struct b4_startup_params)); 541 else 542 memcpy_toio(local->sram + HOST_TO_ECF_BASE, &local->sparm.b5, 543 sizeof(struct b5_startup_params)); 544 545 /* Fill in the CCS fields for the ECF */ 546 if ((ccsindex = get_free_ccs(local)) < 0) 547 return -1; 548 local->dl_param_ccs = ccsindex; 549 pccs = ccs_base(local) + ccsindex; 550 writeb(CCS_DOWNLOAD_STARTUP_PARAMS, &pccs->cmd); 551 dev_dbg(&link->dev, "dl_startup_params start ccsindex = %d\n", 552 local->dl_param_ccs); 553 /* Interrupt the firmware to process the command */ 554 if (interrupt_ecf(local, ccsindex)) { 555 printk(KERN_INFO "ray dl_startup_params failed - " 556 "ECF not ready for intr\n"); 557 local->card_status = CARD_DL_PARAM_ERROR; 558 writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status); 559 return -2; 560 } 561 local->card_status = CARD_DL_PARAM; 562 /* Start kernel timer to wait for dl startup to complete. */ 563 local->timer.expires = jiffies + HZ / 2; 564 local->timer.function = verify_dl_startup; 565 add_timer(&local->timer); 566 dev_dbg(&link->dev, 567 "ray_cs dl_startup_params started timer for verify_dl_startup\n"); 568 return 0; 569 } /* dl_startup_params */ 570 571 /*===========================================================================*/ 572 static void init_startup_params(ray_dev_t *local) 573 { 574 int i; 575 576 if (country > JAPAN_TEST) 577 country = USA; 578 else if (country < USA) 579 country = USA; 580 /* structure for hop time and beacon period is defined here using 581 * New 802.11D6.1 format. Card firmware is still using old format 582 * until version 6. 583 * Before After 584 * a_hop_time ms byte a_hop_time ms byte 585 * a_hop_time 2s byte a_hop_time ls byte 586 * a_hop_time ls byte a_beacon_period ms byte 587 * a_beacon_period a_beacon_period ls byte 588 * 589 * a_hop_time = uS a_hop_time = KuS 590 * a_beacon_period = hops a_beacon_period = KuS 591 *//* 64ms = 010000 */ 592 if (local->fw_ver == 0x55) { 593 memcpy(&local->sparm.b4, b4_default_startup_parms, 594 sizeof(struct b4_startup_params)); 595 /* Translate sane kus input values to old build 4/5 format */ 596 /* i = hop time in uS truncated to 3 bytes */ 597 i = (hop_dwell * 1024) & 0xffffff; 598 local->sparm.b4.a_hop_time[0] = (i >> 16) & 0xff; 599 local->sparm.b4.a_hop_time[1] = (i >> 8) & 0xff; 600 local->sparm.b4.a_beacon_period[0] = 0; 601 local->sparm.b4.a_beacon_period[1] = 602 ((beacon_period / hop_dwell) - 1) & 0xff; 603 local->sparm.b4.a_curr_country_code = country; 604 local->sparm.b4.a_hop_pattern_length = 605 hop_pattern_length[(int)country] - 1; 606 if (bc) { 607 local->sparm.b4.a_ack_timeout = 0x50; 608 local->sparm.b4.a_sifs = 0x3f; 609 } 610 } else { /* Version 5 uses real kus values */ 611 memcpy((UCHAR *) &local->sparm.b5, b5_default_startup_parms, 612 sizeof(struct b5_startup_params)); 613 614 local->sparm.b5.a_hop_time[0] = (hop_dwell >> 8) & 0xff; 615 local->sparm.b5.a_hop_time[1] = hop_dwell & 0xff; 616 local->sparm.b5.a_beacon_period[0] = 617 (beacon_period >> 8) & 0xff; 618 local->sparm.b5.a_beacon_period[1] = beacon_period & 0xff; 619 if (psm) 620 local->sparm.b5.a_power_mgt_state = 1; 621 local->sparm.b5.a_curr_country_code = country; 622 local->sparm.b5.a_hop_pattern_length = 623 hop_pattern_length[(int)country]; 624 } 625 626 local->sparm.b4.a_network_type = net_type & 0x01; 627 local->sparm.b4.a_acting_as_ap_status = TYPE_STA; 628 629 if (essid != NULL) 630 strncpy(local->sparm.b4.a_current_ess_id, essid, ESSID_SIZE); 631 } /* init_startup_params */ 632 633 /*===========================================================================*/ 634 static void verify_dl_startup(struct timer_list *t) 635 { 636 ray_dev_t *local = from_timer(local, t, timer); 637 struct ccs __iomem *pccs = ccs_base(local) + local->dl_param_ccs; 638 UCHAR status; 639 struct pcmcia_device *link = local->finder; 640 641 if (!(pcmcia_dev_present(link))) { 642 dev_dbg(&link->dev, "ray_cs verify_dl_startup - device not present\n"); 643 return; 644 } 645 #if 0 646 { 647 int i; 648 printk(KERN_DEBUG 649 "verify_dl_startup parameters sent via ccs %d:\n", 650 local->dl_param_ccs); 651 for (i = 0; i < sizeof(struct b5_startup_params); i++) { 652 printk(" %2x", 653 (unsigned int)readb(local->sram + 654 HOST_TO_ECF_BASE + i)); 655 } 656 printk("\n"); 657 } 658 #endif 659 660 status = readb(&pccs->buffer_status); 661 if (status != CCS_BUFFER_FREE) { 662 printk(KERN_INFO 663 "Download startup params failed. Status = %d\n", 664 status); 665 local->card_status = CARD_DL_PARAM_ERROR; 666 return; 667 } 668 if (local->sparm.b4.a_network_type == ADHOC) 669 start_net(&local->timer); 670 else 671 join_net(&local->timer); 672 } /* end verify_dl_startup */ 673 674 /*===========================================================================*/ 675 /* Command card to start a network */ 676 static void start_net(struct timer_list *t) 677 { 678 ray_dev_t *local = from_timer(local, t, timer); 679 struct ccs __iomem *pccs; 680 int ccsindex; 681 struct pcmcia_device *link = local->finder; 682 if (!(pcmcia_dev_present(link))) { 683 dev_dbg(&link->dev, "ray_cs start_net - device not present\n"); 684 return; 685 } 686 /* Fill in the CCS fields for the ECF */ 687 if ((ccsindex = get_free_ccs(local)) < 0) 688 return; 689 pccs = ccs_base(local) + ccsindex; 690 writeb(CCS_START_NETWORK, &pccs->cmd); 691 writeb(0, &pccs->var.start_network.update_param); 692 /* Interrupt the firmware to process the command */ 693 if (interrupt_ecf(local, ccsindex)) { 694 dev_dbg(&link->dev, "ray start net failed - card not ready for intr\n"); 695 writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status); 696 return; 697 } 698 local->card_status = CARD_DOING_ACQ; 699 } /* end start_net */ 700 701 /*===========================================================================*/ 702 /* Command card to join a network */ 703 static void join_net(struct timer_list *t) 704 { 705 ray_dev_t *local = from_timer(local, t, timer); 706 707 struct ccs __iomem *pccs; 708 int ccsindex; 709 struct pcmcia_device *link = local->finder; 710 711 if (!(pcmcia_dev_present(link))) { 712 dev_dbg(&link->dev, "ray_cs join_net - device not present\n"); 713 return; 714 } 715 /* Fill in the CCS fields for the ECF */ 716 if ((ccsindex = get_free_ccs(local)) < 0) 717 return; 718 pccs = ccs_base(local) + ccsindex; 719 writeb(CCS_JOIN_NETWORK, &pccs->cmd); 720 writeb(0, &pccs->var.join_network.update_param); 721 writeb(0, &pccs->var.join_network.net_initiated); 722 /* Interrupt the firmware to process the command */ 723 if (interrupt_ecf(local, ccsindex)) { 724 dev_dbg(&link->dev, "ray join net failed - card not ready for intr\n"); 725 writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status); 726 return; 727 } 728 local->card_status = CARD_DOING_ACQ; 729 } 730 731 732 static void ray_release(struct pcmcia_device *link) 733 { 734 struct net_device *dev = link->priv; 735 ray_dev_t *local = netdev_priv(dev); 736 737 dev_dbg(&link->dev, "ray_release\n"); 738 739 del_timer_sync(&local->timer); 740 741 if (local->sram) 742 iounmap(local->sram); 743 if (local->rmem) 744 iounmap(local->rmem); 745 if (local->amem) 746 iounmap(local->amem); 747 pcmcia_disable_device(link); 748 749 dev_dbg(&link->dev, "ray_release ending\n"); 750 } 751 752 static int ray_suspend(struct pcmcia_device *link) 753 { 754 struct net_device *dev = link->priv; 755 756 if (link->open) 757 netif_device_detach(dev); 758 759 return 0; 760 } 761 762 static int ray_resume(struct pcmcia_device *link) 763 { 764 struct net_device *dev = link->priv; 765 766 if (link->open) { 767 ray_reset(dev); 768 netif_device_attach(dev); 769 } 770 771 return 0; 772 } 773 774 /*===========================================================================*/ 775 static int ray_dev_init(struct net_device *dev) 776 { 777 #ifdef RAY_IMMEDIATE_INIT 778 int i; 779 #endif /* RAY_IMMEDIATE_INIT */ 780 ray_dev_t *local = netdev_priv(dev); 781 struct pcmcia_device *link = local->finder; 782 783 dev_dbg(&link->dev, "ray_dev_init(dev=%p)\n", dev); 784 if (!(pcmcia_dev_present(link))) { 785 dev_dbg(&link->dev, "ray_dev_init - device not present\n"); 786 return -1; 787 } 788 #ifdef RAY_IMMEDIATE_INIT 789 /* Download startup parameters */ 790 if ((i = dl_startup_params(dev)) < 0) { 791 printk(KERN_INFO "ray_dev_init dl_startup_params failed - " 792 "returns 0x%x\n", i); 793 return -1; 794 } 795 #else /* RAY_IMMEDIATE_INIT */ 796 /* Postpone the card init so that we can still configure the card, 797 * for example using the Wireless Extensions. The init will happen 798 * in ray_open() - Jean II */ 799 dev_dbg(&link->dev, 800 "ray_dev_init: postponing card init to ray_open() ; Status = %d\n", 801 local->card_status); 802 #endif /* RAY_IMMEDIATE_INIT */ 803 804 /* copy mac and broadcast addresses to linux device */ 805 eth_hw_addr_set(dev, local->sparm.b4.a_mac_addr); 806 eth_broadcast_addr(dev->broadcast); 807 808 dev_dbg(&link->dev, "ray_dev_init ending\n"); 809 return 0; 810 } 811 812 /*===========================================================================*/ 813 static int ray_dev_config(struct net_device *dev, struct ifmap *map) 814 { 815 ray_dev_t *local = netdev_priv(dev); 816 struct pcmcia_device *link = local->finder; 817 /* Dummy routine to satisfy device structure */ 818 dev_dbg(&link->dev, "ray_dev_config(dev=%p,ifmap=%p)\n", dev, map); 819 if (!(pcmcia_dev_present(link))) { 820 dev_dbg(&link->dev, "ray_dev_config - device not present\n"); 821 return -1; 822 } 823 824 return 0; 825 } 826 827 /*===========================================================================*/ 828 static netdev_tx_t ray_dev_start_xmit(struct sk_buff *skb, 829 struct net_device *dev) 830 { 831 ray_dev_t *local = netdev_priv(dev); 832 struct pcmcia_device *link = local->finder; 833 short length = skb->len; 834 835 if (!pcmcia_dev_present(link)) { 836 dev_dbg(&link->dev, "ray_dev_start_xmit - device not present\n"); 837 dev_kfree_skb(skb); 838 return NETDEV_TX_OK; 839 } 840 841 dev_dbg(&link->dev, "ray_dev_start_xmit(skb=%p, dev=%p)\n", skb, dev); 842 if (local->authentication_state == NEED_TO_AUTH) { 843 dev_dbg(&link->dev, "ray_cs Sending authentication request.\n"); 844 if (!build_auth_frame(local, local->auth_id, OPEN_AUTH_REQUEST)) { 845 local->authentication_state = AUTHENTICATED; 846 netif_stop_queue(dev); 847 return NETDEV_TX_BUSY; 848 } 849 } 850 851 if (length < ETH_ZLEN) { 852 if (skb_padto(skb, ETH_ZLEN)) 853 return NETDEV_TX_OK; 854 length = ETH_ZLEN; 855 } 856 switch (ray_hw_xmit(skb->data, length, dev, DATA_TYPE)) { 857 case XMIT_NO_CCS: 858 case XMIT_NEED_AUTH: 859 netif_stop_queue(dev); 860 return NETDEV_TX_BUSY; 861 case XMIT_NO_INTR: 862 case XMIT_MSG_BAD: 863 case XMIT_OK: 864 default: 865 dev_kfree_skb(skb); 866 } 867 868 return NETDEV_TX_OK; 869 } /* ray_dev_start_xmit */ 870 871 /*===========================================================================*/ 872 static int ray_hw_xmit(unsigned char *data, int len, struct net_device *dev, 873 UCHAR msg_type) 874 { 875 ray_dev_t *local = netdev_priv(dev); 876 struct ccs __iomem *pccs; 877 int ccsindex; 878 int offset; 879 struct tx_msg __iomem *ptx; /* Address of xmit buffer in PC space */ 880 short int addr; /* Address of xmit buffer in card space */ 881 882 pr_debug("ray_hw_xmit(data=%p, len=%d, dev=%p)\n", data, len, dev); 883 if (len + TX_HEADER_LENGTH > TX_BUF_SIZE) { 884 printk(KERN_INFO "ray_hw_xmit packet too large: %d bytes\n", 885 len); 886 return XMIT_MSG_BAD; 887 } 888 switch (ccsindex = get_free_tx_ccs(local)) { 889 case ECCSBUSY: 890 pr_debug("ray_hw_xmit tx_ccs table busy\n"); 891 fallthrough; 892 case ECCSFULL: 893 pr_debug("ray_hw_xmit No free tx ccs\n"); 894 fallthrough; 895 case ECARDGONE: 896 netif_stop_queue(dev); 897 return XMIT_NO_CCS; 898 default: 899 break; 900 } 901 addr = TX_BUF_BASE + (ccsindex << 11); 902 903 if (msg_type == DATA_TYPE) { 904 local->stats.tx_bytes += len; 905 local->stats.tx_packets++; 906 } 907 908 ptx = local->sram + addr; 909 910 ray_build_header(local, ptx, msg_type, data); 911 if (translate) { 912 offset = translate_frame(local, ptx, data, len); 913 } else { /* Encapsulate frame */ 914 /* TBD TIB length will move address of ptx->var */ 915 memcpy_toio(&ptx->var, data, len); 916 offset = 0; 917 } 918 919 /* fill in the CCS */ 920 pccs = ccs_base(local) + ccsindex; 921 len += TX_HEADER_LENGTH + offset; 922 writeb(CCS_TX_REQUEST, &pccs->cmd); 923 writeb(addr >> 8, &pccs->var.tx_request.tx_data_ptr[0]); 924 writeb(local->tib_length, &pccs->var.tx_request.tx_data_ptr[1]); 925 writeb(len >> 8, &pccs->var.tx_request.tx_data_length[0]); 926 writeb(len & 0xff, &pccs->var.tx_request.tx_data_length[1]); 927 /* TBD still need psm_cam? */ 928 writeb(PSM_CAM, &pccs->var.tx_request.pow_sav_mode); 929 writeb(local->net_default_tx_rate, &pccs->var.tx_request.tx_rate); 930 writeb(0, &pccs->var.tx_request.antenna); 931 pr_debug("ray_hw_xmit default_tx_rate = 0x%x\n", 932 local->net_default_tx_rate); 933 934 /* Interrupt the firmware to process the command */ 935 if (interrupt_ecf(local, ccsindex)) { 936 pr_debug("ray_hw_xmit failed - ECF not ready for intr\n"); 937 /* TBD very inefficient to copy packet to buffer, and then not 938 send it, but the alternative is to queue the messages and that 939 won't be done for a while. Maybe set tbusy until a CCS is free? 940 */ 941 writeb(CCS_BUFFER_FREE, &pccs->buffer_status); 942 return XMIT_NO_INTR; 943 } 944 return XMIT_OK; 945 } /* end ray_hw_xmit */ 946 947 /*===========================================================================*/ 948 static int translate_frame(ray_dev_t *local, struct tx_msg __iomem *ptx, 949 unsigned char *data, int len) 950 { 951 __be16 proto = ((struct ethhdr *)data)->h_proto; 952 if (ntohs(proto) >= ETH_P_802_3_MIN) { /* DIX II ethernet frame */ 953 pr_debug("ray_cs translate_frame DIX II\n"); 954 /* Copy LLC header to card buffer */ 955 memcpy_toio(&ptx->var, eth2_llc, sizeof(eth2_llc)); 956 memcpy_toio(((void __iomem *)&ptx->var) + sizeof(eth2_llc), 957 (UCHAR *) &proto, 2); 958 if (proto == htons(ETH_P_AARP) || proto == htons(ETH_P_IPX)) { 959 /* This is the selective translation table, only 2 entries */ 960 writeb(0xf8, 961 &((struct snaphdr_t __iomem *)ptx->var)->org[2]); 962 } 963 /* Copy body of ethernet packet without ethernet header */ 964 memcpy_toio((void __iomem *)&ptx->var + 965 sizeof(struct snaphdr_t), data + ETH_HLEN, 966 len - ETH_HLEN); 967 return (int)sizeof(struct snaphdr_t) - ETH_HLEN; 968 } else { /* already 802 type, and proto is length */ 969 pr_debug("ray_cs translate_frame 802\n"); 970 if (proto == htons(0xffff)) { /* evil netware IPX 802.3 without LLC */ 971 pr_debug("ray_cs translate_frame evil IPX\n"); 972 memcpy_toio(&ptx->var, data + ETH_HLEN, len - ETH_HLEN); 973 return 0 - ETH_HLEN; 974 } 975 memcpy_toio(&ptx->var, data + ETH_HLEN, len - ETH_HLEN); 976 return 0 - ETH_HLEN; 977 } 978 /* TBD do other frame types */ 979 } /* end translate_frame */ 980 981 /*===========================================================================*/ 982 static void ray_build_header(ray_dev_t *local, struct tx_msg __iomem *ptx, 983 UCHAR msg_type, unsigned char *data) 984 { 985 writeb(PROTOCOL_VER | msg_type, &ptx->mac.frame_ctl_1); 986 /*** IEEE 802.11 Address field assignments ************* 987 TODS FROMDS addr_1 addr_2 addr_3 addr_4 988 Adhoc 0 0 dest src (terminal) BSSID N/A 989 AP to Terminal 0 1 dest AP(BSSID) source N/A 990 Terminal to AP 1 0 AP(BSSID) src (terminal) dest N/A 991 AP to AP 1 1 dest AP src AP dest source 992 *******************************************************/ 993 if (local->net_type == ADHOC) { 994 writeb(0, &ptx->mac.frame_ctl_2); 995 memcpy_toio(ptx->mac.addr_1, ((struct ethhdr *)data)->h_dest, 996 ADDRLEN); 997 memcpy_toio(ptx->mac.addr_2, ((struct ethhdr *)data)->h_source, 998 ADDRLEN); 999 memcpy_toio(ptx->mac.addr_3, local->bss_id, ADDRLEN); 1000 } else { /* infrastructure */ 1001 1002 if (local->sparm.b4.a_acting_as_ap_status) { 1003 writeb(FC2_FROM_DS, &ptx->mac.frame_ctl_2); 1004 memcpy_toio(ptx->mac.addr_1, 1005 ((struct ethhdr *)data)->h_dest, ADDRLEN); 1006 memcpy_toio(ptx->mac.addr_2, local->bss_id, 6); 1007 memcpy_toio(ptx->mac.addr_3, 1008 ((struct ethhdr *)data)->h_source, ADDRLEN); 1009 } else { /* Terminal */ 1010 1011 writeb(FC2_TO_DS, &ptx->mac.frame_ctl_2); 1012 memcpy_toio(ptx->mac.addr_1, local->bss_id, ADDRLEN); 1013 memcpy_toio(ptx->mac.addr_2, 1014 ((struct ethhdr *)data)->h_source, ADDRLEN); 1015 memcpy_toio(ptx->mac.addr_3, 1016 ((struct ethhdr *)data)->h_dest, ADDRLEN); 1017 } 1018 } 1019 } /* end encapsulate_frame */ 1020 1021 /*====================================================================*/ 1022 1023 /*------------------------------------------------------------------*/ 1024 /* 1025 * Wireless Handler : get protocol name 1026 */ 1027 static int ray_get_name(struct net_device *dev, struct iw_request_info *info, 1028 union iwreq_data *wrqu, char *extra) 1029 { 1030 strcpy(wrqu->name, "IEEE 802.11-FH"); 1031 return 0; 1032 } 1033 1034 /*------------------------------------------------------------------*/ 1035 /* 1036 * Wireless Handler : set frequency 1037 */ 1038 static int ray_set_freq(struct net_device *dev, struct iw_request_info *info, 1039 union iwreq_data *wrqu, char *extra) 1040 { 1041 ray_dev_t *local = netdev_priv(dev); 1042 int err = -EINPROGRESS; /* Call commit handler */ 1043 1044 /* Reject if card is already initialised */ 1045 if (local->card_status != CARD_AWAITING_PARAM) 1046 return -EBUSY; 1047 1048 /* Setting by channel number */ 1049 if ((wrqu->freq.m > USA_HOP_MOD) || (wrqu->freq.e > 0)) 1050 err = -EOPNOTSUPP; 1051 else 1052 local->sparm.b5.a_hop_pattern = wrqu->freq.m; 1053 1054 return err; 1055 } 1056 1057 /*------------------------------------------------------------------*/ 1058 /* 1059 * Wireless Handler : get frequency 1060 */ 1061 static int ray_get_freq(struct net_device *dev, struct iw_request_info *info, 1062 union iwreq_data *wrqu, char *extra) 1063 { 1064 ray_dev_t *local = netdev_priv(dev); 1065 1066 wrqu->freq.m = local->sparm.b5.a_hop_pattern; 1067 wrqu->freq.e = 0; 1068 return 0; 1069 } 1070 1071 /*------------------------------------------------------------------*/ 1072 /* 1073 * Wireless Handler : set ESSID 1074 */ 1075 static int ray_set_essid(struct net_device *dev, struct iw_request_info *info, 1076 union iwreq_data *wrqu, char *extra) 1077 { 1078 ray_dev_t *local = netdev_priv(dev); 1079 1080 /* Reject if card is already initialised */ 1081 if (local->card_status != CARD_AWAITING_PARAM) 1082 return -EBUSY; 1083 1084 /* Check if we asked for `any' */ 1085 if (wrqu->essid.flags == 0) 1086 /* Corey : can you do that ? */ 1087 return -EOPNOTSUPP; 1088 1089 /* Check the size of the string */ 1090 if (wrqu->essid.length > IW_ESSID_MAX_SIZE) 1091 return -E2BIG; 1092 1093 /* Set the ESSID in the card */ 1094 memset(local->sparm.b5.a_current_ess_id, 0, IW_ESSID_MAX_SIZE); 1095 memcpy(local->sparm.b5.a_current_ess_id, extra, wrqu->essid.length); 1096 1097 return -EINPROGRESS; /* Call commit handler */ 1098 } 1099 1100 /*------------------------------------------------------------------*/ 1101 /* 1102 * Wireless Handler : get ESSID 1103 */ 1104 static int ray_get_essid(struct net_device *dev, struct iw_request_info *info, 1105 union iwreq_data *wrqu, char *extra) 1106 { 1107 ray_dev_t *local = netdev_priv(dev); 1108 UCHAR tmp[IW_ESSID_MAX_SIZE + 1]; 1109 1110 /* Get the essid that was set */ 1111 memcpy(extra, local->sparm.b5.a_current_ess_id, IW_ESSID_MAX_SIZE); 1112 memcpy(tmp, local->sparm.b5.a_current_ess_id, IW_ESSID_MAX_SIZE); 1113 tmp[IW_ESSID_MAX_SIZE] = '\0'; 1114 1115 /* Push it out ! */ 1116 wrqu->essid.length = strlen(tmp); 1117 wrqu->essid.flags = 1; /* active */ 1118 1119 return 0; 1120 } 1121 1122 /*------------------------------------------------------------------*/ 1123 /* 1124 * Wireless Handler : get AP address 1125 */ 1126 static int ray_get_wap(struct net_device *dev, struct iw_request_info *info, 1127 union iwreq_data *wrqu, char *extra) 1128 { 1129 ray_dev_t *local = netdev_priv(dev); 1130 1131 memcpy(wrqu->ap_addr.sa_data, local->bss_id, ETH_ALEN); 1132 wrqu->ap_addr.sa_family = ARPHRD_ETHER; 1133 1134 return 0; 1135 } 1136 1137 /*------------------------------------------------------------------*/ 1138 /* 1139 * Wireless Handler : set Bit-Rate 1140 */ 1141 static int ray_set_rate(struct net_device *dev, struct iw_request_info *info, 1142 union iwreq_data *wrqu, char *extra) 1143 { 1144 ray_dev_t *local = netdev_priv(dev); 1145 1146 /* Reject if card is already initialised */ 1147 if (local->card_status != CARD_AWAITING_PARAM) 1148 return -EBUSY; 1149 1150 /* Check if rate is in range */ 1151 if ((wrqu->bitrate.value != 1000000) && (wrqu->bitrate.value != 2000000)) 1152 return -EINVAL; 1153 1154 /* Hack for 1.5 Mb/s instead of 2 Mb/s */ 1155 if ((local->fw_ver == 0x55) && /* Please check */ 1156 (wrqu->bitrate.value == 2000000)) 1157 local->net_default_tx_rate = 3; 1158 else 1159 local->net_default_tx_rate = wrqu->bitrate.value / 500000; 1160 1161 return 0; 1162 } 1163 1164 /*------------------------------------------------------------------*/ 1165 /* 1166 * Wireless Handler : get Bit-Rate 1167 */ 1168 static int ray_get_rate(struct net_device *dev, struct iw_request_info *info, 1169 union iwreq_data *wrqu, char *extra) 1170 { 1171 ray_dev_t *local = netdev_priv(dev); 1172 1173 if (local->net_default_tx_rate == 3) 1174 wrqu->bitrate.value = 2000000; /* Hum... */ 1175 else 1176 wrqu->bitrate.value = local->net_default_tx_rate * 500000; 1177 wrqu->bitrate.fixed = 0; /* We are in auto mode */ 1178 1179 return 0; 1180 } 1181 1182 /*------------------------------------------------------------------*/ 1183 /* 1184 * Wireless Handler : set RTS threshold 1185 */ 1186 static int ray_set_rts(struct net_device *dev, struct iw_request_info *info, 1187 union iwreq_data *wrqu, char *extra) 1188 { 1189 ray_dev_t *local = netdev_priv(dev); 1190 int rthr = wrqu->rts.value; 1191 1192 /* Reject if card is already initialised */ 1193 if (local->card_status != CARD_AWAITING_PARAM) 1194 return -EBUSY; 1195 1196 /* if(wrq->u.rts.fixed == 0) we should complain */ 1197 if (wrqu->rts.disabled) 1198 rthr = 32767; 1199 else { 1200 if ((rthr < 0) || (rthr > 2347)) /* What's the max packet size ??? */ 1201 return -EINVAL; 1202 } 1203 local->sparm.b5.a_rts_threshold[0] = (rthr >> 8) & 0xFF; 1204 local->sparm.b5.a_rts_threshold[1] = rthr & 0xFF; 1205 1206 return -EINPROGRESS; /* Call commit handler */ 1207 } 1208 1209 /*------------------------------------------------------------------*/ 1210 /* 1211 * Wireless Handler : get RTS threshold 1212 */ 1213 static int ray_get_rts(struct net_device *dev, struct iw_request_info *info, 1214 union iwreq_data *wrqu, char *extra) 1215 { 1216 ray_dev_t *local = netdev_priv(dev); 1217 1218 wrqu->rts.value = (local->sparm.b5.a_rts_threshold[0] << 8) 1219 + local->sparm.b5.a_rts_threshold[1]; 1220 wrqu->rts.disabled = (wrqu->rts.value == 32767); 1221 wrqu->rts.fixed = 1; 1222 1223 return 0; 1224 } 1225 1226 /*------------------------------------------------------------------*/ 1227 /* 1228 * Wireless Handler : set Fragmentation threshold 1229 */ 1230 static int ray_set_frag(struct net_device *dev, struct iw_request_info *info, 1231 union iwreq_data *wrqu, char *extra) 1232 { 1233 ray_dev_t *local = netdev_priv(dev); 1234 int fthr = wrqu->frag.value; 1235 1236 /* Reject if card is already initialised */ 1237 if (local->card_status != CARD_AWAITING_PARAM) 1238 return -EBUSY; 1239 1240 /* if(wrq->u.frag.fixed == 0) should complain */ 1241 if (wrqu->frag.disabled) 1242 fthr = 32767; 1243 else { 1244 if ((fthr < 256) || (fthr > 2347)) /* To check out ! */ 1245 return -EINVAL; 1246 } 1247 local->sparm.b5.a_frag_threshold[0] = (fthr >> 8) & 0xFF; 1248 local->sparm.b5.a_frag_threshold[1] = fthr & 0xFF; 1249 1250 return -EINPROGRESS; /* Call commit handler */ 1251 } 1252 1253 /*------------------------------------------------------------------*/ 1254 /* 1255 * Wireless Handler : get Fragmentation threshold 1256 */ 1257 static int ray_get_frag(struct net_device *dev, struct iw_request_info *info, 1258 union iwreq_data *wrqu, char *extra) 1259 { 1260 ray_dev_t *local = netdev_priv(dev); 1261 1262 wrqu->frag.value = (local->sparm.b5.a_frag_threshold[0] << 8) 1263 + local->sparm.b5.a_frag_threshold[1]; 1264 wrqu->frag.disabled = (wrqu->frag.value == 32767); 1265 wrqu->frag.fixed = 1; 1266 1267 return 0; 1268 } 1269 1270 /*------------------------------------------------------------------*/ 1271 /* 1272 * Wireless Handler : set Mode of Operation 1273 */ 1274 static int ray_set_mode(struct net_device *dev, struct iw_request_info *info, 1275 union iwreq_data *wrqu, char *extra) 1276 { 1277 ray_dev_t *local = netdev_priv(dev); 1278 int err = -EINPROGRESS; /* Call commit handler */ 1279 char card_mode = 1; 1280 1281 /* Reject if card is already initialised */ 1282 if (local->card_status != CARD_AWAITING_PARAM) 1283 return -EBUSY; 1284 1285 switch (wrqu->mode) { 1286 case IW_MODE_ADHOC: 1287 card_mode = 0; 1288 fallthrough; 1289 case IW_MODE_INFRA: 1290 local->sparm.b5.a_network_type = card_mode; 1291 break; 1292 default: 1293 err = -EINVAL; 1294 } 1295 1296 return err; 1297 } 1298 1299 /*------------------------------------------------------------------*/ 1300 /* 1301 * Wireless Handler : get Mode of Operation 1302 */ 1303 static int ray_get_mode(struct net_device *dev, struct iw_request_info *info, 1304 union iwreq_data *wrqu, char *extra) 1305 { 1306 ray_dev_t *local = netdev_priv(dev); 1307 1308 if (local->sparm.b5.a_network_type) 1309 wrqu->mode = IW_MODE_INFRA; 1310 else 1311 wrqu->mode = IW_MODE_ADHOC; 1312 1313 return 0; 1314 } 1315 1316 /*------------------------------------------------------------------*/ 1317 /* 1318 * Wireless Handler : get range info 1319 */ 1320 static int ray_get_range(struct net_device *dev, struct iw_request_info *info, 1321 union iwreq_data *wrqu, char *extra) 1322 { 1323 struct iw_range *range = (struct iw_range *)extra; 1324 1325 memset(range, 0, sizeof(struct iw_range)); 1326 1327 /* Set the length (very important for backward compatibility) */ 1328 wrqu->data.length = sizeof(struct iw_range); 1329 1330 /* Set the Wireless Extension versions */ 1331 range->we_version_compiled = WIRELESS_EXT; 1332 range->we_version_source = 9; 1333 1334 /* Set information in the range struct */ 1335 range->throughput = 1.1 * 1000 * 1000; /* Put the right number here */ 1336 range->num_channels = hop_pattern_length[(int)country]; 1337 range->num_frequency = 0; 1338 range->max_qual.qual = 0; 1339 range->max_qual.level = 255; /* What's the correct value ? */ 1340 range->max_qual.noise = 255; /* Idem */ 1341 range->num_bitrates = 2; 1342 range->bitrate[0] = 1000000; /* 1 Mb/s */ 1343 range->bitrate[1] = 2000000; /* 2 Mb/s */ 1344 return 0; 1345 } 1346 1347 /*------------------------------------------------------------------*/ 1348 /* 1349 * Wireless Private Handler : set framing mode 1350 */ 1351 static int ray_set_framing(struct net_device *dev, struct iw_request_info *info, 1352 union iwreq_data *wrqu, char *extra) 1353 { 1354 translate = !!*(extra); /* Set framing mode */ 1355 1356 return 0; 1357 } 1358 1359 /*------------------------------------------------------------------*/ 1360 /* 1361 * Wireless Private Handler : get framing mode 1362 */ 1363 static int ray_get_framing(struct net_device *dev, struct iw_request_info *info, 1364 union iwreq_data *wrqu, char *extra) 1365 { 1366 *(extra) = translate; 1367 1368 return 0; 1369 } 1370 1371 /*------------------------------------------------------------------*/ 1372 /* 1373 * Wireless Private Handler : get country 1374 */ 1375 static int ray_get_country(struct net_device *dev, struct iw_request_info *info, 1376 union iwreq_data *wrqu, char *extra) 1377 { 1378 *(extra) = country; 1379 1380 return 0; 1381 } 1382 1383 /*------------------------------------------------------------------*/ 1384 /* 1385 * Commit handler : called after a bunch of SET operations 1386 */ 1387 static int ray_commit(struct net_device *dev, struct iw_request_info *info, 1388 union iwreq_data *wrqu, char *extra) 1389 { 1390 return 0; 1391 } 1392 1393 /*------------------------------------------------------------------*/ 1394 /* 1395 * Stats handler : return Wireless Stats 1396 */ 1397 static iw_stats *ray_get_wireless_stats(struct net_device *dev) 1398 { 1399 ray_dev_t *local = netdev_priv(dev); 1400 struct pcmcia_device *link = local->finder; 1401 struct status __iomem *p = local->sram + STATUS_BASE; 1402 1403 local->wstats.status = local->card_status; 1404 #ifdef WIRELESS_SPY 1405 if ((local->spy_data.spy_number > 0) 1406 && (local->sparm.b5.a_network_type == 0)) { 1407 /* Get it from the first node in spy list */ 1408 local->wstats.qual.qual = local->spy_data.spy_stat[0].qual; 1409 local->wstats.qual.level = local->spy_data.spy_stat[0].level; 1410 local->wstats.qual.noise = local->spy_data.spy_stat[0].noise; 1411 local->wstats.qual.updated = 1412 local->spy_data.spy_stat[0].updated; 1413 } 1414 #endif /* WIRELESS_SPY */ 1415 1416 if (pcmcia_dev_present(link)) { 1417 local->wstats.qual.noise = readb(&p->rxnoise); 1418 local->wstats.qual.updated |= 4; 1419 } 1420 1421 return &local->wstats; 1422 } /* end ray_get_wireless_stats */ 1423 1424 /*------------------------------------------------------------------*/ 1425 /* 1426 * Structures to export the Wireless Handlers 1427 */ 1428 1429 static const iw_handler ray_handler[] = { 1430 IW_HANDLER(SIOCSIWCOMMIT, ray_commit), 1431 IW_HANDLER(SIOCGIWNAME, ray_get_name), 1432 IW_HANDLER(SIOCSIWFREQ, ray_set_freq), 1433 IW_HANDLER(SIOCGIWFREQ, ray_get_freq), 1434 IW_HANDLER(SIOCSIWMODE, ray_set_mode), 1435 IW_HANDLER(SIOCGIWMODE, ray_get_mode), 1436 IW_HANDLER(SIOCGIWRANGE, ray_get_range), 1437 #ifdef WIRELESS_SPY 1438 IW_HANDLER(SIOCSIWSPY, iw_handler_set_spy), 1439 IW_HANDLER(SIOCGIWSPY, iw_handler_get_spy), 1440 IW_HANDLER(SIOCSIWTHRSPY, iw_handler_set_thrspy), 1441 IW_HANDLER(SIOCGIWTHRSPY, iw_handler_get_thrspy), 1442 #endif /* WIRELESS_SPY */ 1443 IW_HANDLER(SIOCGIWAP, ray_get_wap), 1444 IW_HANDLER(SIOCSIWESSID, ray_set_essid), 1445 IW_HANDLER(SIOCGIWESSID, ray_get_essid), 1446 IW_HANDLER(SIOCSIWRATE, ray_set_rate), 1447 IW_HANDLER(SIOCGIWRATE, ray_get_rate), 1448 IW_HANDLER(SIOCSIWRTS, ray_set_rts), 1449 IW_HANDLER(SIOCGIWRTS, ray_get_rts), 1450 IW_HANDLER(SIOCSIWFRAG, ray_set_frag), 1451 IW_HANDLER(SIOCGIWFRAG, ray_get_frag), 1452 }; 1453 1454 #define SIOCSIPFRAMING SIOCIWFIRSTPRIV /* Set framing mode */ 1455 #define SIOCGIPFRAMING SIOCIWFIRSTPRIV + 1 /* Get framing mode */ 1456 #define SIOCGIPCOUNTRY SIOCIWFIRSTPRIV + 3 /* Get country code */ 1457 1458 static const iw_handler ray_private_handler[] = { 1459 [0] = ray_set_framing, 1460 [1] = ray_get_framing, 1461 [3] = ray_get_country, 1462 }; 1463 1464 static const struct iw_priv_args ray_private_args[] = { 1465 /* cmd, set_args, get_args, name */ 1466 {SIOCSIPFRAMING, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | 1, 0, 1467 "set_framing"}, 1468 {SIOCGIPFRAMING, 0, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | 1, 1469 "get_framing"}, 1470 {SIOCGIPCOUNTRY, 0, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | 1, 1471 "get_country"}, 1472 }; 1473 1474 static const struct iw_handler_def ray_handler_def = { 1475 .num_standard = ARRAY_SIZE(ray_handler), 1476 .num_private = ARRAY_SIZE(ray_private_handler), 1477 .num_private_args = ARRAY_SIZE(ray_private_args), 1478 .standard = ray_handler, 1479 .private = ray_private_handler, 1480 .private_args = ray_private_args, 1481 .get_wireless_stats = ray_get_wireless_stats, 1482 }; 1483 1484 /*===========================================================================*/ 1485 static int ray_open(struct net_device *dev) 1486 { 1487 ray_dev_t *local = netdev_priv(dev); 1488 struct pcmcia_device *link; 1489 link = local->finder; 1490 1491 dev_dbg(&link->dev, "ray_open('%s')\n", dev->name); 1492 1493 if (link->open == 0) 1494 local->num_multi = 0; 1495 link->open++; 1496 1497 /* If the card is not started, time to start it ! - Jean II */ 1498 if (local->card_status == CARD_AWAITING_PARAM) { 1499 int i; 1500 1501 dev_dbg(&link->dev, "ray_open: doing init now !\n"); 1502 1503 /* Download startup parameters */ 1504 if ((i = dl_startup_params(dev)) < 0) { 1505 printk(KERN_INFO 1506 "ray_dev_init dl_startup_params failed - " 1507 "returns 0x%x\n", i); 1508 return -1; 1509 } 1510 } 1511 1512 if (sniffer) 1513 netif_stop_queue(dev); 1514 else 1515 netif_start_queue(dev); 1516 1517 dev_dbg(&link->dev, "ray_open ending\n"); 1518 return 0; 1519 } /* end ray_open */ 1520 1521 /*===========================================================================*/ 1522 static int ray_dev_close(struct net_device *dev) 1523 { 1524 ray_dev_t *local = netdev_priv(dev); 1525 struct pcmcia_device *link; 1526 link = local->finder; 1527 1528 dev_dbg(&link->dev, "ray_dev_close('%s')\n", dev->name); 1529 1530 link->open--; 1531 netif_stop_queue(dev); 1532 1533 /* In here, we should stop the hardware (stop card from beeing active) 1534 * and set local->card_status to CARD_AWAITING_PARAM, so that while the 1535 * card is closed we can chage its configuration. 1536 * Probably also need a COR reset to get sane state - Jean II */ 1537 1538 return 0; 1539 } /* end ray_dev_close */ 1540 1541 /*===========================================================================*/ 1542 static void ray_reset(struct net_device *dev) 1543 { 1544 pr_debug("ray_reset entered\n"); 1545 } 1546 1547 /*===========================================================================*/ 1548 /* Cause a firmware interrupt if it is ready for one */ 1549 /* Return nonzero if not ready */ 1550 static int interrupt_ecf(ray_dev_t *local, int ccs) 1551 { 1552 int i = 50; 1553 struct pcmcia_device *link = local->finder; 1554 1555 if (!(pcmcia_dev_present(link))) { 1556 dev_dbg(&link->dev, "ray_cs interrupt_ecf - device not present\n"); 1557 return -1; 1558 } 1559 dev_dbg(&link->dev, "interrupt_ecf(local=%p, ccs = 0x%x\n", local, ccs); 1560 1561 while (i && 1562 (readb(local->amem + CIS_OFFSET + ECF_INTR_OFFSET) & 1563 ECF_INTR_SET)) 1564 i--; 1565 if (i == 0) { 1566 dev_dbg(&link->dev, "ray_cs interrupt_ecf card not ready for interrupt\n"); 1567 return -1; 1568 } 1569 /* Fill the mailbox, then kick the card */ 1570 writeb(ccs, local->sram + SCB_BASE); 1571 writeb(ECF_INTR_SET, local->amem + CIS_OFFSET + ECF_INTR_OFFSET); 1572 return 0; 1573 } /* interrupt_ecf */ 1574 1575 /*===========================================================================*/ 1576 /* Get next free transmit CCS */ 1577 /* Return - index of current tx ccs */ 1578 static int get_free_tx_ccs(ray_dev_t *local) 1579 { 1580 int i; 1581 struct ccs __iomem *pccs = ccs_base(local); 1582 struct pcmcia_device *link = local->finder; 1583 1584 if (!(pcmcia_dev_present(link))) { 1585 dev_dbg(&link->dev, "ray_cs get_free_tx_ccs - device not present\n"); 1586 return ECARDGONE; 1587 } 1588 1589 if (test_and_set_bit(0, &local->tx_ccs_lock)) { 1590 dev_dbg(&link->dev, "ray_cs tx_ccs_lock busy\n"); 1591 return ECCSBUSY; 1592 } 1593 1594 for (i = 0; i < NUMBER_OF_TX_CCS; i++) { 1595 if (readb(&(pccs + i)->buffer_status) == CCS_BUFFER_FREE) { 1596 writeb(CCS_BUFFER_BUSY, &(pccs + i)->buffer_status); 1597 writeb(CCS_END_LIST, &(pccs + i)->link); 1598 local->tx_ccs_lock = 0; 1599 return i; 1600 } 1601 } 1602 local->tx_ccs_lock = 0; 1603 dev_dbg(&link->dev, "ray_cs ERROR no free tx CCS for raylink card\n"); 1604 return ECCSFULL; 1605 } /* get_free_tx_ccs */ 1606 1607 /*===========================================================================*/ 1608 /* Get next free CCS */ 1609 /* Return - index of current ccs */ 1610 static int get_free_ccs(ray_dev_t *local) 1611 { 1612 int i; 1613 struct ccs __iomem *pccs = ccs_base(local); 1614 struct pcmcia_device *link = local->finder; 1615 1616 if (!(pcmcia_dev_present(link))) { 1617 dev_dbg(&link->dev, "ray_cs get_free_ccs - device not present\n"); 1618 return ECARDGONE; 1619 } 1620 if (test_and_set_bit(0, &local->ccs_lock)) { 1621 dev_dbg(&link->dev, "ray_cs ccs_lock busy\n"); 1622 return ECCSBUSY; 1623 } 1624 1625 for (i = NUMBER_OF_TX_CCS; i < NUMBER_OF_CCS; i++) { 1626 if (readb(&(pccs + i)->buffer_status) == CCS_BUFFER_FREE) { 1627 writeb(CCS_BUFFER_BUSY, &(pccs + i)->buffer_status); 1628 writeb(CCS_END_LIST, &(pccs + i)->link); 1629 local->ccs_lock = 0; 1630 return i; 1631 } 1632 } 1633 local->ccs_lock = 0; 1634 dev_dbg(&link->dev, "ray_cs ERROR no free CCS for raylink card\n"); 1635 return ECCSFULL; 1636 } /* get_free_ccs */ 1637 1638 /*===========================================================================*/ 1639 static void authenticate_timeout(struct timer_list *t) 1640 { 1641 ray_dev_t *local = from_timer(local, t, timer); 1642 del_timer(&local->timer); 1643 printk(KERN_INFO "ray_cs Authentication with access point failed" 1644 " - timeout\n"); 1645 join_net(&local->timer); 1646 } 1647 1648 /*===========================================================================*/ 1649 static int parse_addr(char *in_str, UCHAR *out) 1650 { 1651 int i, k; 1652 int len; 1653 1654 if (in_str == NULL) 1655 return 0; 1656 len = strnlen(in_str, ADDRLEN * 2 + 1) - 1; 1657 if (len < 1) 1658 return 0; 1659 memset(out, 0, ADDRLEN); 1660 1661 i = 5; 1662 1663 while (len > 0) { 1664 if ((k = hex_to_bin(in_str[len--])) != -1) 1665 out[i] = k; 1666 else 1667 return 0; 1668 1669 if (len == 0) 1670 break; 1671 if ((k = hex_to_bin(in_str[len--])) != -1) 1672 out[i] += k << 4; 1673 else 1674 return 0; 1675 if (!i--) 1676 break; 1677 } 1678 return 1; 1679 } 1680 1681 /*===========================================================================*/ 1682 static struct net_device_stats *ray_get_stats(struct net_device *dev) 1683 { 1684 ray_dev_t *local = netdev_priv(dev); 1685 struct pcmcia_device *link = local->finder; 1686 struct status __iomem *p = local->sram + STATUS_BASE; 1687 if (!(pcmcia_dev_present(link))) { 1688 dev_dbg(&link->dev, "ray_cs net_device_stats - device not present\n"); 1689 return &local->stats; 1690 } 1691 if (readb(&p->mrx_overflow_for_host)) { 1692 local->stats.rx_over_errors += swab16(readw(&p->mrx_overflow)); 1693 writeb(0, &p->mrx_overflow); 1694 writeb(0, &p->mrx_overflow_for_host); 1695 } 1696 if (readb(&p->mrx_checksum_error_for_host)) { 1697 local->stats.rx_crc_errors += 1698 swab16(readw(&p->mrx_checksum_error)); 1699 writeb(0, &p->mrx_checksum_error); 1700 writeb(0, &p->mrx_checksum_error_for_host); 1701 } 1702 if (readb(&p->rx_hec_error_for_host)) { 1703 local->stats.rx_frame_errors += swab16(readw(&p->rx_hec_error)); 1704 writeb(0, &p->rx_hec_error); 1705 writeb(0, &p->rx_hec_error_for_host); 1706 } 1707 return &local->stats; 1708 } 1709 1710 /*===========================================================================*/ 1711 static void ray_update_parm(struct net_device *dev, UCHAR objid, UCHAR *value, 1712 int len) 1713 { 1714 ray_dev_t *local = netdev_priv(dev); 1715 struct pcmcia_device *link = local->finder; 1716 int ccsindex; 1717 int i; 1718 struct ccs __iomem *pccs; 1719 1720 if (!(pcmcia_dev_present(link))) { 1721 dev_dbg(&link->dev, "ray_update_parm - device not present\n"); 1722 return; 1723 } 1724 1725 if ((ccsindex = get_free_ccs(local)) < 0) { 1726 dev_dbg(&link->dev, "ray_update_parm - No free ccs\n"); 1727 return; 1728 } 1729 pccs = ccs_base(local) + ccsindex; 1730 writeb(CCS_UPDATE_PARAMS, &pccs->cmd); 1731 writeb(objid, &pccs->var.update_param.object_id); 1732 writeb(1, &pccs->var.update_param.number_objects); 1733 writeb(0, &pccs->var.update_param.failure_cause); 1734 for (i = 0; i < len; i++) { 1735 writeb(value[i], local->sram + HOST_TO_ECF_BASE); 1736 } 1737 /* Interrupt the firmware to process the command */ 1738 if (interrupt_ecf(local, ccsindex)) { 1739 dev_dbg(&link->dev, "ray_cs associate failed - ECF not ready for intr\n"); 1740 writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status); 1741 } 1742 } 1743 1744 /*===========================================================================*/ 1745 static void ray_update_multi_list(struct net_device *dev, int all) 1746 { 1747 int ccsindex; 1748 struct ccs __iomem *pccs; 1749 ray_dev_t *local = netdev_priv(dev); 1750 struct pcmcia_device *link = local->finder; 1751 void __iomem *p = local->sram + HOST_TO_ECF_BASE; 1752 1753 if (!(pcmcia_dev_present(link))) { 1754 dev_dbg(&link->dev, "ray_update_multi_list - device not present\n"); 1755 return; 1756 } else 1757 dev_dbg(&link->dev, "ray_update_multi_list(%p)\n", dev); 1758 if ((ccsindex = get_free_ccs(local)) < 0) { 1759 dev_dbg(&link->dev, "ray_update_multi - No free ccs\n"); 1760 return; 1761 } 1762 pccs = ccs_base(local) + ccsindex; 1763 writeb(CCS_UPDATE_MULTICAST_LIST, &pccs->cmd); 1764 1765 if (all) { 1766 writeb(0xff, &pccs->var); 1767 local->num_multi = 0xff; 1768 } else { 1769 struct netdev_hw_addr *ha; 1770 int i = 0; 1771 1772 /* Copy the kernel's list of MC addresses to card */ 1773 netdev_for_each_mc_addr(ha, dev) { 1774 memcpy_toio(p, ha->addr, ETH_ALEN); 1775 dev_dbg(&link->dev, "ray_update_multi add addr %pm\n", 1776 ha->addr); 1777 p += ETH_ALEN; 1778 i++; 1779 } 1780 if (i > 256 / ADDRLEN) 1781 i = 256 / ADDRLEN; 1782 writeb((UCHAR) i, &pccs->var); 1783 dev_dbg(&link->dev, "ray_cs update_multi %d addresses in list\n", i); 1784 /* Interrupt the firmware to process the command */ 1785 local->num_multi = i; 1786 } 1787 if (interrupt_ecf(local, ccsindex)) { 1788 dev_dbg(&link->dev, 1789 "ray_cs update_multi failed - ECF not ready for intr\n"); 1790 writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status); 1791 } 1792 } /* end ray_update_multi_list */ 1793 1794 /*===========================================================================*/ 1795 static void set_multicast_list(struct net_device *dev) 1796 { 1797 ray_dev_t *local = netdev_priv(dev); 1798 UCHAR promisc; 1799 1800 pr_debug("ray_cs set_multicast_list(%p)\n", dev); 1801 1802 if (dev->flags & IFF_PROMISC) { 1803 if (local->sparm.b5.a_promiscuous_mode == 0) { 1804 pr_debug("ray_cs set_multicast_list promisc on\n"); 1805 local->sparm.b5.a_promiscuous_mode = 1; 1806 promisc = 1; 1807 ray_update_parm(dev, OBJID_promiscuous_mode, 1808 &promisc, sizeof(promisc)); 1809 } 1810 } else { 1811 if (local->sparm.b5.a_promiscuous_mode == 1) { 1812 pr_debug("ray_cs set_multicast_list promisc off\n"); 1813 local->sparm.b5.a_promiscuous_mode = 0; 1814 promisc = 0; 1815 ray_update_parm(dev, OBJID_promiscuous_mode, 1816 &promisc, sizeof(promisc)); 1817 } 1818 } 1819 1820 if (dev->flags & IFF_ALLMULTI) 1821 ray_update_multi_list(dev, 1); 1822 else { 1823 if (local->num_multi != netdev_mc_count(dev)) 1824 ray_update_multi_list(dev, 0); 1825 } 1826 } /* end set_multicast_list */ 1827 1828 /*============================================================================= 1829 * All routines below here are run at interrupt time. 1830 =============================================================================*/ 1831 static irqreturn_t ray_interrupt(int irq, void *dev_id) 1832 { 1833 struct net_device *dev = (struct net_device *)dev_id; 1834 struct pcmcia_device *link; 1835 ray_dev_t *local; 1836 struct ccs __iomem *pccs; 1837 struct rcs __iomem *prcs; 1838 UCHAR rcsindex; 1839 UCHAR tmp; 1840 UCHAR cmd; 1841 UCHAR status; 1842 UCHAR memtmp[ESSID_SIZE + 1]; 1843 1844 1845 if (dev == NULL) /* Note that we want interrupts with dev->start == 0 */ 1846 return IRQ_NONE; 1847 1848 pr_debug("ray_cs: interrupt for *dev=%p\n", dev); 1849 1850 local = netdev_priv(dev); 1851 link = local->finder; 1852 if (!pcmcia_dev_present(link)) { 1853 pr_debug( 1854 "ray_cs interrupt from device not present or suspended.\n"); 1855 return IRQ_NONE; 1856 } 1857 rcsindex = readb(&((struct scb __iomem *)(local->sram))->rcs_index); 1858 1859 if (rcsindex >= (NUMBER_OF_CCS + NUMBER_OF_RCS)) { 1860 dev_dbg(&link->dev, "ray_cs interrupt bad rcsindex = 0x%x\n", rcsindex); 1861 clear_interrupt(local); 1862 return IRQ_HANDLED; 1863 } 1864 if (rcsindex < NUMBER_OF_CCS) { /* If it's a returned CCS */ 1865 pccs = ccs_base(local) + rcsindex; 1866 cmd = readb(&pccs->cmd); 1867 status = readb(&pccs->buffer_status); 1868 switch (cmd) { 1869 case CCS_DOWNLOAD_STARTUP_PARAMS: /* Happens in firmware someday */ 1870 del_timer(&local->timer); 1871 if (status == CCS_COMMAND_COMPLETE) { 1872 dev_dbg(&link->dev, 1873 "ray_cs interrupt download_startup_parameters OK\n"); 1874 } else { 1875 dev_dbg(&link->dev, 1876 "ray_cs interrupt download_startup_parameters fail\n"); 1877 } 1878 break; 1879 case CCS_UPDATE_PARAMS: 1880 dev_dbg(&link->dev, "ray_cs interrupt update params done\n"); 1881 if (status != CCS_COMMAND_COMPLETE) { 1882 tmp = 1883 readb(&pccs->var.update_param. 1884 failure_cause); 1885 dev_dbg(&link->dev, 1886 "ray_cs interrupt update params failed - reason %d\n", 1887 tmp); 1888 } 1889 break; 1890 case CCS_REPORT_PARAMS: 1891 dev_dbg(&link->dev, "ray_cs interrupt report params done\n"); 1892 break; 1893 case CCS_UPDATE_MULTICAST_LIST: /* Note that this CCS isn't returned */ 1894 dev_dbg(&link->dev, 1895 "ray_cs interrupt CCS Update Multicast List done\n"); 1896 break; 1897 case CCS_UPDATE_POWER_SAVINGS_MODE: 1898 dev_dbg(&link->dev, 1899 "ray_cs interrupt update power save mode done\n"); 1900 break; 1901 case CCS_START_NETWORK: 1902 case CCS_JOIN_NETWORK: 1903 memcpy(memtmp, local->sparm.b4.a_current_ess_id, 1904 ESSID_SIZE); 1905 memtmp[ESSID_SIZE] = '\0'; 1906 1907 if (status == CCS_COMMAND_COMPLETE) { 1908 if (readb 1909 (&pccs->var.start_network.net_initiated) == 1910 1) { 1911 dev_dbg(&link->dev, 1912 "ray_cs interrupt network \"%s\" started\n", 1913 memtmp); 1914 } else { 1915 dev_dbg(&link->dev, 1916 "ray_cs interrupt network \"%s\" joined\n", 1917 memtmp); 1918 } 1919 memcpy_fromio(&local->bss_id, 1920 pccs->var.start_network.bssid, 1921 ADDRLEN); 1922 1923 if (local->fw_ver == 0x55) 1924 local->net_default_tx_rate = 3; 1925 else 1926 local->net_default_tx_rate = 1927 readb(&pccs->var.start_network. 1928 net_default_tx_rate); 1929 local->encryption = 1930 readb(&pccs->var.start_network.encryption); 1931 if (!sniffer && (local->net_type == INFRA) 1932 && !(local->sparm.b4.a_acting_as_ap_status)) { 1933 authenticate(local); 1934 } 1935 local->card_status = CARD_ACQ_COMPLETE; 1936 } else { 1937 local->card_status = CARD_ACQ_FAILED; 1938 1939 del_timer(&local->timer); 1940 local->timer.expires = jiffies + HZ * 5; 1941 if (status == CCS_START_NETWORK) { 1942 dev_dbg(&link->dev, 1943 "ray_cs interrupt network \"%s\" start failed\n", 1944 memtmp); 1945 local->timer.function = start_net; 1946 } else { 1947 dev_dbg(&link->dev, 1948 "ray_cs interrupt network \"%s\" join failed\n", 1949 memtmp); 1950 local->timer.function = join_net; 1951 } 1952 add_timer(&local->timer); 1953 } 1954 break; 1955 case CCS_START_ASSOCIATION: 1956 if (status == CCS_COMMAND_COMPLETE) { 1957 local->card_status = CARD_ASSOC_COMPLETE; 1958 dev_dbg(&link->dev, "ray_cs association successful\n"); 1959 } else { 1960 dev_dbg(&link->dev, "ray_cs association failed,\n"); 1961 local->card_status = CARD_ASSOC_FAILED; 1962 join_net(&local->timer); 1963 } 1964 break; 1965 case CCS_TX_REQUEST: 1966 if (status == CCS_COMMAND_COMPLETE) { 1967 dev_dbg(&link->dev, 1968 "ray_cs interrupt tx request complete\n"); 1969 } else { 1970 dev_dbg(&link->dev, 1971 "ray_cs interrupt tx request failed\n"); 1972 } 1973 if (!sniffer) 1974 netif_start_queue(dev); 1975 netif_wake_queue(dev); 1976 break; 1977 case CCS_TEST_MEMORY: 1978 dev_dbg(&link->dev, "ray_cs interrupt mem test done\n"); 1979 break; 1980 case CCS_SHUTDOWN: 1981 dev_dbg(&link->dev, 1982 "ray_cs interrupt Unexpected CCS returned - Shutdown\n"); 1983 break; 1984 case CCS_DUMP_MEMORY: 1985 dev_dbg(&link->dev, "ray_cs interrupt dump memory done\n"); 1986 break; 1987 case CCS_START_TIMER: 1988 dev_dbg(&link->dev, 1989 "ray_cs interrupt DING - raylink timer expired\n"); 1990 break; 1991 default: 1992 dev_dbg(&link->dev, 1993 "ray_cs interrupt Unexpected CCS 0x%x returned 0x%x\n", 1994 rcsindex, cmd); 1995 } 1996 writeb(CCS_BUFFER_FREE, &pccs->buffer_status); 1997 } else { /* It's an RCS */ 1998 1999 prcs = rcs_base(local) + rcsindex; 2000 2001 switch (readb(&prcs->interrupt_id)) { 2002 case PROCESS_RX_PACKET: 2003 ray_rx(dev, local, prcs); 2004 break; 2005 case REJOIN_NET_COMPLETE: 2006 dev_dbg(&link->dev, "ray_cs interrupt rejoin net complete\n"); 2007 local->card_status = CARD_ACQ_COMPLETE; 2008 /* do we need to clear tx buffers CCS's? */ 2009 if (local->sparm.b4.a_network_type == ADHOC) { 2010 if (!sniffer) 2011 netif_start_queue(dev); 2012 } else { 2013 memcpy_fromio(&local->bss_id, 2014 prcs->var.rejoin_net_complete. 2015 bssid, ADDRLEN); 2016 dev_dbg(&link->dev, "ray_cs new BSSID = %pm\n", 2017 local->bss_id); 2018 if (!sniffer) 2019 authenticate(local); 2020 } 2021 break; 2022 case ROAMING_INITIATED: 2023 dev_dbg(&link->dev, "ray_cs interrupt roaming initiated\n"); 2024 netif_stop_queue(dev); 2025 local->card_status = CARD_DOING_ACQ; 2026 break; 2027 case JAPAN_CALL_SIGN_RXD: 2028 dev_dbg(&link->dev, "ray_cs interrupt japan call sign rx\n"); 2029 break; 2030 default: 2031 dev_dbg(&link->dev, 2032 "ray_cs Unexpected interrupt for RCS 0x%x cmd = 0x%x\n", 2033 rcsindex, 2034 (unsigned int)readb(&prcs->interrupt_id)); 2035 break; 2036 } 2037 writeb(CCS_BUFFER_FREE, &prcs->buffer_status); 2038 } 2039 clear_interrupt(local); 2040 return IRQ_HANDLED; 2041 } /* ray_interrupt */ 2042 2043 /*===========================================================================*/ 2044 static void ray_rx(struct net_device *dev, ray_dev_t *local, 2045 struct rcs __iomem *prcs) 2046 { 2047 int rx_len; 2048 unsigned int pkt_addr; 2049 void __iomem *pmsg; 2050 pr_debug("ray_rx process rx packet\n"); 2051 2052 /* Calculate address of packet within Rx buffer */ 2053 pkt_addr = ((readb(&prcs->var.rx_packet.rx_data_ptr[0]) << 8) 2054 + readb(&prcs->var.rx_packet.rx_data_ptr[1])) & RX_BUFF_END; 2055 /* Length of first packet fragment */ 2056 rx_len = (readb(&prcs->var.rx_packet.rx_data_length[0]) << 8) 2057 + readb(&prcs->var.rx_packet.rx_data_length[1]); 2058 2059 local->last_rsl = readb(&prcs->var.rx_packet.rx_sig_lev); 2060 pmsg = local->rmem + pkt_addr; 2061 switch (readb(pmsg)) { 2062 case DATA_TYPE: 2063 pr_debug("ray_rx data type\n"); 2064 rx_data(dev, prcs, pkt_addr, rx_len); 2065 break; 2066 case AUTHENTIC_TYPE: 2067 pr_debug("ray_rx authentic type\n"); 2068 if (sniffer) 2069 rx_data(dev, prcs, pkt_addr, rx_len); 2070 else 2071 rx_authenticate(local, prcs, pkt_addr, rx_len); 2072 break; 2073 case DEAUTHENTIC_TYPE: 2074 pr_debug("ray_rx deauth type\n"); 2075 if (sniffer) 2076 rx_data(dev, prcs, pkt_addr, rx_len); 2077 else 2078 rx_deauthenticate(local, prcs, pkt_addr, rx_len); 2079 break; 2080 case NULL_MSG_TYPE: 2081 pr_debug("ray_cs rx NULL msg\n"); 2082 break; 2083 case BEACON_TYPE: 2084 pr_debug("ray_rx beacon type\n"); 2085 if (sniffer) 2086 rx_data(dev, prcs, pkt_addr, rx_len); 2087 2088 copy_from_rx_buff(local, (UCHAR *) &local->last_bcn, pkt_addr, 2089 rx_len < sizeof(struct beacon_rx) ? 2090 rx_len : sizeof(struct beacon_rx)); 2091 2092 local->beacon_rxed = 1; 2093 /* Get the statistics so the card counters never overflow */ 2094 ray_get_stats(dev); 2095 break; 2096 default: 2097 pr_debug("ray_cs unknown pkt type %2x\n", 2098 (unsigned int)readb(pmsg)); 2099 break; 2100 } 2101 2102 } /* end ray_rx */ 2103 2104 /*===========================================================================*/ 2105 static void rx_data(struct net_device *dev, struct rcs __iomem *prcs, 2106 unsigned int pkt_addr, int rx_len) 2107 { 2108 struct sk_buff *skb = NULL; 2109 struct rcs __iomem *prcslink = prcs; 2110 ray_dev_t *local = netdev_priv(dev); 2111 UCHAR *rx_ptr; 2112 int total_len; 2113 int tmp; 2114 #ifdef WIRELESS_SPY 2115 int siglev = local->last_rsl; 2116 u_char linksrcaddr[ETH_ALEN]; /* Other end of the wireless link */ 2117 #endif 2118 2119 if (!sniffer) { 2120 if (translate) { 2121 /* TBD length needs fixing for translated header */ 2122 if (rx_len < (ETH_HLEN + RX_MAC_HEADER_LENGTH) || 2123 rx_len > 2124 (dev->mtu + RX_MAC_HEADER_LENGTH + ETH_HLEN + 2125 FCS_LEN)) { 2126 pr_debug( 2127 "ray_cs invalid packet length %d received\n", 2128 rx_len); 2129 return; 2130 } 2131 } else { /* encapsulated ethernet */ 2132 2133 if (rx_len < (ETH_HLEN + RX_MAC_HEADER_LENGTH) || 2134 rx_len > 2135 (dev->mtu + RX_MAC_HEADER_LENGTH + ETH_HLEN + 2136 FCS_LEN)) { 2137 pr_debug( 2138 "ray_cs invalid packet length %d received\n", 2139 rx_len); 2140 return; 2141 } 2142 } 2143 } 2144 pr_debug("ray_cs rx_data packet\n"); 2145 /* If fragmented packet, verify sizes of fragments add up */ 2146 if (readb(&prcs->var.rx_packet.next_frag_rcs_index) != 0xFF) { 2147 pr_debug("ray_cs rx'ed fragment\n"); 2148 tmp = (readb(&prcs->var.rx_packet.totalpacketlength[0]) << 8) 2149 + readb(&prcs->var.rx_packet.totalpacketlength[1]); 2150 total_len = tmp; 2151 prcslink = prcs; 2152 do { 2153 tmp -= 2154 (readb(&prcslink->var.rx_packet.rx_data_length[0]) 2155 << 8) 2156 + readb(&prcslink->var.rx_packet.rx_data_length[1]); 2157 if (readb(&prcslink->var.rx_packet.next_frag_rcs_index) 2158 == 0xFF || tmp < 0) 2159 break; 2160 prcslink = rcs_base(local) 2161 + readb(&prcslink->link_field); 2162 } while (1); 2163 2164 if (tmp < 0) { 2165 pr_debug( 2166 "ray_cs rx_data fragment lengths don't add up\n"); 2167 local->stats.rx_dropped++; 2168 release_frag_chain(local, prcs); 2169 return; 2170 } 2171 } else { /* Single unfragmented packet */ 2172 total_len = rx_len; 2173 } 2174 2175 skb = dev_alloc_skb(total_len + 5); 2176 if (skb == NULL) { 2177 pr_debug("ray_cs rx_data could not allocate skb\n"); 2178 local->stats.rx_dropped++; 2179 if (readb(&prcs->var.rx_packet.next_frag_rcs_index) != 0xFF) 2180 release_frag_chain(local, prcs); 2181 return; 2182 } 2183 skb_reserve(skb, 2); /* Align IP on 16 byte (TBD check this) */ 2184 2185 pr_debug("ray_cs rx_data total_len = %x, rx_len = %x\n", total_len, 2186 rx_len); 2187 2188 /************************/ 2189 /* Reserve enough room for the whole damn packet. */ 2190 rx_ptr = skb_put(skb, total_len); 2191 /* Copy the whole packet to sk_buff */ 2192 rx_ptr += 2193 copy_from_rx_buff(local, rx_ptr, pkt_addr & RX_BUFF_END, rx_len); 2194 /* Get source address */ 2195 #ifdef WIRELESS_SPY 2196 skb_copy_from_linear_data_offset(skb, 2197 offsetof(struct mac_header, addr_2), 2198 linksrcaddr, ETH_ALEN); 2199 #endif 2200 /* Now, deal with encapsulation/translation/sniffer */ 2201 if (!sniffer) { 2202 if (!translate) { 2203 /* Encapsulated ethernet, so just lop off 802.11 MAC header */ 2204 /* TBD reserve skb_reserve( skb, RX_MAC_HEADER_LENGTH); */ 2205 skb_pull(skb, RX_MAC_HEADER_LENGTH); 2206 } else { 2207 /* Do translation */ 2208 untranslate(local, skb, total_len); 2209 } 2210 } else { /* sniffer mode, so just pass whole packet */ 2211 } 2212 2213 /************************/ 2214 /* Now pick up the rest of the fragments if any */ 2215 tmp = 17; 2216 if (readb(&prcs->var.rx_packet.next_frag_rcs_index) != 0xFF) { 2217 prcslink = prcs; 2218 pr_debug("ray_cs rx_data in fragment loop\n"); 2219 do { 2220 prcslink = rcs_base(local) 2221 + 2222 readb(&prcslink->var.rx_packet.next_frag_rcs_index); 2223 rx_len = 2224 ((readb(&prcslink->var.rx_packet.rx_data_length[0]) 2225 << 8) 2226 + 2227 readb(&prcslink->var.rx_packet.rx_data_length[1])) 2228 & RX_BUFF_END; 2229 pkt_addr = 2230 ((readb(&prcslink->var.rx_packet.rx_data_ptr[0]) << 2231 8) 2232 + readb(&prcslink->var.rx_packet.rx_data_ptr[1])) 2233 & RX_BUFF_END; 2234 2235 rx_ptr += 2236 copy_from_rx_buff(local, rx_ptr, pkt_addr, rx_len); 2237 2238 } while (tmp-- && 2239 readb(&prcslink->var.rx_packet.next_frag_rcs_index) != 2240 0xFF); 2241 release_frag_chain(local, prcs); 2242 } 2243 2244 skb->protocol = eth_type_trans(skb, dev); 2245 netif_rx(skb); 2246 local->stats.rx_packets++; 2247 local->stats.rx_bytes += total_len; 2248 2249 /* Gather signal strength per address */ 2250 #ifdef WIRELESS_SPY 2251 /* For the Access Point or the node having started the ad-hoc net 2252 * note : ad-hoc work only in some specific configurations, but we 2253 * kludge in ray_get_wireless_stats... */ 2254 if (!memcmp(linksrcaddr, local->bss_id, ETH_ALEN)) { 2255 /* Update statistics */ 2256 /*local->wstats.qual.qual = none ? */ 2257 local->wstats.qual.level = siglev; 2258 /*local->wstats.qual.noise = none ? */ 2259 local->wstats.qual.updated = 0x2; 2260 } 2261 /* Now, update the spy stuff */ 2262 { 2263 struct iw_quality wstats; 2264 wstats.level = siglev; 2265 /* wstats.noise = none ? */ 2266 /* wstats.qual = none ? */ 2267 wstats.updated = 0x2; 2268 /* Update spy records */ 2269 wireless_spy_update(dev, linksrcaddr, &wstats); 2270 } 2271 #endif /* WIRELESS_SPY */ 2272 } /* end rx_data */ 2273 2274 /*===========================================================================*/ 2275 static void untranslate(ray_dev_t *local, struct sk_buff *skb, int len) 2276 { 2277 snaphdr_t *psnap = (snaphdr_t *) (skb->data + RX_MAC_HEADER_LENGTH); 2278 struct ieee80211_hdr *pmac = (struct ieee80211_hdr *)skb->data; 2279 __be16 type = *(__be16 *) psnap->ethertype; 2280 int delta; 2281 struct ethhdr *peth; 2282 UCHAR srcaddr[ADDRLEN]; 2283 UCHAR destaddr[ADDRLEN]; 2284 static const UCHAR org_bridge[3] = { 0, 0, 0xf8 }; 2285 static const UCHAR org_1042[3] = { 0, 0, 0 }; 2286 2287 memcpy(destaddr, ieee80211_get_DA(pmac), ADDRLEN); 2288 memcpy(srcaddr, ieee80211_get_SA(pmac), ADDRLEN); 2289 2290 #if 0 2291 if { 2292 print_hex_dump(KERN_DEBUG, "skb->data before untranslate: ", 2293 DUMP_PREFIX_NONE, 16, 1, 2294 skb->data, 64, true); 2295 printk(KERN_DEBUG 2296 "type = %08x, xsap = %02x%02x%02x, org = %02x02x02x\n", 2297 ntohs(type), psnap->dsap, psnap->ssap, psnap->ctrl, 2298 psnap->org[0], psnap->org[1], psnap->org[2]); 2299 printk(KERN_DEBUG "untranslate skb->data = %p\n", skb->data); 2300 } 2301 #endif 2302 2303 if (psnap->dsap != 0xaa || psnap->ssap != 0xaa || psnap->ctrl != 3) { 2304 /* not a snap type so leave it alone */ 2305 pr_debug("ray_cs untranslate NOT SNAP %02x %02x %02x\n", 2306 psnap->dsap, psnap->ssap, psnap->ctrl); 2307 2308 delta = RX_MAC_HEADER_LENGTH - ETH_HLEN; 2309 peth = (struct ethhdr *)(skb->data + delta); 2310 peth->h_proto = htons(len - RX_MAC_HEADER_LENGTH); 2311 } else { /* Its a SNAP */ 2312 if (memcmp(psnap->org, org_bridge, 3) == 0) { 2313 /* EtherII and nuke the LLC */ 2314 pr_debug("ray_cs untranslate Bridge encap\n"); 2315 delta = RX_MAC_HEADER_LENGTH 2316 + sizeof(struct snaphdr_t) - ETH_HLEN; 2317 peth = (struct ethhdr *)(skb->data + delta); 2318 peth->h_proto = type; 2319 } else if (memcmp(psnap->org, org_1042, 3) == 0) { 2320 switch (ntohs(type)) { 2321 case ETH_P_IPX: 2322 case ETH_P_AARP: 2323 pr_debug("ray_cs untranslate RFC IPX/AARP\n"); 2324 delta = RX_MAC_HEADER_LENGTH - ETH_HLEN; 2325 peth = (struct ethhdr *)(skb->data + delta); 2326 peth->h_proto = 2327 htons(len - RX_MAC_HEADER_LENGTH); 2328 break; 2329 default: 2330 pr_debug("ray_cs untranslate RFC default\n"); 2331 delta = RX_MAC_HEADER_LENGTH + 2332 sizeof(struct snaphdr_t) - ETH_HLEN; 2333 peth = (struct ethhdr *)(skb->data + delta); 2334 peth->h_proto = type; 2335 break; 2336 } 2337 } else { 2338 printk("ray_cs untranslate very confused by packet\n"); 2339 delta = RX_MAC_HEADER_LENGTH - ETH_HLEN; 2340 peth = (struct ethhdr *)(skb->data + delta); 2341 peth->h_proto = type; 2342 } 2343 } 2344 /* TBD reserve skb_reserve(skb, delta); */ 2345 skb_pull(skb, delta); 2346 pr_debug("untranslate after skb_pull(%d), skb->data = %p\n", delta, 2347 skb->data); 2348 memcpy(peth->h_dest, destaddr, ADDRLEN); 2349 memcpy(peth->h_source, srcaddr, ADDRLEN); 2350 #if 0 2351 { 2352 int i; 2353 printk(KERN_DEBUG "skb->data after untranslate:"); 2354 for (i = 0; i < 64; i++) 2355 printk("%02x ", skb->data[i]); 2356 printk("\n"); 2357 } 2358 #endif 2359 } /* end untranslate */ 2360 2361 /*===========================================================================*/ 2362 /* Copy data from circular receive buffer to PC memory. 2363 * dest = destination address in PC memory 2364 * pkt_addr = source address in receive buffer 2365 * len = length of packet to copy 2366 */ 2367 static int copy_from_rx_buff(ray_dev_t *local, UCHAR *dest, int pkt_addr, 2368 int length) 2369 { 2370 int wrap_bytes = (pkt_addr + length) - (RX_BUFF_END + 1); 2371 if (wrap_bytes <= 0) { 2372 memcpy_fromio(dest, local->rmem + pkt_addr, length); 2373 } else { /* Packet wrapped in circular buffer */ 2374 2375 memcpy_fromio(dest, local->rmem + pkt_addr, 2376 length - wrap_bytes); 2377 memcpy_fromio(dest + length - wrap_bytes, local->rmem, 2378 wrap_bytes); 2379 } 2380 return length; 2381 } 2382 2383 /*===========================================================================*/ 2384 static void release_frag_chain(ray_dev_t *local, struct rcs __iomem *prcs) 2385 { 2386 struct rcs __iomem *prcslink = prcs; 2387 int tmp = 17; 2388 unsigned rcsindex = readb(&prcs->var.rx_packet.next_frag_rcs_index); 2389 2390 while (tmp--) { 2391 writeb(CCS_BUFFER_FREE, &prcslink->buffer_status); 2392 if (rcsindex >= (NUMBER_OF_CCS + NUMBER_OF_RCS)) { 2393 pr_debug("ray_cs interrupt bad rcsindex = 0x%x\n", 2394 rcsindex); 2395 break; 2396 } 2397 prcslink = rcs_base(local) + rcsindex; 2398 rcsindex = readb(&prcslink->var.rx_packet.next_frag_rcs_index); 2399 } 2400 writeb(CCS_BUFFER_FREE, &prcslink->buffer_status); 2401 } 2402 2403 /*===========================================================================*/ 2404 static void authenticate(ray_dev_t *local) 2405 { 2406 struct pcmcia_device *link = local->finder; 2407 dev_dbg(&link->dev, "ray_cs Starting authentication.\n"); 2408 if (!(pcmcia_dev_present(link))) { 2409 dev_dbg(&link->dev, "ray_cs authenticate - device not present\n"); 2410 return; 2411 } 2412 2413 del_timer(&local->timer); 2414 if (build_auth_frame(local, local->bss_id, OPEN_AUTH_REQUEST)) { 2415 local->timer.function = join_net; 2416 } else { 2417 local->timer.function = authenticate_timeout; 2418 } 2419 local->timer.expires = jiffies + HZ * 2; 2420 add_timer(&local->timer); 2421 local->authentication_state = AWAITING_RESPONSE; 2422 } /* end authenticate */ 2423 2424 /*===========================================================================*/ 2425 static void rx_authenticate(ray_dev_t *local, struct rcs __iomem *prcs, 2426 unsigned int pkt_addr, int rx_len) 2427 { 2428 UCHAR buff[256]; 2429 struct ray_rx_msg *msg = (struct ray_rx_msg *) buff; 2430 2431 del_timer(&local->timer); 2432 2433 copy_from_rx_buff(local, buff, pkt_addr, rx_len & 0xff); 2434 /* if we are trying to get authenticated */ 2435 if (local->sparm.b4.a_network_type == ADHOC) { 2436 pr_debug("ray_cs rx_auth var= %6ph\n", msg->var); 2437 if (msg->var[2] == 1) { 2438 pr_debug("ray_cs Sending authentication response.\n"); 2439 if (!build_auth_frame 2440 (local, msg->mac.addr_2, OPEN_AUTH_RESPONSE)) { 2441 local->authentication_state = NEED_TO_AUTH; 2442 memcpy(local->auth_id, msg->mac.addr_2, 2443 ADDRLEN); 2444 } 2445 } 2446 } else { /* Infrastructure network */ 2447 2448 if (local->authentication_state == AWAITING_RESPONSE) { 2449 /* Verify authentication sequence #2 and success */ 2450 if (msg->var[2] == 2) { 2451 if ((msg->var[3] | msg->var[4]) == 0) { 2452 pr_debug("Authentication successful\n"); 2453 local->card_status = CARD_AUTH_COMPLETE; 2454 associate(local); 2455 local->authentication_state = 2456 AUTHENTICATED; 2457 } else { 2458 pr_debug("Authentication refused\n"); 2459 local->card_status = CARD_AUTH_REFUSED; 2460 join_net(&local->timer); 2461 local->authentication_state = 2462 UNAUTHENTICATED; 2463 } 2464 } 2465 } 2466 } 2467 2468 } /* end rx_authenticate */ 2469 2470 /*===========================================================================*/ 2471 static void associate(ray_dev_t *local) 2472 { 2473 struct ccs __iomem *pccs; 2474 struct pcmcia_device *link = local->finder; 2475 struct net_device *dev = link->priv; 2476 int ccsindex; 2477 if (!(pcmcia_dev_present(link))) { 2478 dev_dbg(&link->dev, "ray_cs associate - device not present\n"); 2479 return; 2480 } 2481 /* If no tx buffers available, return */ 2482 if ((ccsindex = get_free_ccs(local)) < 0) { 2483 /* TBD should never be here but... what if we are? */ 2484 dev_dbg(&link->dev, "ray_cs associate - No free ccs\n"); 2485 return; 2486 } 2487 dev_dbg(&link->dev, "ray_cs Starting association with access point\n"); 2488 pccs = ccs_base(local) + ccsindex; 2489 /* fill in the CCS */ 2490 writeb(CCS_START_ASSOCIATION, &pccs->cmd); 2491 /* Interrupt the firmware to process the command */ 2492 if (interrupt_ecf(local, ccsindex)) { 2493 dev_dbg(&link->dev, "ray_cs associate failed - ECF not ready for intr\n"); 2494 writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status); 2495 2496 del_timer(&local->timer); 2497 local->timer.expires = jiffies + HZ * 2; 2498 local->timer.function = join_net; 2499 add_timer(&local->timer); 2500 local->card_status = CARD_ASSOC_FAILED; 2501 return; 2502 } 2503 if (!sniffer) 2504 netif_start_queue(dev); 2505 2506 } /* end associate */ 2507 2508 /*===========================================================================*/ 2509 static void rx_deauthenticate(ray_dev_t *local, struct rcs __iomem *prcs, 2510 unsigned int pkt_addr, int rx_len) 2511 { 2512 /* UCHAR buff[256]; 2513 struct ray_rx_msg *msg = (struct ray_rx_msg *) buff; 2514 */ 2515 pr_debug("Deauthentication frame received\n"); 2516 local->authentication_state = UNAUTHENTICATED; 2517 /* Need to reauthenticate or rejoin depending on reason code */ 2518 /* copy_from_rx_buff(local, buff, pkt_addr, rx_len & 0xff); 2519 */ 2520 } 2521 2522 /*===========================================================================*/ 2523 static void clear_interrupt(ray_dev_t *local) 2524 { 2525 writeb(0, local->amem + CIS_OFFSET + HCS_INTR_OFFSET); 2526 } 2527 2528 /*===========================================================================*/ 2529 #ifdef CONFIG_PROC_FS 2530 #define MAXDATA (PAGE_SIZE - 80) 2531 2532 static const char *card_status[] = { 2533 "Card inserted - uninitialized", /* 0 */ 2534 "Card not downloaded", /* 1 */ 2535 "Waiting for download parameters", /* 2 */ 2536 "Card doing acquisition", /* 3 */ 2537 "Acquisition complete", /* 4 */ 2538 "Authentication complete", /* 5 */ 2539 "Association complete", /* 6 */ 2540 "???", "???", "???", "???", /* 7 8 9 10 undefined */ 2541 "Card init error", /* 11 */ 2542 "Download parameters error", /* 12 */ 2543 "???", /* 13 */ 2544 "Acquisition failed", /* 14 */ 2545 "Authentication refused", /* 15 */ 2546 "Association failed" /* 16 */ 2547 }; 2548 2549 static const char *nettype[] = { "Adhoc", "Infra " }; 2550 static const char *framing[] = { "Encapsulation", "Translation" } 2551 2552 ; 2553 /*===========================================================================*/ 2554 static int ray_cs_proc_show(struct seq_file *m, void *v) 2555 { 2556 /* Print current values which are not available via other means 2557 * eg ifconfig 2558 */ 2559 int i; 2560 struct pcmcia_device *link; 2561 struct net_device *dev; 2562 ray_dev_t *local; 2563 UCHAR *p; 2564 struct freq_hop_element *pfh; 2565 UCHAR c[33]; 2566 2567 link = this_device; 2568 if (!link) 2569 return 0; 2570 dev = (struct net_device *)link->priv; 2571 if (!dev) 2572 return 0; 2573 local = netdev_priv(dev); 2574 if (!local) 2575 return 0; 2576 2577 seq_puts(m, "Raylink Wireless LAN driver status\n"); 2578 seq_printf(m, "%s\n", rcsid); 2579 /* build 4 does not report version, and field is 0x55 after memtest */ 2580 seq_puts(m, "Firmware version = "); 2581 if (local->fw_ver == 0x55) 2582 seq_puts(m, "4 - Use dump_cis for more details\n"); 2583 else 2584 seq_printf(m, "%2d.%02d.%02d\n", 2585 local->fw_ver, local->fw_bld, local->fw_var); 2586 2587 for (i = 0; i < 32; i++) 2588 c[i] = local->sparm.b5.a_current_ess_id[i]; 2589 c[32] = 0; 2590 seq_printf(m, "%s network ESSID = \"%s\"\n", 2591 nettype[local->sparm.b5.a_network_type], c); 2592 2593 p = local->bss_id; 2594 seq_printf(m, "BSSID = %pM\n", p); 2595 2596 seq_printf(m, "Country code = %d\n", 2597 local->sparm.b5.a_curr_country_code); 2598 2599 i = local->card_status; 2600 if (i < 0) 2601 i = 10; 2602 if (i > 16) 2603 i = 10; 2604 seq_printf(m, "Card status = %s\n", card_status[i]); 2605 2606 seq_printf(m, "Framing mode = %s\n", framing[translate]); 2607 2608 seq_printf(m, "Last pkt signal lvl = %d\n", local->last_rsl); 2609 2610 if (local->beacon_rxed) { 2611 /* Pull some fields out of last beacon received */ 2612 seq_printf(m, "Beacon Interval = %d Kus\n", 2613 local->last_bcn.beacon_intvl[0] 2614 + 256 * local->last_bcn.beacon_intvl[1]); 2615 2616 p = local->last_bcn.elements; 2617 if (p[0] == C_ESSID_ELEMENT_ID) 2618 p += p[1] + 2; 2619 else { 2620 seq_printf(m, 2621 "Parse beacon failed at essid element id = %d\n", 2622 p[0]); 2623 return 0; 2624 } 2625 2626 if (p[0] == C_SUPPORTED_RATES_ELEMENT_ID) { 2627 seq_puts(m, "Supported rate codes = "); 2628 for (i = 2; i < p[1] + 2; i++) 2629 seq_printf(m, "0x%02x ", p[i]); 2630 seq_putc(m, '\n'); 2631 p += p[1] + 2; 2632 } else { 2633 seq_puts(m, "Parse beacon failed at rates element\n"); 2634 return 0; 2635 } 2636 2637 if (p[0] == C_FH_PARAM_SET_ELEMENT_ID) { 2638 pfh = (struct freq_hop_element *)p; 2639 seq_printf(m, "Hop dwell = %d Kus\n", 2640 pfh->dwell_time[0] + 2641 256 * pfh->dwell_time[1]); 2642 seq_printf(m, "Hop set = %d\n", 2643 pfh->hop_set); 2644 seq_printf(m, "Hop pattern = %d\n", 2645 pfh->hop_pattern); 2646 seq_printf(m, "Hop index = %d\n", 2647 pfh->hop_index); 2648 p += p[1] + 2; 2649 } else { 2650 seq_puts(m, 2651 "Parse beacon failed at FH param element\n"); 2652 return 0; 2653 } 2654 } else { 2655 seq_puts(m, "No beacons received\n"); 2656 } 2657 return 0; 2658 } 2659 #endif 2660 /*===========================================================================*/ 2661 static int build_auth_frame(ray_dev_t *local, UCHAR *dest, int auth_type) 2662 { 2663 int addr; 2664 struct ccs __iomem *pccs; 2665 struct tx_msg __iomem *ptx; 2666 int ccsindex; 2667 2668 /* If no tx buffers available, return */ 2669 if ((ccsindex = get_free_tx_ccs(local)) < 0) { 2670 pr_debug("ray_cs send authenticate - No free tx ccs\n"); 2671 return -1; 2672 } 2673 2674 pccs = ccs_base(local) + ccsindex; 2675 2676 /* Address in card space */ 2677 addr = TX_BUF_BASE + (ccsindex << 11); 2678 /* fill in the CCS */ 2679 writeb(CCS_TX_REQUEST, &pccs->cmd); 2680 writeb(addr >> 8, pccs->var.tx_request.tx_data_ptr); 2681 writeb(0x20, pccs->var.tx_request.tx_data_ptr + 1); 2682 writeb(TX_AUTHENTICATE_LENGTH_MSB, pccs->var.tx_request.tx_data_length); 2683 writeb(TX_AUTHENTICATE_LENGTH_LSB, 2684 pccs->var.tx_request.tx_data_length + 1); 2685 writeb(0, &pccs->var.tx_request.pow_sav_mode); 2686 2687 ptx = local->sram + addr; 2688 /* fill in the mac header */ 2689 writeb(PROTOCOL_VER | AUTHENTIC_TYPE, &ptx->mac.frame_ctl_1); 2690 writeb(0, &ptx->mac.frame_ctl_2); 2691 2692 memcpy_toio(ptx->mac.addr_1, dest, ADDRLEN); 2693 memcpy_toio(ptx->mac.addr_2, local->sparm.b4.a_mac_addr, ADDRLEN); 2694 memcpy_toio(ptx->mac.addr_3, local->bss_id, ADDRLEN); 2695 2696 /* Fill in msg body with protocol 00 00, sequence 01 00 ,status 00 00 */ 2697 memset_io(ptx->var, 0, 6); 2698 writeb(auth_type & 0xff, ptx->var + 2); 2699 2700 /* Interrupt the firmware to process the command */ 2701 if (interrupt_ecf(local, ccsindex)) { 2702 pr_debug( 2703 "ray_cs send authentication request failed - ECF not ready for intr\n"); 2704 writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status); 2705 return -1; 2706 } 2707 return 0; 2708 } /* End build_auth_frame */ 2709 2710 /*===========================================================================*/ 2711 #ifdef CONFIG_PROC_FS 2712 static ssize_t ray_cs_essid_proc_write(struct file *file, 2713 const char __user *buffer, size_t count, loff_t *pos) 2714 { 2715 static char proc_essid[33]; 2716 unsigned int len = count; 2717 2718 if (len > 32) 2719 len = 32; 2720 memset(proc_essid, 0, 33); 2721 if (copy_from_user(proc_essid, buffer, len)) 2722 return -EFAULT; 2723 essid = proc_essid; 2724 return count; 2725 } 2726 2727 static const struct proc_ops ray_cs_essid_proc_ops = { 2728 .proc_write = ray_cs_essid_proc_write, 2729 .proc_lseek = noop_llseek, 2730 }; 2731 2732 static ssize_t int_proc_write(struct file *file, const char __user *buffer, 2733 size_t count, loff_t *pos) 2734 { 2735 static char proc_number[10]; 2736 char *p; 2737 int nr, len; 2738 2739 if (!count) 2740 return 0; 2741 2742 if (count > 9) 2743 return -EINVAL; 2744 if (copy_from_user(proc_number, buffer, count)) 2745 return -EFAULT; 2746 p = proc_number; 2747 nr = 0; 2748 len = count; 2749 do { 2750 unsigned int c = *p - '0'; 2751 if (c > 9) 2752 return -EINVAL; 2753 nr = nr * 10 + c; 2754 p++; 2755 } while (--len); 2756 *(int *)pde_data(file_inode(file)) = nr; 2757 return count; 2758 } 2759 2760 static const struct proc_ops int_proc_ops = { 2761 .proc_write = int_proc_write, 2762 .proc_lseek = noop_llseek, 2763 }; 2764 #endif 2765 2766 static const struct pcmcia_device_id ray_ids[] = { 2767 PCMCIA_DEVICE_MANF_CARD(0x01a6, 0x0000), 2768 PCMCIA_DEVICE_NULL, 2769 }; 2770 2771 MODULE_DEVICE_TABLE(pcmcia, ray_ids); 2772 2773 static struct pcmcia_driver ray_driver = { 2774 .owner = THIS_MODULE, 2775 .name = "ray_cs", 2776 .probe = ray_probe, 2777 .remove = ray_detach, 2778 .id_table = ray_ids, 2779 .suspend = ray_suspend, 2780 .resume = ray_resume, 2781 }; 2782 2783 static int __init init_ray_cs(void) 2784 { 2785 int rc; 2786 2787 pr_debug("%s\n", rcsid); 2788 rc = pcmcia_register_driver(&ray_driver); 2789 pr_debug("raylink init_module register_pcmcia_driver returns 0x%x\n", 2790 rc); 2791 if (rc) 2792 return rc; 2793 2794 #ifdef CONFIG_PROC_FS 2795 proc_mkdir("driver/ray_cs", NULL); 2796 2797 proc_create_single("driver/ray_cs/ray_cs", 0, NULL, ray_cs_proc_show); 2798 proc_create("driver/ray_cs/essid", 0200, NULL, &ray_cs_essid_proc_ops); 2799 proc_create_data("driver/ray_cs/net_type", 0200, NULL, &int_proc_ops, 2800 &net_type); 2801 proc_create_data("driver/ray_cs/translate", 0200, NULL, &int_proc_ops, 2802 &translate); 2803 #endif 2804 translate = !!translate; 2805 return 0; 2806 } /* init_ray_cs */ 2807 2808 /*===========================================================================*/ 2809 2810 static void __exit exit_ray_cs(void) 2811 { 2812 pr_debug("ray_cs: cleanup_module\n"); 2813 2814 #ifdef CONFIG_PROC_FS 2815 remove_proc_subtree("driver/ray_cs", NULL); 2816 #endif 2817 2818 pcmcia_unregister_driver(&ray_driver); 2819 } /* exit_ray_cs */ 2820 2821 module_init(init_ray_cs); 2822 module_exit(exit_ray_cs); 2823 2824 /*===========================================================================*/ 2825