sys/dev/an/if_an.c

   1 /*-
   2  * Copyright (c) 1997, 1998, 1999
   3  *      Bill Paul <wpaul@ctr.columbia.edu>.  All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  * 3. All advertising materials mentioning features or use of this software
  14  *    must display the following acknowledgement:
  15  *      This product includes software developed by Bill Paul.
  16  * 4. Neither the name of the author nor the names of any co-contributors
  17  *    may be used to endorse or promote products derived from this software
  18  *    without specific prior written permission.
  19  *
  20  * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
  21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  23  * ARE DISCLAIMED.  IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
  24  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  25  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  26  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  27  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  28  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  29  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
  30  * THE POSSIBILITY OF SUCH DAMAGE.
  31  */
  32 /*
  33  * Aironet 4500/4800 802.11 PCMCIA/ISA/PCI driver for FreeBSD.
  34  *
  35  * Written by Bill Paul <wpaul@ctr.columbia.edu>
  36  * Electrical Engineering Department
  37  * Columbia University, New York City
  38  */
  39
  40 #include <sys/cdefs.h>
  41 __FBSDID("$FreeBSD$");
  42
  43 /*
  44  * The Aironet 4500/4800 series cards come in PCMCIA, ISA and PCI form.
  45  * This driver supports all three device types (PCI devices are supported
  46  * through an extra PCI shim: /sys/dev/an/if_an_pci.c). ISA devices can be
  47  * supported either using hard-coded IO port/IRQ settings or via Plug
  48  * and Play. The 4500 series devices support 1Mbps and 2Mbps data rates.
  49  * The 4800 devices support 1, 2, 5.5 and 11Mbps rates.
  50  *
  51  * Like the WaveLAN/IEEE cards, the Aironet NICs are all essentially
  52  * PCMCIA devices. The ISA and PCI cards are a combination of a PCMCIA
  53  * device and a PCMCIA to ISA or PCMCIA to PCI adapter card. There are
  54  * a couple of important differences though:
  55  *
  56  * - Lucent ISA card looks to the host like a PCMCIA controller with
  57  *   a PCMCIA WaveLAN card inserted. This means that even desktop
  58  *   machines need to be configured with PCMCIA support in order to
  59  *   use WaveLAN/IEEE ISA cards. The Aironet cards on the other hand
  60  *   actually look like normal ISA and PCI devices to the host, so
  61  *   no PCMCIA controller support is needed
  62  *
  63  * The latter point results in a small gotcha. The Aironet PCMCIA
  64  * cards can be configured for one of two operating modes depending
  65  * on how the Vpp1 and Vpp2 programming voltages are set when the
  66  * card is activated. In order to put the card in proper PCMCIA
  67  * operation (where the CIS table is visible and the interface is
  68  * programmed for PCMCIA operation), both Vpp1 and Vpp2 have to be
  69  * set to 5 volts. FreeBSD by default doesn't set the Vpp voltages,
  70  * which leaves the card in ISA/PCI mode, which prevents it from
  71  * being activated as an PCMCIA device.
  72  *
  73  * Note that some PCMCIA controller software packages for Windows NT
  74  * fail to set the voltages as well.
  75  *
  76  * The Aironet devices can operate in both station mode and access point
  77  * mode. Typically, when programmed for station mode, the card can be set
  78  * to automatically perform encapsulation/decapsulation of Ethernet II
  79  * and 802.3 frames within 802.11 frames so that the host doesn't have
  80  * to do it itself. This driver doesn't program the card that way: the
  81  * driver handles all of the encapsulation/decapsulation itself.
  82  */
  83
  84 #include "opt_inet.h"
  85
  86 #ifdef INET
  87 #define ANCACHE                 /* enable signal strength cache */
  88 #endif
  89
  90 #include <sys/param.h>
  91 #include <sys/ctype.h>
  92 #include <sys/systm.h>
  93 #include <sys/sockio.h>
  94 #include <sys/mbuf.h>
  95 #include <sys/priv.h>
  96 #include <sys/proc.h>
  97 #include <sys/kernel.h>
  98 #include <sys/socket.h>
  99 #ifdef ANCACHE
 100 #include <sys/syslog.h>
 101 #endif
 102 #include <sys/sysctl.h>
 103
 104 #include <sys/module.h>
 105 #include <sys/bus.h>
 106 #include <machine/bus.h>
 107 #include <sys/rman.h>
 108 #include <sys/lock.h>
 109 #include <sys/mutex.h>
 110 #include <machine/resource.h>
 111 #include <sys/malloc.h>
 112
 113 #include <net/if.h>
 114 #include <net/if_arp.h>
 115 #include <net/if_dl.h>
 116 #include <net/ethernet.h>
 117 #include <net/if_types.h>
 118 #include <net/if_media.h>
 119
 120 #include <net80211/ieee80211_var.h>
 121 #include <net80211/ieee80211_ioctl.h>
 122
 123 #ifdef INET
 124 #include <netinet/in.h>
 125 #include <netinet/in_systm.h>
 126 #include <netinet/in_var.h>
 127 #include <netinet/ip.h>
 128 #endif
 129
 130 #include <net/bpf.h>
 131
 132 #include <machine/md_var.h>
 133
 134 #include <dev/an/if_aironet_ieee.h>
 135 #include <dev/an/if_anreg.h>
 136
 137 /* These are global because we need them in sys/pci/if_an_p.c. */
 138 static void an_reset(struct an_softc *);
 139 static int an_init_mpi350_desc(struct an_softc *);
 140 static int an_ioctl(struct ifnet *, u_long, caddr_t);
 141 static void an_init(void *);
 142 static void an_init_locked(struct an_softc *);
 143 static int an_init_tx_ring(struct an_softc *);
 144 static void an_start(struct ifnet *);
 145 static void an_start_locked(struct ifnet *);
 146 static void an_watchdog(struct an_softc *);
 147 static void an_rxeof(struct an_softc *);
 148 static void an_txeof(struct an_softc *, int);
 149
 150 static void an_promisc(struct an_softc *, int);
 151 static int an_cmd(struct an_softc *, int, int);
 152 static int an_cmd_struct(struct an_softc *, struct an_command *,
 153     struct an_reply *);
 154 static int an_read_record(struct an_softc *, struct an_ltv_gen *);
 155 static int an_write_record(struct an_softc *, struct an_ltv_gen *);
 156 static int an_read_data(struct an_softc *, int, int, caddr_t, int);
 157 static int an_write_data(struct an_softc *, int, int, caddr_t, int);
 158 static int an_seek(struct an_softc *, int, int, int);
 159 static int an_alloc_nicmem(struct an_softc *, int, int *);
 160 static int an_dma_malloc(struct an_softc *, bus_size_t, struct an_dma_alloc *,
 161     int);
 162 static void an_dma_free(struct an_softc *, struct an_dma_alloc *);
 163 static void an_dma_malloc_cb(void *, bus_dma_segment_t *, int, int);
 164 static void an_stats_update(void *);
 165 static void an_setdef(struct an_softc *, struct an_req *);
 166 #ifdef ANCACHE
 167 static void an_cache_store(struct an_softc *, struct ether_header *,
 168     struct mbuf *, u_int8_t, u_int8_t);
 169 #endif
 170
 171 /* function definitions for use with the Cisco's Linux configuration
 172    utilities
 173 */
 174
 175 static int readrids(struct ifnet*, struct aironet_ioctl*);
 176 static int writerids(struct ifnet*, struct aironet_ioctl*);
 177 static int flashcard(struct ifnet*, struct aironet_ioctl*);
 178
 179 static int cmdreset(struct ifnet *);
 180 static int setflashmode(struct ifnet *);
 181 static int flashgchar(struct ifnet *,int,int);
 182 static int flashpchar(struct ifnet *,int,int);
 183 static int flashputbuf(struct ifnet *);
 184 static int flashrestart(struct ifnet *);
 185 static int WaitBusy(struct ifnet *, int);
 186 static int unstickbusy(struct ifnet *);
 187
 188 static void an_dump_record      (struct an_softc *,struct an_ltv_gen *,
 189                                     char *);
 190
 191 static int an_media_change      (struct ifnet *);
 192 static void an_media_status     (struct ifnet *, struct ifmediareq *);
 193
 194 static int      an_dump = 0;
 195 static int      an_cache_mode = 0;
 196
 197 #define DBM 0
 198 #define PERCENT 1
 199 #define RAW 2
 200
 201 static char an_conf[256];
 202 static char an_conf_cache[256];
 203
 204 /* sysctl vars */
 205
 206 static SYSCTL_NODE(_hw, OID_AUTO, an, CTLFLAG_RD, 0,
 207     "Wireless driver parameters");
 208
 209 /* XXX violate ethernet/netgraph callback hooks */
 210 extern  void    (*ng_ether_attach_p)(struct ifnet *ifp);
 211 extern  void    (*ng_ether_detach_p)(struct ifnet *ifp);
 212
 213 static int
 214 sysctl_an_dump(SYSCTL_HANDLER_ARGS)
 215 {
 216         int     error, r, last;
 217         char    *s = an_conf;
 218
 219         last = an_dump;
 220
 221         switch (an_dump) {
 222         case 0:
 223                 strcpy(an_conf, "off");
 224                 break;
 225         case 1:
 226                 strcpy(an_conf, "type");
 227                 break;
 228         case 2:
 229                 strcpy(an_conf, "dump");
 230                 break;
 231         default:
 232                 snprintf(an_conf, 5, "%x", an_dump);
 233                 break;
 234         }
 235
 236         error = sysctl_handle_string(oidp, an_conf, sizeof(an_conf), req);
 237
 238         if (strncmp(an_conf,"off", 3) == 0) {
 239                 an_dump = 0;
 240         }
 241         if (strncmp(an_conf,"dump", 4) == 0) {
 242                 an_dump = 1;
 243         }
 244         if (strncmp(an_conf,"type", 4) == 0) {
 245                 an_dump = 2;
 246         }
 247         if (*s == 'f') {
 248                 r = 0;
 249                 for (;;s++) {
 250                         if ((*s >= '0') && (*s <= '9')) {
 251                                 r = r * 16 + (*s - '0');
 252                         } else if ((*s >= 'a') && (*s <= 'f')) {
 253                                 r = r * 16 + (*s - 'a' + 10);
 254                         } else {
 255                                 break;
 256                         }
 257                 }
 258                 an_dump = r;
 259         }
 260         if (an_dump != last)
 261                 printf("Sysctl changed for Aironet driver\n");
 262
 263         return error;
 264 }
 265
 266 SYSCTL_PROC(_hw_an, OID_AUTO, an_dump, CTLTYPE_STRING | CTLFLAG_RW,
 267             0, sizeof(an_conf), sysctl_an_dump, "A", "");
 268
 269 static int
 270 sysctl_an_cache_mode(SYSCTL_HANDLER_ARGS)
 271 {
 272         int     error, last;
 273
 274         last = an_cache_mode;
 275
 276         switch (an_cache_mode) {
 277         case 1:
 278                 strcpy(an_conf_cache, "per");
 279                 break;
 280         case 2:
 281                 strcpy(an_conf_cache, "raw");
 282                 break;
 283         default:
 284                 strcpy(an_conf_cache, "dbm");
 285                 break;
 286         }
 287
 288         error = sysctl_handle_string(oidp, an_conf_cache,
 289                         sizeof(an_conf_cache), req);
 290
 291         if (strncmp(an_conf_cache,"dbm", 3) == 0) {
 292                 an_cache_mode = 0;
 293         }
 294         if (strncmp(an_conf_cache,"per", 3) == 0) {
 295                 an_cache_mode = 1;
 296         }
 297         if (strncmp(an_conf_cache,"raw", 3) == 0) {
 298                 an_cache_mode = 2;
 299         }
 300
 301         return error;
 302 }
 303
 304 SYSCTL_PROC(_hw_an, OID_AUTO, an_cache_mode, CTLTYPE_STRING | CTLFLAG_RW,
 305             0, sizeof(an_conf_cache), sysctl_an_cache_mode, "A", "");
 306
 307 /*
 308  * Setup the lock for PCI attachment since it skips the an_probe
 309  * function.  We need to setup the lock in an_probe since some
 310  * operations need the lock.  So we might as well create the
 311  * lock in the probe.
 312  */
 313 int
 314 an_pci_probe(device_t dev)
 315 {
 316         struct an_softc *sc = device_get_softc(dev);
 317
 318         mtx_init(&sc->an_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
 319             MTX_DEF);
 320
 321         return(0);
 322 }
 323
 324 /*
 325  * We probe for an Aironet 4500/4800 card by attempting to
 326  * read the default SSID list. On reset, the first entry in
 327  * the SSID list will contain the name "tsunami." If we don't
 328  * find this, then there's no card present.
 329  */
 330 int
 331 an_probe(device_t dev)
 332 {
 333         struct an_softc *sc = device_get_softc(dev);
 334         struct an_ltv_ssidlist_new      ssid;
 335         int     error;
 336
 337         bzero((char *)&ssid, sizeof(ssid));
 338
 339         error = an_alloc_port(dev, 0, AN_IOSIZ);
 340         if (error != 0)
 341                 return (0);
 342
 343         /* can't do autoprobing */
 344         if (rman_get_start(sc->port_res) == -1)
 345                 return(0);
 346
 347         /*
 348          * We need to fake up a softc structure long enough
 349          * to be able to issue commands and call some of the
 350          * other routines.
 351          */
 352         ssid.an_len = sizeof(ssid);
 353         ssid.an_type = AN_RID_SSIDLIST;
 354
 355         /* Make sure interrupts are disabled. */
 356         sc->mpi350 = 0;
 357         CSR_WRITE_2(sc, AN_INT_EN(sc->mpi350), 0);
 358         CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), 0xFFFF);
 359
 360         mtx_init(&sc->an_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
 361             MTX_DEF);
 362         AN_LOCK(sc);
 363         an_reset(sc);
 364
 365         if (an_cmd(sc, AN_CMD_READCFG, 0)) {
 366                 AN_UNLOCK(sc);
 367                 goto fail;
 368         }
 369
 370         if (an_read_record(sc, (struct an_ltv_gen *)&ssid)) {
 371                 AN_UNLOCK(sc);
 372                 goto fail;
 373         }
 374
 375         /* See if the ssid matches what we expect ... but doesn't have to */
 376         if (strcmp(ssid.an_entry[0].an_ssid, AN_DEF_SSID)) {
 377                 AN_UNLOCK(sc);
 378                 goto fail;
 379         }
 380
 381         AN_UNLOCK(sc);
 382         return(AN_IOSIZ);
 383 fail:
 384         mtx_destroy(&sc->an_mtx);
 385         return(0);
 386 }
 387
 388 /*
 389  * Allocate a port resource with the given resource id.
 390  */
 391 int
 392 an_alloc_port(device_t dev, int rid, int size)
 393 {
 394         struct an_softc *sc = device_get_softc(dev);
 395         struct resource *res;
 396
 397         res = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
 398                                  0ul, ~0ul, size, RF_ACTIVE);
 399         if (res) {
 400                 sc->port_rid = rid;
 401                 sc->port_res = res;
 402                 return (0);
 403         } else {
 404                 return (ENOENT);
 405         }
 406 }
 407
 408 /*
 409  * Allocate a memory resource with the given resource id.
 410  */
 411 int an_alloc_memory(device_t dev, int rid, int size)
 412 {
 413         struct an_softc *sc = device_get_softc(dev);
 414         struct resource *res;
 415
 416         res = bus_alloc_resource(dev, SYS_RES_MEMORY, &rid,
 417                                  0ul, ~0ul, size, RF_ACTIVE);
 418         if (res) {
 419                 sc->mem_rid = rid;
 420                 sc->mem_res = res;
 421                 sc->mem_used = size;
 422                 return (0);
 423         } else {
 424                 return (ENOENT);
 425         }
 426 }
 427
 428 /*
 429  * Allocate a auxilary memory resource with the given resource id.
 430  */
 431 int an_alloc_aux_memory(device_t dev, int rid, int size)
 432 {
 433         struct an_softc *sc = device_get_softc(dev);
 434         struct resource *res;
 435
 436         res = bus_alloc_resource(dev, SYS_RES_MEMORY, &rid,
 437                                  0ul, ~0ul, size, RF_ACTIVE);
 438         if (res) {
 439                 sc->mem_aux_rid = rid;
 440                 sc->mem_aux_res = res;
 441                 sc->mem_aux_used = size;
 442                 return (0);
 443         } else {
 444                 return (ENOENT);
 445         }
 446 }
 447
 448 /*
 449  * Allocate an irq resource with the given resource id.
 450  */
 451 int
 452 an_alloc_irq(device_t dev, int rid, int flags)
 453 {
 454         struct an_softc *sc = device_get_softc(dev);
 455         struct resource *res;
 456
 457         res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
 458                                      (RF_ACTIVE | flags));
 459         if (res) {
 460                 sc->irq_rid = rid;
 461                 sc->irq_res = res;
 462                 return (0);
 463         } else {
 464                 return (ENOENT);
 465         }
 466 }
 467
 468 static void
 469 an_dma_malloc_cb(void *arg, bus_dma_segment_t *segs, int nseg, int error)
 470 {
 471         bus_addr_t *paddr = (bus_addr_t*) arg;
 472         *paddr = segs->ds_addr;
 473 }
 474
 475 /*
 476  * Alloc DMA memory and set the pointer to it
 477  */
 478 static int
 479 an_dma_malloc(struct an_softc *sc, bus_size_t size, struct an_dma_alloc *dma,
 480     int mapflags)
 481 {
 482         int r;
 483
 484         r = bus_dmamap_create(sc->an_dtag, BUS_DMA_NOWAIT, &dma->an_dma_map);
 485         if (r != 0)
 486                 goto fail_0;
 487
 488         r = bus_dmamem_alloc(sc->an_dtag, (void**) &dma->an_dma_vaddr,
 489                              BUS_DMA_NOWAIT, &dma->an_dma_map);
 490         if (r != 0)
 491                 goto fail_1;
 492
 493         r = bus_dmamap_load(sc->an_dtag, dma->an_dma_map, dma->an_dma_vaddr,
 494                             size,
 495                             an_dma_malloc_cb,
 496                             &dma->an_dma_paddr,
 497                             mapflags | BUS_DMA_NOWAIT);
 498         if (r != 0)
 499                 goto fail_2;
 500
 501         dma->an_dma_size = size;
 502         return (0);
 503
 504 fail_2:
 505         bus_dmamap_unload(sc->an_dtag, dma->an_dma_map);
 506 fail_1:
 507         bus_dmamem_free(sc->an_dtag, dma->an_dma_vaddr, dma->an_dma_map);
 508 fail_0:
 509         bus_dmamap_destroy(sc->an_dtag, dma->an_dma_map);
 510         dma->an_dma_map = NULL;
 511         return (r);
 512 }
 513
 514 static void
 515 an_dma_free(struct an_softc *sc, struct an_dma_alloc *dma)
 516 {
 517         bus_dmamap_unload(sc->an_dtag, dma->an_dma_map);
 518         bus_dmamem_free(sc->an_dtag, dma->an_dma_vaddr, dma->an_dma_map);
 519         dma->an_dma_vaddr = 0;
 520         bus_dmamap_destroy(sc->an_dtag, dma->an_dma_map);
 521 }
 522
 523 /*
 524  * Release all resources
 525  */
 526 void
 527 an_release_resources(device_t dev)
 528 {
 529         struct an_softc *sc = device_get_softc(dev);
 530         int i;
 531
 532         if (sc->port_res) {
 533                 bus_release_resource(dev, SYS_RES_IOPORT,
 534                                      sc->port_rid, sc->port_res);
 535                 sc->port_res = 0;
 536         }
 537         if (sc->mem_res) {
 538                 bus_release_resource(dev, SYS_RES_MEMORY,
 539                                      sc->mem_rid, sc->mem_res);
 540                 sc->mem_res = 0;
 541         }
 542         if (sc->mem_aux_res) {
 543                 bus_release_resource(dev, SYS_RES_MEMORY,
 544                                      sc->mem_aux_rid, sc->mem_aux_res);
 545                 sc->mem_aux_res = 0;
 546         }
 547         if (sc->irq_res) {
 548                 bus_release_resource(dev, SYS_RES_IRQ,
 549                                      sc->irq_rid, sc->irq_res);
 550                 sc->irq_res = 0;
 551         }
 552         if (sc->an_rid_buffer.an_dma_paddr) {
 553                 an_dma_free(sc, &sc->an_rid_buffer);
 554         }
 555         for (i = 0; i < AN_MAX_RX_DESC; i++)
 556                 if (sc->an_rx_buffer[i].an_dma_paddr) {
 557                         an_dma_free(sc, &sc->an_rx_buffer[i]);
 558                 }
 559         for (i = 0; i < AN_MAX_TX_DESC; i++)
 560                 if (sc->an_tx_buffer[i].an_dma_paddr) {
 561                         an_dma_free(sc, &sc->an_tx_buffer[i]);
 562                 }
 563         if (sc->an_dtag) {
 564                 bus_dma_tag_destroy(sc->an_dtag);
 565         }
 566
 567 }
 568
 569 int
 570 an_init_mpi350_desc(struct an_softc *sc)
 571 {
 572         struct an_command       cmd_struct;
 573         struct an_reply         reply;
 574         struct an_card_rid_desc an_rid_desc;
 575         struct an_card_rx_desc  an_rx_desc;
 576         struct an_card_tx_desc  an_tx_desc;
 577         int                     i, desc;
 578
 579         AN_LOCK_ASSERT(sc);
 580         if(!sc->an_rid_buffer.an_dma_paddr)
 581                 an_dma_malloc(sc, AN_RID_BUFFER_SIZE,
 582                                  &sc->an_rid_buffer, 0);
 583         for (i = 0; i < AN_MAX_RX_DESC; i++)
 584                 if(!sc->an_rx_buffer[i].an_dma_paddr)
 585                         an_dma_malloc(sc, AN_RX_BUFFER_SIZE,
 586                                       &sc->an_rx_buffer[i], 0);
 587         for (i = 0; i < AN_MAX_TX_DESC; i++)
 588                 if(!sc->an_tx_buffer[i].an_dma_paddr)
 589                         an_dma_malloc(sc, AN_TX_BUFFER_SIZE,
 590                                       &sc->an_tx_buffer[i], 0);
 591
 592         /*
 593          * Allocate RX descriptor
 594          */
 595         bzero(&reply,sizeof(reply));
 596         cmd_struct.an_cmd   = AN_CMD_ALLOC_DESC;
 597         cmd_struct.an_parm0 = AN_DESCRIPTOR_RX;
 598         cmd_struct.an_parm1 = AN_RX_DESC_OFFSET;
 599         cmd_struct.an_parm2 = AN_MAX_RX_DESC;
 600         if (an_cmd_struct(sc, &cmd_struct, &reply)) {
 601                 if_printf(sc->an_ifp, "failed to allocate RX descriptor\n");
 602                 return(EIO);
 603         }
 604
 605         for (desc = 0; desc < AN_MAX_RX_DESC; desc++) {
 606                 bzero(&an_rx_desc, sizeof(an_rx_desc));
 607                 an_rx_desc.an_valid = 1;
 608                 an_rx_desc.an_len = AN_RX_BUFFER_SIZE;
 609                 an_rx_desc.an_done = 0;
 610                 an_rx_desc.an_phys = sc->an_rx_buffer[desc].an_dma_paddr;
 611
 612                 for (i = 0; i < sizeof(an_rx_desc) / 4; i++)
 613                         CSR_MEM_AUX_WRITE_4(sc, AN_RX_DESC_OFFSET
 614                             + (desc * sizeof(an_rx_desc))
 615                             + (i * 4),
 616                             ((u_int32_t *)(void *)&an_rx_desc)[i]);
 617         }
 618
 619         /*
 620          * Allocate TX descriptor
 621          */
 622
 623         bzero(&reply,sizeof(reply));
 624         cmd_struct.an_cmd   = AN_CMD_ALLOC_DESC;
 625         cmd_struct.an_parm0 = AN_DESCRIPTOR_TX;
 626         cmd_struct.an_parm1 = AN_TX_DESC_OFFSET;
 627         cmd_struct.an_parm2 = AN_MAX_TX_DESC;
 628         if (an_cmd_struct(sc, &cmd_struct, &reply)) {
 629                 if_printf(sc->an_ifp, "failed to allocate TX descriptor\n");
 630                 return(EIO);
 631         }
 632
 633         for (desc = 0; desc < AN_MAX_TX_DESC; desc++) {
 634                 bzero(&an_tx_desc, sizeof(an_tx_desc));
 635                 an_tx_desc.an_offset = 0;
 636                 an_tx_desc.an_eoc = 0;
 637                 an_tx_desc.an_valid = 0;
 638                 an_tx_desc.an_len = 0;
 639                 an_tx_desc.an_phys = sc->an_tx_buffer[desc].an_dma_paddr;
 640
 641                 for (i = 0; i < sizeof(an_tx_desc) / 4; i++)
 642                         CSR_MEM_AUX_WRITE_4(sc, AN_TX_DESC_OFFSET
 643                             + (desc * sizeof(an_tx_desc))
 644                             + (i * 4),
 645                             ((u_int32_t *)(void *)&an_tx_desc)[i]);
 646         }
 647
 648         /*
 649          * Allocate RID descriptor
 650          */
 651
 652         bzero(&reply,sizeof(reply));
 653         cmd_struct.an_cmd   = AN_CMD_ALLOC_DESC;
 654         cmd_struct.an_parm0 = AN_DESCRIPTOR_HOSTRW;
 655         cmd_struct.an_parm1 = AN_HOST_DESC_OFFSET;
 656         cmd_struct.an_parm2 = 1;
 657         if (an_cmd_struct(sc, &cmd_struct, &reply)) {
 658                 if_printf(sc->an_ifp, "failed to allocate host descriptor\n");
 659                 return(EIO);
 660         }
 661
 662         bzero(&an_rid_desc, sizeof(an_rid_desc));
 663         an_rid_desc.an_valid = 1;
 664         an_rid_desc.an_len = AN_RID_BUFFER_SIZE;
 665         an_rid_desc.an_rid = 0;
 666         an_rid_desc.an_phys = sc->an_rid_buffer.an_dma_paddr;
 667
 668         for (i = 0; i < sizeof(an_rid_desc) / 4; i++)
 669                 CSR_MEM_AUX_WRITE_4(sc, AN_HOST_DESC_OFFSET + i * 4,
 670                                     ((u_int32_t *)(void *)&an_rid_desc)[i]);
 671
 672         return(0);
 673 }
 674
 675 int
 676 an_attach(struct an_softc *sc, int flags)
 677 {
 678         struct ifnet            *ifp;
 679         int                     error = EIO;
 680         int                     i, nrate, mword;
 681         u_int8_t                r;
 682
 683         ifp = sc->an_ifp = if_alloc(IFT_ETHER);
 684         if (ifp == NULL) {
 685                 device_printf(sc->an_dev, "can not if_alloc()\n");
 686                 goto fail;
 687         }
 688
 689         sc->an_gone = 0;
 690         sc->an_associated = 0;
 691         sc->an_monitor = 0;
 692         sc->an_was_monitor = 0;
 693         sc->an_flash_buffer = NULL;
 694
 695         /* Reset the NIC. */
 696         AN_LOCK(sc);
 697         an_reset(sc);
 698         if (sc->mpi350) {
 699                 error = an_init_mpi350_desc(sc);
 700                 if (error)
 701                         goto fail;
 702         }
 703
 704         /* Load factory config */
 705         if (an_cmd(sc, AN_CMD_READCFG, 0)) {
 706                 device_printf(sc->an_dev, "failed to load config data\n");
 707                 goto fail;
 708         }
 709
 710         /* Read the current configuration */
 711         sc->an_config.an_type = AN_RID_GENCONFIG;
 712         sc->an_config.an_len = sizeof(struct an_ltv_genconfig);
 713         if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_config)) {
 714                 device_printf(sc->an_dev, "read record failed\n");
 715                 goto fail;
 716         }
 717
 718         /* Read the card capabilities */
 719         sc->an_caps.an_type = AN_RID_CAPABILITIES;
 720         sc->an_caps.an_len = sizeof(struct an_ltv_caps);
 721         if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_caps)) {
 722                 device_printf(sc->an_dev, "read record failed\n");
 723                 goto fail;
 724         }
 725
 726         /* Read ssid list */
 727         sc->an_ssidlist.an_type = AN_RID_SSIDLIST;
 728         sc->an_ssidlist.an_len = sizeof(struct an_ltv_ssidlist_new);
 729         if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_ssidlist)) {
 730                 device_printf(sc->an_dev, "read record failed\n");
 731                 goto fail;
 732         }
 733
 734         /* Read AP list */
 735         sc->an_aplist.an_type = AN_RID_APLIST;
 736         sc->an_aplist.an_len = sizeof(struct an_ltv_aplist);
 737         if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_aplist)) {
 738                 device_printf(sc->an_dev, "read record failed\n");
 739                 goto fail;
 740         }
 741
 742 #ifdef ANCACHE
 743         /* Read the RSSI <-> dBm map */
 744         sc->an_have_rssimap = 0;
 745         if (sc->an_caps.an_softcaps & 8) {
 746                 sc->an_rssimap.an_type = AN_RID_RSSI_MAP;
 747                 sc->an_rssimap.an_len = sizeof(struct an_ltv_rssi_map);
 748                 if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_rssimap)) {
 749                         device_printf(sc->an_dev,
 750                             "unable to get RSSI <-> dBM map\n");
 751                 } else {
 752                         device_printf(sc->an_dev, "got RSSI <-> dBM map\n");
 753                         sc->an_have_rssimap = 1;
 754                 }
 755         } else {
 756                 device_printf(sc->an_dev, "no RSSI <-> dBM map\n");
 757         }
 758 #endif
 759         AN_UNLOCK(sc);
 760
 761         ifp->if_softc = sc;
 762         if_initname(ifp, device_get_name(sc->an_dev),
 763             device_get_unit(sc->an_dev));
 764         ifp->if_mtu = ETHERMTU;
 765         ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
 766         ifp->if_ioctl = an_ioctl;
 767         ifp->if_start = an_start;
 768         ifp->if_init = an_init;
 769         ifp->if_baudrate = 10000000;
 770         IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen);
 771         ifp->if_snd.ifq_drv_maxlen = ifqmaxlen;
 772         IFQ_SET_READY(&ifp->if_snd);
 773
 774         bzero(sc->an_config.an_nodename, sizeof(sc->an_config.an_nodename));
 775         bcopy(AN_DEFAULT_NODENAME, sc->an_config.an_nodename,
 776             sizeof(AN_DEFAULT_NODENAME) - 1);
 777
 778         bzero(sc->an_ssidlist.an_entry[0].an_ssid,
 779               sizeof(sc->an_ssidlist.an_entry[0].an_ssid));
 780         bcopy(AN_DEFAULT_NETNAME, sc->an_ssidlist.an_entry[0].an_ssid,
 781             sizeof(AN_DEFAULT_NETNAME) - 1);
 782         sc->an_ssidlist.an_entry[0].an_len = strlen(AN_DEFAULT_NETNAME);
 783
 784         sc->an_config.an_opmode =
 785             AN_OPMODE_INFRASTRUCTURE_STATION;
 786
 787         sc->an_tx_rate = 0;
 788         bzero((char *)&sc->an_stats, sizeof(sc->an_stats));
 789
 790         nrate = 8;
 791
 792         ifmedia_init(&sc->an_ifmedia, 0, an_media_change, an_media_status);
 793         if_printf(ifp, "supported rates: ");
 794 #define ADD(s, o)       ifmedia_add(&sc->an_ifmedia, \
 795         IFM_MAKEWORD(IFM_IEEE80211, (s), (o), 0), 0, NULL)
 796         ADD(IFM_AUTO, 0);
 797         ADD(IFM_AUTO, IFM_IEEE80211_ADHOC);
 798         for (i = 0; i < nrate; i++) {
 799                 r = sc->an_caps.an_rates[i];
 800                 mword = ieee80211_rate2media(NULL, r, IEEE80211_MODE_AUTO);
 801                 if (mword == 0)
 802                         continue;
 803                 printf("%s%d%sMbps", (i != 0 ? " " : ""),
 804                     (r & IEEE80211_RATE_VAL) / 2, ((r & 0x1) != 0 ? ".5" : ""));
 805                 ADD(mword, 0);
 806                 ADD(mword, IFM_IEEE80211_ADHOC);
 807         }
 808         printf("\n");
 809         ifmedia_set(&sc->an_ifmedia, IFM_MAKEWORD(IFM_IEEE80211,
 810             IFM_AUTO, 0, 0));
 811 #undef ADD
 812
 813         /*
 814          * Call MI attach routine.
 815          */
 816
 817         ether_ifattach(ifp, sc->an_caps.an_oemaddr);
 818         callout_init_mtx(&sc->an_stat_ch, &sc->an_mtx, 0);
 819
 820         return(0);
 821 fail:
 822         AN_UNLOCK(sc);
 823         mtx_destroy(&sc->an_mtx);
 824         if (ifp != NULL)
 825                 if_free(ifp);
 826         return(error);
 827 }
 828
 829 int
 830 an_detach(device_t dev)
 831 {
 832         struct an_softc         *sc = device_get_softc(dev);
 833         struct ifnet            *ifp = sc->an_ifp;
 834
 835         if (sc->an_gone) {
 836                 device_printf(dev,"already unloaded\n");
 837                 return(0);
 838         }
 839         AN_LOCK(sc);
 840         an_stop(sc);
 841         sc->an_gone = 1;
 842         ifmedia_removeall(&sc->an_ifmedia);
 843         ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
 844         AN_UNLOCK(sc);
 845         ether_ifdetach(ifp);
 846         bus_teardown_intr(dev, sc->irq_res, sc->irq_handle);
 847         callout_drain(&sc->an_stat_ch);
 848         if_free(ifp);
 849         an_release_resources(dev);
 850         mtx_destroy(&sc->an_mtx);
 851         return (0);
 852 }
 853
 854 static void
 855 an_rxeof(struct an_softc *sc)
 856 {
 857         struct ifnet   *ifp;
 858         struct ether_header *eh;
 859         struct ieee80211_frame *ih;
 860         struct an_rxframe rx_frame;
 861         struct an_rxframe_802_3 rx_frame_802_3;
 862         struct mbuf    *m;
 863         int             len, id, error = 0, i, count = 0;
 864         int             ieee80211_header_len;
 865         u_char          *bpf_buf;
 866         u_short         fc1;
 867         struct an_card_rx_desc an_rx_desc;
 868         u_int8_t        *buf;
 869
 870         AN_LOCK_ASSERT(sc);
 871
 872         ifp = sc->an_ifp;
 873
 874         if (!sc->mpi350) {
 875                 id = CSR_READ_2(sc, AN_RX_FID);
 876
 877                 if (sc->an_monitor && (ifp->if_flags & IFF_PROMISC)) {
 878                         /* read raw 802.11 packet */
 879                         bpf_buf = sc->buf_802_11;
 880
 881                         /* read header */
 882                         if (an_read_data(sc, id, 0x0, (caddr_t)&rx_frame,
 883                                          sizeof(rx_frame))) {
 884                                 ifp->if_ierrors++;
 885                                 return;
 886                         }
 887
 888                         /*
 889                          * skip beacon by default since this increases the
 890                          * system load a lot
 891                          */
 892
 893                         if (!(sc->an_monitor & AN_MONITOR_INCLUDE_BEACON) &&
 894                             (rx_frame.an_frame_ctl &
 895                              IEEE80211_FC0_SUBTYPE_BEACON)) {
 896                                 return;
 897                         }
 898
 899                         if (sc->an_monitor & AN_MONITOR_AIRONET_HEADER) {
 900                                 len = rx_frame.an_rx_payload_len
 901                                         + sizeof(rx_frame);
 902                                 /* Check for insane frame length */
 903                                 if (len > sizeof(sc->buf_802_11)) {
 904                                         if_printf(ifp, "oversized packet "
 905                                                "received (%d, %d)\n",
 906                                                len, MCLBYTES);
 907                                         ifp->if_ierrors++;
 908                                         return;
 909                                 }
 910
 911                                 bcopy((char *)&rx_frame,
 912                                       bpf_buf, sizeof(rx_frame));
 913
 914                                 error = an_read_data(sc, id, sizeof(rx_frame),
 915                                             (caddr_t)bpf_buf+sizeof(rx_frame),
 916                                             rx_frame.an_rx_payload_len);
 917                         } else {
 918                                 fc1=rx_frame.an_frame_ctl >> 8;
 919                                 ieee80211_header_len =
 920                                         sizeof(struct ieee80211_frame);
 921                                 if ((fc1 & IEEE80211_FC1_DIR_TODS) &&
 922                                     (fc1 & IEEE80211_FC1_DIR_FROMDS)) {
 923                                         ieee80211_header_len += ETHER_ADDR_LEN;
 924                                 }
 925
 926                                 len = rx_frame.an_rx_payload_len
 927                                         + ieee80211_header_len;
 928                                 /* Check for insane frame length */
 929                                 if (len > sizeof(sc->buf_802_11)) {
 930                                         if_printf(ifp, "oversized packet "
 931                                                "received (%d, %d)\n",
 932                                                len, MCLBYTES);
 933                                         ifp->if_ierrors++;
 934                                         return;
 935                                 }
 936
 937                                 ih = (struct ieee80211_frame *)bpf_buf;
 938
 939                                 bcopy((char *)&rx_frame.an_frame_ctl,
 940                                       (char *)ih, ieee80211_header_len);
 941
 942                                 error = an_read_data(sc, id, sizeof(rx_frame) +
 943                                             rx_frame.an_gaplen,
 944                                             (caddr_t)ih +ieee80211_header_len,
 945                                             rx_frame.an_rx_payload_len);
 946                         }
 947                         /* dump raw 802.11 packet to bpf and skip ip stack */
 948                         BPF_TAP(ifp, bpf_buf, len);
 949                 } else {
 950                         MGETHDR(m, M_NOWAIT, MT_DATA);
 951                         if (m == NULL) {
 952                                 ifp->if_ierrors++;
 953                                 return;
 954                         }
 955                         MCLGET(m, M_NOWAIT);
 956                         if (!(m->m_flags & M_EXT)) {
 957                                 m_freem(m);
 958                                 ifp->if_ierrors++;
 959                                 return;
 960                         }
 961                         m->m_pkthdr.rcvif = ifp;
 962                         /* Read Ethernet encapsulated packet */
 963
 964 #ifdef ANCACHE
 965                         /* Read NIC frame header */
 966                         if (an_read_data(sc, id, 0, (caddr_t)&rx_frame,
 967                                          sizeof(rx_frame))) {
 968                                 m_freem(m);
 969                                 ifp->if_ierrors++;
 970                                 return;
 971                         }
 972 #endif
 973                         /* Read in the 802_3 frame header */
 974                         if (an_read_data(sc, id, 0x34,
 975                                          (caddr_t)&rx_frame_802_3,
 976                                          sizeof(rx_frame_802_3))) {
 977                                 m_freem(m);
 978                                 ifp->if_ierrors++;
 979                                 return;
 980                         }
 981                         if (rx_frame_802_3.an_rx_802_3_status != 0) {
 982                                 m_freem(m);
 983                                 ifp->if_ierrors++;
 984                                 return;
 985                         }
 986                         /* Check for insane frame length */
 987                         len = rx_frame_802_3.an_rx_802_3_payload_len;
 988                         if (len > sizeof(sc->buf_802_11)) {
 989                                 m_freem(m);
 990                                 if_printf(ifp, "oversized packet "
 991                                        "received (%d, %d)\n",
 992                                        len, MCLBYTES);
 993                                 ifp->if_ierrors++;
 994                                 return;
 995                         }
 996                         m->m_pkthdr.len = m->m_len =
 997                                 rx_frame_802_3.an_rx_802_3_payload_len + 12;
 998
 999                         eh = mtod(m, struct ether_header *);
1000
1001                         bcopy((char *)&rx_frame_802_3.an_rx_dst_addr,
1002                               (char *)&eh->ether_dhost, ETHER_ADDR_LEN);
1003                         bcopy((char *)&rx_frame_802_3.an_rx_src_addr,
1004                               (char *)&eh->ether_shost, ETHER_ADDR_LEN);
1005
1006                         /* in mbuf header type is just before payload */
1007                         error = an_read_data(sc, id, 0x44,
1008                                     (caddr_t)&(eh->ether_type),
1009                                     rx_frame_802_3.an_rx_802_3_payload_len);
1010
1011                         if (error) {
1012                                 m_freem(m);
1013                                 ifp->if_ierrors++;
1014                                 return;
1015                         }
1016                         ifp->if_ipackets++;
1017
1018                         /* Receive packet. */
1019 #ifdef ANCACHE
1020                         an_cache_store(sc, eh, m,
1021                                 rx_frame.an_rx_signal_strength,
1022                                 rx_frame.an_rsvd0);
1023 #endif
1024                         AN_UNLOCK(sc);
1025                         (*ifp->if_input)(ifp, m);
1026                         AN_LOCK(sc);
1027                 }
1028
1029         } else { /* MPI-350 */
1030                 for (count = 0; count < AN_MAX_RX_DESC; count++){
1031                         for (i = 0; i < sizeof(an_rx_desc) / 4; i++)
1032                                 ((u_int32_t *)(void *)&an_rx_desc)[i]
1033                                         = CSR_MEM_AUX_READ_4(sc,
1034                                                 AN_RX_DESC_OFFSET
1035                                                 + (count * sizeof(an_rx_desc))
1036                                                 + (i * 4));
1037
1038                         if (an_rx_desc.an_done && !an_rx_desc.an_valid) {
1039                                 buf = sc->an_rx_buffer[count].an_dma_vaddr;
1040
1041                                 MGETHDR(m, M_NOWAIT, MT_DATA);
1042                                 if (m == NULL) {
1043                                         ifp->if_ierrors++;
1044                                         return;
1045                                 }
1046                                 MCLGET(m, M_NOWAIT);
1047                                 if (!(m->m_flags & M_EXT)) {
1048                                         m_freem(m);
1049                                         ifp->if_ierrors++;
1050                                         return;
1051                                 }
1052                                 m->m_pkthdr.rcvif = ifp;
1053                                 /* Read Ethernet encapsulated packet */
1054
1055                                 /*
1056                                  * No ANCACHE support since we just get back
1057                                  * an Ethernet packet no 802.11 info
1058                                  */
1059 #if 0
1060 #ifdef ANCACHE
1061                                 /* Read NIC frame header */
1062                                 bcopy(buf, (caddr_t)&rx_frame,
1063                                       sizeof(rx_frame));
1064 #endif
1065 #endif
1066                                 /* Check for insane frame length */
1067                                 len = an_rx_desc.an_len + 12;
1068                                 if (len > MCLBYTES) {
1069                                         m_freem(m);
1070                                         if_printf(ifp, "oversized packet "
1071                                                "received (%d, %d)\n",
1072                                                len, MCLBYTES);
1073                                         ifp->if_ierrors++;
1074                                         return;
1075                                 }
1076
1077                                 m->m_pkthdr.len = m->m_len =
1078                                         an_rx_desc.an_len + 12;
1079
1080                                 eh = mtod(m, struct ether_header *);
1081
1082                                 bcopy(buf, (char *)eh,
1083                                       m->m_pkthdr.len);
1084
1085                                 ifp->if_ipackets++;
1086
1087                                 /* Receive packet. */
1088 #if 0
1089 #ifdef ANCACHE
1090                                 an_cache_store(sc, eh, m,
1091                                         rx_frame.an_rx_signal_strength,
1092                                         rx_frame.an_rsvd0);
1093 #endif
1094 #endif
1095                                 AN_UNLOCK(sc);
1096                                 (*ifp->if_input)(ifp, m);
1097                                 AN_LOCK(sc);
1098
1099                                 an_rx_desc.an_valid = 1;
1100                                 an_rx_desc.an_len = AN_RX_BUFFER_SIZE;
1101                                 an_rx_desc.an_done = 0;
1102                                 an_rx_desc.an_phys =
1103                                         sc->an_rx_buffer[count].an_dma_paddr;
1104
1105                                 for (i = 0; i < sizeof(an_rx_desc) / 4; i++)
1106                                         CSR_MEM_AUX_WRITE_4(sc,
1107                                             AN_RX_DESC_OFFSET
1108                                             + (count * sizeof(an_rx_desc))
1109                                             + (i * 4),
1110                                             ((u_int32_t *)(void *)&an_rx_desc)[i]);
1111
1112                         } else {
1113                                 if_printf(ifp, "Didn't get valid RX packet "
1114                                        "%x %x %d\n",
1115                                        an_rx_desc.an_done,
1116                                        an_rx_desc.an_valid, an_rx_desc.an_len);
1117                         }
1118                 }
1119         }
1120 }
1121
1122 static void
1123 an_txeof(struct an_softc *sc, int status)
1124 {
1125         struct ifnet            *ifp;
1126         int                     id, i;
1127
1128         AN_LOCK_ASSERT(sc);
1129         ifp = sc->an_ifp;
1130
1131         sc->an_timer = 0;
1132         ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1133
1134         if (!sc->mpi350) {
1135                 id = CSR_READ_2(sc, AN_TX_CMP_FID(sc->mpi350));
1136
1137                 if (status & AN_EV_TX_EXC) {
1138                         ifp->if_oerrors++;
1139                 } else
1140                         ifp->if_opackets++;
1141
1142                 for (i = 0; i < AN_TX_RING_CNT; i++) {
1143                         if (id == sc->an_rdata.an_tx_ring[i]) {
1144                                 sc->an_rdata.an_tx_ring[i] = 0;
1145                                 break;
1146                         }
1147                 }
1148
1149                 AN_INC(sc->an_rdata.an_tx_cons, AN_TX_RING_CNT);
1150         } else { /* MPI 350 */
1151                 id = CSR_READ_2(sc, AN_TX_CMP_FID(sc->mpi350));
1152                 if (!sc->an_rdata.an_tx_empty){
1153                         if (status & AN_EV_TX_EXC) {
1154                                 ifp->if_oerrors++;
1155                         } else
1156                                 ifp->if_opackets++;
1157                         AN_INC(sc->an_rdata.an_tx_cons, AN_MAX_TX_DESC);
1158                         if (sc->an_rdata.an_tx_prod ==
1159                             sc->an_rdata.an_tx_cons)
1160                                 sc->an_rdata.an_tx_empty = 1;
1161                 }
1162         }
1163
1164         return;
1165 }
1166
1167 /*
1168  * We abuse the stats updater to check the current NIC status. This
1169  * is important because we don't want to allow transmissions until
1170  * the NIC has synchronized to the current cell (either as the master
1171  * in an ad-hoc group, or as a station connected to an access point).
1172  *
1173  * Note that this function will be called via callout(9) with a lock held.
1174  */
1175 static void
1176 an_stats_update(void *xsc)
1177 {
1178         struct an_softc         *sc;
1179         struct ifnet            *ifp;
1180
1181         sc = xsc;
1182         AN_LOCK_ASSERT(sc);
1183         ifp = sc->an_ifp;
1184         if (sc->an_timer > 0 && --sc->an_timer == 0)
1185                 an_watchdog(sc);
1186
1187         sc->an_status.an_type = AN_RID_STATUS;
1188         sc->an_status.an_len = sizeof(struct an_ltv_status);
1189         if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_status))
1190                 return;
1191
1192         if (sc->an_status.an_opmode & AN_STATUS_OPMODE_IN_SYNC)
1193                 sc->an_associated = 1;
1194         else
1195                 sc->an_associated = 0;
1196
1197         /* Don't do this while we're transmitting */
1198         if (ifp->if_drv_flags & IFF_DRV_OACTIVE) {
1199                 callout_reset(&sc->an_stat_ch, hz, an_stats_update, sc);
1200                 return;
1201         }
1202
1203         sc->an_stats.an_len = sizeof(struct an_ltv_stats);
1204         sc->an_stats.an_type = AN_RID_32BITS_CUM;
1205         if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_stats.an_len))
1206                 return;
1207
1208         callout_reset(&sc->an_stat_ch, hz, an_stats_update, sc);
1209
1210         return;
1211 }
1212
1213 void
1214 an_intr(void *xsc)
1215 {
1216         struct an_softc         *sc;
1217         struct ifnet            *ifp;
1218         u_int16_t               status;
1219
1220         sc = (struct an_softc*)xsc;
1221
1222         AN_LOCK(sc);
1223
1224         if (sc->an_gone) {
1225                 AN_UNLOCK(sc);
1226                 return;
1227         }
1228
1229         ifp = sc->an_ifp;
1230
1231         /* Disable interrupts. */
1232         CSR_WRITE_2(sc, AN_INT_EN(sc->mpi350), 0);
1233
1234         status = CSR_READ_2(sc, AN_EVENT_STAT(sc->mpi350));
1235         CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), ~AN_INTRS(sc->mpi350));
1236
1237         if (status & AN_EV_MIC) {
1238                 CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_MIC);
1239         }
1240
1241         if (status & AN_EV_LINKSTAT) {
1242                 if (CSR_READ_2(sc, AN_LINKSTAT(sc->mpi350))
1243                     == AN_LINKSTAT_ASSOCIATED)
1244                         sc->an_associated = 1;
1245                 else
1246                         sc->an_associated = 0;
1247                 CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_LINKSTAT);
1248         }
1249
1250         if (status & AN_EV_RX) {
1251                 an_rxeof(sc);
1252                 CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_RX);
1253         }
1254
1255         if (sc->mpi350 && status & AN_EV_TX_CPY) {
1256                 an_txeof(sc, status);
1257                 CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_TX_CPY);
1258         }
1259
1260         if (status & AN_EV_TX) {
1261                 an_txeof(sc, status);
1262                 CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_TX);
1263         }
1264
1265         if (status & AN_EV_TX_EXC) {
1266                 an_txeof(sc, status);
1267                 CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_TX_EXC);
1268         }
1269
1270         if (status & AN_EV_ALLOC)
1271                 CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_ALLOC);
1272
1273         /* Re-enable interrupts. */
1274         CSR_WRITE_2(sc, AN_INT_EN(sc->mpi350), AN_INTRS(sc->mpi350));
1275
1276         if ((ifp->if_flags & IFF_UP) && !IFQ_DRV_IS_EMPTY(&ifp->if_snd))
1277                 an_start_locked(ifp);
1278
1279         AN_UNLOCK(sc);
1280
1281         return;
1282 }
1283
1284
1285 static int
1286 an_cmd_struct(struct an_softc *sc, struct an_command *cmd,
1287     struct an_reply *reply)
1288 {
1289         int                     i;
1290
1291         AN_LOCK_ASSERT(sc);
1292         for (i = 0; i != AN_TIMEOUT; i++) {
1293                 if (CSR_READ_2(sc, AN_COMMAND(sc->mpi350)) & AN_CMD_BUSY) {
1294                         DELAY(1000);
1295                 } else
1296                         break;
1297         }
1298
1299         if( i == AN_TIMEOUT) {
1300                 printf("BUSY\n");
1301                 return(ETIMEDOUT);
1302         }
1303
1304         CSR_WRITE_2(sc, AN_PARAM0(sc->mpi350), cmd->an_parm0);
1305         CSR_WRITE_2(sc, AN_PARAM1(sc->mpi350), cmd->an_parm1);
1306         CSR_WRITE_2(sc, AN_PARAM2(sc->mpi350), cmd->an_parm2);
1307         CSR_WRITE_2(sc, AN_COMMAND(sc->mpi350), cmd->an_cmd);
1308
1309         for (i = 0; i < AN_TIMEOUT; i++) {
1310                 if (CSR_READ_2(sc, AN_EVENT_STAT(sc->mpi350)) & AN_EV_CMD)
1311                         break;
1312                 DELAY(1000);
1313         }
1314
1315         reply->an_resp0 = CSR_READ_2(sc, AN_RESP0(sc->mpi350));
1316         reply->an_resp1 = CSR_READ_2(sc, AN_RESP1(sc->mpi350));
1317         reply->an_resp2 = CSR_READ_2(sc, AN_RESP2(sc->mpi350));
1318         reply->an_status = CSR_READ_2(sc, AN_STATUS(sc->mpi350));
1319
1320         if (CSR_READ_2(sc, AN_COMMAND(sc->mpi350)) & AN_CMD_BUSY)
1321                 CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350),
1322                     AN_EV_CLR_STUCK_BUSY);
1323
1324         /* Ack the command */
1325         CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_CMD);
1326
1327         if (i == AN_TIMEOUT)
1328                 return(ETIMEDOUT);
1329
1330         return(0);
1331 }
1332
1333 static int
1334 an_cmd(struct an_softc *sc, int cmd, int val)
1335 {
1336         int                     i, s = 0;
1337
1338         AN_LOCK_ASSERT(sc);
1339         CSR_WRITE_2(sc, AN_PARAM0(sc->mpi350), val);
1340         CSR_WRITE_2(sc, AN_PARAM1(sc->mpi350), 0);
1341         CSR_WRITE_2(sc, AN_PARAM2(sc->mpi350), 0);
1342         CSR_WRITE_2(sc, AN_COMMAND(sc->mpi350), cmd);
1343
1344         for (i = 0; i < AN_TIMEOUT; i++) {
1345                 if (CSR_READ_2(sc, AN_EVENT_STAT(sc->mpi350)) & AN_EV_CMD)
1346                         break;
1347                 else {
1348                         if (CSR_READ_2(sc, AN_COMMAND(sc->mpi350)) == cmd)
1349                                 CSR_WRITE_2(sc, AN_COMMAND(sc->mpi350), cmd);
1350                 }
1351         }
1352
1353         for (i = 0; i < AN_TIMEOUT; i++) {
1354                 CSR_READ_2(sc, AN_RESP0(sc->mpi350));
1355                 CSR_READ_2(sc, AN_RESP1(sc->mpi350));
1356                 CSR_READ_2(sc, AN_RESP2(sc->mpi350));
1357                 s = CSR_READ_2(sc, AN_STATUS(sc->mpi350));
1358                 if ((s & AN_STAT_CMD_CODE) == (cmd & AN_STAT_CMD_CODE))
1359                         break;
1360         }
1361
1362         /* Ack the command */
1363         CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_CMD);
1364
1365         if (CSR_READ_2(sc, AN_COMMAND(sc->mpi350)) & AN_CMD_BUSY)
1366                 CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_CLR_STUCK_BUSY);
1367
1368         if (i == AN_TIMEOUT)
1369                 return(ETIMEDOUT);
1370
1371         return(0);
1372 }
1373
1374 /*
1375  * This reset sequence may look a little strange, but this is the
1376  * most reliable method I've found to really kick the NIC in the
1377  * head and force it to reboot correctly.
1378  */
1379 static void
1380 an_reset(struct an_softc *sc)
1381 {
1382         if (sc->an_gone)
1383                 return;
1384
1385         AN_LOCK_ASSERT(sc);
1386         an_cmd(sc, AN_CMD_ENABLE, 0);
1387         an_cmd(sc, AN_CMD_FW_RESTART, 0);
1388         an_cmd(sc, AN_CMD_NOOP2, 0);
1389
1390         if (an_cmd(sc, AN_CMD_FORCE_SYNCLOSS, 0) == ETIMEDOUT)
1391                 if_printf(sc->an_ifp, "reset failed\n");
1392
1393         an_cmd(sc, AN_CMD_DISABLE, 0);
1394
1395         return;
1396 }
1397
1398 /*
1399  * Read an LTV record from the NIC.
1400  */
1401 static int
1402 an_read_record(struct an_softc *sc, struct an_ltv_gen *ltv)
1403 {
1404         struct an_ltv_gen       *an_ltv;
1405         struct an_card_rid_desc an_rid_desc;
1406         struct an_command       cmd;
1407         struct an_reply         reply;
1408         struct ifnet            *ifp;
1409         u_int16_t               *ptr;
1410         u_int8_t                *ptr2;
1411         int                     i, len;
1412
1413         AN_LOCK_ASSERT(sc);
1414         if (ltv->an_len < 4 || ltv->an_type == 0)
1415                 return(EINVAL);
1416
1417         ifp = sc->an_ifp;
1418         if (!sc->mpi350){
1419                 /* Tell the NIC to enter record read mode. */
1420                 if (an_cmd(sc, AN_CMD_ACCESS|AN_ACCESS_READ, ltv->an_type)) {
1421                         if_printf(ifp, "RID access failed\n");
1422                         return(EIO);
1423                 }
1424
1425                 /* Seek to the record. */
1426                 if (an_seek(sc, ltv->an_type, 0, AN_BAP1)) {
1427                         if_printf(ifp, "seek to record failed\n");
1428                         return(EIO);
1429                 }
1430
1431                 /*
1432                  * Read the length and record type and make sure they
1433                  * match what we expect (this verifies that we have enough
1434                  * room to hold all of the returned data).
1435                  * Length includes type but not length.
1436                  */
1437                 len = CSR_READ_2(sc, AN_DATA1);
1438                 if (len > (ltv->an_len - 2)) {
1439                         if_printf(ifp, "record length mismatch -- expected %d, "
1440                                "got %d for Rid %x\n",
1441                                ltv->an_len - 2, len, ltv->an_type);
1442                         len = ltv->an_len - 2;
1443                 } else {
1444                         ltv->an_len = len + 2;
1445                 }
1446
1447                 /* Now read the data. */
1448                 len -= 2;       /* skip the type */
1449                 ptr = &ltv->an_val;
1450                 for (i = len; i > 1; i -= 2)
1451                         *ptr++ = CSR_READ_2(sc, AN_DATA1);
1452                 if (i) {
1453                         ptr2 = (u_int8_t *)ptr;
1454                         *ptr2 = CSR_READ_1(sc, AN_DATA1);
1455                 }
1456         } else { /* MPI-350 */
1457                 if (!sc->an_rid_buffer.an_dma_vaddr)
1458                         return(EIO);
1459                 an_rid_desc.an_valid = 1;
1460                 an_rid_desc.an_len = AN_RID_BUFFER_SIZE;
1461                 an_rid_desc.an_rid = 0;
1462                 an_rid_desc.an_phys = sc->an_rid_buffer.an_dma_paddr;
1463                 bzero(sc->an_rid_buffer.an_dma_vaddr, AN_RID_BUFFER_SIZE);
1464
1465                 bzero(&cmd, sizeof(cmd));
1466                 bzero(&reply, sizeof(reply));
1467                 cmd.an_cmd = AN_CMD_ACCESS|AN_ACCESS_READ;
1468                 cmd.an_parm0 = ltv->an_type;
1469
1470                 for (i = 0; i < sizeof(an_rid_desc) / 4; i++)
1471                         CSR_MEM_AUX_WRITE_4(sc, AN_HOST_DESC_OFFSET + i * 4,
1472                             ((u_int32_t *)(void *)&an_rid_desc)[i]);
1473
1474                 if (an_cmd_struct(sc, &cmd, &reply)
1475                     || reply.an_status & AN_CMD_QUAL_MASK) {
1476                         if_printf(ifp, "failed to read RID %x %x %x %x %x, %d\n",
1477                                ltv->an_type,
1478                                reply.an_status,
1479                                reply.an_resp0,
1480                                reply.an_resp1,
1481                                reply.an_resp2,
1482                                i);
1483                         return(EIO);
1484                 }
1485
1486                 an_ltv = (struct an_ltv_gen *)sc->an_rid_buffer.an_dma_vaddr;
1487                 if (an_ltv->an_len + 2 < an_rid_desc.an_len) {
1488                         an_rid_desc.an_len = an_ltv->an_len;
1489                 }
1490
1491                 len = an_rid_desc.an_len;
1492                 if (len > (ltv->an_len - 2)) {
1493                         if_printf(ifp, "record length mismatch -- expected %d, "
1494                                "got %d for Rid %x\n",
1495                                ltv->an_len - 2, len, ltv->an_type);
1496                         len = ltv->an_len - 2;
1497                 } else {
1498                         ltv->an_len = len + 2;
1499                 }
1500                 bcopy(&an_ltv->an_type,
1501                     &ltv->an_val,
1502                     len);
1503         }
1504
1505         if (an_dump)
1506                 an_dump_record(sc, ltv, "Read");
1507
1508         return(0);
1509 }
1510
1511 /*
1512  * Same as read, except we inject data instead of reading it.
1513  */
1514 static int
1515 an_write_record(struct an_softc *sc, struct an_ltv_gen *ltv)
1516 {
1517         struct an_card_rid_desc an_rid_desc;
1518         struct an_command       cmd;
1519         struct an_reply         reply;
1520         u_int16_t               *ptr;
1521         u_int8_t                *ptr2;
1522         int                     i, len;
1523
1524         AN_LOCK_ASSERT(sc);
1525         if (an_dump)
1526                 an_dump_record(sc, ltv, "Write");
1527
1528         if (!sc->mpi350){
1529                 if (an_cmd(sc, AN_CMD_ACCESS|AN_ACCESS_READ, ltv->an_type))
1530                         return(EIO);
1531
1532                 if (an_seek(sc, ltv->an_type, 0, AN_BAP1))
1533                         return(EIO);
1534
1535                 /*
1536                  * Length includes type but not length.
1537                  */
1538                 len = ltv->an_len - 2;
1539                 CSR_WRITE_2(sc, AN_DATA1, len);
1540
1541                 len -= 2;       /* skip the type */
1542                 ptr = &ltv->an_val;
1543                 for (i = len; i > 1; i -= 2)
1544                         CSR_WRITE_2(sc, AN_DATA1, *ptr++);
1545                 if (i) {
1546                         ptr2 = (u_int8_t *)ptr;
1547                         CSR_WRITE_1(sc, AN_DATA0, *ptr2);
1548                 }
1549
1550                 if (an_cmd(sc, AN_CMD_ACCESS|AN_ACCESS_WRITE, ltv->an_type))
1551                         return(EIO);
1552         } else {
1553                 /* MPI-350 */
1554
1555                 for (i = 0; i != AN_TIMEOUT; i++) {
1556                         if (CSR_READ_2(sc, AN_COMMAND(sc->mpi350))
1557                             & AN_CMD_BUSY) {
1558                                 DELAY(10);
1559                         } else
1560                                 break;
1561                 }
1562                 if (i == AN_TIMEOUT) {
1563                         printf("BUSY\n");
1564                 }
1565
1566                 an_rid_desc.an_valid = 1;
1567                 an_rid_desc.an_len = ltv->an_len - 2;
1568                 an_rid_desc.an_rid = ltv->an_type;
1569                 an_rid_desc.an_phys = sc->an_rid_buffer.an_dma_paddr;
1570
1571                 bcopy(&ltv->an_type, sc->an_rid_buffer.an_dma_vaddr,
1572                       an_rid_desc.an_len);
1573
1574                 bzero(&cmd,sizeof(cmd));
1575                 bzero(&reply,sizeof(reply));
1576                 cmd.an_cmd = AN_CMD_ACCESS|AN_ACCESS_WRITE;
1577                 cmd.an_parm0 = ltv->an_type;
1578
1579                 for (i = 0; i < sizeof(an_rid_desc) / 4; i++)
1580                         CSR_MEM_AUX_WRITE_4(sc, AN_HOST_DESC_OFFSET + i * 4,
1581                             ((u_int32_t *)(void *)&an_rid_desc)[i]);
1582
1583                 DELAY(100000);
1584
1585                 if ((i = an_cmd_struct(sc, &cmd, &reply))) {
1586                         if_printf(sc->an_ifp,
1587                             "failed to write RID 1 %x %x %x %x %x, %d\n",
1588                             ltv->an_type,
1589                             reply.an_status,
1590                             reply.an_resp0,
1591                             reply.an_resp1,
1592                             reply.an_resp2,
1593                             i);
1594                         return(EIO);
1595                 }
1596
1597
1598                 if (reply.an_status & AN_CMD_QUAL_MASK) {
1599                         if_printf(sc->an_ifp,
1600                             "failed to write RID 2 %x %x %x %x %x, %d\n",
1601                             ltv->an_type,
1602                             reply.an_status,
1603                             reply.an_resp0,
1604                             reply.an_resp1,
1605                             reply.an_resp2,
1606                             i);
1607                         return(EIO);
1608                 }
1609                 DELAY(100000);
1610         }
1611
1612         return(0);
1613 }
1614
1615 static void
1616 an_dump_record(struct an_softc *sc, struct an_ltv_gen *ltv, char *string)
1617 {
1618         u_int8_t                *ptr2;
1619         int                     len;
1620         int                     i;
1621         int                     count = 0;
1622         char                    buf[17], temp;
1623
1624         len = ltv->an_len - 4;
1625         if_printf(sc->an_ifp, "RID %4x, Length %4d, Mode %s\n",
1626                 ltv->an_type, ltv->an_len - 4, string);
1627
1628         if (an_dump == 1 || (an_dump == ltv->an_type)) {
1629                 if_printf(sc->an_ifp, "\t");
1630                 bzero(buf,sizeof(buf));
1631
1632                 ptr2 = (u_int8_t *)&ltv->an_val;
1633                 for (i = len; i > 0; i--) {
1634                         printf("%02x ", *ptr2);
1635
1636                         temp = *ptr2++;
1637                         if (isprint(temp))
1638                                 buf[count] = temp;
1639                         else
1640                                 buf[count] = '.';
1641                         if (++count == 16) {
1642                                 count = 0;
1643                                 printf("%s\n",buf);
1644                                 if_printf(sc->an_ifp, "\t");
1645                                 bzero(buf,sizeof(buf));
1646                         }
1647                 }
1648                 for (; count != 16; count++) {
1649                         printf("   ");
1650                 }
1651                 printf(" %s\n",buf);
1652         }
1653 }
1654
1655 static int
1656 an_seek(struct an_softc *sc, int id, int off, int chan)
1657 {
1658         int                     i;
1659         int                     selreg, offreg;
1660
1661         switch (chan) {
1662         case AN_BAP0:
1663                 selreg = AN_SEL0;
1664                 offreg = AN_OFF0;
1665                 break;
1666         case AN_BAP1:
1667                 selreg = AN_SEL1;
1668                 offreg = AN_OFF1;
1669                 break;
1670         default:
1671                 if_printf(sc->an_ifp, "invalid data path: %x\n", chan);
1672                 return(EIO);
1673         }
1674
1675         CSR_WRITE_2(sc, selreg, id);
1676         CSR_WRITE_2(sc, offreg, off);
1677
1678         for (i = 0; i < AN_TIMEOUT; i++) {
1679                 if (!(CSR_READ_2(sc, offreg) & (AN_OFF_BUSY|AN_OFF_ERR)))
1680                         break;
1681         }
1682
1683         if (i == AN_TIMEOUT)
1684                 return(ETIMEDOUT);
1685
1686         return(0);
1687 }
1688
1689 static int
1690 an_read_data(struct an_softc *sc, int id, int off, caddr_t buf, int len)
1691 {
1692         int                     i;
1693         u_int16_t               *ptr;
1694         u_int8_t                *ptr2;
1695
1696         if (off != -1) {
1697                 if (an_seek(sc, id, off, AN_BAP1))
1698                         return(EIO);
1699         }
1700
1701         ptr = (u_int16_t *)buf;
1702         for (i = len; i > 1; i -= 2)
1703                 *ptr++ = CSR_READ_2(sc, AN_DATA1);
1704         if (i) {
1705                 ptr2 = (u_int8_t *)ptr;
1706                 *ptr2 = CSR_READ_1(sc, AN_DATA1);
1707         }
1708
1709         return(0);
1710 }
1711
1712 static int
1713 an_write_data(struct an_softc *sc, int id, int off, caddr_t buf, int len)
1714 {
1715         int                     i;
1716         u_int16_t               *ptr;
1717         u_int8_t                *ptr2;
1718
1719         if (off != -1) {
1720                 if (an_seek(sc, id, off, AN_BAP0))
1721                         return(EIO);
1722         }
1723
1724         ptr = (u_int16_t *)buf;
1725         for (i = len; i > 1; i -= 2)
1726                 CSR_WRITE_2(sc, AN_DATA0, *ptr++);
1727         if (i) {
1728                 ptr2 = (u_int8_t *)ptr;
1729                 CSR_WRITE_1(sc, AN_DATA0, *ptr2);
1730         }
1731
1732         return(0);
1733 }
1734
1735 /*
1736  * Allocate a region of memory inside the NIC and zero
1737  * it out.
1738  */
1739 static int
1740 an_alloc_nicmem(struct an_softc *sc, int len, int *id)
1741 {
1742         int                     i;
1743
1744         if (an_cmd(sc, AN_CMD_ALLOC_MEM, len)) {
1745                 if_printf(sc->an_ifp, "failed to allocate %d bytes on NIC\n",
1746                     len);
1747                 return(ENOMEM);
1748         }
1749
1750         for (i = 0; i < AN_TIMEOUT; i++) {
1751                 if (CSR_READ_2(sc, AN_EVENT_STAT(sc->mpi350)) & AN_EV_ALLOC)
1752                         break;
1753         }
1754
1755         if (i == AN_TIMEOUT)
1756                 return(ETIMEDOUT);
1757
1758         CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_ALLOC);
1759         *id = CSR_READ_2(sc, AN_ALLOC_FID);
1760
1761         if (an_seek(sc, *id, 0, AN_BAP0))
1762                 return(EIO);
1763
1764         for (i = 0; i < len / 2; i++)
1765                 CSR_WRITE_2(sc, AN_DATA0, 0);
1766
1767         return(0);
1768 }
1769
1770 static void
1771 an_setdef(struct an_softc *sc, struct an_req *areq)
1772 {
1773         struct ifnet            *ifp;
1774         struct an_ltv_genconfig *cfg;
1775         struct an_ltv_ssidlist_new      *ssid;
1776         struct an_ltv_aplist    *ap;
1777         struct an_ltv_gen       *sp;
1778
1779         ifp = sc->an_ifp;
1780
1781         AN_LOCK_ASSERT(sc);
1782         switch (areq->an_type) {
1783         case AN_RID_GENCONFIG:
1784                 cfg = (struct an_ltv_genconfig *)areq;
1785
1786                 bcopy((char *)&cfg->an_macaddr, IF_LLADDR(sc->an_ifp),
1787                     ETHER_ADDR_LEN);
1788
1789                 bcopy((char *)cfg, (char *)&sc->an_config,
1790                         sizeof(struct an_ltv_genconfig));
1791                 break;
1792         case AN_RID_SSIDLIST:
1793                 ssid = (struct an_ltv_ssidlist_new *)areq;
1794                 bcopy((char *)ssid, (char *)&sc->an_ssidlist,
1795                         sizeof(struct an_ltv_ssidlist_new));
1796                 break;
1797         case AN_RID_APLIST:
1798                 ap = (struct an_ltv_aplist *)areq;
1799                 bcopy((char *)ap, (char *)&sc->an_aplist,
1800                         sizeof(struct an_ltv_aplist));
1801                 break;
1802         case AN_RID_TX_SPEED:
1803                 sp = (struct an_ltv_gen *)areq;
1804                 sc->an_tx_rate = sp->an_val;
1805
1806                 /* Read the current configuration */
1807                 sc->an_config.an_type = AN_RID_GENCONFIG;
1808                 sc->an_config.an_len = sizeof(struct an_ltv_genconfig);
1809                 an_read_record(sc, (struct an_ltv_gen *)&sc->an_config);
1810                 cfg = &sc->an_config;
1811
1812                 /* clear other rates and set the only one we want */
1813                 bzero(cfg->an_rates, sizeof(cfg->an_rates));
1814                 cfg->an_rates[0] = sc->an_tx_rate;
1815
1816                 /* Save the new rate */
1817                 sc->an_config.an_type = AN_RID_GENCONFIG;
1818                 sc->an_config.an_len = sizeof(struct an_ltv_genconfig);
1819                 break;
1820         case AN_RID_WEP_TEMP:
1821                 /* Cache the temp keys */
1822                 bcopy(areq,
1823                     &sc->an_temp_keys[((struct an_ltv_key *)areq)->kindex],
1824                     sizeof(struct an_ltv_key));
1825         case AN_RID_WEP_PERM:
1826         case AN_RID_LEAPUSERNAME:
1827         case AN_RID_LEAPPASSWORD:
1828                 an_init_locked(sc);
1829
1830                 /* Disable the MAC. */
1831                 an_cmd(sc, AN_CMD_DISABLE, 0);
1832
1833                 /* Write the key */
1834                 an_write_record(sc, (struct an_ltv_gen *)areq);
1835
1836                 /* Turn the MAC back on. */
1837                 an_cmd(sc, AN_CMD_ENABLE, 0);
1838
1839                 break;
1840         case AN_RID_MONITOR_MODE:
1841                 cfg = (struct an_ltv_genconfig *)areq;
1842                 bpfdetach(ifp);
1843                 if (ng_ether_detach_p != NULL)
1844                         (*ng_ether_detach_p) (ifp);
1845                 sc->an_monitor = cfg->an_len;
1846
1847                 if (sc->an_monitor & AN_MONITOR) {
1848                         if (sc->an_monitor & AN_MONITOR_AIRONET_HEADER) {
1849                                 bpfattach(ifp, DLT_AIRONET_HEADER,
1850                                         sizeof(struct ether_header));
1851                         } else {
1852                                 bpfattach(ifp, DLT_IEEE802_11,
1853                                         sizeof(struct ether_header));
1854                         }
1855                 } else {
1856                         bpfattach(ifp, DLT_EN10MB,
1857                                   sizeof(struct ether_header));
1858                         if (ng_ether_attach_p != NULL)
1859                                 (*ng_ether_attach_p) (ifp);
1860                 }
1861                 break;
1862         default:
1863                 if_printf(ifp, "unknown RID: %x\n", areq->an_type);
1864                 return;
1865         }
1866
1867
1868         /* Reinitialize the card. */
1869         if (ifp->if_flags)
1870                 an_init_locked(sc);
1871
1872         return;
1873 }
1874
1875 /*
1876  * Derived from Linux driver to enable promiscious mode.
1877  */
1878
1879 static void
1880 an_promisc(struct an_softc *sc, int promisc)
1881 {
1882         AN_LOCK_ASSERT(sc);
1883         if (sc->an_was_monitor) {
1884                 an_reset(sc);
1885                 if (sc->mpi350)
1886                         an_init_mpi350_desc(sc);
1887         }
1888         if (sc->an_monitor || sc->an_was_monitor)
1889                 an_init_locked(sc);
1890
1891         sc->an_was_monitor = sc->an_monitor;
1892         an_cmd(sc, AN_CMD_SET_MODE, promisc ? 0xffff : 0);
1893
1894         return;
1895 }
1896
1897 static int
1898 an_ioctl(struct ifnet *ifp, u_long command, caddr_t data)
1899 {
1900         int                     error = 0;
1901         int                     len;
1902         int                     i, max;
1903         struct an_softc         *sc;
1904         struct ifreq            *ifr;
1905         struct thread           *td = curthread;
1906         struct ieee80211req     *ireq;
1907         struct ieee80211_channel        ch;
1908         u_int8_t                tmpstr[IEEE80211_NWID_LEN*2];
1909         u_int8_t                *tmpptr;
1910         struct an_ltv_genconfig *config;
1911         struct an_ltv_key       *key;
1912         struct an_ltv_status    *status;
1913         struct an_ltv_ssidlist_new      *ssids;
1914         int                     mode;
1915         struct aironet_ioctl    l_ioctl;
1916
1917         sc = ifp->if_softc;
1918         ifr = (struct ifreq *)data;
1919         ireq = (struct ieee80211req *)data;
1920
1921         config = (struct an_ltv_genconfig *)&sc->areq;
1922         key = (struct an_ltv_key *)&sc->areq;
1923         status = (struct an_ltv_status *)&sc->areq;
1924         ssids = (struct an_ltv_ssidlist_new *)&sc->areq;
1925
1926         if (sc->an_gone) {
1927                 error = ENODEV;
1928                 goto out;
1929         }
1930
1931         switch (command) {
1932         case SIOCSIFFLAGS:
1933                 AN_LOCK(sc);
1934                 if (ifp->if_flags & IFF_UP) {
1935                         if (ifp->if_drv_flags & IFF_DRV_RUNNING &&
1936                             ifp->if_flags & IFF_PROMISC &&
1937                             !(sc->an_if_flags & IFF_PROMISC)) {
1938                                 an_promisc(sc, 1);
1939                         } else if (ifp->if_drv_flags & IFF_DRV_RUNNING &&
1940                             !(ifp->if_flags & IFF_PROMISC) &&
1941                             sc->an_if_flags & IFF_PROMISC) {
1942                                 an_promisc(sc, 0);
1943                         } else
1944                                 an_init_locked(sc);
1945                 } else {
1946                         if (ifp->if_drv_flags & IFF_DRV_RUNNING)
1947                                 an_stop(sc);
1948                 }
1949                 sc->an_if_flags = ifp->if_flags;
1950                 AN_UNLOCK(sc);
1951                 error = 0;
1952                 break;
1953         case SIOCSIFMEDIA:
1954         case SIOCGIFMEDIA:
1955                 error = ifmedia_ioctl(ifp, ifr, &sc->an_ifmedia, command);
1956                 break;
1957         case SIOCADDMULTI:
1958         case SIOCDELMULTI:
1959                 /* The Aironet has no multicast filter. */
1960                 error = 0;
1961                 break;
1962         case SIOCGAIRONET:
1963                 error = copyin(ifr->ifr_data, &sc->areq, sizeof(sc->areq));
1964                 if (error != 0)
1965                         break;
1966                 AN_LOCK(sc);
1967 #ifdef ANCACHE
1968                 if (sc->areq.an_type == AN_RID_ZERO_CACHE) {
1969                         error = priv_check(td, PRIV_DRIVER);
1970                         if (error)
1971                                 break;
1972                         sc->an_sigitems = sc->an_nextitem = 0;
1973                         break;
1974                 } else if (sc->areq.an_type == AN_RID_READ_CACHE) {
1975                         char *pt = (char *)&sc->areq.an_val;
1976                         bcopy((char *)&sc->an_sigitems, (char *)pt,
1977                             sizeof(int));
1978                         pt += sizeof(int);
1979                         sc->areq.an_len = sizeof(int) / 2;
1980                         bcopy((char *)&sc->an_sigcache, (char *)pt,
1981                             sizeof(struct an_sigcache) * sc->an_sigitems);
1982                         sc->areq.an_len += ((sizeof(struct an_sigcache) *
1983                             sc->an_sigitems) / 2) + 1;
1984                 } else
1985 #endif
1986                 if (an_read_record(sc, (struct an_ltv_gen *)&sc->areq)) {
1987                         AN_UNLOCK(sc);
1988                         error = EINVAL;
1989                         break;
1990                 }
1991                 AN_UNLOCK(sc);
1992                 error = copyout(&sc->areq, ifr->ifr_data, sizeof(sc->areq));
1993                 break;
1994         case SIOCSAIRONET:
1995                 if ((error = priv_check(td, PRIV_DRIVER)))
1996                         goto out;
1997                 AN_LOCK(sc);
1998                 error = copyin(ifr->ifr_data, &sc->areq, sizeof(sc->areq));
1999                 if (error != 0)
2000                         break;
2001                 an_setdef(sc, &sc->areq);
2002                 AN_UNLOCK(sc);
2003                 break;
2004         case SIOCGPRIVATE_0:            /* used by Cisco client utility */
2005                 if ((error = priv_check(td, PRIV_DRIVER)))
2006                         goto out;
2007                 error = copyin(ifr->ifr_data, &l_ioctl, sizeof(l_ioctl));
2008                 if (error)
2009                         goto out;
2010                 mode = l_ioctl.command;
2011
2012                 AN_LOCK(sc);
2013                 if (mode >= AIROGCAP && mode <= AIROGSTATSD32) {
2014                         error = readrids(ifp, &l_ioctl);
2015                 } else if (mode >= AIROPCAP && mode <= AIROPLEAPUSR) {
2016                         error = writerids(ifp, &l_ioctl);
2017                 } else if (mode >= AIROFLSHRST && mode <= AIRORESTART) {
2018                         error = flashcard(ifp, &l_ioctl);
2019                 } else {
2020                         error =-1;
2021                 }
2022                 AN_UNLOCK(sc);
2023                 if (!error) {
2024                         /* copy out the updated command info */
2025                         error = copyout(&l_ioctl, ifr->ifr_data, sizeof(l_ioctl));
2026                 }
2027                 break;
2028         case SIOCGPRIVATE_1:            /* used by Cisco client utility */
2029                 if ((error = priv_check(td, PRIV_DRIVER)))
2030                         goto out;
2031                 error = copyin(ifr->ifr_data, &l_ioctl, sizeof(l_ioctl));
2032                 if (error)
2033                         goto out;
2034                 l_ioctl.command = 0;
2035                 error = AIROMAGIC;
2036                 (void) copyout(&error, l_ioctl.data, sizeof(error));
2037                 error = 0;
2038                 break;
2039         case SIOCG80211:
2040                 sc->areq.an_len = sizeof(sc->areq);
2041                 /* was that a good idea DJA we are doing a short-cut */
2042                 switch (ireq->i_type) {
2043                 case IEEE80211_IOC_SSID:
2044                         AN_LOCK(sc);
2045                         if (ireq->i_val == -1) {
2046                                 sc->areq.an_type = AN_RID_STATUS;
2047                                 if (an_read_record(sc,
2048                                     (struct an_ltv_gen *)&sc->areq)) {
2049                                         error = EINVAL;
2050                                         AN_UNLOCK(sc);
2051                                         break;
2052                                 }
2053                                 len = status->an_ssidlen;
2054                                 tmpptr = status->an_ssid;
2055                         } else if (ireq->i_val >= 0) {
2056                                 sc->areq.an_type = AN_RID_SSIDLIST;
2057                                 if (an_read_record(sc,
2058                                     (struct an_ltv_gen *)&sc->areq)) {
2059                                         error = EINVAL;
2060                                         AN_UNLOCK(sc);
2061                                         break;
2062                                 }
2063                                 max = (sc->areq.an_len - 4)
2064                                     / sizeof(struct an_ltv_ssid_entry);
2065                                 if ( max > MAX_SSIDS ) {
2066                                         printf("To many SSIDs only using "
2067                                             "%d of %d\n",
2068                                             MAX_SSIDS, max);
2069                                         max = MAX_SSIDS;
2070                                 }
2071                                 if (ireq->i_val > max) {
2072                                         error = EINVAL;
2073                                         AN_UNLOCK(sc);
2074                                         break;
2075                                 } else {
2076                                         len = ssids->an_entry[ireq->i_val].an_len;
2077                                         tmpptr = ssids->an_entry[ireq->i_val].an_ssid;
2078                                 }
2079                         } else {
2080                                 error = EINVAL;
2081                                 AN_UNLOCK(sc);
2082                                 break;
2083                         }
2084                         if (len > IEEE80211_NWID_LEN) {
2085                                 error = EINVAL;
2086                                 AN_UNLOCK(sc);
2087                                 break;
2088                         }
2089                         AN_UNLOCK(sc);
2090                         ireq->i_len = len;
2091                         bzero(tmpstr, IEEE80211_NWID_LEN);
2092                         bcopy(tmpptr, tmpstr, len);
2093                         error = copyout(tmpstr, ireq->i_data,
2094                             IEEE80211_NWID_LEN);
2095                         break;
2096                 case IEEE80211_IOC_NUMSSIDS:
2097                         AN_LOCK(sc);
2098                         sc->areq.an_len = sizeof(sc->areq);
2099                         sc->areq.an_type = AN_RID_SSIDLIST;
2100                         if (an_read_record(sc,
2101                             (struct an_ltv_gen *)&sc->areq)) {
2102                                 AN_UNLOCK(sc);
2103                                 error = EINVAL;
2104                                 break;
2105                         }
2106                         max = (sc->areq.an_len - 4)
2107                             / sizeof(struct an_ltv_ssid_entry);
2108                         AN_UNLOCK(sc);
2109                         if ( max > MAX_SSIDS ) {
2110                                 printf("To many SSIDs only using "
2111                                     "%d of %d\n",
2112                                     MAX_SSIDS, max);
2113                                 max = MAX_SSIDS;
2114                         }
2115                         ireq->i_val = max;
2116                         break;
2117                 case IEEE80211_IOC_WEP:
2118                         AN_LOCK(sc);
2119                         sc->areq.an_type = AN_RID_ACTUALCFG;
2120                         if (an_read_record(sc,
2121                             (struct an_ltv_gen *)&sc->areq)) {
2122                                 error = EINVAL;
2123                                 AN_UNLOCK(sc);
2124                                 break;
2125                         }
2126                         AN_UNLOCK(sc);
2127                         if (config->an_authtype & AN_AUTHTYPE_PRIVACY_IN_USE) {
2128                                 if (config->an_authtype &
2129                                     AN_AUTHTYPE_ALLOW_UNENCRYPTED)
2130                                         ireq->i_val = IEEE80211_WEP_MIXED;
2131                                 else
2132                                         ireq->i_val = IEEE80211_WEP_ON;
2133                         } else {
2134                                 ireq->i_val = IEEE80211_WEP_OFF;
2135                         }
2136                         break;
2137                 case IEEE80211_IOC_WEPKEY:
2138                         /*
2139                          * XXX: I'm not entierly convinced this is
2140                          * correct, but it's what is implemented in
2141                          * ancontrol so it will have to do until we get
2142                          * access to actual Cisco code.
2143                          */
2144                         if (ireq->i_val < 0 || ireq->i_val > 8) {
2145                                 error = EINVAL;
2146                                 break;
2147                         }
2148                         len = 0;
2149                         if (ireq->i_val < 5) {
2150                                 AN_LOCK(sc);
2151                                 sc->areq.an_type = AN_RID_WEP_TEMP;
2152                                 for (i = 0; i < 5; i++) {
2153                                         if (an_read_record(sc,
2154                                             (struct an_ltv_gen *)&sc->areq)) {
2155                                                 error = EINVAL;
2156                                                 break;
2157                                         }
2158                                         if (key->kindex == 0xffff)
2159                                                 break;
2160                                         if (key->kindex == ireq->i_val)
2161                                                 len = key->klen;
2162                                         /* Required to get next entry */
2163                                         sc->areq.an_type = AN_RID_WEP_PERM;
2164                                 }
2165                                 AN_UNLOCK(sc);
2166                                 if (error != 0) {
2167                                         break;
2168                                 }
2169                         }
2170                         /* We aren't allowed to read the value of the
2171                          * key from the card so we just output zeros
2172                          * like we would if we could read the card, but
2173                          * denied the user access.
2174                          */
2175                         bzero(tmpstr, len);
2176                         ireq->i_len = len;
2177                         error = copyout(tmpstr, ireq->i_data, len);
2178                         break;
2179                 case IEEE80211_IOC_NUMWEPKEYS:
2180                         ireq->i_val = 9; /* include home key */
2181                         break;
2182                 case IEEE80211_IOC_WEPTXKEY:
2183                         /*
2184                          * For some strange reason, you have to read all
2185                          * keys before you can read the txkey.
2186                          */
2187                         AN_LOCK(sc);
2188                         sc->areq.an_type = AN_RID_WEP_TEMP;
2189                         for (i = 0; i < 5; i++) {
2190                                 if (an_read_record(sc,
2191                                     (struct an_ltv_gen *) &sc->areq)) {
2192                                         error = EINVAL;
2193                                         break;
2194                                 }
2195                                 if (key->kindex == 0xffff) {
2196                                         break;
2197                                 }
2198                                 /* Required to get next entry */
2199                                 sc->areq.an_type = AN_RID_WEP_PERM;
2200                         }
2201                         if (error != 0) {
2202                                 AN_UNLOCK(sc);
2203                                 break;
2204                         }
2205
2206                         sc->areq.an_type = AN_RID_WEP_PERM;
2207                         key->kindex = 0xffff;
2208                         if (an_read_record(sc,
2209                             (struct an_ltv_gen *)&sc->areq)) {
2210                                 error = EINVAL;
2211                                 AN_UNLOCK(sc);
2212                                 break;
2213                         }
2214                         ireq->i_val = key->mac[0];
2215                         /*
2216                          * Check for home mode.  Map home mode into
2217                          * 5th key since that is how it is stored on
2218                          * the card
2219                          */
2220                         sc->areq.an_len  = sizeof(struct an_ltv_genconfig);
2221                         sc->areq.an_type = AN_RID_GENCONFIG;
2222                         if (an_read_record(sc,
2223                             (struct an_ltv_gen *)&sc->areq)) {
2224                                 error = EINVAL;
2225                                 AN_UNLOCK(sc);
2226                                 break;
2227                         }
2228                         if (config->an_home_product & AN_HOME_NETWORK)
2229                                 ireq->i_val = 4;
2230                         AN_UNLOCK(sc);
2231                         break;
2232                 case IEEE80211_IOC_AUTHMODE:
2233                         AN_LOCK(sc);
2234                         sc->areq.an_type = AN_RID_ACTUALCFG;
2235                         if (an_read_record(sc,
2236                             (struct an_ltv_gen *)&sc->areq)) {
2237                                 error = EINVAL;
2238                                 AN_UNLOCK(sc);
2239                                 break;
2240                         }
2241                         AN_UNLOCK(sc);
2242                         if ((config->an_authtype & AN_AUTHTYPE_MASK) ==
2243                             AN_AUTHTYPE_NONE) {
2244                             ireq->i_val = IEEE80211_AUTH_NONE;
2245                         } else if ((config->an_authtype & AN_AUTHTYPE_MASK) ==
2246                             AN_AUTHTYPE_OPEN) {
2247                             ireq->i_val = IEEE80211_AUTH_OPEN;
2248                         } else if ((config->an_authtype & AN_AUTHTYPE_MASK) ==
2249                             AN_AUTHTYPE_SHAREDKEY) {
2250                             ireq->i_val = IEEE80211_AUTH_SHARED;
2251                         } else
2252                                 error = EINVAL;
2253                         break;
2254                 case IEEE80211_IOC_STATIONNAME:
2255                         AN_LOCK(sc);
2256                         sc->areq.an_type = AN_RID_ACTUALCFG;
2257                         if (an_read_record(sc,
2258                             (struct an_ltv_gen *)&sc->areq)) {
2259                                 error = EINVAL;
2260                                 AN_UNLOCK(sc);
2261                                 break;
2262                         }
2263                         AN_UNLOCK(sc);
2264                         ireq->i_len = sizeof(config->an_nodename);
2265                         tmpptr = config->an_nodename;
2266                         bzero(tmpstr, IEEE80211_NWID_LEN);
2267                         bcopy(tmpptr, tmpstr, ireq->i_len);
2268                         error = copyout(tmpstr, ireq->i_data,
2269                             IEEE80211_NWID_LEN);
2270                         break;
2271                 case IEEE80211_IOC_CHANNEL:
2272                         AN_LOCK(sc);
2273                         sc->areq.an_type = AN_RID_STATUS;
2274                         if (an_read_record(sc,
2275                             (struct an_ltv_gen *)&sc->areq)) {
2276                                 error = EINVAL;
2277                                 AN_UNLOCK(sc);
2278                                 break;
2279                         }
2280                         AN_UNLOCK(sc);
2281                         ireq->i_val = status->an_cur_channel;
2282                         break;
2283                 case IEEE80211_IOC_CURCHAN:
2284                         AN_LOCK(sc);
2285                         sc->areq.an_type = AN_RID_STATUS;
2286                         if (an_read_record(sc,
2287                             (struct an_ltv_gen *)&sc->areq)) {
2288                                 error = EINVAL;
2289                                 AN_UNLOCK(sc);
2290                                 break;
2291                         }
2292                         AN_UNLOCK(sc);
2293                         bzero(&ch, sizeof(ch));
2294                         ch.ic_freq = ieee80211_ieee2mhz(status->an_cur_channel,
2295                             IEEE80211_CHAN_B);
2296                         ch.ic_flags = IEEE80211_CHAN_B;
2297                         ch.ic_ieee = status->an_cur_channel;
2298                         error = copyout(&ch, ireq->i_data, sizeof(ch));
2299                         break;
2300                 case IEEE80211_IOC_POWERSAVE:
2301                         AN_LOCK(sc);
2302                         sc->areq.an_type = AN_RID_ACTUALCFG;
2303                         if (an_read_record(sc,
2304                             (struct an_ltv_gen *)&sc->areq)) {
2305                                 error = EINVAL;
2306                                 AN_UNLOCK(sc);
2307                                 break;
2308                         }
2309                         AN_UNLOCK(sc);
2310                         if (config->an_psave_mode == AN_PSAVE_NONE) {
2311                                 ireq->i_val = IEEE80211_POWERSAVE_OFF;
2312                         } else if (config->an_psave_mode == AN_PSAVE_CAM) {
2313                                 ireq->i_val = IEEE80211_POWERSAVE_CAM;
2314                         } else if (config->an_psave_mode == AN_PSAVE_PSP) {
2315                                 ireq->i_val = IEEE80211_POWERSAVE_PSP;
2316                         } else if (config->an_psave_mode == AN_PSAVE_PSP_CAM) {
2317                                 ireq->i_val = IEEE80211_POWERSAVE_PSP_CAM;
2318                         } else
2319                                 error = EINVAL;
2320                         break;
2321                 case IEEE80211_IOC_POWERSAVESLEEP:
2322                         AN_LOCK(sc);
2323                         sc->areq.an_type = AN_RID_ACTUALCFG;
2324                         if (an_read_record(sc,
2325                             (struct an_ltv_gen *)&sc->areq)) {
2326                                 error = EINVAL;
2327                                 AN_UNLOCK(sc);
2328                                 break;
2329                         }
2330                         AN_UNLOCK(sc);
2331                         ireq->i_val = config->an_listen_interval;
2332                         break;
2333                 }
2334                 break;
2335         case SIOCS80211:
2336                 if ((error = priv_check(td, PRIV_NET80211_MANAGE)))
2337                         goto out;
2338                 AN_LOCK(sc);
2339                 sc->areq.an_len = sizeof(sc->areq);
2340                 /*
2341                  * We need a config structure for everything but the WEP
2342                  * key management and SSIDs so we get it now so avoid
2343                  * duplicating this code every time.
2344                  */
2345                 if (ireq->i_type != IEEE80211_IOC_SSID &&
2346                     ireq->i_type != IEEE80211_IOC_WEPKEY &&
2347                     ireq->i_type != IEEE80211_IOC_WEPTXKEY) {
2348                         sc->areq.an_type = AN_RID_GENCONFIG;
2349                         if (an_read_record(sc,
2350                             (struct an_ltv_gen *)&sc->areq)) {
2351                                 error = EINVAL;
2352                                 AN_UNLOCK(sc);
2353                                 break;
2354                         }
2355                 }
2356                 switch (ireq->i_type) {
2357                 case IEEE80211_IOC_SSID:
2358                         sc->areq.an_len = sizeof(sc->areq);
2359                         sc->areq.an_type = AN_RID_SSIDLIST;
2360                         if (an_read_record(sc,
2361                             (struct an_ltv_gen *)&sc->areq)) {
2362                                 error = EINVAL;
2363                                 AN_UNLOCK(sc);
2364                                 break;
2365                         }
2366                         if (ireq->i_len > IEEE80211_NWID_LEN) {
2367                                 error = EINVAL;
2368                                 AN_UNLOCK(sc);
2369                                 break;
2370                         }
2371                         max = (sc->areq.an_len - 4)
2372                             / sizeof(struct an_ltv_ssid_entry);
2373                         if ( max > MAX_SSIDS ) {
2374                                 printf("To many SSIDs only using "
2375                                     "%d of %d\n",
2376                                     MAX_SSIDS, max);
2377                                 max = MAX_SSIDS;
2378                         }
2379                         if (ireq->i_val > max) {
2380                                 error = EINVAL;
2381                                 AN_UNLOCK(sc);
2382                                 break;
2383                         } else {
2384                                 error = copyin(ireq->i_data,
2385                                     ssids->an_entry[ireq->i_val].an_ssid,
2386                                     ireq->i_len);
2387                                 ssids->an_entry[ireq->i_val].an_len
2388                                     = ireq->i_len;
2389                                 sc->areq.an_len = sizeof(sc->areq);
2390                                 sc->areq.an_type = AN_RID_SSIDLIST;
2391                                 an_setdef(sc, &sc->areq);
2392                                 AN_UNLOCK(sc);
2393                                 break;
2394                         }
2395                         break;
2396                 case IEEE80211_IOC_WEP:
2397                         switch (ireq->i_val) {
2398                         case IEEE80211_WEP_OFF:
2399                                 config->an_authtype &=
2400                                     ~(AN_AUTHTYPE_PRIVACY_IN_USE |
2401                                     AN_AUTHTYPE_ALLOW_UNENCRYPTED);
2402                                 break;
2403                         case IEEE80211_WEP_ON:
2404                                 config->an_authtype |=
2405                                     AN_AUTHTYPE_PRIVACY_IN_USE;
2406                                 config->an_authtype &=
2407                                     ~AN_AUTHTYPE_ALLOW_UNENCRYPTED;
2408                                 break;
2409                         case IEEE80211_WEP_MIXED:
2410                                 config->an_authtype |=
2411                                     AN_AUTHTYPE_PRIVACY_IN_USE |
2412                                     AN_AUTHTYPE_ALLOW_UNENCRYPTED;
2413                                 break;
2414                         default:
2415                                 error = EINVAL;
2416                                 break;
2417                         }
2418                         if (error != EINVAL)
2419                                 an_setdef(sc, &sc->areq);
2420                         AN_UNLOCK(sc);
2421                         break;
2422                 case IEEE80211_IOC_WEPKEY:
2423                         if (ireq->i_val < 0 || ireq->i_val > 8 ||
2424                             ireq->i_len > 13) {
2425                                 error = EINVAL;
2426                                 AN_UNLOCK(sc);
2427                                 break;
2428                         }
2429                         error = copyin(ireq->i_data, tmpstr, 13);
2430                         if (error != 0) {
2431                                 AN_UNLOCK(sc);
2432                                 break;
2433                         }
2434                         /*
2435                          * Map the 9th key into the home mode
2436                          * since that is how it is stored on
2437                          * the card
2438                          */
2439                         bzero(&sc->areq, sizeof(struct an_ltv_key));
2440                         sc->areq.an_len = sizeof(struct an_ltv_key);
2441                         key->mac[0] = 1;        /* The others are 0. */
2442                         if (ireq->i_val < 4) {
2443                                 sc->areq.an_type = AN_RID_WEP_TEMP;
2444                                 key->kindex = ireq->i_val;
2445                         } else {
2446                                 sc->areq.an_type = AN_RID_WEP_PERM;
2447                                 key->kindex = ireq->i_val - 4;
2448                         }
2449                         key->klen = ireq->i_len;
2450                         bcopy(tmpstr, key->key, key->klen);
2451                         an_setdef(sc, &sc->areq);
2452                         AN_UNLOCK(sc);
2453                         break;
2454                 case IEEE80211_IOC_WEPTXKEY:
2455                         if (ireq->i_val < 0 || ireq->i_val > 4) {
2456                                 error = EINVAL;
2457                                 AN_UNLOCK(sc);
2458                                 break;
2459                         }
2460
2461                         /*
2462                          * Map the 5th key into the home mode
2463                          * since that is how it is stored on
2464                          * the card
2465                          */
2466                         sc->areq.an_len  = sizeof(struct an_ltv_genconfig);
2467                         sc->areq.an_type = AN_RID_ACTUALCFG;
2468                         if (an_read_record(sc,
2469                             (struct an_ltv_gen *)&sc->areq)) {
2470                                 error = EINVAL;
2471                                 AN_UNLOCK(sc);
2472                                 break;
2473                         }
2474                         if (ireq->i_val ==  4) {
2475                                 config->an_home_product |= AN_HOME_NETWORK;
2476                                 ireq->i_val = 0;
2477                         } else {
2478                                 config->an_home_product &= ~AN_HOME_NETWORK;
2479                         }
2480
2481                         sc->an_config.an_home_product
2482                                 = config->an_home_product;
2483
2484                         /* update configuration */
2485                         an_init_locked(sc);
2486
2487                         bzero(&sc->areq, sizeof(struct an_ltv_key));
2488                         sc->areq.an_len = sizeof(struct an_ltv_key);
2489                         sc->areq.an_type = AN_RID_WEP_PERM;
2490                         key->kindex = 0xffff;
2491                         key->mac[0] = ireq->i_val;
2492                         an_setdef(sc, &sc->areq);
2493                         AN_UNLOCK(sc);
2494                         break;
2495                 case IEEE80211_IOC_AUTHMODE:
2496                         switch (ireq->i_val) {
2497                         case IEEE80211_AUTH_NONE:
2498                                 config->an_authtype = AN_AUTHTYPE_NONE |
2499                                     (config->an_authtype & ~AN_AUTHTYPE_MASK);
2500                                 break;
2501                         case IEEE80211_AUTH_OPEN:
2502                                 config->an_authtype = AN_AUTHTYPE_OPEN |
2503                                     (config->an_authtype & ~AN_AUTHTYPE_MASK);
2504                                 break;
2505                         case IEEE80211_AUTH_SHARED:
2506                                 config->an_authtype = AN_AUTHTYPE_SHAREDKEY |
2507                                     (config->an_authtype & ~AN_AUTHTYPE_MASK);
2508                                 break;
2509                         default:
2510                                 error = EINVAL;
2511                         }
2512                         if (error != EINVAL) {
2513                                 an_setdef(sc, &sc->areq);
2514                         }
2515                         AN_UNLOCK(sc);
2516                         break;
2517                 case IEEE80211_IOC_STATIONNAME:
2518                         if (ireq->i_len > 16) {
2519                                 error = EINVAL;
2520                                 AN_UNLOCK(sc);
2521                                 break;
2522                         }
2523                         bzero(config->an_nodename, 16);
2524                         error = copyin(ireq->i_data,
2525                             config->an_nodename, ireq->i_len);
2526                         an_setdef(sc, &sc->areq);
2527                         AN_UNLOCK(sc);
2528                         break;
2529                 case IEEE80211_IOC_CHANNEL:
2530                         /*
2531                          * The actual range is 1-14, but if you set it
2532                          * to 0 you get the default so we let that work
2533                          * too.
2534                          */
2535                         if (ireq->i_val < 0 || ireq->i_val >14) {
2536                                 error = EINVAL;
2537                                 AN_UNLOCK(sc);
2538                                 break;
2539                         }
2540                         config->an_ds_channel = ireq->i_val;
2541                         an_setdef(sc, &sc->areq);
2542                         AN_UNLOCK(sc);
2543                         break;
2544                 case IEEE80211_IOC_POWERSAVE:
2545                         switch (ireq->i_val) {
2546                         case IEEE80211_POWERSAVE_OFF:
2547                                 config->an_psave_mode = AN_PSAVE_NONE;
2548                                 break;
2549                         case IEEE80211_POWERSAVE_CAM:
2550                                 config->an_psave_mode = AN_PSAVE_CAM;
2551                                 break;
2552                         case IEEE80211_POWERSAVE_PSP:
2553                                 config->an_psave_mode = AN_PSAVE_PSP;
2554                                 break;
2555                         case IEEE80211_POWERSAVE_PSP_CAM:
2556                                 config->an_psave_mode = AN_PSAVE_PSP_CAM;
2557                                 break;
2558                         default:
2559                                 error = EINVAL;
2560                                 break;
2561                         }
2562                         an_setdef(sc, &sc->areq);
2563                         AN_UNLOCK(sc);
2564                         break;
2565                 case IEEE80211_IOC_POWERSAVESLEEP:
2566                         config->an_listen_interval = ireq->i_val;
2567                         an_setdef(sc, &sc->areq);
2568                         AN_UNLOCK(sc);
2569                         break;
2570                 default:
2571                         AN_UNLOCK(sc);
2572                         break;
2573                 }
2574
2575                 /*
2576                 if (!error) {
2577                         AN_LOCK(sc);
2578                         an_setdef(sc, &sc->areq);
2579                         AN_UNLOCK(sc);
2580                 }
2581                 */
2582                 break;
2583         default:
2584                 error = ether_ioctl(ifp, command, data);
2585                 break;
2586         }
2587 out:
2588
2589         return(error != 0);
2590 }
2591
2592 static int
2593 an_init_tx_ring(struct an_softc *sc)
2594 {
2595         int                     i;
2596         int                     id;
2597
2598         if (sc->an_gone)
2599                 return (0);
2600
2601         if (!sc->mpi350) {
2602                 for (i = 0; i < AN_TX_RING_CNT; i++) {
2603                         if (an_alloc_nicmem(sc, 1518 +
2604                             0x44, &id))
2605                                 return(ENOMEM);
2606                         sc->an_rdata.an_tx_fids[i] = id;
2607                         sc->an_rdata.an_tx_ring[i] = 0;
2608                 }
2609         }
2610
2611         sc->an_rdata.an_tx_prod = 0;
2612         sc->an_rdata.an_tx_cons = 0;
2613         sc->an_rdata.an_tx_empty = 1;
2614
2615         return(0);
2616 }
2617
2618 static void
2619 an_init(void *xsc)
2620 {
2621         struct an_softc         *sc = xsc;
2622
2623         AN_LOCK(sc);
2624         an_init_locked(sc);
2625         AN_UNLOCK(sc);
2626 }
2627
2628 static void
2629 an_init_locked(struct an_softc *sc)
2630 {
2631         struct ifnet *ifp;
2632
2633         AN_LOCK_ASSERT(sc);
2634         ifp = sc->an_ifp;
2635         if (sc->an_gone)
2636                 return;
2637
2638         if (ifp->if_drv_flags & IFF_DRV_RUNNING)
2639                 an_stop(sc);
2640
2641         sc->an_associated = 0;
2642
2643         /* Allocate the TX buffers */
2644         if (an_init_tx_ring(sc)) {
2645                 an_reset(sc);
2646                 if (sc->mpi350)
2647                         an_init_mpi350_desc(sc);
2648                 if (an_init_tx_ring(sc)) {
2649                         if_printf(ifp, "tx buffer allocation failed\n");
2650                         return;
2651                 }
2652         }
2653
2654         /* Set our MAC address. */
2655         bcopy((char *)IF_LLADDR(sc->an_ifp),
2656             (char *)&sc->an_config.an_macaddr, ETHER_ADDR_LEN);
2657
2658         if (ifp->if_flags & IFF_BROADCAST)
2659                 sc->an_config.an_rxmode = AN_RXMODE_BC_ADDR;
2660         else
2661                 sc->an_config.an_rxmode = AN_RXMODE_ADDR;
2662
2663         if (ifp->if_flags & IFF_MULTICAST)
2664                 sc->an_config.an_rxmode = AN_RXMODE_BC_MC_ADDR;
2665
2666         if (ifp->if_flags & IFF_PROMISC) {
2667                 if (sc->an_monitor & AN_MONITOR) {
2668                         if (sc->an_monitor & AN_MONITOR_ANY_BSS) {
2669                                 sc->an_config.an_rxmode |=
2670                                     AN_RXMODE_80211_MONITOR_ANYBSS |
2671                                     AN_RXMODE_NO_8023_HEADER;
2672                         } else {
2673                                 sc->an_config.an_rxmode |=
2674                                     AN_RXMODE_80211_MONITOR_CURBSS |
2675                                     AN_RXMODE_NO_8023_HEADER;
2676                         }
2677                 }
2678         }
2679
2680 #ifdef ANCACHE
2681         if (sc->an_have_rssimap)
2682                 sc->an_config.an_rxmode |= AN_RXMODE_NORMALIZED_RSSI;
2683 #endif
2684
2685         /* Set the ssid list */
2686         sc->an_ssidlist.an_type = AN_RID_SSIDLIST;
2687         sc->an_ssidlist.an_len = sizeof(struct an_ltv_ssidlist_new);
2688         if (an_write_record(sc, (struct an_ltv_gen *)&sc->an_ssidlist)) {
2689                 if_printf(ifp, "failed to set ssid list\n");
2690                 return;
2691         }
2692
2693         /* Set the AP list */
2694         sc->an_aplist.an_type = AN_RID_APLIST;
2695         sc->an_aplist.an_len = sizeof(struct an_ltv_aplist);
2696         if (an_write_record(sc, (struct an_ltv_gen *)&sc->an_aplist)) {
2697                 if_printf(ifp, "failed to set AP list\n");
2698                 return;
2699         }
2700
2701         /* Set the configuration in the NIC */
2702         sc->an_config.an_len = sizeof(struct an_ltv_genconfig);
2703         sc->an_config.an_type = AN_RID_GENCONFIG;
2704         if (an_write_record(sc, (struct an_ltv_gen *)&sc->an_config)) {
2705                 if_printf(ifp, "failed to set configuration\n");
2706                 return;
2707         }
2708
2709         /* Enable the MAC */
2710         if (an_cmd(sc, AN_CMD_ENABLE, 0)) {
2711                 if_printf(ifp, "failed to enable MAC\n");
2712                 return;
2713         }
2714
2715         if (ifp->if_flags & IFF_PROMISC)
2716                 an_cmd(sc, AN_CMD_SET_MODE, 0xffff);
2717
2718         /* enable interrupts */
2719         CSR_WRITE_2(sc, AN_INT_EN(sc->mpi350), AN_INTRS(sc->mpi350));
2720
2721         ifp->if_drv_flags |= IFF_DRV_RUNNING;
2722         ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
2723
2724         callout_reset(&sc->an_stat_ch, hz, an_stats_update, sc);
2725
2726         return;
2727 }
2728
2729 static void
2730 an_start(struct ifnet *ifp)
2731 {
2732         struct an_softc         *sc;
2733
2734         sc = ifp->if_softc;
2735         AN_LOCK(sc);
2736         an_start_locked(ifp);
2737         AN_UNLOCK(sc);
2738 }
2739
2740 static void
2741 an_start_locked(struct ifnet *ifp)
2742 {
2743         struct an_softc         *sc;
2744         struct mbuf             *m0 = NULL;
2745         struct an_txframe_802_3 tx_frame_802_3;
2746         struct ether_header     *eh;
2747         int                     id, idx, i;
2748         unsigned char           txcontrol;
2749         struct an_card_tx_desc an_tx_desc;
2750         u_int8_t                *buf;
2751
2752         sc = ifp->if_softc;
2753
2754         AN_LOCK_ASSERT(sc);
2755         if (sc->an_gone)
2756                 return;
2757
2758         if (ifp->if_drv_flags & IFF_DRV_OACTIVE)
2759                 return;
2760
2761         if (!sc->an_associated)
2762                 return;
2763
2764         /* We can't send in monitor mode so toss any attempts. */
2765         if (sc->an_monitor && (ifp->if_flags & IFF_PROMISC)) {
2766                 for (;;) {
2767                         IFQ_DRV_DEQUEUE(&ifp->if_snd, m0);
2768                         if (m0 == NULL)
2769                                 break;
2770                         m_freem(m0);
2771                 }
2772                 return;
2773         }
2774
2775         idx = sc->an_rdata.an_tx_prod;
2776
2777         if (!sc->mpi350) {
2778                 bzero((char *)&tx_frame_802_3, sizeof(tx_frame_802_3));
2779
2780                 while (sc->an_rdata.an_tx_ring[idx] == 0) {
2781                         IFQ_DRV_DEQUEUE(&ifp->if_snd, m0);
2782                         if (m0 == NULL)
2783                                 break;
2784
2785                         id = sc->an_rdata.an_tx_fids[idx];
2786                         eh = mtod(m0, struct ether_header *);
2787
2788                         bcopy((char *)&eh->ether_dhost,
2789                               (char *)&tx_frame_802_3.an_tx_dst_addr,
2790                               ETHER_ADDR_LEN);
2791                         bcopy((char *)&eh->ether_shost,
2792                               (char *)&tx_frame_802_3.an_tx_src_addr,
2793                               ETHER_ADDR_LEN);
2794
2795                         /* minus src/dest mac & type */
2796                         tx_frame_802_3.an_tx_802_3_payload_len =
2797                                 m0->m_pkthdr.len - 12;
2798
2799                         m_copydata(m0, sizeof(struct ether_header) - 2 ,
2800                                    tx_frame_802_3.an_tx_802_3_payload_len,
2801                                    (caddr_t)&sc->an_txbuf);
2802
2803                         txcontrol = AN_TXCTL_8023 | AN_TXCTL_HW(sc->mpi350);
2804                         /* write the txcontrol only */
2805                         an_write_data(sc, id, 0x08, (caddr_t)&txcontrol,
2806                                       sizeof(txcontrol));
2807
2808                         /* 802_3 header */
2809                         an_write_data(sc, id, 0x34, (caddr_t)&tx_frame_802_3,
2810                                       sizeof(struct an_txframe_802_3));
2811
2812                         /* in mbuf header type is just before payload */
2813                         an_write_data(sc, id, 0x44, (caddr_t)&sc->an_txbuf,
2814                                       tx_frame_802_3.an_tx_802_3_payload_len);
2815
2816                         /*
2817                          * If there's a BPF listner, bounce a copy of
2818                          * this frame to him.
2819                          */
2820                         BPF_MTAP(ifp, m0);
2821
2822                         m_freem(m0);
2823                         m0 = NULL;
2824
2825                         sc->an_rdata.an_tx_ring[idx] = id;
2826                         if (an_cmd(sc, AN_CMD_TX, id))
2827                                 if_printf(ifp, "xmit failed\n");
2828
2829                         AN_INC(idx, AN_TX_RING_CNT);
2830
2831                         /*
2832                          * Set a timeout in case the chip goes out to lunch.
2833                          */
2834                         sc->an_timer = 5;
2835                 }
2836         } else { /* MPI-350 */
2837                 /* Disable interrupts. */
2838                 CSR_WRITE_2(sc, AN_INT_EN(sc->mpi350), 0);
2839
2840                 while (sc->an_rdata.an_tx_empty ||
2841                     idx != sc->an_rdata.an_tx_cons) {
2842                         IFQ_DRV_DEQUEUE(&ifp->if_snd, m0);
2843                         if (m0 == NULL) {
2844                                 break;
2845                         }
2846                         buf = sc->an_tx_buffer[idx].an_dma_vaddr;
2847
2848                         eh = mtod(m0, struct ether_header *);
2849
2850                         /* DJA optimize this to limit bcopy */
2851                         bcopy((char *)&eh->ether_dhost,
2852                               (char *)&tx_frame_802_3.an_tx_dst_addr,
2853                               ETHER_ADDR_LEN);
2854                         bcopy((char *)&eh->ether_shost,
2855                               (char *)&tx_frame_802_3.an_tx_src_addr,
2856                               ETHER_ADDR_LEN);
2857
2858                         /* minus src/dest mac & type */
2859                         tx_frame_802_3.an_tx_802_3_payload_len =
2860                                 m0->m_pkthdr.len - 12;
2861
2862                         m_copydata(m0, sizeof(struct ether_header) - 2 ,
2863                                    tx_frame_802_3.an_tx_802_3_payload_len,
2864                                    (caddr_t)&sc->an_txbuf);
2865
2866                         txcontrol = AN_TXCTL_8023 | AN_TXCTL_HW(sc->mpi350);
2867                         /* write the txcontrol only */
2868                         bcopy((caddr_t)&txcontrol, &buf[0x08],
2869                               sizeof(txcontrol));
2870
2871                         /* 802_3 header */
2872                         bcopy((caddr_t)&tx_frame_802_3, &buf[0x34],
2873                               sizeof(struct an_txframe_802_3));
2874
2875                         /* in mbuf header type is just before payload */
2876                         bcopy((caddr_t)&sc->an_txbuf, &buf[0x44],
2877                               tx_frame_802_3.an_tx_802_3_payload_len);
2878
2879
2880                         bzero(&an_tx_desc, sizeof(an_tx_desc));
2881                         an_tx_desc.an_offset = 0;
2882                         an_tx_desc.an_eoc = 1;
2883                         an_tx_desc.an_valid = 1;
2884                         an_tx_desc.an_len =  0x44 +
2885                             tx_frame_802_3.an_tx_802_3_payload_len;
2886                         an_tx_desc.an_phys
2887                             = sc->an_tx_buffer[idx].an_dma_paddr;
2888                         for (i = sizeof(an_tx_desc) / 4 - 1; i >= 0; i--) {
2889                                 CSR_MEM_AUX_WRITE_4(sc, AN_TX_DESC_OFFSET
2890                                     /* zero for now */
2891                                     + (0 * sizeof(an_tx_desc))
2892                                     + (i * 4),
2893                                     ((u_int32_t *)(void *)&an_tx_desc)[i]);
2894                         }
2895
2896                         /*
2897                          * If there's a BPF listner, bounce a copy of
2898                          * this frame to him.
2899                          */
2900                         BPF_MTAP(ifp, m0);
2901
2902                         m_freem(m0);
2903                         m0 = NULL;
2904                         AN_INC(idx, AN_MAX_TX_DESC);
2905                         sc->an_rdata.an_tx_empty = 0;
2906                         CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350), AN_EV_ALLOC);
2907
2908                         /*
2909                          * Set a timeout in case the chip goes out to lunch.
2910                          */
2911                         sc->an_timer = 5;
2912                 }
2913
2914                 /* Re-enable interrupts. */
2915                 CSR_WRITE_2(sc, AN_INT_EN(sc->mpi350), AN_INTRS(sc->mpi350));
2916         }
2917
2918         if (m0 != NULL)
2919                 ifp->if_drv_flags |= IFF_DRV_OACTIVE;
2920
2921         sc->an_rdata.an_tx_prod = idx;
2922
2923         return;
2924 }
2925
2926 void
2927 an_stop(struct an_softc *sc)
2928 {
2929         struct ifnet            *ifp;
2930         int                     i;
2931
2932         AN_LOCK_ASSERT(sc);
2933
2934         if (sc->an_gone)
2935                 return;
2936
2937         ifp = sc->an_ifp;
2938
2939         an_cmd(sc, AN_CMD_FORCE_SYNCLOSS, 0);
2940         CSR_WRITE_2(sc, AN_INT_EN(sc->mpi350), 0);
2941         an_cmd(sc, AN_CMD_DISABLE, 0);
2942
2943         for (i = 0; i < AN_TX_RING_CNT; i++)
2944                 an_cmd(sc, AN_CMD_DEALLOC_MEM, sc->an_rdata.an_tx_fids[i]);
2945
2946         callout_stop(&sc->an_stat_ch);
2947
2948         ifp->if_drv_flags &= ~(IFF_DRV_RUNNING|IFF_DRV_OACTIVE);
2949
2950         if (sc->an_flash_buffer) {
2951                 free(sc->an_flash_buffer, M_DEVBUF);
2952                 sc->an_flash_buffer = NULL;
2953         }
2954 }
2955
2956 static void
2957 an_watchdog(struct an_softc *sc)
2958 {
2959         struct ifnet *ifp;
2960
2961         AN_LOCK_ASSERT(sc);
2962
2963         if (sc->an_gone)
2964                 return;
2965
2966         ifp = sc->an_ifp;
2967         if_printf(ifp, "device timeout\n");
2968
2969         an_reset(sc);
2970         if (sc->mpi350)
2971                 an_init_mpi350_desc(sc);
2972         an_init_locked(sc);
2973
2974         ifp->if_oerrors++;
2975 }
2976
2977 int
2978 an_shutdown(device_t dev)
2979 {
2980         struct an_softc         *sc;
2981
2982         sc = device_get_softc(dev);
2983         AN_LOCK(sc);
2984         an_stop(sc);
2985         sc->an_gone = 1;
2986         AN_UNLOCK(sc);
2987
2988         return (0);
2989 }
2990
2991 void
2992 an_resume(device_t dev)
2993 {
2994         struct an_softc         *sc;
2995         struct ifnet            *ifp;
2996         int                     i;
2997
2998         sc = device_get_softc(dev);
2999         AN_LOCK(sc);
3000         ifp = sc->an_ifp;
3001
3002         sc->an_gone = 0;
3003         an_reset(sc);
3004         if (sc->mpi350)
3005                 an_init_mpi350_desc(sc);
3006         an_init_locked(sc);
3007
3008         /* Recovery temporary keys */
3009         for (i = 0; i < 4; i++) {
3010                 sc->areq.an_type = AN_RID_WEP_TEMP;
3011                 sc->areq.an_len = sizeof(struct an_ltv_key);
3012                 bcopy(&sc->an_temp_keys[i],
3013                     &sc->areq, sizeof(struct an_ltv_key));
3014                 an_setdef(sc, &sc->areq);
3015         }
3016
3017         if (ifp->if_flags & IFF_UP)
3018                 an_start_locked(ifp);
3019         AN_UNLOCK(sc);
3020
3021         return;
3022 }
3023
3024 #ifdef ANCACHE
3025 /* Aironet signal strength cache code.
3026  * store signal/noise/quality on per MAC src basis in
3027  * a small fixed cache.  The cache wraps if > MAX slots
3028  * used.  The cache may be zeroed out to start over.
3029  * Two simple filters exist to reduce computation:
3030  * 1. ip only (literally 0x800, ETHERTYPE_IP) which may be used
3031  * to ignore some packets.  It defaults to ip only.
3032  * it could be used to focus on broadcast, non-IP 802.11 beacons.
3033  * 2. multicast/broadcast only.  This may be used to
3034  * ignore unicast packets and only cache signal strength
3035  * for multicast/broadcast packets (beacons); e.g., Mobile-IP
3036  * beacons and not unicast traffic.
3037  *
3038  * The cache stores (MAC src(index), IP src (major clue), signal,
3039  *      quality, noise)
3040  *
3041  * No apologies for storing IP src here.  It's easy and saves much
3042  * trouble elsewhere.  The cache is assumed to be INET dependent,
3043  * although it need not be.
3044  *
3045  * Note: the Aironet only has a single byte of signal strength value
3046  * in the rx frame header, and it's not scaled to anything sensible.
3047  * This is kind of lame, but it's all we've got.
3048  */
3049
3050 #ifdef documentation
3051
3052 int an_sigitems;                                /* number of cached entries */
3053 struct an_sigcache an_sigcache[MAXANCACHE];     /* array of cache entries */
3054 int an_nextitem;                                /* index/# of entries */
3055
3056
3057 #endif
3058
3059 /* control variables for cache filtering.  Basic idea is
3060  * to reduce cost (e.g., to only Mobile-IP agent beacons
3061  * which are broadcast or multicast).  Still you might
3062  * want to measure signal strength anth unicast ping packets
3063  * on a pt. to pt. ant. setup.
3064  */
3065 /* set true if you want to limit cache items to broadcast/mcast
3066  * only packets (not unicast).  Useful for mobile-ip beacons which
3067  * are broadcast/multicast at network layer.  Default is all packets
3068  * so ping/unicast anll work say anth pt. to pt. antennae setup.
3069  */
3070 static int an_cache_mcastonly = 0;
3071 SYSCTL_INT(_hw_an, OID_AUTO, an_cache_mcastonly, CTLFLAG_RW,
3072         &an_cache_mcastonly, 0, "");
3073
3074 /* set true if you want to limit cache items to IP packets only
3075 */
3076 static int an_cache_iponly = 1;
3077 SYSCTL_INT(_hw_an, OID_AUTO, an_cache_iponly, CTLFLAG_RW,
3078         &an_cache_iponly, 0, "");
3079
3080 /*
3081  * an_cache_store, per rx packet store signal
3082  * strength in MAC (src) indexed cache.
3083  */
3084 static void
3085 an_cache_store(struct an_softc *sc, struct ether_header *eh, struct mbuf *m,
3086     u_int8_t rx_rssi, u_int8_t rx_quality)
3087 {
3088         struct ip *ip = 0;
3089         int i;
3090         static int cache_slot = 0;      /* use this cache entry */
3091         static int wrapindex = 0;       /* next "free" cache entry */
3092         int type_ipv4 = 0;
3093
3094         /* filters:
3095          * 1. ip only
3096          * 2. configurable filter to throw out unicast packets,
3097          * keep multicast only.
3098          */
3099
3100         if ((ntohs(eh->ether_type) == ETHERTYPE_IP)) {
3101                 type_ipv4 = 1;
3102         }
3103
3104         /* filter for ip packets only
3105         */
3106         if ( an_cache_iponly && !type_ipv4) {
3107                 return;
3108         }
3109
3110         /* filter for broadcast/multicast only
3111          */
3112         if (an_cache_mcastonly && ((eh->ether_dhost[0] & 1) == 0)) {
3113                 return;
3114         }
3115
3116 #ifdef SIGDEBUG
3117         if_printf(sc->an_ifp, "q value %x (MSB=0x%x, LSB=0x%x) \n",
3118                 rx_rssi & 0xffff, rx_rssi >> 8, rx_rssi & 0xff);
3119 #endif
3120
3121         /* find the ip header.  we want to store the ip_src
3122          * address.
3123          */
3124         if (type_ipv4) {
3125                 ip = mtod(m, struct ip *);
3126         }
3127
3128         /* do a linear search for a matching MAC address
3129          * in the cache table
3130          * . MAC address is 6 bytes,
3131          * . var w_nextitem holds total number of entries already cached
3132          */
3133         for (i = 0; i < sc->an_nextitem; i++) {
3134                 if (! bcmp(eh->ether_shost , sc->an_sigcache[i].macsrc,  6 )) {
3135                         /* Match!,
3136                          * so we already have this entry,
3137                          * update the data
3138                          */
3139                         break;
3140                 }
3141         }
3142
3143         /* did we find a matching mac address?
3144          * if yes, then overwrite a previously existing cache entry
3145          */
3146         if (i < sc->an_nextitem )   {
3147                 cache_slot = i;
3148         }
3149         /* else, have a new address entry,so
3150          * add this new entry,
3151          * if table full, then we need to replace LRU entry
3152          */
3153         else    {
3154
3155                 /* check for space in cache table
3156                  * note: an_nextitem also holds number of entries
3157                  * added in the cache table
3158                  */
3159                 if ( sc->an_nextitem < MAXANCACHE ) {
3160                         cache_slot = sc->an_nextitem;
3161                         sc->an_nextitem++;
3162                         sc->an_sigitems = sc->an_nextitem;
3163                 }
3164                 /* no space found, so simply wrap anth wrap index
3165                  * and "zap" the next entry
3166                  */
3167                 else {
3168                         if (wrapindex == MAXANCACHE) {
3169                                 wrapindex = 0;
3170                         }
3171                         cache_slot = wrapindex++;
3172                 }
3173         }
3174
3175         /* invariant: cache_slot now points at some slot
3176          * in cache.
3177          */
3178         if (cache_slot < 0 || cache_slot >= MAXANCACHE) {
3179                 log(LOG_ERR, "an_cache_store, bad index: %d of "
3180                     "[0..%d], gross cache error\n",
3181                     cache_slot, MAXANCACHE);
3182                 return;
3183         }
3184
3185         /*  store items in cache
3186          *  .ip source address
3187          *  .mac src
3188          *  .signal, etc.
3189          */
3190         if (type_ipv4) {
3191                 sc->an_sigcache[cache_slot].ipsrc = ip->ip_src.s_addr;
3192         }
3193         bcopy( eh->ether_shost, sc->an_sigcache[cache_slot].macsrc,  6);
3194
3195
3196         switch (an_cache_mode) {
3197         case DBM:
3198                 if (sc->an_have_rssimap) {
3199                         sc->an_sigcache[cache_slot].signal =
3200                                 - sc->an_rssimap.an_entries[rx_rssi].an_rss_dbm;
3201                         sc->an_sigcache[cache_slot].quality =
3202                                 - sc->an_rssimap.an_entries[rx_quality].an_rss_dbm;
3203                 } else {
3204                         sc->an_sigcache[cache_slot].signal = rx_rssi - 100;
3205                         sc->an_sigcache[cache_slot].quality = rx_quality - 100;
3206                 }
3207                 break;
3208         case PERCENT:
3209                 if (sc->an_have_rssimap) {
3210                         sc->an_sigcache[cache_slot].signal =
3211                                 sc->an_rssimap.an_entries[rx_rssi].an_rss_pct;
3212                         sc->an_sigcache[cache_slot].quality =
3213                                 sc->an_rssimap.an_entries[rx_quality].an_rss_pct;
3214                 } else {
3215                         if (rx_rssi > 100)
3216                                 rx_rssi = 100;
3217                         if (rx_quality > 100)
3218                                 rx_quality = 100;
3219                         sc->an_sigcache[cache_slot].signal = rx_rssi;
3220                         sc->an_sigcache[cache_slot].quality = rx_quality;
3221                 }
3222                 break;
3223         case RAW:
3224                 sc->an_sigcache[cache_slot].signal = rx_rssi;
3225                 sc->an_sigcache[cache_slot].quality = rx_quality;
3226                 break;
3227         }
3228
3229         sc->an_sigcache[cache_slot].noise = 0;
3230
3231         return;
3232 }
3233 #endif
3234
3235 static int
3236 an_media_change(struct ifnet *ifp)
3237 {
3238         struct an_softc *sc = ifp->if_softc;
3239         struct an_ltv_genconfig *cfg;
3240         int otype = sc->an_config.an_opmode;
3241         int orate = sc->an_tx_rate;
3242
3243         AN_LOCK(sc);
3244         sc->an_tx_rate = ieee80211_media2rate(
3245                 IFM_SUBTYPE(sc->an_ifmedia.ifm_cur->ifm_media));
3246         if (sc->an_tx_rate < 0)
3247                 sc->an_tx_rate = 0;
3248
3249         if (orate != sc->an_tx_rate) {
3250                 /* Read the current configuration */
3251                 sc->an_config.an_type = AN_RID_GENCONFIG;
3252                 sc->an_config.an_len = sizeof(struct an_ltv_genconfig);
3253                 an_read_record(sc, (struct an_ltv_gen *)&sc->an_config);
3254                 cfg = &sc->an_config;
3255
3256                 /* clear other rates and set the only one we want */
3257                 bzero(cfg->an_rates, sizeof(cfg->an_rates));
3258                 cfg->an_rates[0] = sc->an_tx_rate;
3259
3260                 /* Save the new rate */
3261                 sc->an_config.an_type = AN_RID_GENCONFIG;
3262                 sc->an_config.an_len = sizeof(struct an_ltv_genconfig);
3263         }
3264
3265         if ((sc->an_ifmedia.ifm_cur->ifm_media & IFM_IEEE80211_ADHOC) != 0)
3266                 sc->an_config.an_opmode &= ~AN_OPMODE_INFRASTRUCTURE_STATION;
3267         else
3268                 sc->an_config.an_opmode |= AN_OPMODE_INFRASTRUCTURE_STATION;
3269
3270         if (otype != sc->an_config.an_opmode ||
3271             orate != sc->an_tx_rate)
3272                 an_init_locked(sc);
3273         AN_UNLOCK(sc);
3274
3275         return(0);
3276 }
3277
3278 static void
3279 an_media_status(struct ifnet *ifp, struct ifmediareq *imr)
3280 {
3281         struct an_ltv_status    status;
3282         struct an_softc         *sc = ifp->if_softc;
3283
3284         imr->ifm_active = IFM_IEEE80211;
3285
3286         AN_LOCK(sc);
3287         status.an_len = sizeof(status);
3288         status.an_type = AN_RID_STATUS;
3289         if (an_read_record(sc, (struct an_ltv_gen *)&status)) {
3290                 /* If the status read fails, just lie. */
3291                 imr->ifm_active = sc->an_ifmedia.ifm_cur->ifm_media;
3292                 imr->ifm_status = IFM_AVALID|IFM_ACTIVE;
3293         }
3294
3295         if (sc->an_tx_rate == 0) {
3296                 imr->ifm_active = IFM_IEEE80211|IFM_AUTO;
3297         }
3298
3299         if (sc->an_config.an_opmode == AN_OPMODE_IBSS_ADHOC)
3300                 imr->ifm_active |= IFM_IEEE80211_ADHOC;
3301         imr->ifm_active |= ieee80211_rate2media(NULL,
3302                 status.an_current_tx_rate, IEEE80211_MODE_AUTO);
3303         imr->ifm_status = IFM_AVALID;
3304         if (status.an_opmode & AN_STATUS_OPMODE_ASSOCIATED)
3305                 imr->ifm_status |= IFM_ACTIVE;
3306         AN_UNLOCK(sc);
3307 }
3308
3309 /********************** Cisco utility support routines *************/
3310
3311 /*
3312  * ReadRids & WriteRids derived from Cisco driver additions to Ben Reed's
3313  * Linux driver
3314  */
3315
3316 static int
3317 readrids(struct ifnet *ifp, struct aironet_ioctl *l_ioctl)
3318 {
3319         unsigned short  rid;
3320         struct an_softc *sc;
3321         int error;
3322
3323         switch (l_ioctl->command) {
3324         case AIROGCAP:
3325                 rid = AN_RID_CAPABILITIES;
3326                 break;
3327         case AIROGCFG:
3328                 rid = AN_RID_GENCONFIG;
3329                 break;
3330         case AIROGSLIST:
3331                 rid = AN_RID_SSIDLIST;
3332                 break;
3333         case AIROGVLIST:
3334                 rid = AN_RID_APLIST;
3335                 break;
3336         case AIROGDRVNAM:
3337                 rid = AN_RID_DRVNAME;
3338                 break;
3339         case AIROGEHTENC:
3340                 rid = AN_RID_ENCAPPROTO;
3341                 break;
3342         case AIROGWEPKTMP:
3343                 rid = AN_RID_WEP_TEMP;
3344                 break;
3345         case AIROGWEPKNV:
3346                 rid = AN_RID_WEP_PERM;
3347                 break;
3348         case AIROGSTAT:
3349                 rid = AN_RID_STATUS;
3350                 break;
3351         case AIROGSTATSD32:
3352                 rid = AN_RID_32BITS_DELTA;
3353                 break;
3354         case AIROGSTATSC32:
3355                 rid = AN_RID_32BITS_CUM;
3356                 break;
3357         default:
3358                 rid = 999;
3359                 break;
3360         }
3361
3362         if (rid == 999) /* Is bad command */
3363                 return -EINVAL;
3364
3365         sc = ifp->if_softc;
3366         sc->areq.an_len  = AN_MAX_DATALEN;
3367         sc->areq.an_type = rid;
3368
3369         an_read_record(sc, (struct an_ltv_gen *)&sc->areq);
3370
3371         l_ioctl->len = sc->areq.an_len - 4;     /* just data */
3372
3373         AN_UNLOCK(sc);
3374         /* the data contains the length at first */
3375         if (copyout(&(sc->areq.an_len), l_ioctl->data,
3376                     sizeof(sc->areq.an_len))) {
3377                 error = -EFAULT;
3378                 goto lock_exit;
3379         }
3380         /* Just copy the data back */
3381         if (copyout(&(sc->areq.an_val), l_ioctl->data + 2,
3382                     l_ioctl->len)) {
3383                 error = -EFAULT;
3384                 goto lock_exit;
3385         }
3386         error = 0;
3387 lock_exit:
3388         AN_LOCK(sc);
3389         return (error);
3390 }
3391
3392 static int
3393 writerids(struct ifnet *ifp, struct aironet_ioctl *l_ioctl)
3394 {
3395         struct an_softc *sc;
3396         int             rid, command, error;
3397
3398         sc = ifp->if_softc;
3399         AN_LOCK_ASSERT(sc);
3400         rid = 0;
3401         command = l_ioctl->command;
3402
3403         switch (command) {
3404         case AIROPSIDS:
3405                 rid = AN_RID_SSIDLIST;
3406                 break;
3407         case AIROPCAP:
3408                 rid = AN_RID_CAPABILITIES;
3409                 break;
3410         case AIROPAPLIST:
3411                 rid = AN_RID_APLIST;
3412                 break;
3413         case AIROPCFG:
3414                 rid = AN_RID_GENCONFIG;
3415                 break;
3416         case AIROPMACON:
3417                 an_cmd(sc, AN_CMD_ENABLE, 0);
3418                 return 0;
3419                 break;
3420         case AIROPMACOFF:
3421                 an_cmd(sc, AN_CMD_DISABLE, 0);
3422                 return 0;
3423                 break;
3424         case AIROPSTCLR:
3425                 /*
3426                  * This command merely clears the counts does not actually
3427                  * store any data only reads rid. But as it changes the cards
3428                  * state, I put it in the writerid routines.
3429                  */
3430
3431                 rid = AN_RID_32BITS_DELTACLR;
3432                 sc = ifp->if_softc;
3433                 sc->areq.an_len = AN_MAX_DATALEN;
3434                 sc->areq.an_type = rid;
3435
3436                 an_read_record(sc, (struct an_ltv_gen *)&sc->areq);
3437                 l_ioctl->len = sc->areq.an_len - 4;     /* just data */
3438
3439                 AN_UNLOCK(sc);
3440                 /* the data contains the length at first */
3441                 error = copyout(&(sc->areq.an_len), l_ioctl->data,
3442                             sizeof(sc->areq.an_len));
3443                 if (error) {
3444                         AN_LOCK(sc);
3445                         return -EFAULT;
3446                 }
3447                 /* Just copy the data */
3448                 error = copyout(&(sc->areq.an_val), l_ioctl->data + 2,
3449                             l_ioctl->len);
3450                 AN_LOCK(sc);
3451                 if (error)
3452                         return -EFAULT;
3453                 return 0;
3454                 break;
3455         case AIROPWEPKEY:
3456                 rid = AN_RID_WEP_TEMP;
3457                 break;
3458         case AIROPWEPKEYNV:
3459                 rid = AN_RID_WEP_PERM;
3460                 break;
3461         case AIROPLEAPUSR:
3462                 rid = AN_RID_LEAPUSERNAME;
3463                 break;
3464         case AIROPLEAPPWD:
3465                 rid = AN_RID_LEAPPASSWORD;
3466                 break;
3467         default:
3468                 return -EOPNOTSUPP;
3469         }
3470
3471         if (rid) {
3472                 if (l_ioctl->len > sizeof(sc->areq.an_val) + 4)
3473                         return -EINVAL;
3474                 sc->areq.an_len = l_ioctl->len + 4;     /* add type & length */
3475                 sc->areq.an_type = rid;
3476
3477                 /* Just copy the data back */
3478                 AN_UNLOCK(sc);
3479                 error = copyin((l_ioctl->data) + 2, &sc->areq.an_val,
3480                        l_ioctl->len);
3481                 AN_LOCK(sc);
3482                 if (error)
3483                         return -EFAULT;
3484
3485                 an_cmd(sc, AN_CMD_DISABLE, 0);
3486                 an_write_record(sc, (struct an_ltv_gen *)&sc->areq);
3487                 an_cmd(sc, AN_CMD_ENABLE, 0);
3488                 return 0;
3489         }
3490         return -EOPNOTSUPP;
3491 }
3492
3493 /*
3494  * General Flash utilities derived from Cisco driver additions to Ben Reed's
3495  * Linux driver
3496  */
3497
3498 #define FLASH_DELAY(_sc, x)     msleep(ifp, &(_sc)->an_mtx, PZERO, \
3499         "flash", ((x) / hz) + 1);
3500 #define FLASH_COMMAND   0x7e7e
3501 #define FLASH_SIZE      32 * 1024
3502
3503 static int
3504 unstickbusy(struct ifnet *ifp)
3505 {
3506         struct an_softc *sc = ifp->if_softc;
3507
3508         if (CSR_READ_2(sc, AN_COMMAND(sc->mpi350)) & AN_CMD_BUSY) {
3509                 CSR_WRITE_2(sc, AN_EVENT_ACK(sc->mpi350),
3510                             AN_EV_CLR_STUCK_BUSY);
3511                 return 1;
3512         }
3513         return 0;
3514 }
3515
3516 /*
3517  * Wait for busy completion from card wait for delay uSec's Return true for
3518  * success meaning command reg is clear
3519  */
3520
3521 static int
3522 WaitBusy(struct ifnet *ifp, int uSec)
3523 {
3524         int             statword = 0xffff;
3525         int             delay = 0;
3526         struct an_softc *sc = ifp->if_softc;
3527
3528         while ((statword & AN_CMD_BUSY) && delay <= (1000 * 100)) {
3529                 FLASH_DELAY(sc, 10);
3530                 delay += 10;
3531                 statword = CSR_READ_2(sc, AN_COMMAND(sc->mpi350));
3532
3533                 if ((AN_CMD_BUSY & statword) && (delay % 200)) {
3534                         unstickbusy(ifp);
3535                 }
3536         }
3537
3538         return 0 == (AN_CMD_BUSY & statword);
3539 }
3540
3541 /*
3542  * STEP 1) Disable MAC and do soft reset on card.
3543  */
3544
3545 static int
3546 cmdreset(struct ifnet *ifp)
3547 {
3548         int             status;
3549         struct an_softc *sc = ifp->if_softc;
3550
3551         AN_LOCK(sc);
3552         an_stop(sc);
3553
3554         an_cmd(sc, AN_CMD_DISABLE, 0);
3555
3556         if (!(status = WaitBusy(ifp, AN_TIMEOUT))) {
3557                 if_printf(ifp, "Waitbusy hang b4 RESET =%d\n", status);
3558                 AN_UNLOCK(sc);
3559                 return -EBUSY;
3560         }
3561         CSR_WRITE_2(sc, AN_COMMAND(sc->mpi350), AN_CMD_FW_RESTART);
3562
3563         FLASH_DELAY(sc, 1000);  /* WAS 600 12/7/00 */
3564
3565
3566         if (!(status = WaitBusy(ifp, 100))) {
3567                 if_printf(ifp, "Waitbusy hang AFTER RESET =%d\n", status);
3568                 AN_UNLOCK(sc);
3569                 return -EBUSY;
3570         }
3571         AN_UNLOCK(sc);
3572         return 0;
3573 }
3574
3575 /*
3576  * STEP 2) Put the card in legendary flash mode
3577  */
3578
3579 static int
3580 setflashmode(struct ifnet *ifp)
3581 {
3582         int             status;
3583         struct an_softc *sc = ifp->if_softc;
3584
3585         CSR_WRITE_2(sc, AN_SW0(sc->mpi350), FLASH_COMMAND);
3586         CSR_WRITE_2(sc, AN_SW1(sc->mpi350), FLASH_COMMAND);
3587         CSR_WRITE_2(sc, AN_SW0(sc->mpi350), FLASH_COMMAND);
3588         CSR_WRITE_2(sc, AN_COMMAND(sc->mpi350), FLASH_COMMAND);
3589
3590         /*
3591          * mdelay(500); // 500ms delay
3592          */
3593
3594         FLASH_DELAY(sc, 500);
3595
3596         if (!(status = WaitBusy(ifp, AN_TIMEOUT))) {
3597                 printf("Waitbusy hang after setflash mode\n");
3598                 return -EIO;
3599         }
3600         return 0;
3601 }
3602
3603 /*
3604  * Get a character from the card matching matchbyte Step 3)
3605  */
3606
3607 static int
3608 flashgchar(struct ifnet *ifp, int matchbyte, int dwelltime)
3609 {
3610         int             rchar;
3611         unsigned char   rbyte = 0;
3612         int             success = -1;
3613         struct an_softc *sc = ifp->if_softc;
3614
3615
3616         do {
3617                 rchar = CSR_READ_2(sc, AN_SW1(sc->mpi350));
3618
3619                 if (dwelltime && !(0x8000 & rchar)) {
3620                         dwelltime -= 10;
3621                         FLASH_DELAY(sc, 10);
3622                         continue;
3623                 }
3624                 rbyte = 0xff & rchar;
3625
3626                 if ((rbyte == matchbyte) && (0x8000 & rchar)) {
3627                         CSR_WRITE_2(sc, AN_SW1(sc->mpi350), 0);
3628                         success = 1;
3629                         break;
3630                 }
3631                 if (rbyte == 0x81 || rbyte == 0x82 || rbyte == 0x83 || rbyte == 0x1a || 0xffff == rchar)
3632                         break;
3633                 CSR_WRITE_2(sc, AN_SW1(sc->mpi350), 0);
3634
3635         } while (dwelltime > 0);
3636         return success;
3637 }
3638
3639 /*
3640  * Put character to SWS0 wait for dwelltime x 50us for  echo .
3641  */
3642
3643 static int
3644 flashpchar(struct ifnet *ifp, int byte, int dwelltime)
3645 {
3646         int             echo;
3647         int             pollbusy, waittime;
3648         struct an_softc *sc = ifp->if_softc;
3649
3650         byte |= 0x8000;
3651
3652         if (dwelltime == 0)
3653                 dwelltime = 200;
3654
3655         waittime = dwelltime;
3656
3657         /*
3658          * Wait for busy bit d15 to go false indicating buffer empty
3659          */
3660         do {
3661                 pollbusy = CSR_READ_2(sc, AN_SW0(sc->mpi350));
3662
3663                 if (pollbusy & 0x8000) {
3664                         FLASH_DELAY(sc, 50);
3665                         waittime -= 50;
3666                         continue;
3667                 } else
3668                         break;
3669         }
3670         while (waittime >= 0);
3671
3672         /* timeout for busy clear wait */
3673
3674         if (waittime <= 0) {
3675                 if_printf(ifp, "flash putchar busywait timeout!\n");
3676                 return -1;
3677         }
3678         /*
3679          * Port is clear now write byte and wait for it to echo back
3680          */
3681         do {
3682                 CSR_WRITE_2(sc, AN_SW0(sc->mpi350), byte);
3683                 FLASH_DELAY(sc, 50);
3684                 dwelltime -= 50;
3685                 echo = CSR_READ_2(sc, AN_SW1(sc->mpi350));
3686         } while (dwelltime >= 0 && echo != byte);
3687
3688
3689         CSR_WRITE_2(sc, AN_SW1(sc->mpi350), 0);
3690
3691         return echo == byte;
3692 }
3693
3694 /*
3695  * Transfer 32k of firmware data from user buffer to our buffer and send to
3696  * the card
3697  */
3698
3699 static int
3700 flashputbuf(struct ifnet *ifp)
3701 {
3702         unsigned short *bufp;
3703         int             nwords;
3704         struct an_softc *sc = ifp->if_softc;
3705
3706         /* Write stuff */
3707
3708         bufp = sc->an_flash_buffer;
3709
3710         if (!sc->mpi350) {
3711                 CSR_WRITE_2(sc, AN_AUX_PAGE, 0x100);
3712                 CSR_WRITE_2(sc, AN_AUX_OFFSET, 0);
3713
3714                 for (nwords = 0; nwords != FLASH_SIZE / 2; nwords++) {
3715                         CSR_WRITE_2(sc, AN_AUX_DATA, bufp[nwords] & 0xffff);
3716                 }
3717         } else {
3718                 for (nwords = 0; nwords != FLASH_SIZE / 4; nwords++) {
3719                         CSR_MEM_AUX_WRITE_4(sc, 0x8000,
3720                                 ((u_int32_t *)bufp)[nwords] & 0xffff);
3721                 }
3722         }
3723
3724         CSR_WRITE_2(sc, AN_SW0(sc->mpi350), 0x8000);
3725
3726         return 0;
3727 }
3728
3729 /*
3730  * After flashing restart the card.
3731  */
3732
3733 static int
3734 flashrestart(struct ifnet *ifp)
3735 {
3736         int             status = 0;
3737         struct an_softc *sc = ifp->if_softc;
3738
3739         FLASH_DELAY(sc, 1024);          /* Added 12/7/00 */
3740
3741         an_init_locked(sc);
3742
3743         FLASH_DELAY(sc, 1024);          /* Added 12/7/00 */
3744         return status;
3745 }
3746
3747 /*
3748  * Entry point for flash ioclt.
3749  */
3750
3751 static int
3752 flashcard(struct ifnet *ifp, struct aironet_ioctl *l_ioctl)
3753 {
3754         int             z = 0, status;
3755         struct an_softc *sc;
3756
3757         sc = ifp->if_softc;
3758         if (sc->mpi350) {
3759                 if_printf(ifp, "flashing not supported on MPI 350 yet\n");
3760                 return(-1);
3761         }
3762         status = l_ioctl->command;
3763
3764         switch (l_ioctl->command) {
3765         case AIROFLSHRST:
3766                 return cmdreset(ifp);
3767                 break;
3768         case AIROFLSHSTFL:
3769                 if (sc->an_flash_buffer) {
3770                         free(sc->an_flash_buffer, M_DEVBUF);
3771                         sc->an_flash_buffer = NULL;
3772                 }
3773                 sc->an_flash_buffer = malloc(FLASH_SIZE, M_DEVBUF, M_WAITOK);
3774                 if (sc->an_flash_buffer)
3775                         return setflashmode(ifp);
3776                 else
3777                         return ENOBUFS;
3778                 break;
3779         case AIROFLSHGCHR:      /* Get char from aux */
3780                 AN_UNLOCK(sc);
3781                 status = copyin(l_ioctl->data, &sc->areq, l_ioctl->len);
3782                 AN_LOCK(sc);
3783                 if (status)
3784                         return status;
3785                 z = *(int *)&sc->areq;
3786                 if ((status = flashgchar(ifp, z, 8000)) == 1)
3787                         return 0;
3788                 else
3789                         return -1;
3790         case AIROFLSHPCHR:      /* Send char to card. */
3791                 AN_UNLOCK(sc);
3792                 status = copyin(l_ioctl->data, &sc->areq, l_ioctl->len);
3793                 AN_LOCK(sc);
3794                 if (status)
3795                         return status;
3796                 z = *(int *)&sc->areq;
3797                 if ((status = flashpchar(ifp, z, 8000)) == -1)
3798                         return -EIO;
3799                 else
3800                         return 0;
3801                 break;
3802         case AIROFLPUTBUF:      /* Send 32k to card */
3803                 if (l_ioctl->len > FLASH_SIZE) {
3804                         if_printf(ifp, "Buffer to big, %x %x\n",
3805                                l_ioctl->len, FLASH_SIZE);
3806                         return -EINVAL;
3807                 }
3808                 AN_UNLOCK(sc);
3809                 status = copyin(l_ioctl->data, sc->an_flash_buffer, l_ioctl->len);
3810                 AN_LOCK(sc);
3811                 if (status)
3812                         return status;
3813
3814                 if ((status = flashputbuf(ifp)) != 0)
3815                         return -EIO;
3816                 else
3817                         return 0;
3818                 break;
3819         case AIRORESTART:
3820                 if ((status = flashrestart(ifp)) != 0) {
3821                         if_printf(ifp, "FLASHRESTART returned %d\n", status);
3822                         return -EIO;
3823                 } else
3824                         return 0;
3825
3826                 break;
3827         default:
3828                 return -EINVAL;
3829         }
3830
3831         return -EINVAL;
3832 }