2002-03-23 06:40:24 +03:00
|
|
|
/* $NetBSD: an.c,v 1.22 2002/03/23 03:40:24 gmcgarry Exp $ */
|
2000-12-12 02:16:50 +03:00
|
|
|
/*
|
|
|
|
* Copyright (c) 1997, 1998, 1999
|
|
|
|
* Bill Paul <wpaul@ctr.columbia.edu>. All rights reserved.
|
|
|
|
*
|
|
|
|
* Redistribution and use in source and binary forms, with or without
|
|
|
|
* modification, are permitted provided that the following conditions
|
|
|
|
* are met:
|
|
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
|
|
* notice, this list of conditions and the following disclaimer.
|
|
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
|
|
* documentation and/or other materials provided with the distribution.
|
|
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
|
|
* must display the following acknowledgement:
|
|
|
|
* This product includes software developed by Bill Paul.
|
|
|
|
* 4. Neither the name of the author nor the names of any co-contributors
|
|
|
|
* may be used to endorse or promote products derived from this software
|
|
|
|
* without specific prior written permission.
|
|
|
|
*
|
|
|
|
* THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
|
|
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
|
|
|
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
|
|
|
|
* THE POSSIBILITY OF SUCH DAMAGE.
|
|
|
|
*
|
|
|
|
* $FreeBSD: src/sys/dev/an/if_an.c,v 1.12 2000/11/13 23:04:12 wpaul Exp $
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Aironet 4500/4800 802.11 PCMCIA/ISA/PCI driver for FreeBSD.
|
|
|
|
*
|
|
|
|
* Written by Bill Paul <wpaul@ctr.columbia.edu>
|
|
|
|
* Electrical Engineering Department
|
|
|
|
* Columbia University, New York City
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* The Aironet 4500/4800 series cards some in PCMCIA, ISA and PCI form.
|
|
|
|
* This driver supports all three device types (PCI devices are supported
|
|
|
|
* through an extra PCI shim: /sys/pci/if_an_p.c). ISA devices can be
|
|
|
|
* supported either using hard-coded IO port/IRQ settings or via Plug
|
|
|
|
* and Play. The 4500 series devices support 1Mbps and 2Mbps data rates.
|
|
|
|
* The 4800 devices support 1, 2, 5.5 and 11Mbps rates.
|
|
|
|
*
|
|
|
|
* Like the WaveLAN/IEEE cards, the Aironet NICs are all essentially
|
|
|
|
* PCMCIA devices. The ISA and PCI cards are a combination of a PCMCIA
|
|
|
|
* device and a PCMCIA to ISA or PCMCIA to PCI adapter card. There are
|
|
|
|
* a couple of important differences though:
|
|
|
|
*
|
|
|
|
* - Lucent doesn't currently offer a PCI card, however Aironet does
|
|
|
|
* - Lucent ISA card looks to the host like a PCMCIA controller with
|
|
|
|
* a PCMCIA WaveLAN card inserted. This means that even desktop
|
|
|
|
* machines need to be configured with PCMCIA support in order to
|
|
|
|
* use WaveLAN/IEEE ISA cards. The Aironet cards on the other hand
|
|
|
|
* actually look like normal ISA and PCI devices to the host, so
|
|
|
|
* no PCMCIA controller support is needed
|
|
|
|
*
|
|
|
|
* The latter point results in a small gotcha. The Aironet PCMCIA
|
|
|
|
* cards can be configured for one of two operating modes depending
|
|
|
|
* on how the Vpp1 and Vpp2 programming voltages are set when the
|
|
|
|
* card is activated. In order to put the card in proper PCMCIA
|
|
|
|
* operation (where the CIS table is visible and the interface is
|
|
|
|
* programmed for PCMCIA operation), both Vpp1 and Vpp2 have to be
|
|
|
|
* set to 5 volts. FreeBSD by default doesn't set the Vpp voltages,
|
|
|
|
* which leaves the card in ISA/PCI mode, which prevents it from
|
|
|
|
* being activated as an PCMCIA device. Consequently, /sys/pccard/pccard.c
|
|
|
|
* has to be patched slightly in order to enable the Vpp voltages in
|
|
|
|
* order to make the Aironet PCMCIA cards work.
|
|
|
|
*
|
|
|
|
* Note that some PCMCIA controller software packages for Windows NT
|
|
|
|
* fail to set the voltages as well.
|
|
|
|
*
|
|
|
|
* The Aironet devices can operate in both station mode and access point
|
|
|
|
* mode. Typically, when programmed for station mode, the card can be set
|
|
|
|
* to automatically perform encapsulation/decapsulation of Ethernet II
|
|
|
|
* and 802.3 frames within 802.11 frames so that the host doesn't have
|
|
|
|
* to do it itself. This driver doesn't program the card that way: the
|
|
|
|
* driver handles all of the encapsulation/decapsulation itself.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Ported to NetBSD from FreeBSD by Atsushi Onoe at the San Diego
|
|
|
|
* IETF meeting.
|
|
|
|
*/
|
|
|
|
|
2001-11-13 16:14:31 +03:00
|
|
|
#include <sys/cdefs.h>
|
2002-03-23 06:40:24 +03:00
|
|
|
__KERNEL_RCSID(0, "$NetBSD: an.c,v 1.22 2002/03/23 03:40:24 gmcgarry Exp $");
|
2001-11-13 16:14:31 +03:00
|
|
|
|
2000-12-12 02:16:50 +03:00
|
|
|
#include "opt_inet.h"
|
|
|
|
#include "bpfilter.h"
|
|
|
|
|
|
|
|
#ifdef INET
|
2001-06-21 16:49:06 +04:00
|
|
|
/*
|
|
|
|
* It is designed for IPv4 only.
|
|
|
|
* no one use it and disabled for now. -- onoe
|
|
|
|
*/
|
|
|
|
#undef ANCACHE /* enable signal strength cache */
|
2000-12-12 02:16:50 +03:00
|
|
|
#endif
|
|
|
|
|
|
|
|
#include <sys/param.h>
|
|
|
|
#include <sys/callout.h>
|
|
|
|
#include <sys/systm.h>
|
|
|
|
#include <sys/sockio.h>
|
|
|
|
#include <sys/mbuf.h>
|
|
|
|
#include <sys/kernel.h>
|
|
|
|
#include <sys/ucred.h>
|
|
|
|
#include <sys/socket.h>
|
|
|
|
#include <sys/device.h>
|
2001-06-21 16:49:06 +04:00
|
|
|
#include <sys/proc.h>
|
2001-06-29 15:24:42 +04:00
|
|
|
#include <sys/md4.h>
|
2000-12-12 02:16:50 +03:00
|
|
|
#ifdef ANCACHE
|
|
|
|
#include <sys/syslog.h>
|
|
|
|
#include <sys/sysctl.h>
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#include <machine/bus.h>
|
|
|
|
|
|
|
|
#include <net/if.h>
|
|
|
|
#include <net/if_arp.h>
|
|
|
|
#include <net/if_dl.h>
|
|
|
|
#include <net/if_ether.h>
|
|
|
|
#include <net/if_ieee80211.h>
|
|
|
|
#include <net/if_types.h>
|
|
|
|
#include <net/if_media.h>
|
|
|
|
|
|
|
|
#ifdef INET
|
|
|
|
#include <netinet/in.h>
|
|
|
|
#include <netinet/in_systm.h>
|
|
|
|
#include <netinet/in_var.h>
|
|
|
|
#include <netinet/ip.h>
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if NBPFILTER > 0
|
|
|
|
#include <net/bpf.h>
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#include <dev/ic/anreg.h>
|
2000-12-12 08:11:15 +03:00
|
|
|
#include <dev/ic/anvar.h>
|
2000-12-12 02:16:50 +03:00
|
|
|
|
|
|
|
/* These are global because we need them in sys/pci/if_an_p.c. */
|
|
|
|
static void an_reset __P((struct an_softc *));
|
2000-12-19 11:00:55 +03:00
|
|
|
static void an_wait __P((struct an_softc *));
|
2000-12-12 02:16:50 +03:00
|
|
|
static int an_ioctl __P((struct ifnet *, u_long, caddr_t));
|
2001-06-21 16:49:06 +04:00
|
|
|
static int an_set_nwkey __P((struct an_softc *,
|
|
|
|
struct ieee80211_nwkey *));
|
2001-06-29 15:24:42 +04:00
|
|
|
static int an_set_nwkey_wep __P((struct an_softc *,
|
|
|
|
struct ieee80211_nwkey *));
|
|
|
|
static int an_set_nwkey_eap __P((struct an_softc *,
|
|
|
|
struct ieee80211_nwkey *));
|
2001-06-21 16:49:06 +04:00
|
|
|
static int an_get_nwkey __P((struct an_softc *,
|
|
|
|
struct ieee80211_nwkey *));
|
|
|
|
static int an_write_wepkey __P((struct an_softc *sc, int type,
|
|
|
|
struct an_wepkey *keys, int kid));
|
2000-12-12 02:16:50 +03:00
|
|
|
static int an_init __P((struct ifnet *));
|
|
|
|
static void an_stop __P((struct ifnet *, int));
|
|
|
|
static int an_init_tx_ring __P((struct an_softc *));
|
|
|
|
static void an_start __P((struct ifnet *));
|
|
|
|
static void an_watchdog __P((struct ifnet *));
|
|
|
|
static void an_rxeof __P((struct an_softc *));
|
|
|
|
static void an_txeof __P((struct an_softc *, int));
|
|
|
|
|
|
|
|
static int an_cmd __P((struct an_softc *, int, int));
|
|
|
|
static int an_read_record __P((struct an_softc *, struct an_ltv_gen *));
|
|
|
|
static int an_write_record __P((struct an_softc *, struct an_ltv_gen *));
|
|
|
|
static int an_read_data __P((struct an_softc *, int,
|
|
|
|
int, caddr_t, int));
|
|
|
|
static int an_write_data __P((struct an_softc *, int,
|
|
|
|
int, caddr_t, int));
|
|
|
|
static int an_seek __P((struct an_softc *, int, int, int));
|
|
|
|
static int an_alloc_nicmem __P((struct an_softc *, int, int *));
|
|
|
|
static void an_stats_update __P((void *));
|
2001-06-21 16:49:06 +04:00
|
|
|
static int an_setdef __P((struct an_softc *, struct an_req *));
|
2000-12-12 02:16:50 +03:00
|
|
|
#ifdef ANCACHE
|
|
|
|
static void an_cache_store __P((struct an_softc *, struct ether_header *,
|
|
|
|
struct mbuf *, unsigned short));
|
|
|
|
#endif
|
|
|
|
#ifdef IFM_IEEE80211
|
|
|
|
static int an_media_change __P((struct ifnet *ifp));
|
|
|
|
static void an_media_status __P((struct ifnet *ifp, struct ifmediareq *imr));
|
|
|
|
#endif
|
|
|
|
|
2000-12-19 11:00:55 +03:00
|
|
|
int
|
|
|
|
an_attach(struct an_softc *sc)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
struct ifnet *ifp = &sc->arpcom.ec_if;
|
2000-12-19 11:00:55 +03:00
|
|
|
int i, s;
|
2001-06-21 16:49:06 +04:00
|
|
|
struct an_ltv_wepkey *akey;
|
2000-12-12 02:16:50 +03:00
|
|
|
#ifdef IFM_IEEE80211
|
2000-12-19 11:00:55 +03:00
|
|
|
int mtype;
|
2000-12-12 02:16:50 +03:00
|
|
|
struct ifmediareq imr;
|
|
|
|
#endif
|
|
|
|
|
2000-12-19 11:00:55 +03:00
|
|
|
s = splnet();
|
2000-12-12 02:16:50 +03:00
|
|
|
sc->an_associated = 0;
|
2000-12-19 11:00:55 +03:00
|
|
|
an_wait(sc);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
|
|
|
/* Load factory config */
|
|
|
|
if (an_cmd(sc, AN_CMD_READCFG, 0)) {
|
2000-12-19 11:00:55 +03:00
|
|
|
splx(s);
|
2000-12-12 02:16:50 +03:00
|
|
|
printf("%s: failed to load config data\n", sc->an_dev.dv_xname);
|
|
|
|
return(EIO);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Read the current configuration */
|
|
|
|
sc->an_config.an_type = AN_RID_GENCONFIG;
|
|
|
|
sc->an_config.an_len = sizeof(struct an_ltv_genconfig);
|
|
|
|
if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_config)) {
|
2000-12-19 11:00:55 +03:00
|
|
|
splx(s);
|
2000-12-12 02:16:50 +03:00
|
|
|
printf("%s: read record failed\n", sc->an_dev.dv_xname);
|
|
|
|
return(EIO);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Read the card capabilities */
|
|
|
|
sc->an_caps.an_type = AN_RID_CAPABILITIES;
|
|
|
|
sc->an_caps.an_len = sizeof(struct an_ltv_caps);
|
|
|
|
if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_caps)) {
|
2000-12-19 11:00:55 +03:00
|
|
|
splx(s);
|
2000-12-12 02:16:50 +03:00
|
|
|
printf("%s: read record failed\n", sc->an_dev.dv_xname);
|
|
|
|
return(EIO);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Read ssid list */
|
|
|
|
sc->an_ssidlist.an_type = AN_RID_SSIDLIST;
|
|
|
|
sc->an_ssidlist.an_len = sizeof(struct an_ltv_ssidlist);
|
|
|
|
if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_ssidlist)) {
|
2000-12-19 11:00:55 +03:00
|
|
|
splx(s);
|
2000-12-12 02:16:50 +03:00
|
|
|
printf("%s: read record failed\n", sc->an_dev.dv_xname);
|
|
|
|
return(EIO);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Read AP list */
|
|
|
|
sc->an_aplist.an_type = AN_RID_APLIST;
|
|
|
|
sc->an_aplist.an_len = sizeof(struct an_ltv_aplist);
|
|
|
|
if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_aplist)) {
|
2000-12-19 11:00:55 +03:00
|
|
|
splx(s);
|
2000-12-12 02:16:50 +03:00
|
|
|
printf("%s: read record failed\n", sc->an_dev.dv_xname);
|
|
|
|
return(EIO);
|
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Read WEP settings from persistent memory */
|
|
|
|
akey = (struct an_ltv_wepkey *)&sc->an_reqbuf;
|
|
|
|
akey->an_type = AN_RID_WEP_VOLATILE;
|
|
|
|
akey->an_len = sizeof(struct an_ltv_wepkey);
|
|
|
|
while (an_read_record(sc, (struct an_ltv_gen *)akey) == 0) {
|
|
|
|
if (akey->an_key_index == 0xffff) {
|
|
|
|
sc->an_tx_perskey = akey->an_mac_addr[0];
|
|
|
|
sc->an_tx_key = -1;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (akey->an_key_index >= IEEE80211_WEP_NKID)
|
|
|
|
break;
|
|
|
|
sc->an_perskeylen[akey->an_key_index] = akey->an_key_len;
|
|
|
|
sc->an_wepkeys[akey->an_key_index].an_wep_keylen = -1;
|
|
|
|
akey->an_type = AN_RID_WEP_PERSISTENT; /* for next key */
|
|
|
|
akey->an_len = sizeof(*akey);
|
|
|
|
}
|
|
|
|
/* XXX not sure if persistent key settings should be printed here */
|
|
|
|
|
2000-12-12 04:32:34 +03:00
|
|
|
printf("%s: 802.11 address: %s\n", sc->an_dev.dv_xname,
|
2000-12-12 02:16:50 +03:00
|
|
|
ether_sprintf(sc->an_caps.an_oemaddr));
|
|
|
|
|
|
|
|
ifp->if_softc = sc;
|
2001-06-21 16:49:06 +04:00
|
|
|
ifp->if_flags = IFF_BROADCAST | IFF_NOTRAILERS | IFF_SIMPLEX |
|
|
|
|
IFF_MULTICAST | IFF_ALLMULTI;
|
2000-12-12 02:16:50 +03:00
|
|
|
ifp->if_ioctl = an_ioctl;
|
|
|
|
ifp->if_start = an_start;
|
|
|
|
ifp->if_init = an_init;
|
|
|
|
ifp->if_stop = an_stop;
|
|
|
|
ifp->if_watchdog = an_watchdog;
|
2000-12-14 09:27:23 +03:00
|
|
|
IFQ_SET_READY(&ifp->if_snd);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
|
|
|
memcpy(ifp->if_xname, sc->an_dev.dv_xname, IFNAMSIZ);
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
memset(sc->an_config.an_nodename, 0, sizeof(sc->an_config.an_nodename));
|
|
|
|
memcpy(sc->an_config.an_nodename, AN_DEFAULT_NODENAME,
|
2000-12-12 02:16:50 +03:00
|
|
|
sizeof(AN_DEFAULT_NODENAME) - 1);
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
memset(sc->an_ssidlist.an_ssid1, 0, sizeof(sc->an_ssidlist.an_ssid1));
|
|
|
|
memcpy(sc->an_ssidlist.an_ssid1, AN_DEFAULT_NETNAME,
|
2000-12-12 02:16:50 +03:00
|
|
|
sizeof(AN_DEFAULT_NETNAME) - 1);
|
|
|
|
sc->an_ssidlist.an_ssid1_len = strlen(AN_DEFAULT_NETNAME);
|
|
|
|
|
|
|
|
sc->an_config.an_opmode = AN_OPMODE_INFRASTRUCTURE_STATION;
|
|
|
|
|
|
|
|
sc->an_tx_rate = 0;
|
2001-06-21 16:49:06 +04:00
|
|
|
#if 0
|
|
|
|
memset(&sc->an_stats, 0, sizeof(sc->an_stats));
|
|
|
|
#endif
|
2000-12-12 02:16:50 +03:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Call MI attach routine.
|
|
|
|
*/
|
|
|
|
if_attach(ifp);
|
|
|
|
ether_ifattach(ifp, sc->an_caps.an_oemaddr);
|
|
|
|
|
|
|
|
#ifdef IFM_IEEE80211
|
|
|
|
ifmedia_init(&sc->sc_media, 0, an_media_change, an_media_status);
|
2000-12-12 08:34:02 +03:00
|
|
|
ifmedia_add(&sc->sc_media, IFM_MAKEWORD(IFM_IEEE80211, IFM_AUTO,
|
|
|
|
0, 0), 0, NULL);
|
|
|
|
ifmedia_add(&sc->sc_media, IFM_MAKEWORD(IFM_IEEE80211, IFM_AUTO,
|
|
|
|
IFM_IEEE80211_ADHOC, 0), 0, NULL);
|
|
|
|
for (i = 0; i < sizeof(sc->an_caps.an_rates); i++) {
|
|
|
|
switch (sc->an_caps.an_rates[i]) {
|
|
|
|
case AN_RATE_1MBPS:
|
|
|
|
mtype = IFM_IEEE80211_DS1;
|
|
|
|
break;
|
|
|
|
case AN_RATE_2MBPS:
|
|
|
|
mtype = IFM_IEEE80211_DS2;
|
|
|
|
break;
|
|
|
|
case AN_RATE_5_5MBPS:
|
|
|
|
mtype = IFM_IEEE80211_DS5;
|
|
|
|
break;
|
|
|
|
case AN_RATE_11MBPS:
|
|
|
|
mtype = IFM_IEEE80211_DS11;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
ifmedia_add(&sc->sc_media, IFM_MAKEWORD(IFM_IEEE80211, mtype,
|
|
|
|
0, 0), 0, NULL);
|
|
|
|
ifmedia_add(&sc->sc_media, IFM_MAKEWORD(IFM_IEEE80211, mtype,
|
|
|
|
IFM_IEEE80211_ADHOC, 0), 0, NULL);
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
an_media_status(ifp, &imr);
|
|
|
|
ifmedia_set(&sc->sc_media, imr.ifm_active);
|
|
|
|
#endif
|
|
|
|
callout_init(&sc->an_stat_ch);
|
2000-12-19 11:00:55 +03:00
|
|
|
splx(s);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
|
|
|
return(0);
|
|
|
|
}
|
|
|
|
|
|
|
|
int
|
2000-12-19 11:00:55 +03:00
|
|
|
an_detach(struct an_softc *sc)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
|
|
|
struct ifnet *ifp = &sc->arpcom.ec_if;
|
|
|
|
int s;
|
|
|
|
|
|
|
|
s = splnet();
|
|
|
|
an_stop(ifp, 1);
|
|
|
|
ifmedia_delete_instance(&sc->sc_media, IFM_INST_ANY);
|
|
|
|
ether_ifdetach(ifp);
|
|
|
|
if_detach(ifp);
|
|
|
|
splx(s);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
int
|
2000-12-19 11:00:55 +03:00
|
|
|
an_activate(struct device *self, enum devact act)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
|
|
|
struct an_softc *sc = (struct an_softc *)self;
|
|
|
|
int s, error = 0;
|
|
|
|
|
|
|
|
s = splnet();
|
|
|
|
switch (act) {
|
|
|
|
case DVACT_ACTIVATE:
|
|
|
|
error = EOPNOTSUPP;
|
|
|
|
break;
|
|
|
|
|
|
|
|
case DVACT_DEACTIVATE:
|
|
|
|
if_deactivate(&sc->arpcom.ec_if);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
splx(s);
|
|
|
|
|
|
|
|
return error;
|
|
|
|
}
|
|
|
|
|
2000-12-19 11:00:55 +03:00
|
|
|
void
|
|
|
|
an_power(int why, void *arg)
|
|
|
|
{
|
|
|
|
int s;
|
|
|
|
struct an_softc *sc = arg;
|
|
|
|
struct ifnet *ifp = &sc->arpcom.ec_if;
|
|
|
|
|
|
|
|
s = splnet();
|
|
|
|
switch (why) {
|
|
|
|
case PWR_SUSPEND:
|
|
|
|
case PWR_STANDBY:
|
2001-06-21 16:49:06 +04:00
|
|
|
an_stop(ifp, 1);
|
2000-12-19 11:00:55 +03:00
|
|
|
break;
|
|
|
|
case PWR_RESUME:
|
2001-06-28 14:34:17 +04:00
|
|
|
if (ifp->if_flags & IFF_UP)
|
|
|
|
an_init(ifp);
|
2000-12-19 11:00:55 +03:00
|
|
|
break;
|
|
|
|
case PWR_SOFTSUSPEND:
|
|
|
|
case PWR_SOFTSTANDBY:
|
|
|
|
case PWR_SOFTRESUME:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
splx(s);
|
|
|
|
}
|
|
|
|
|
|
|
|
void
|
|
|
|
an_shutdown(void *arg)
|
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
struct an_softc *sc = arg;
|
2000-12-19 11:00:55 +03:00
|
|
|
|
|
|
|
an_stop(&sc->arpcom.ec_if, 1);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static int
|
|
|
|
an_setdef(struct an_softc *sc, struct an_req *areq)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
int error;
|
|
|
|
struct ifnet *ifp = &sc->arpcom.ec_if;
|
|
|
|
struct an_ltv_genconfig *cfg;
|
|
|
|
struct an_ltv_gen *sp;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
error = 0;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
switch (areq->an_type) {
|
|
|
|
case AN_RID_GENCONFIG:
|
|
|
|
cfg = (struct an_ltv_genconfig *)areq;
|
|
|
|
memcpy(sc->an_caps.an_oemaddr, cfg->an_macaddr, ETHER_ADDR_LEN);
|
|
|
|
memcpy(LLADDR(ifp->if_sadl), cfg->an_macaddr, ETHER_ADDR_LEN);
|
|
|
|
memcpy(&sc->an_config, areq, sizeof(struct an_ltv_genconfig));
|
|
|
|
error = ENETRESET;
|
|
|
|
break;
|
|
|
|
case AN_RID_SSIDLIST:
|
|
|
|
memcpy(&sc->an_ssidlist, areq, sizeof(struct an_ltv_ssidlist));
|
|
|
|
error = ENETRESET;
|
|
|
|
break;
|
|
|
|
case AN_RID_APLIST:
|
|
|
|
memcpy(&sc->an_aplist, areq, sizeof(struct an_ltv_aplist));
|
|
|
|
error = ENETRESET;
|
|
|
|
break;
|
|
|
|
case AN_RID_TX_SPEED:
|
|
|
|
sp = (struct an_ltv_gen *)areq;
|
|
|
|
sc->an_tx_rate = sp->an_val;
|
|
|
|
break;
|
|
|
|
case AN_RID_WEP_VOLATILE:
|
|
|
|
case AN_RID_WEP_PERSISTENT:
|
|
|
|
case AN_RID_LEAP_USER:
|
|
|
|
case AN_RID_LEAP_PASS:
|
|
|
|
if (!sc->sc_enabled) {
|
|
|
|
error = ENXIO;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
an_cmd(sc, AN_CMD_DISABLE, 0);
|
|
|
|
an_write_record(sc, (struct an_ltv_gen *)areq);
|
|
|
|
if (an_cmd(sc, AN_CMD_ENABLE, 0))
|
|
|
|
error = EIO;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
if (ifp->if_flags & IFF_DEBUG)
|
|
|
|
printf("%s: unknown RID: %x\n", sc->an_dev.dv_xname,
|
|
|
|
areq->an_type);
|
|
|
|
error = EINVAL;
|
|
|
|
break;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
2001-06-21 16:49:06 +04:00
|
|
|
return error;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static int
|
|
|
|
an_ioctl(struct ifnet *ifp, u_long command, caddr_t data)
|
|
|
|
{
|
|
|
|
int s;
|
|
|
|
int error = 0;
|
|
|
|
struct an_softc *sc;
|
|
|
|
struct an_req *areq;
|
|
|
|
struct ifreq *ifr;
|
|
|
|
struct ieee80211_nwid nwid;
|
|
|
|
struct ieee80211_power *power;
|
2001-03-08 19:33:43 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
sc = ifp->if_softc;
|
|
|
|
ifr = (struct ifreq *)data;
|
|
|
|
s = splnet();
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
switch (command) {
|
|
|
|
case SIOCSIFFLAGS:
|
2001-06-29 15:24:42 +04:00
|
|
|
if (ifp->if_flags & IFF_UP) {
|
|
|
|
if (sc->sc_enabled) {
|
|
|
|
/*
|
|
|
|
* To avoid rescanning another access point,
|
|
|
|
* do not call an_init() here. Instead, only
|
|
|
|
* reflect promisc mode settings.
|
|
|
|
*/
|
|
|
|
error = an_cmd(sc, AN_CMD_SET_MODE,
|
|
|
|
(ifp->if_flags & IFF_PROMISC) ? 0xffff : 0);
|
|
|
|
} else
|
|
|
|
error = an_init(ifp);
|
|
|
|
} else if (sc->sc_enabled)
|
2001-06-21 16:49:06 +04:00
|
|
|
an_stop(ifp, 1);
|
|
|
|
break;
|
|
|
|
case SIOCGAIRONET:
|
|
|
|
areq = &sc->an_reqbuf;
|
|
|
|
error = copyin(ifr->ifr_data, areq, sizeof(struct an_req));
|
|
|
|
if (error)
|
|
|
|
break;
|
|
|
|
switch (areq->an_type) {
|
2000-12-12 02:16:50 +03:00
|
|
|
#ifdef ANCACHE
|
2001-06-21 16:49:06 +04:00
|
|
|
case AN_RID_ZERO_CACHE:
|
|
|
|
/* XXX suser()? -- should belong to SIOCSAIRONET */
|
|
|
|
sc->an_sigitems = sc->an_nextitem = 0;
|
|
|
|
goto out;
|
|
|
|
case AN_RID_READ_CACHE:
|
|
|
|
caddr_t pt = (char *)&areq->an_val;
|
|
|
|
memcpy(pt, &sc->an_sigitems, sizeof(int));
|
|
|
|
pt += sizeof(int);
|
|
|
|
areq->an_len = sizeof(int) / 2;
|
|
|
|
memcpy(pt, &sc->an_sigcache,
|
|
|
|
sizeof(struct an_sigcache) * sc->an_sigitems);
|
|
|
|
areq->an_len += ((sizeof(struct an_sigcache) *
|
|
|
|
sc->an_sigitems) / 2) + 1;
|
|
|
|
break;
|
2000-12-12 02:16:50 +03:00
|
|
|
#endif
|
2001-06-21 16:49:06 +04:00
|
|
|
default:
|
|
|
|
if (an_read_record(sc, (struct an_ltv_gen *)areq)) {
|
|
|
|
error = EINVAL;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
error = copyout(areq, ifr->ifr_data, sizeof(struct an_req));
|
|
|
|
break;
|
|
|
|
case SIOCSAIRONET:
|
|
|
|
if ((error = suser(curproc->p_ucred, &curproc->p_acflag)))
|
|
|
|
break;
|
|
|
|
areq = &sc->an_reqbuf;
|
|
|
|
error = copyin(ifr->ifr_data, areq, sizeof(struct an_req));
|
|
|
|
if (error)
|
|
|
|
break;
|
|
|
|
error = an_setdef(sc, areq);
|
|
|
|
break;
|
|
|
|
case SIOCS80211NWID:
|
|
|
|
error = copyin(ifr->ifr_data, &nwid, sizeof(nwid));
|
|
|
|
if (error)
|
|
|
|
break;
|
|
|
|
if (nwid.i_len > IEEE80211_NWID_LEN) {
|
|
|
|
error = EINVAL;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (sc->an_ssidlist.an_ssid1_len == nwid.i_len &&
|
|
|
|
memcmp(sc->an_ssidlist.an_ssid1, nwid.i_nwid, nwid.i_len)
|
|
|
|
== 0)
|
|
|
|
break;
|
|
|
|
memset(sc->an_ssidlist.an_ssid1, 0, IEEE80211_NWID_LEN);
|
|
|
|
sc->an_ssidlist.an_ssid1_len = nwid.i_len;
|
|
|
|
memcpy(sc->an_ssidlist.an_ssid1, nwid.i_nwid, nwid.i_len);
|
|
|
|
error = ENETRESET;
|
|
|
|
break;
|
|
|
|
case SIOCG80211NWID:
|
|
|
|
memset(&nwid, 0, sizeof(nwid));
|
|
|
|
if (sc->sc_enabled && sc->an_associated) {
|
|
|
|
nwid.i_len = sc->an_status.an_ssidlen;
|
|
|
|
memcpy(nwid.i_nwid, sc->an_status.an_ssid, nwid.i_len);
|
|
|
|
} else {
|
|
|
|
nwid.i_len = sc->an_ssidlist.an_ssid1_len;
|
|
|
|
memcpy(nwid.i_nwid, sc->an_ssidlist.an_ssid1,
|
|
|
|
nwid.i_len);
|
|
|
|
}
|
|
|
|
error = copyout(&nwid, ifr->ifr_data, sizeof(nwid));
|
|
|
|
break;
|
|
|
|
case SIOCS80211NWKEY:
|
|
|
|
error = an_set_nwkey(sc, (struct ieee80211_nwkey *)data);
|
|
|
|
break;
|
|
|
|
case SIOCG80211NWKEY:
|
|
|
|
error = an_get_nwkey(sc, (struct ieee80211_nwkey *)data);
|
|
|
|
break;
|
|
|
|
case SIOCS80211POWER:
|
|
|
|
power = (struct ieee80211_power *)data;
|
|
|
|
sc->an_config.an_psave_mode = power->i_enabled ?
|
|
|
|
AN_PSAVE_PSP : AN_PSAVE_NONE;
|
|
|
|
sc->an_config.an_listen_interval = power->i_maxsleep;
|
|
|
|
error = ENETRESET;
|
|
|
|
break;
|
|
|
|
case SIOCG80211POWER:
|
|
|
|
power = (struct ieee80211_power *)data;
|
|
|
|
power->i_enabled =
|
|
|
|
sc->an_config.an_psave_mode != AN_PSAVE_NONE ? 1 : 0;
|
|
|
|
power->i_maxsleep = sc->an_config.an_listen_interval;
|
|
|
|
break;
|
|
|
|
#ifdef IFM_IEEE80211
|
|
|
|
case SIOCSIFMEDIA:
|
|
|
|
case SIOCGIFMEDIA:
|
|
|
|
error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, command);
|
|
|
|
break;
|
|
|
|
#endif
|
|
|
|
case SIOCADDMULTI:
|
|
|
|
case SIOCDELMULTI:
|
|
|
|
error = ether_ioctl(ifp, command, data);
|
|
|
|
if (error == ENETRESET) {
|
|
|
|
/* we don't have multicast filter. */
|
|
|
|
error = 0;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
error = ether_ioctl(ifp, command, data);
|
|
|
|
break;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
2001-06-21 16:49:06 +04:00
|
|
|
if (error == ENETRESET) {
|
|
|
|
if (sc->sc_enabled)
|
|
|
|
error = an_init(ifp);
|
|
|
|
else
|
|
|
|
error = 0;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
#ifdef ANCACHE
|
2001-06-21 16:49:06 +04:00
|
|
|
out:
|
2000-12-12 02:16:50 +03:00
|
|
|
#endif
|
2001-06-21 16:49:06 +04:00
|
|
|
splx(s);
|
|
|
|
return error;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static int
|
|
|
|
an_set_nwkey(struct an_softc *sc, struct ieee80211_nwkey *nwkey)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-29 15:24:42 +04:00
|
|
|
int error;
|
2001-06-21 16:49:06 +04:00
|
|
|
u_int16_t prevauth;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
error = 0;
|
|
|
|
prevauth = sc->an_config.an_authtype;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
switch (nwkey->i_wepon) {
|
|
|
|
case IEEE80211_NWKEY_OPEN:
|
|
|
|
sc->an_config.an_authtype = AN_AUTHTYPE_OPEN;
|
|
|
|
break;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
case IEEE80211_NWKEY_WEP:
|
|
|
|
case IEEE80211_NWKEY_WEP | IEEE80211_NWKEY_PERSIST:
|
2001-06-29 15:24:42 +04:00
|
|
|
error = an_set_nwkey_wep(sc, nwkey);
|
|
|
|
if (error == 0 || error == ENETRESET)
|
2001-06-21 16:49:06 +04:00
|
|
|
sc->an_config.an_authtype =
|
|
|
|
AN_AUTHTYPE_OPEN | AN_AUTHTYPE_PRIVACY_IN_USE;
|
2001-06-29 15:24:42 +04:00
|
|
|
break;
|
|
|
|
|
|
|
|
case IEEE80211_NWKEY_EAP:
|
|
|
|
error = an_set_nwkey_eap(sc, nwkey);
|
|
|
|
if (error == 0 || error == ENETRESET)
|
|
|
|
sc->an_config.an_authtype = AN_AUTHTYPE_OPEN |
|
|
|
|
AN_AUTHTYPE_PRIVACY_IN_USE | AN_AUTHTYPE_LEAP;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
error = EINVAL;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (error == 0 && prevauth != sc->an_config.an_authtype)
|
|
|
|
error = ENETRESET;
|
|
|
|
return error;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
an_set_nwkey_wep(struct an_softc *sc, struct ieee80211_nwkey *nwkey)
|
|
|
|
{
|
|
|
|
int i, txkey, anysetkey, needreset, error;
|
2001-07-18 06:06:44 +04:00
|
|
|
struct an_wepkey keys[IEEE80211_WEP_NKID];
|
2001-06-29 15:24:42 +04:00
|
|
|
|
|
|
|
error = 0;
|
|
|
|
memset(keys, 0, sizeof(keys));
|
|
|
|
anysetkey = needreset = 0;
|
|
|
|
|
|
|
|
/* load argument and sanity check */
|
2001-07-18 06:06:44 +04:00
|
|
|
for (i = 0; i < IEEE80211_WEP_NKID; i++) {
|
|
|
|
keys[i].an_wep_keylen = nwkey->i_key[i].i_keylen;
|
|
|
|
if (keys[i].an_wep_keylen < 0)
|
2001-06-29 15:24:42 +04:00
|
|
|
continue;
|
2001-07-18 06:06:44 +04:00
|
|
|
if (keys[i].an_wep_keylen != 0 &&
|
|
|
|
keys[i].an_wep_keylen < IEEE80211_WEP_KEYLEN)
|
2001-06-29 15:24:42 +04:00
|
|
|
return EINVAL;
|
2001-07-18 06:06:44 +04:00
|
|
|
if (keys[i].an_wep_keylen > sizeof(keys[i].an_wep_key))
|
2001-06-29 15:24:42 +04:00
|
|
|
return EINVAL;
|
|
|
|
if ((error = copyin(nwkey->i_key[i].i_keydat,
|
2001-07-18 06:06:44 +04:00
|
|
|
keys[i].an_wep_key, keys[i].an_wep_keylen)) != 0)
|
2001-06-29 15:24:42 +04:00
|
|
|
return error;
|
|
|
|
anysetkey++;
|
|
|
|
}
|
|
|
|
txkey = nwkey->i_defkid - 1;
|
|
|
|
if (txkey >= 0) {
|
|
|
|
if (txkey >= IEEE80211_WEP_NKID)
|
|
|
|
return EINVAL;
|
|
|
|
/* default key must have a valid value */
|
|
|
|
if (keys[txkey].an_wep_keylen == 0 ||
|
|
|
|
(keys[txkey].an_wep_keylen < 0 &&
|
|
|
|
sc->an_perskeylen[txkey] == 0))
|
|
|
|
return EINVAL;
|
|
|
|
anysetkey++;
|
|
|
|
}
|
|
|
|
if (!(nwkey->i_wepon & IEEE80211_NWKEY_PERSIST)) {
|
|
|
|
/* set temporary keys */
|
|
|
|
sc->an_tx_key = txkey;
|
2001-07-18 06:06:44 +04:00
|
|
|
for (i = 0; i < IEEE80211_WEP_NKID; i++) {
|
2001-06-29 15:24:42 +04:00
|
|
|
if (keys[i].an_wep_keylen < 0)
|
|
|
|
continue;
|
2001-07-18 06:06:44 +04:00
|
|
|
memcpy(&sc->an_wepkeys[i], &keys[i], sizeof(keys[i]));
|
2001-06-21 16:49:06 +04:00
|
|
|
}
|
2001-06-29 15:24:42 +04:00
|
|
|
} else {
|
|
|
|
/* set persist keys */
|
2001-06-21 16:49:06 +04:00
|
|
|
if (anysetkey) {
|
2001-06-29 15:24:42 +04:00
|
|
|
/* prepare to write nvram */
|
2001-06-21 16:49:06 +04:00
|
|
|
if (!sc->sc_enabled) {
|
2001-06-29 15:24:42 +04:00
|
|
|
if (sc->sc_enable)
|
2001-06-21 16:49:06 +04:00
|
|
|
(*sc->sc_enable)(sc);
|
2001-06-29 15:24:42 +04:00
|
|
|
an_wait(sc);
|
2001-06-21 16:49:06 +04:00
|
|
|
sc->sc_enabled = 1;
|
|
|
|
error = an_write_wepkey(sc,
|
2001-06-29 15:24:42 +04:00
|
|
|
AN_RID_WEP_PERSISTENT, keys, txkey);
|
2001-06-21 16:49:06 +04:00
|
|
|
if (sc->sc_disable)
|
|
|
|
(*sc->sc_disable)(sc);
|
|
|
|
sc->sc_enabled = 0;
|
|
|
|
} else {
|
|
|
|
an_cmd(sc, AN_CMD_DISABLE, 0);
|
|
|
|
error = an_write_wepkey(sc,
|
2001-06-29 15:24:42 +04:00
|
|
|
AN_RID_WEP_PERSISTENT, keys, txkey);
|
2001-06-21 16:49:06 +04:00
|
|
|
an_cmd(sc, AN_CMD_ENABLE, 0);
|
|
|
|
}
|
|
|
|
if (error)
|
2001-06-29 15:24:42 +04:00
|
|
|
return error;
|
2001-06-21 16:49:06 +04:00
|
|
|
}
|
2001-06-29 15:24:42 +04:00
|
|
|
if (txkey >= 0)
|
|
|
|
sc->an_tx_perskey = txkey;
|
|
|
|
if (sc->an_tx_key >= 0) {
|
|
|
|
sc->an_tx_key = -1;
|
2001-06-21 16:49:06 +04:00
|
|
|
needreset++;
|
2001-06-29 15:24:42 +04:00
|
|
|
}
|
2001-06-21 16:49:06 +04:00
|
|
|
for (i = 0; i < IEEE80211_WEP_NKID; i++) {
|
2001-06-29 15:24:42 +04:00
|
|
|
if (sc->an_wepkeys[i].an_wep_keylen >= 0) {
|
2001-06-21 16:49:06 +04:00
|
|
|
memset(&sc->an_wepkeys[i].an_wep_key, 0,
|
|
|
|
sizeof(sc->an_wepkeys[i].an_wep_key));
|
|
|
|
sc->an_wepkeys[i].an_wep_keylen = -1;
|
2001-06-29 15:24:42 +04:00
|
|
|
needreset++;
|
2001-06-21 16:49:06 +04:00
|
|
|
}
|
|
|
|
if (keys[i].an_wep_keylen >= 0)
|
|
|
|
sc->an_perskeylen[i] = keys[i].an_wep_keylen;
|
|
|
|
}
|
2001-06-29 15:24:42 +04:00
|
|
|
}
|
|
|
|
if (needreset) {
|
|
|
|
/* firmware restart to reload persistent key */
|
|
|
|
an_reset(sc);
|
|
|
|
}
|
|
|
|
if (anysetkey || needreset)
|
2001-06-21 16:49:06 +04:00
|
|
|
error = ENETRESET;
|
2001-06-29 15:24:42 +04:00
|
|
|
return error;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
an_set_nwkey_eap(struct an_softc *sc, struct ieee80211_nwkey *nwkey)
|
|
|
|
{
|
|
|
|
int i, error;
|
|
|
|
struct an_ltv_leapkey *key;
|
|
|
|
u_int16_t unibuf[sizeof(key->an_key)];
|
|
|
|
MD4_CTX ctx;
|
|
|
|
|
|
|
|
error = 0;
|
|
|
|
|
|
|
|
if (nwkey->i_key[0].i_keydat == NULL &&
|
|
|
|
nwkey->i_key[1].i_keydat == NULL)
|
|
|
|
return 0;
|
|
|
|
if (!sc->sc_enabled)
|
|
|
|
return ENXIO;
|
|
|
|
an_cmd(sc, AN_CMD_DISABLE, 0);
|
|
|
|
key = (struct an_ltv_leapkey *)&sc->an_reqbuf;
|
|
|
|
if (nwkey->i_key[0].i_keydat != NULL) {
|
|
|
|
memset(key, 0, sizeof(*key));
|
|
|
|
key->an_type = AN_RID_LEAP_USER;
|
|
|
|
key->an_len = sizeof(*key);
|
|
|
|
key->an_key_len = nwkey->i_key[0].i_keylen;
|
|
|
|
if (key->an_key_len > sizeof(key->an_key))
|
|
|
|
return EINVAL;
|
|
|
|
if ((error = copyin(nwkey->i_key[0].i_keydat, key->an_key,
|
|
|
|
key->an_key_len)) != 0)
|
|
|
|
return error;
|
|
|
|
an_write_record(sc, (struct an_ltv_gen *)key);
|
2001-06-21 16:49:06 +04:00
|
|
|
}
|
2001-06-29 15:24:42 +04:00
|
|
|
if (nwkey->i_key[1].i_keydat != NULL) {
|
|
|
|
memset(key, 0, sizeof(*key));
|
|
|
|
key->an_type = AN_RID_LEAP_PASS;
|
|
|
|
key->an_len = sizeof(*key);
|
|
|
|
key->an_key_len = nwkey->i_key[1].i_keylen;
|
|
|
|
if (key->an_key_len > sizeof(key->an_key))
|
|
|
|
return EINVAL;
|
|
|
|
if ((error = copyin(nwkey->i_key[1].i_keydat, key->an_key,
|
|
|
|
key->an_key_len)) != 0)
|
|
|
|
return error;
|
|
|
|
/*
|
|
|
|
* Cisco seems to use PasswordHash and PasswordHashHash
|
|
|
|
* in RFC-2759 (MS-CHAP-V2).
|
|
|
|
*/
|
|
|
|
memset(unibuf, 0, sizeof(unibuf));
|
|
|
|
/* XXX: convert password to unicode */
|
|
|
|
for (i = 0; i < key->an_key_len; i++)
|
|
|
|
unibuf[i] = key->an_key[i];
|
|
|
|
/* set PasswordHash */
|
|
|
|
MD4Init(&ctx);
|
|
|
|
MD4Update(&ctx, (u_int8_t *)unibuf, key->an_key_len * 2);
|
|
|
|
MD4Final(key->an_key, &ctx);
|
|
|
|
/* set PasswordHashHash */
|
|
|
|
MD4Init(&ctx);
|
|
|
|
MD4Update(&ctx, key->an_key, 16);
|
|
|
|
MD4Final(key->an_key + 16, &ctx);
|
|
|
|
key->an_key_len = 32;
|
|
|
|
an_write_record(sc, (struct an_ltv_gen *)key);
|
|
|
|
}
|
|
|
|
error = an_cmd(sc, AN_CMD_ENABLE, 0);
|
|
|
|
if (error)
|
|
|
|
printf("%s: an_set_nwkey: failed to enable MAC\n",
|
|
|
|
sc->an_dev.dv_xname);
|
|
|
|
else
|
2001-06-21 16:49:06 +04:00
|
|
|
error = ENETRESET;
|
|
|
|
return error;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static int
|
|
|
|
an_get_nwkey(struct an_softc *sc, struct ieee80211_nwkey *nwkey)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
int i, error;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
error = 0;
|
|
|
|
if (sc->an_config.an_authtype & AN_AUTHTYPE_LEAP)
|
|
|
|
nwkey->i_wepon = IEEE80211_NWKEY_EAP;
|
|
|
|
else if (sc->an_config.an_authtype & AN_AUTHTYPE_PRIVACY_IN_USE)
|
|
|
|
nwkey->i_wepon = IEEE80211_NWKEY_WEP;
|
2000-12-12 02:16:50 +03:00
|
|
|
else
|
2001-06-21 16:49:06 +04:00
|
|
|
nwkey->i_wepon = IEEE80211_NWKEY_OPEN;
|
|
|
|
if (sc->an_tx_key == -1)
|
|
|
|
nwkey->i_defkid = sc->an_tx_perskey + 1;
|
|
|
|
else
|
|
|
|
nwkey->i_defkid = sc->an_tx_key + 1;
|
|
|
|
if (nwkey->i_key[0].i_keydat == NULL)
|
|
|
|
return 0;
|
|
|
|
for (i = 0; i < IEEE80211_WEP_NKID; i++) {
|
|
|
|
if (nwkey->i_key[i].i_keydat == NULL)
|
|
|
|
continue;
|
|
|
|
/* do not show any keys to non-root user */
|
|
|
|
if ((error = suser(curproc->p_ucred, &curproc->p_acflag)) != 0)
|
|
|
|
break;
|
|
|
|
nwkey->i_key[i].i_keylen = sc->an_wepkeys[i].an_wep_keylen;
|
|
|
|
if (nwkey->i_key[i].i_keylen < 0) {
|
|
|
|
if (sc->an_perskeylen[i] == 0)
|
|
|
|
nwkey->i_key[i].i_keylen = 0;
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if ((error = copyout(sc->an_wepkeys[i].an_wep_key,
|
|
|
|
nwkey->i_key[i].i_keydat,
|
|
|
|
sc->an_wepkeys[i].an_wep_keylen)) != 0)
|
|
|
|
break;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
2001-06-21 16:49:06 +04:00
|
|
|
return error;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static int
|
|
|
|
an_write_wepkey(struct an_softc *sc, int type, struct an_wepkey *keys, int kid)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
int i, error;
|
|
|
|
struct an_ltv_wepkey *akey;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
error = 0;
|
|
|
|
akey = (struct an_ltv_wepkey *)&sc->an_reqbuf;
|
|
|
|
memset(akey, 0, sizeof(struct an_ltv_wepkey));
|
|
|
|
akey->an_type = type;
|
|
|
|
akey->an_len = sizeof(struct an_ltv_wepkey);
|
|
|
|
for (i = 0; i < IEEE80211_WEP_NKID; i++) {
|
|
|
|
if (keys[i].an_wep_keylen < 0 ||
|
|
|
|
keys[i].an_wep_keylen > sizeof(akey->an_key))
|
|
|
|
continue;
|
|
|
|
akey->an_key_len = keys[i].an_wep_keylen;
|
|
|
|
akey->an_key_index = i;
|
|
|
|
akey->an_mac_addr[0] = 1; /* default mac */
|
|
|
|
memcpy(akey->an_key, keys[i].an_wep_key, akey->an_key_len);
|
|
|
|
error = an_write_record(sc, (struct an_ltv_gen *)akey);
|
|
|
|
if (error)
|
|
|
|
return error;
|
|
|
|
}
|
|
|
|
if (kid >= 0) {
|
|
|
|
akey->an_key_index = 0xffff;
|
|
|
|
akey->an_mac_addr[0] = kid;
|
|
|
|
akey->an_key_len = 0;
|
|
|
|
memset(akey->an_key, 0, sizeof(akey->an_key));
|
|
|
|
error = an_write_record(sc, (struct an_ltv_gen *)akey);
|
|
|
|
}
|
|
|
|
return error;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
#ifdef IFM_IEEE80211
|
|
|
|
static int
|
|
|
|
an_media_change(struct ifnet *ifp)
|
|
|
|
{
|
|
|
|
struct an_softc *sc = ifp->if_softc;
|
|
|
|
struct ifmedia_entry *ime;
|
|
|
|
int error;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
error = 0;
|
|
|
|
ime = sc->sc_media.ifm_cur;
|
|
|
|
switch (IFM_SUBTYPE(ime->ifm_media)) {
|
|
|
|
case IFM_AUTO:
|
|
|
|
sc->an_tx_rate = 0;
|
|
|
|
break;
|
|
|
|
case IFM_IEEE80211_DS1:
|
|
|
|
sc->an_tx_rate = AN_RATE_1MBPS;
|
|
|
|
break;
|
|
|
|
case IFM_IEEE80211_DS2:
|
|
|
|
sc->an_tx_rate = AN_RATE_2MBPS;
|
|
|
|
break;
|
|
|
|
case IFM_IEEE80211_DS5:
|
|
|
|
sc->an_tx_rate = AN_RATE_5_5MBPS;
|
|
|
|
break;
|
|
|
|
case IFM_IEEE80211_DS11:
|
|
|
|
sc->an_tx_rate = AN_RATE_11MBPS;
|
|
|
|
break;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
2001-06-21 16:49:06 +04:00
|
|
|
if (ime->ifm_media & IFM_IEEE80211_ADHOC)
|
|
|
|
sc->an_config.an_opmode = AN_OPMODE_IBSS_ADHOC;
|
|
|
|
else
|
|
|
|
sc->an_config.an_opmode = AN_OPMODE_INFRASTRUCTURE_STATION;
|
|
|
|
/*
|
|
|
|
* XXX: how to set txrate for the firmware?
|
|
|
|
* There is a struct defined as an_txframe, which is used nowhere.
|
|
|
|
* Perhaps we need to change the transmit mode from 802.3 to native.
|
|
|
|
*/
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* we cannot return ENETRESET here */
|
|
|
|
if (sc->sc_enabled)
|
|
|
|
error = an_init(ifp);
|
|
|
|
return error;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static void
|
|
|
|
an_media_status(ifp, imr)
|
|
|
|
struct ifnet *ifp;
|
|
|
|
struct ifmediareq *imr;
|
|
|
|
{
|
|
|
|
struct an_softc *sc = ifp->if_softc;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
imr->ifm_status = IFM_AVALID;
|
|
|
|
imr->ifm_active = IFM_IEEE80211;
|
|
|
|
if (sc->sc_enabled && sc->an_associated) {
|
|
|
|
imr->ifm_status |= IFM_ACTIVE;
|
|
|
|
switch (sc->an_status.an_current_tx_rate) {
|
|
|
|
case 0:
|
|
|
|
imr->ifm_active |= IFM_AUTO;
|
|
|
|
break;
|
|
|
|
case AN_RATE_1MBPS:
|
|
|
|
imr->ifm_active |= IFM_IEEE80211_DS1;
|
|
|
|
break;
|
|
|
|
case AN_RATE_2MBPS:
|
|
|
|
imr->ifm_active |= IFM_IEEE80211_DS2;
|
|
|
|
break;
|
|
|
|
case AN_RATE_5_5MBPS:
|
|
|
|
imr->ifm_active |= IFM_IEEE80211_DS5;
|
|
|
|
break;
|
|
|
|
case AN_RATE_11MBPS:
|
|
|
|
imr->ifm_active |= IFM_IEEE80211_DS11;
|
|
|
|
break;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
2001-06-21 16:49:06 +04:00
|
|
|
if ((sc->an_config.an_opmode & 0x0f) == AN_OPMODE_IBSS_ADHOC)
|
|
|
|
imr->ifm_active |= IFM_IEEE80211_ADHOC;
|
|
|
|
}
|
|
|
|
#endif /* IFM_IEEE80211 */
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static int
|
|
|
|
an_init_tx_ring(struct an_softc *sc)
|
|
|
|
{
|
|
|
|
int i, id;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
for (i = 0; i < AN_TX_RING_CNT; i++) {
|
|
|
|
if (an_alloc_nicmem(sc,
|
|
|
|
ETHER_MAX_LEN + ETHER_TYPE_LEN + AN_802_11_OFFSET, &id))
|
|
|
|
return ENOMEM;
|
|
|
|
sc->an_rdata.an_tx_fids[i] = id;
|
|
|
|
sc->an_rdata.an_tx_ring[i] = 0;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
sc->an_rdata.an_tx_prod = 0;
|
|
|
|
sc->an_rdata.an_tx_cons = 0;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
an_init(struct ifnet *ifp)
|
|
|
|
{
|
|
|
|
struct an_softc *sc = (struct an_softc *)ifp->if_softc;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (sc->sc_enabled) {
|
|
|
|
an_stop(ifp, 0);
|
|
|
|
} else {
|
|
|
|
if (sc->sc_enable)
|
|
|
|
(*sc->sc_enable)(sc);
|
|
|
|
sc->sc_enabled = 1;
|
|
|
|
an_wait(sc);
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
sc->an_associated = 0;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Allocate the TX buffers */
|
|
|
|
if (an_init_tx_ring(sc)) {
|
|
|
|
an_reset(sc);
|
|
|
|
if (an_init_tx_ring(sc)) {
|
|
|
|
printf("%s: tx buffer allocation failed\n",
|
|
|
|
sc->an_dev.dv_xname);
|
|
|
|
an_stop(ifp, 1);
|
|
|
|
return ENOMEM;
|
|
|
|
}
|
2000-12-19 11:00:55 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Set our MAC address. */
|
|
|
|
memcpy(sc->an_config.an_macaddr, sc->an_caps.an_oemaddr,
|
|
|
|
ETHER_ADDR_LEN);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (ifp->if_flags & IFF_MULTICAST)
|
|
|
|
sc->an_config.an_rxmode = AN_RXMODE_BC_MC_ADDR;
|
|
|
|
else if (ifp->if_flags & IFF_BROADCAST)
|
|
|
|
sc->an_config.an_rxmode = AN_RXMODE_BC_ADDR;
|
|
|
|
else
|
|
|
|
sc->an_config.an_rxmode = AN_RXMODE_ADDR;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Set the ssid list */
|
|
|
|
sc->an_ssidlist.an_type = AN_RID_SSIDLIST;
|
|
|
|
sc->an_ssidlist.an_len = sizeof(struct an_ltv_ssidlist);
|
|
|
|
if (an_write_record(sc, (struct an_ltv_gen *)&sc->an_ssidlist)) {
|
|
|
|
printf("%s: failed to set ssid list\n", sc->an_dev.dv_xname);
|
|
|
|
an_stop(ifp, 1);
|
|
|
|
return ENXIO;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Set the AP list */
|
|
|
|
sc->an_aplist.an_type = AN_RID_APLIST;
|
|
|
|
sc->an_aplist.an_len = sizeof(struct an_ltv_aplist);
|
|
|
|
if (an_write_record(sc, (struct an_ltv_gen *)&sc->an_aplist)) {
|
|
|
|
printf("%s: failed to set AP list\n", sc->an_dev.dv_xname);
|
|
|
|
an_stop(ifp, 1);
|
|
|
|
return ENXIO;
|
|
|
|
}
|
2000-12-21 18:37:18 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Set the configuration in the NIC */
|
|
|
|
sc->an_config.an_len = sizeof(struct an_ltv_genconfig);
|
|
|
|
sc->an_config.an_type = AN_RID_GENCONFIG;
|
|
|
|
if (an_write_record(sc, (struct an_ltv_gen *)&sc->an_config)) {
|
|
|
|
printf("%s: failed to set configuration\n", sc->an_dev.dv_xname);
|
|
|
|
an_stop(ifp, 1);
|
|
|
|
return ENXIO;
|
2000-12-21 18:37:18 +03:00
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Set the WEP Keys */
|
|
|
|
if ((sc->an_config.an_authtype & AN_AUTHTYPE_PRIVACY_IN_USE) != 0)
|
|
|
|
an_write_wepkey(sc, AN_RID_WEP_VOLATILE, sc->an_wepkeys,
|
|
|
|
sc->an_tx_key);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Enable the MAC */
|
|
|
|
if (an_cmd(sc, AN_CMD_ENABLE, 0)) {
|
|
|
|
printf("%s: failed to enable MAC\n", sc->an_dev.dv_xname);
|
|
|
|
an_stop(ifp, 1);
|
|
|
|
return ENXIO;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
an_cmd(sc, AN_CMD_SET_MODE, (ifp->if_flags & IFF_PROMISC) ? 0xffff : 0);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* enable interrupts */
|
|
|
|
CSR_WRITE_2(sc, AN_INT_EN, AN_INTRS);
|
2000-12-21 18:37:18 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
ifp->if_flags |= IFF_RUNNING;
|
|
|
|
ifp->if_flags &= ~IFF_OACTIVE;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
callout_reset(&sc->an_stat_ch, hz, an_stats_update, sc);
|
2000-12-21 18:37:18 +03:00
|
|
|
return 0;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2000-12-19 11:00:55 +03:00
|
|
|
static void
|
2001-06-21 16:49:06 +04:00
|
|
|
an_start(struct ifnet *ifp)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
struct an_softc *sc = (struct an_softc *)ifp->if_softc;
|
|
|
|
struct mbuf *m0 = NULL, *m;
|
|
|
|
struct an_txframe_802_3 tx_frame_802_3;
|
|
|
|
struct ether_header *eh;
|
|
|
|
int id, idx;
|
|
|
|
u_int16_t txctl;
|
|
|
|
|
2000-12-12 02:58:55 +03:00
|
|
|
if (!sc->sc_enabled)
|
2000-12-12 02:16:50 +03:00
|
|
|
return;
|
2000-12-19 11:00:55 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (ifp->if_flags & IFF_OACTIVE)
|
|
|
|
return;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (!sc->an_associated)
|
|
|
|
return;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
idx = sc->an_rdata.an_tx_prod;
|
|
|
|
memset(&tx_frame_802_3, 0, sizeof(tx_frame_802_3));
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
for (;;) {
|
|
|
|
IFQ_POLL(&ifp->if_snd, m0);
|
|
|
|
if (m0 == NULL)
|
|
|
|
break;
|
|
|
|
if (sc->an_rdata.an_tx_ring[idx] != 0)
|
|
|
|
break;
|
|
|
|
id = sc->an_rdata.an_tx_fids[idx];
|
|
|
|
IFQ_DEQUEUE(&ifp->if_snd, m0);
|
|
|
|
#if NBPFILTER > 0
|
|
|
|
/*
|
|
|
|
* If there's a BPF listner, bounce a copy of
|
|
|
|
* this frame to him.
|
|
|
|
*/
|
|
|
|
if (ifp->if_bpf)
|
|
|
|
bpf_mtap(ifp->if_bpf, m0);
|
|
|
|
#endif
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
txctl = AN_TXCTL_8023;
|
|
|
|
/* write the txctl only */
|
|
|
|
an_write_data(sc, id, 0x08, (caddr_t)&txctl, sizeof(txctl));
|
2000-12-19 11:00:55 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
eh = mtod(m0, struct ether_header *);
|
|
|
|
memcpy(tx_frame_802_3.an_tx_dst_addr, eh->ether_dhost,
|
|
|
|
ETHER_ADDR_LEN);
|
|
|
|
memcpy(tx_frame_802_3.an_tx_src_addr, eh->ether_shost,
|
|
|
|
ETHER_ADDR_LEN);
|
|
|
|
tx_frame_802_3.an_tx_802_3_payload_len =
|
|
|
|
m0->m_pkthdr.len - ETHER_ADDR_LEN * 2;
|
|
|
|
m_adj(m0, ETHER_ADDR_LEN * 2);
|
2000-12-19 11:00:55 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* 802_3 header */
|
|
|
|
an_write_data(sc, id, AN_802_3_OFFSET,
|
|
|
|
(caddr_t)&tx_frame_802_3, sizeof(struct an_txframe_802_3));
|
|
|
|
for (m = m0; m != NULL; m = m->m_next)
|
|
|
|
an_write_data(sc, id, -1, mtod(m, caddr_t), m->m_len);
|
|
|
|
m_freem(m0);
|
|
|
|
m0 = NULL;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
sc->an_rdata.an_tx_ring[idx] = id;
|
|
|
|
if (an_cmd(sc, AN_CMD_TX, id))
|
|
|
|
printf("%s: xmit failed\n", sc->an_dev.dv_xname);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
AN_INC(idx, AN_TX_RING_CNT);
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (m0 != NULL)
|
|
|
|
ifp->if_flags |= IFF_OACTIVE;
|
|
|
|
|
|
|
|
sc->an_rdata.an_tx_prod = idx;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
|
|
|
/*
|
2001-06-21 16:49:06 +04:00
|
|
|
* Set a timeout in case the chip goes out to lunch.
|
2000-12-12 02:16:50 +03:00
|
|
|
*/
|
2001-06-21 16:49:06 +04:00
|
|
|
ifp->if_timer = 5;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
void
|
|
|
|
an_stop(struct ifnet *ifp, int disable)
|
|
|
|
{
|
|
|
|
struct an_softc *sc = (struct an_softc *)ifp->if_softc;
|
|
|
|
int i;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
callout_stop(&sc->an_stat_ch);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
ifp->if_flags &= ~(IFF_RUNNING|IFF_OACTIVE);
|
|
|
|
ifp->if_timer = 0;
|
|
|
|
|
|
|
|
if (!sc->sc_enabled)
|
|
|
|
return;
|
|
|
|
|
|
|
|
an_cmd(sc, AN_CMD_FORCE_SYNCLOSS, 0);
|
|
|
|
CSR_WRITE_2(sc, AN_INT_EN, 0);
|
|
|
|
an_cmd(sc, AN_CMD_DISABLE, 0);
|
|
|
|
|
|
|
|
for (i = 0; i < AN_TX_RING_CNT; i++)
|
|
|
|
an_cmd(sc, AN_CMD_DEALLOC_MEM, sc->an_rdata.an_tx_fids[i]);
|
|
|
|
|
|
|
|
if (disable) {
|
|
|
|
if (sc->sc_disable)
|
|
|
|
(*sc->sc_disable)(sc);
|
|
|
|
sc->sc_enabled = 0;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static void
|
|
|
|
an_watchdog(struct ifnet *ifp)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
struct an_softc *sc;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
sc = ifp->if_softc;
|
|
|
|
if (!sc->sc_enabled)
|
|
|
|
return;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
printf("%s: device timeout\n", sc->an_dev.dv_xname);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
an_reset(sc);
|
|
|
|
an_init(ifp);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
ifp->if_oerrors++;
|
|
|
|
return;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/*
|
|
|
|
* Low level functions
|
|
|
|
*/
|
|
|
|
|
|
|
|
static void
|
|
|
|
an_rxeof(struct an_softc *sc)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
struct ifnet *ifp = &sc->arpcom.ec_if;
|
|
|
|
struct ether_header *eh;
|
|
|
|
#ifdef ANCACHE
|
|
|
|
struct an_rxframe rx_frame;
|
|
|
|
#endif
|
|
|
|
struct an_rxframe_802_3 rx_frame_802_3;
|
|
|
|
struct mbuf *m;
|
|
|
|
int id, error = 0;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
id = CSR_READ_2(sc, AN_RX_FID);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
MGETHDR(m, M_DONTWAIT, MT_DATA);
|
|
|
|
if (m == NULL) {
|
|
|
|
ifp->if_ierrors++;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
MCLGET(m, M_DONTWAIT);
|
|
|
|
if (!(m->m_flags & M_EXT)) {
|
|
|
|
m_freem(m);
|
|
|
|
ifp->if_ierrors++;
|
|
|
|
return;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
m->m_pkthdr.rcvif = ifp;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Align the data after the ethernet header */
|
|
|
|
m->m_data = (caddr_t) ALIGN(m->m_data + sizeof(struct ether_header)) -
|
|
|
|
sizeof(struct ether_header);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
eh = mtod(m, struct ether_header *);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
#ifdef ANCACHE
|
|
|
|
/* Read NIC frame header */
|
|
|
|
if (an_read_data(sc, id, 0, (caddr_t)&rx_frame, sizeof(rx_frame))) {
|
|
|
|
ifp->if_ierrors++;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
/* Read in the 802_3 frame header */
|
|
|
|
if (an_read_data(sc, id, AN_802_3_OFFSET, (caddr_t)&rx_frame_802_3,
|
|
|
|
sizeof(rx_frame_802_3))) {
|
|
|
|
ifp->if_ierrors++;
|
|
|
|
return;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (rx_frame_802_3.an_rx_802_3_status != 0) {
|
|
|
|
ifp->if_ierrors++;
|
|
|
|
return;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Check for insane frame length */
|
|
|
|
if (rx_frame_802_3.an_rx_802_3_payload_len > MCLBYTES) {
|
|
|
|
ifp->if_ierrors++;
|
|
|
|
return;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
m->m_pkthdr.len = m->m_len =
|
|
|
|
rx_frame_802_3.an_rx_802_3_payload_len + ETHER_ADDR_LEN * 2;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
memcpy(&eh->ether_dhost, &rx_frame_802_3.an_rx_dst_addr,
|
|
|
|
ETHER_ADDR_LEN);
|
|
|
|
memcpy(&eh->ether_shost, &rx_frame_802_3.an_rx_src_addr,
|
|
|
|
ETHER_ADDR_LEN);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* in mbuf header type is just before payload */
|
|
|
|
error = an_read_data(sc, id, -1, (caddr_t)&(eh->ether_type),
|
|
|
|
rx_frame_802_3.an_rx_802_3_payload_len);
|
|
|
|
|
|
|
|
if (error) {
|
|
|
|
m_freem(m);
|
|
|
|
ifp->if_ierrors++;
|
|
|
|
return;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
ifp->if_ipackets++;
|
|
|
|
|
|
|
|
/* Receive packet. */
|
|
|
|
#ifdef ANCACHE
|
|
|
|
an_cache_store(sc, eh, m, rx_frame.an_rx_signal_strength);
|
|
|
|
#endif
|
|
|
|
#if NBPFILTER > 0
|
|
|
|
if (ifp->if_bpf)
|
|
|
|
bpf_mtap(ifp->if_bpf, m);
|
|
|
|
#endif
|
|
|
|
(*ifp->if_input)(ifp, m);
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static void
|
|
|
|
an_txeof(struct an_softc *sc, int status)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
struct ifnet *ifp = &sc->arpcom.ec_if;
|
|
|
|
int i, id;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
ifp->if_timer = 0;
|
|
|
|
ifp->if_flags &= ~IFF_OACTIVE;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
id = CSR_READ_2(sc, AN_TX_CMP_FID);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (status & AN_EV_TX_EXC)
|
|
|
|
ifp->if_oerrors++;
|
|
|
|
else
|
|
|
|
ifp->if_opackets++;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* fix from Doug Ambrisko -wsr */
|
|
|
|
for (i = 0; i < AN_TX_RING_CNT; i++) {
|
|
|
|
if (id == sc->an_rdata.an_tx_ring[i]) {
|
|
|
|
sc->an_rdata.an_tx_ring[i] = 0;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (i != sc->an_rdata.an_tx_cons) {
|
|
|
|
if (ifp->if_flags & IFF_DEBUG)
|
|
|
|
printf("%s: id mismatch: id %x, "
|
|
|
|
"expected %x(%d), actual %x(%d)\n",
|
|
|
|
sc->an_dev.dv_xname, id,
|
|
|
|
sc->an_rdata.an_tx_ring[sc->an_rdata.an_tx_cons],
|
|
|
|
sc->an_rdata.an_tx_cons, id, i);
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
AN_INC(sc->an_rdata.an_tx_cons, AN_TX_RING_CNT);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
return;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/*
|
|
|
|
* We abuse the stats updater to check the current NIC status. This
|
|
|
|
* is important because we don't want to allow transmissions until
|
|
|
|
* the NIC has synchronized to the current cell (either as the master
|
|
|
|
* in an ad-hoc group, or as a station connected to an access point).
|
|
|
|
*/
|
|
|
|
void
|
|
|
|
an_stats_update(void *xsc)
|
|
|
|
{
|
|
|
|
struct an_softc *sc = xsc;
|
|
|
|
|
|
|
|
if (sc->sc_enabled) {
|
|
|
|
sc->an_status.an_type = AN_RID_STATUS;
|
|
|
|
sc->an_status.an_len = sizeof(struct an_ltv_status);
|
|
|
|
if (an_read_record(sc, (struct an_ltv_gen *)&sc->an_status)
|
|
|
|
== 0) {
|
|
|
|
if (sc->an_status.an_opmode & AN_STATUS_OPMODE_IN_SYNC)
|
|
|
|
sc->an_associated = 1;
|
|
|
|
else
|
|
|
|
sc->an_associated = 0;
|
|
|
|
#if 0
|
|
|
|
/* Don't do this while we're transmitting */
|
|
|
|
if (sc->arpcom.ec_if.if_flags & IFF_OACTIVE) {
|
|
|
|
sc->an_stats.an_len =
|
|
|
|
sizeof(struct an_ltv_stats);
|
|
|
|
sc->an_stats.an_type = AN_RID_32BITS_CUM;
|
|
|
|
an_read_record(sc,
|
|
|
|
(struct an_ltv_gen *)&sc->an_stats.an_len);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
callout_reset(&sc->an_stat_ch, hz, an_stats_update, sc);
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
int
|
|
|
|
an_intr(void *arg)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
struct an_softc *sc = arg;
|
|
|
|
struct ifnet *ifp = &sc->arpcom.ec_if;
|
|
|
|
u_int16_t status;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (!sc->sc_enabled)
|
|
|
|
return 0;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (!(ifp->if_flags & IFF_UP)) {
|
|
|
|
CSR_WRITE_2(sc, AN_EVENT_ACK, 0xFFFF);
|
|
|
|
CSR_WRITE_2(sc, AN_INT_EN, 0);
|
|
|
|
return 0;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Disable interrupts. */
|
|
|
|
CSR_WRITE_2(sc, AN_INT_EN, 0);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
while ((status = (CSR_READ_2(sc, AN_EVENT_STAT) & AN_INTRS)) != 0) {
|
|
|
|
if (status & AN_EV_RX) {
|
|
|
|
an_rxeof(sc);
|
|
|
|
CSR_WRITE_2(sc, AN_EVENT_ACK, AN_EV_RX);
|
|
|
|
status &= ~AN_EV_RX;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
2001-06-21 16:49:06 +04:00
|
|
|
if (status & (AN_EV_TX | AN_EV_TX_EXC)) {
|
|
|
|
an_txeof(sc, status);
|
|
|
|
CSR_WRITE_2(sc, AN_EVENT_ACK,
|
|
|
|
status & (AN_EV_TX | AN_EV_TX_EXC));
|
|
|
|
status &= ~(AN_EV_TX | AN_EV_TX_EXC);
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
2001-06-21 16:49:06 +04:00
|
|
|
if (status & AN_EV_LINKSTAT) {
|
|
|
|
if (CSR_READ_2(sc, AN_LINKSTAT) ==
|
|
|
|
AN_LINKSTAT_ASSOCIATED)
|
|
|
|
sc->an_associated = 1;
|
|
|
|
else
|
|
|
|
sc->an_associated = 0;
|
|
|
|
CSR_WRITE_2(sc, AN_EVENT_ACK, AN_EV_LINKSTAT);
|
|
|
|
status &= ~AN_EV_LINKSTAT;
|
2000-12-13 23:21:10 +03:00
|
|
|
}
|
2001-06-21 16:49:06 +04:00
|
|
|
#if 0
|
|
|
|
if (status & AN_EV_CMD) {
|
|
|
|
wakeup(sc);
|
|
|
|
CSR_WRITE_2(sc, AN_EVENT_ACK, AN_EV_CMD);
|
|
|
|
status &= ~AN_EV_CMD;
|
2000-12-13 23:21:10 +03:00
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
#endif
|
2001-06-21 16:49:06 +04:00
|
|
|
if (status)
|
|
|
|
CSR_WRITE_2(sc, AN_EVENT_ACK, status);
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Re-enable interrupts. */
|
|
|
|
CSR_WRITE_2(sc, AN_INT_EN, AN_INTRS);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
|
|
|
|
an_start(ifp);
|
|
|
|
|
|
|
|
return 1;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static int
|
|
|
|
an_cmd(struct an_softc *sc, int cmd, int val)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
int i, stat;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* make sure that previous command completed */
|
|
|
|
if (CSR_READ_2(sc, AN_COMMAND) & AN_CMD_BUSY) {
|
|
|
|
if (sc->arpcom.ec_if.if_flags & IFF_DEBUG)
|
|
|
|
printf("%s: command 0x%x busy\n", sc->an_dev.dv_xname,
|
|
|
|
CSR_READ_2(sc, AN_COMMAND));
|
|
|
|
CSR_WRITE_2(sc, AN_EVENT_ACK, AN_EV_CLR_STUCK_BUSY);
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
CSR_WRITE_2(sc, AN_PARAM0, val);
|
|
|
|
CSR_WRITE_2(sc, AN_PARAM1, 0);
|
|
|
|
CSR_WRITE_2(sc, AN_PARAM2, 0);
|
|
|
|
CSR_WRITE_2(sc, AN_COMMAND, cmd);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
for (i = 0; i < AN_TIMEOUT; i++) {
|
|
|
|
if (CSR_READ_2(sc, AN_EVENT_STAT) & AN_EV_CMD)
|
|
|
|
break;
|
|
|
|
/* make sure the command is accepted */
|
|
|
|
if (CSR_READ_2(sc, AN_COMMAND) == cmd)
|
|
|
|
CSR_WRITE_2(sc, AN_COMMAND, cmd);
|
|
|
|
DELAY(10);
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
stat = CSR_READ_2(sc, AN_STATUS);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* clear stuck command busy if necessary */
|
|
|
|
if (CSR_READ_2(sc, AN_COMMAND) & AN_CMD_BUSY)
|
|
|
|
CSR_WRITE_2(sc, AN_EVENT_ACK, AN_EV_CLR_STUCK_BUSY);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Ack the command */
|
|
|
|
CSR_WRITE_2(sc, AN_EVENT_ACK, AN_EV_CMD);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (i == AN_TIMEOUT) {
|
|
|
|
if (sc->arpcom.ec_if.if_flags & IFF_DEBUG)
|
|
|
|
printf("%s: command 0x%x param 0x%x timeout\n",
|
|
|
|
sc->an_dev.dv_xname, cmd, val);
|
|
|
|
return ETIMEDOUT;
|
2000-12-19 11:00:55 +03:00
|
|
|
}
|
2001-06-21 16:49:06 +04:00
|
|
|
if (stat & AN_STAT_CMD_RESULT) {
|
|
|
|
if (sc->arpcom.ec_if.if_flags & IFF_DEBUG)
|
|
|
|
printf("%s: command 0x%x param 0x%x stat 0x%x\n",
|
|
|
|
sc->an_dev.dv_xname, cmd, val, stat);
|
|
|
|
return EIO;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
return 0;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/*
|
|
|
|
* This reset sequence may look a little strange, but this is the
|
|
|
|
* most reliable method I've found to really kick the NIC in the
|
|
|
|
* head and force it to reboot correctly.
|
|
|
|
*/
|
|
|
|
static void
|
|
|
|
an_reset(struct an_softc *sc)
|
|
|
|
{
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (!sc->sc_enabled)
|
|
|
|
return;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
an_cmd(sc, AN_CMD_ENABLE, 0);
|
|
|
|
an_cmd(sc, AN_CMD_FW_RESTART, 0);
|
|
|
|
an_cmd(sc, AN_CMD_NOOP2, 0);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (an_cmd(sc, AN_CMD_FORCE_SYNCLOSS, 0) == ETIMEDOUT)
|
|
|
|
printf("%s: reset failed\n", sc->an_dev.dv_xname);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
an_cmd(sc, AN_CMD_DISABLE, 0);
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/*
|
|
|
|
* Wait for firmware come up after power enabled.
|
|
|
|
*/
|
|
|
|
static void
|
|
|
|
an_wait(struct an_softc *sc)
|
|
|
|
{
|
|
|
|
int i;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
CSR_WRITE_2(sc, AN_COMMAND, AN_CMD_NOOP2);
|
|
|
|
for (i = 0; i < 3*hz; i++) {
|
|
|
|
if (CSR_READ_2(sc, AN_EVENT_STAT) & AN_EV_CMD)
|
|
|
|
break;
|
|
|
|
(void)tsleep(sc, PWAIT, "anatch", 1);
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
2001-06-21 16:49:06 +04:00
|
|
|
CSR_WRITE_2(sc, AN_EVENT_ACK, AN_EV_CMD);
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/*
|
|
|
|
* Read an LTV record from the NIC.
|
|
|
|
*/
|
|
|
|
static int
|
|
|
|
an_read_record(struct an_softc *sc, struct an_ltv_gen *ltv)
|
|
|
|
{
|
|
|
|
u_int16_t *ptr;
|
|
|
|
int i, len;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (ltv->an_len == 0 || ltv->an_type == 0)
|
|
|
|
return EINVAL;
|
2000-12-13 23:21:10 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Tell the NIC to enter record read mode. */
|
|
|
|
if (an_cmd(sc, AN_CMD_ACCESS|AN_ACCESS_READ, ltv->an_type))
|
|
|
|
return EIO;
|
|
|
|
|
|
|
|
/* Seek to the record. */
|
|
|
|
if (an_seek(sc, ltv->an_type, 0, AN_BAP1))
|
|
|
|
return EIO;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Read the length and record type and make sure they
|
|
|
|
* match what we expect (this verifies that we have enough
|
|
|
|
* room to hold all of the returned data).
|
|
|
|
*/
|
|
|
|
len = CSR_READ_2(sc, AN_DATA1);
|
|
|
|
if (len > ltv->an_len) {
|
|
|
|
if (sc->arpcom.ec_if.if_flags & IFF_DEBUG)
|
|
|
|
printf("%s: RID 0x%04x record length mismatch"
|
|
|
|
"-- expected %d, got %d\n", sc->an_dev.dv_xname,
|
|
|
|
ltv->an_type, ltv->an_len, len);
|
|
|
|
return ENOSPC;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
ltv->an_len = len;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/* Now read the data. */
|
|
|
|
ptr = <v->an_val;
|
|
|
|
for (i = 0; i < (ltv->an_len - 2) >> 1; i++)
|
|
|
|
ptr[i] = CSR_READ_2(sc, AN_DATA1);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/*
|
|
|
|
* Same as read, except we inject data instead of reading it.
|
|
|
|
*/
|
|
|
|
static int
|
|
|
|
an_write_record(struct an_softc *sc, struct an_ltv_gen *ltv)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
u_int16_t *ptr;
|
|
|
|
int i;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (an_cmd(sc, AN_CMD_ACCESS|AN_ACCESS_READ, ltv->an_type))
|
|
|
|
return EIO;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (an_seek(sc, ltv->an_type, 0, AN_BAP1))
|
|
|
|
return EIO;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
CSR_WRITE_2(sc, AN_DATA1, ltv->an_len-2);
|
|
|
|
|
|
|
|
ptr = <v->an_val;
|
|
|
|
for (i = 0; i < (ltv->an_len - 4) >> 1; i++)
|
|
|
|
CSR_WRITE_2(sc, AN_DATA1, ptr[i]);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (an_cmd(sc, AN_CMD_ACCESS|AN_ACCESS_WRITE, ltv->an_type))
|
|
|
|
return EIO;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
return 0;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static int
|
|
|
|
an_seek(struct an_softc *sc, int id, int off, int chan)
|
|
|
|
{
|
|
|
|
int i, selreg, offreg;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
switch (chan) {
|
|
|
|
case AN_BAP0:
|
|
|
|
selreg = AN_SEL0;
|
|
|
|
offreg = AN_OFF0;
|
|
|
|
break;
|
|
|
|
case AN_BAP1:
|
|
|
|
selreg = AN_SEL1;
|
|
|
|
offreg = AN_OFF1;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
panic("%s: invalid chan: %x\n", sc->an_dev.dv_xname, chan);
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
CSR_WRITE_2(sc, selreg, id);
|
|
|
|
CSR_WRITE_2(sc, offreg, off);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
for (i = 0; i < AN_TIMEOUT; i++) {
|
|
|
|
if (!(CSR_READ_2(sc, offreg) & (AN_OFF_BUSY|AN_OFF_ERR)))
|
|
|
|
break;
|
|
|
|
DELAY(10);
|
|
|
|
}
|
|
|
|
if (i == AN_TIMEOUT) {
|
|
|
|
if (sc->arpcom.ec_if.if_flags & IFF_DEBUG)
|
|
|
|
printf("%s: seek(0x%x, 0x%x, 0x%x) timeout\n",
|
|
|
|
sc->an_dev.dv_xname, id, off, chan);
|
|
|
|
return ETIMEDOUT;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
return 0;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static int
|
|
|
|
an_read_data(struct an_softc *sc, int id, int off, caddr_t buf, int len)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
u_int16_t *ptr;
|
|
|
|
u_int8_t *ptr2;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (off != -1) {
|
|
|
|
if (an_seek(sc, id, off, AN_BAP1))
|
|
|
|
return EIO;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
ptr = (u_int16_t *)buf;
|
|
|
|
for (i = 0; i < len / 2; i++)
|
|
|
|
ptr[i] = CSR_READ_2(sc, AN_DATA1);
|
|
|
|
i *= 2;
|
|
|
|
if (i < len){
|
|
|
|
ptr2 = (u_int8_t *)buf;
|
|
|
|
ptr2[i] = CSR_READ_1(sc, AN_DATA1);
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
return 0;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
static int
|
|
|
|
an_write_data(struct an_softc *sc, int id, int off, caddr_t buf, int len)
|
2000-12-12 02:16:50 +03:00
|
|
|
{
|
2001-06-21 16:49:06 +04:00
|
|
|
int i;
|
|
|
|
u_int16_t *ptr;
|
|
|
|
u_int8_t *ptr2;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (off != -1) {
|
|
|
|
if (an_seek(sc, id, off, AN_BAP0))
|
|
|
|
return EIO;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
ptr = (u_int16_t *)buf;
|
|
|
|
for (i = 0; i < (len / 2); i++)
|
|
|
|
CSR_WRITE_2(sc, AN_DATA0, ptr[i]);
|
|
|
|
i *= 2;
|
|
|
|
if (i < len){
|
|
|
|
ptr2 = (u_int8_t *)buf;
|
|
|
|
CSR_WRITE_1(sc, AN_DATA0, ptr2[i]);
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
return 0;
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
/*
|
|
|
|
* Allocate a region of memory inside the NIC and zero
|
|
|
|
* it out.
|
|
|
|
*/
|
|
|
|
static int
|
|
|
|
an_alloc_nicmem(struct an_softc *sc, int len, int *id)
|
|
|
|
{
|
|
|
|
int i;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (an_cmd(sc, AN_CMD_ALLOC_MEM, len)) {
|
|
|
|
printf("%s: failed to allocate %d bytes on NIC\n",
|
|
|
|
sc->an_dev.dv_xname, len);
|
|
|
|
return ENOMEM;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
for (i = 0; i < AN_TIMEOUT; i++) {
|
|
|
|
if (CSR_READ_2(sc, AN_EVENT_STAT) & AN_EV_ALLOC)
|
|
|
|
break;
|
|
|
|
DELAY(10);
|
|
|
|
}
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (i == AN_TIMEOUT)
|
|
|
|
return(ETIMEDOUT);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
CSR_WRITE_2(sc, AN_EVENT_ACK, AN_EV_ALLOC);
|
|
|
|
*id = CSR_READ_2(sc, AN_ALLOC_FID);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
if (an_seek(sc, *id, 0, AN_BAP0))
|
|
|
|
return EIO;
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
for (i = 0; i < len / 2; i++)
|
|
|
|
CSR_WRITE_2(sc, AN_DATA0, 0);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
2001-06-21 16:49:06 +04:00
|
|
|
return 0;
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef ANCACHE
|
|
|
|
/* Aironet signal strength cache code.
|
|
|
|
* store signal/noise/quality on per MAC src basis in
|
|
|
|
* a small fixed cache. The cache wraps if > MAX slots
|
|
|
|
* used. The cache may be zeroed out to start over.
|
|
|
|
* Two simple filters exist to reduce computation:
|
|
|
|
* 1. ip only (literally 0x800) which may be used
|
|
|
|
* to ignore some packets. It defaults to ip only.
|
|
|
|
* it could be used to focus on broadcast, non-IP 802.11 beacons.
|
|
|
|
* 2. multicast/broadcast only. This may be used to
|
|
|
|
* ignore unicast packets and only cache signal strength
|
|
|
|
* for multicast/broadcast packets (beacons); e.g., Mobile-IP
|
|
|
|
* beacons and not unicast traffic.
|
|
|
|
*
|
|
|
|
* The cache stores (MAC src(index), IP src (major clue), signal,
|
|
|
|
* quality, noise)
|
|
|
|
*
|
|
|
|
* No apologies for storing IP src here. It's easy and saves much
|
|
|
|
* trouble elsewhere. The cache is assumed to be INET dependent,
|
|
|
|
* although it need not be.
|
|
|
|
*
|
|
|
|
* Note: the Aironet only has a single byte of signal strength value
|
|
|
|
* in the rx frame header, and it's not scaled to anything sensible.
|
|
|
|
* This is kind of lame, but it's all we've got.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#ifdef documentation
|
|
|
|
|
|
|
|
int an_sigitems; /* number of cached entries */
|
|
|
|
struct an_sigcache an_sigcache[MAXANCACHE]; /* array of cache entries */
|
|
|
|
int an_nextitem; /* index/# of entries */
|
|
|
|
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* control variables for cache filtering. Basic idea is
|
|
|
|
* to reduce cost (e.g., to only Mobile-IP agent beacons
|
|
|
|
* which are broadcast or multicast). Still you might
|
|
|
|
* want to measure signal strength anth unicast ping packets
|
|
|
|
* on a pt. to pt. ant. setup.
|
|
|
|
*/
|
|
|
|
/* set true if you want to limit cache items to broadcast/mcast
|
|
|
|
* only packets (not unicast). Useful for mobile-ip beacons which
|
|
|
|
* are broadcast/multicast at network layer. Default is all packets
|
|
|
|
* so ping/unicast anll work say anth pt. to pt. antennae setup.
|
|
|
|
*/
|
|
|
|
static int an_cache_mcastonly = 0;
|
|
|
|
#if 0
|
|
|
|
SYSCTL_INT(_machdep, OID_AUTO, an_cache_mcastonly, CTLFLAG_RW,
|
|
|
|
&an_cache_mcastonly, 0, "");
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* set true if you want to limit cache items to IP packets only
|
|
|
|
*/
|
|
|
|
static int an_cache_iponly = 1;
|
|
|
|
#if 0
|
|
|
|
SYSCTL_INT(_machdep, OID_AUTO, an_cache_iponly, CTLFLAG_RW,
|
|
|
|
&an_cache_iponly, 0, "");
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/*
|
|
|
|
* an_cache_store, per rx packet store signal
|
|
|
|
* strength in MAC (src) indexed cache.
|
|
|
|
*/
|
|
|
|
static
|
|
|
|
void an_cache_store (sc, eh, m, rx_quality)
|
|
|
|
struct an_softc *sc;
|
|
|
|
struct ether_header *eh;
|
|
|
|
struct mbuf *m;
|
|
|
|
unsigned short rx_quality;
|
|
|
|
{
|
|
|
|
struct ip *ip = 0;
|
|
|
|
int i;
|
|
|
|
static int cache_slot = 0; /* use this cache entry */
|
|
|
|
static int wrapindex = 0; /* next "free" cache entry */
|
|
|
|
int saanp=0;
|
|
|
|
|
|
|
|
/* filters:
|
|
|
|
* 1. ip only
|
|
|
|
* 2. configurable filter to throw out unicast packets,
|
|
|
|
* keep multicast only.
|
|
|
|
*/
|
|
|
|
|
|
|
|
if ((ntohs(eh->ether_type) == 0x800)) {
|
|
|
|
saanp = 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* filter for ip packets only
|
|
|
|
*/
|
2001-05-24 12:12:28 +04:00
|
|
|
if (an_cache_iponly && !saanp) {
|
2000-12-12 02:16:50 +03:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* filter for broadcast/multicast only
|
|
|
|
*/
|
|
|
|
if (an_cache_mcastonly && ((eh->ether_dhost[0] & 1) == 0)) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef SIGDEBUG
|
|
|
|
printf("an: q value %x (MSB=0x%x, LSB=0x%x) \n",
|
|
|
|
rx_quality & 0xffff, rx_quality >> 8, rx_quality & 0xff);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* find the ip header. we want to store the ip_src
|
|
|
|
* address.
|
|
|
|
*/
|
|
|
|
if (saanp) {
|
2001-06-21 16:49:06 +04:00
|
|
|
ip = (struct ip *)(mtod(m, caddr_t) + 14);
|
2000-12-12 02:16:50 +03:00
|
|
|
}
|
|
|
|
|
|
|
|
/* do a linear search for a matching MAC address
|
|
|
|
* in the cache table
|
|
|
|
* . MAC address is 6 bytes,
|
|
|
|
* . var w_nextitem holds total number of entries already cached
|
|
|
|
*/
|
|
|
|
for(i = 0; i < sc->an_nextitem; i++) {
|
2001-07-07 09:35:39 +04:00
|
|
|
if (!memcmp(eh->ether_shost , sc->an_sigcache[i].macsrc, 6 )) {
|
2000-12-12 02:16:50 +03:00
|
|
|
/* Match!,
|
|
|
|
* so we already have this entry,
|
|
|
|
* update the data
|
|
|
|
*/
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* did we find a matching mac address?
|
|
|
|
* if yes, then overwrite a previously existing cache entry
|
|
|
|
*/
|
|
|
|
if (i < sc->an_nextitem ) {
|
|
|
|
cache_slot = i;
|
|
|
|
}
|
|
|
|
/* else, have a new address entry,so
|
|
|
|
* add this new entry,
|
|
|
|
* if table full, then we need to replace LRU entry
|
|
|
|
*/
|
|
|
|
else {
|
|
|
|
|
|
|
|
/* check for space in cache table
|
|
|
|
* note: an_nextitem also holds number of entries
|
|
|
|
* added in the cache table
|
|
|
|
*/
|
2001-05-24 12:12:28 +04:00
|
|
|
if (sc->an_nextitem < MAXANCACHE ) {
|
2000-12-12 02:16:50 +03:00
|
|
|
cache_slot = sc->an_nextitem;
|
|
|
|
sc->an_nextitem++;
|
|
|
|
sc->an_sigitems = sc->an_nextitem;
|
|
|
|
}
|
|
|
|
/* no space found, so simply wrap anth wrap index
|
|
|
|
* and "zap" the next entry
|
|
|
|
*/
|
|
|
|
else {
|
|
|
|
if (wrapindex == MAXANCACHE) {
|
|
|
|
wrapindex = 0;
|
|
|
|
}
|
|
|
|
cache_slot = wrapindex++;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* invariant: cache_slot now points at some slot
|
|
|
|
* in cache.
|
|
|
|
*/
|
|
|
|
if (cache_slot < 0 || cache_slot >= MAXANCACHE) {
|
|
|
|
log(LOG_ERR, "an_cache_store, bad index: %d of "
|
|
|
|
"[0..%d], gross cache error\n",
|
|
|
|
cache_slot, MAXANCACHE);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* store items in cache
|
|
|
|
* .ip source address
|
|
|
|
* .mac src
|
|
|
|
* .signal, etc.
|
|
|
|
*/
|
|
|
|
if (saanp) {
|
|
|
|
sc->an_sigcache[cache_slot].ipsrc = ip->ip_src.s_addr;
|
|
|
|
}
|
2001-07-07 19:53:13 +04:00
|
|
|
memcpy(sc->an_sigcache[cache_slot].macsrc, eh->ether_shost, 6);
|
2000-12-12 02:16:50 +03:00
|
|
|
|
|
|
|
sc->an_sigcache[cache_slot].signal = rx_quality;
|
|
|
|
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
#endif
|