if_vx.c

来自「基于组件方式开发操作系统的OSKIT源代码」· C语言 代码 · 共 1,090 行 · 第 1/2 页

/*
 * Copyright (c) 1994 Herb Peyerl <[e-mail]>
 * 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 Herb Peyerl.
 * 4. The name of Herb Peyerl may not be used to endorse or promote products
 *    derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 THE AUTHOR 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.
 *
 * $Id: if_vx.c,v 1.19 1999/01/12 02:09:31 eivind Exp $
 *
 */

/*
 * Created from if_ep.c driver by Fred Gray ([e-mail]) to support
 * the 3c590 family.
 */

/*
 *	Modified from the FreeBSD 1.1.5.1 version by:
 *		 	Andres Vega Garcia
 *			INRIA - Sophia Antipolis, France
 *			[e-mail]
 */

/*
 *  Promiscuous mode added and interrupt logic slightly changed
 *  to reduce the number of adapter failures. Transceiver select
 *  logic changed to use value from EEPROM. Autoconfiguration
 *  features added.
 *  Done by:
 *          Serge Babkin
 *          Chelindbank (Chelyabinsk, Russia)
 *          [e-mail]
 */

#include "vx.h"
#if NVX > 0

#if NVX < 4	/* These cost 4 bytes apiece, so give us 4 */
#undef NVX
#define NVX 4
#endif

#include "bpfilter.h"

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/sockio.h>
#include <sys/malloc.h>
#include <sys/mbuf.h>
#include <sys/socket.h>

#include <net/if.h>

#include <net/ethernet.h>
#include <net/if_arp.h>

#if NBPFILTER > 0
#include <net/bpf.h>
#endif

#include <machine/clock.h>

#include <dev/vx/if_vxreg.h>

#define ETHER_MAX_LEN	1518
#define ETHER_ADDR_LEN	6

struct vx_softc *vx_softc[NVX];

u_long vx_count;	/* both PCI and EISA */

static struct connector_entry {
  int bit;
  char *name;
} conn_tab[VX_CONNECTORS] = {
#define CONNECTOR_UTP	0
  { 0x08, "utp"},
#define CONNECTOR_AUI	1
  { 0x20, "aui"},
/* dummy */
  { 0, "???"},
#define CONNECTOR_BNC	3
  { 0x10, "bnc"},
#define CONNECTOR_TX	4
  { 0x02, "tx"},
#define CONNECTOR_FX	5
  { 0x04, "fx"},
#define CONNECTOR_MII	6
  { 0x40, "mii"},
  { 0, "???"}
};

/* struct vx_softc *vxalloc __P((int)); */
/* void *vxfree __P((struct vx_softc *)); */
/* int vxattach __P((struct vx_softc *)); */
static void vxtxstat __P((struct vx_softc *));
static int vxstatus __P((struct vx_softc *));
static void vxinit __P((void *));
static int vxioctl __P((struct ifnet *, u_long, caddr_t)); 
static void vxstart __P((struct ifnet *ifp));
static void vxwatchdog __P((struct ifnet *));
static void vxreset __P((struct vx_softc *));
/* void vxstop __P((struct vx_softc *)); */
static void vxread __P((struct vx_softc *));
static struct mbuf *vxget __P((struct vx_softc *, u_int));
static void vxmbuffill __P((void *));
static void vxmbufempty __P((struct vx_softc *));
static void vxsetfilter __P((struct vx_softc *));
static void vxgetlink __P((struct vx_softc *));
static void vxsetlink __P((struct vx_softc *));
/* int vxbusyeeprom __P((struct vx_softc *)); */

struct vx_softc *
vxalloc(unit)
    int unit;
{
    struct vx_softc *sc;

    if (unit >= NVX) {
	printf("vx%d: unit number too high.\n", unit);
	return NULL;
    }

    if (vx_softc[unit]) {
	printf("vx%d: already allocated.\n", unit);
	return NULL;
    }

    sc = malloc(sizeof(struct vx_softc), M_DEVBUF, M_NOWAIT);
    if (sc == NULL) {
	printf("vx%d: cannot malloc.\n", unit);
	return NULL;
    }
    bzero(sc, sizeof(struct vx_softc));
    callout_handle_init(&sc->ch);

    vx_softc[unit] = sc;
    sc->unit = unit;
    return (sc);    
}

void
vxfree(sc)
    struct vx_softc *sc;
{
    vx_softc[sc->unit] = NULL;
    free(sc, M_DEVBUF);
    return;
}

int
vxattach(sc)
    struct vx_softc *sc;
{
    struct ifnet *ifp = &sc->arpcom.ac_if;
    int i;

    GO_WINDOW(0);
    outw(VX_COMMAND, GLOBAL_RESET);
    VX_BUSY_WAIT;

    vxgetlink(sc);

    /*
     * Read the station address from the eeprom
     */
    GO_WINDOW(0);
    for (i = 0; i < 3; i++) {
        int x;
        if (vxbusyeeprom(sc))
            return 0;
        outw(BASE + VX_W0_EEPROM_COMMAND, EEPROM_CMD_RD
	     | (EEPROM_OEM_ADDR_0 + i));
        if (vxbusyeeprom(sc))
            return 0;
        x = inw(BASE + VX_W0_EEPROM_DATA);
        sc->arpcom.ac_enaddr[(i << 1)] = x >> 8;
        sc->arpcom.ac_enaddr[(i << 1) + 1] = x;
    }

    printf(" address %6D\n", sc->arpcom.ac_enaddr, ":");

    ifp->if_unit = sc->unit;
    ifp->if_name = "vx";
    ifp->if_mtu = ETHERMTU;
    ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    ifp->if_output = ether_output;
    ifp->if_start = vxstart;
    ifp->if_ioctl = vxioctl;
    ifp->if_init = vxinit;
    ifp->if_watchdog = vxwatchdog;
    ifp->if_softc = sc;

    if_attach(ifp);
    ether_ifattach(ifp);

#if NBPFILTER > 0
    bpfattach(ifp, DLT_EN10MB, sizeof(struct ether_header));
#endif

    sc->tx_start_thresh = 20;	/* probably a good starting point. */

    vxstop(sc);

    return 1;
}



/*
 * The order in here seems important. Otherwise we may not receive
 * interrupts. ?!
 */
static void
vxinit(xsc)
	void *xsc;
{
    struct vx_softc *sc = (struct vx_softc *) xsc;
    struct ifnet *ifp = &sc->arpcom.ac_if;
    int i;

    VX_BUSY_WAIT;

    GO_WINDOW(2);

    for (i = 0; i < 6; i++) /* Reload the ether_addr. */
	outb(BASE + VX_W2_ADDR_0 + i, sc->arpcom.ac_enaddr[i]);

    outw(BASE + VX_COMMAND, RX_RESET);
    VX_BUSY_WAIT;
    outw(BASE + VX_COMMAND, TX_RESET);
    VX_BUSY_WAIT;

    GO_WINDOW(1);	/* Window 1 is operating window */
    for (i = 0; i < 31; i++)
	inb(BASE + VX_W1_TX_STATUS);

    outw(BASE + VX_COMMAND,SET_RD_0_MASK | S_CARD_FAILURE |
			S_RX_COMPLETE | S_TX_COMPLETE | S_TX_AVAIL);
    outw(BASE + VX_COMMAND,SET_INTR_MASK | S_CARD_FAILURE |
			S_RX_COMPLETE | S_TX_COMPLETE | S_TX_AVAIL);

    /*
     * Attempt to get rid of any stray interrupts that occured during
     * configuration.  On the i386 this isn't possible because one may
     * already be queued.  However, a single stray interrupt is
     * unimportant.
     */
    outw(BASE + VX_COMMAND, ACK_INTR | 0xff);

    vxsetfilter(sc);
    vxsetlink(sc);

    outw(BASE + VX_COMMAND, RX_ENABLE);
    outw(BASE + VX_COMMAND, TX_ENABLE);

    vxmbuffill((caddr_t) sc);

    /* Interface is now `running', with no output active. */
    ifp->if_flags |= IFF_RUNNING;
    ifp->if_flags &= ~IFF_OACTIVE;

    /* Attempt to start output, if any. */
    vxstart(ifp);
}

static void
vxsetfilter(sc)
    struct vx_softc *sc;
{
    register struct ifnet *ifp = &sc->arpcom.ac_if;  
    
    GO_WINDOW(1);           /* Window 1 is operating window */
    outw(BASE + VX_COMMAND, SET_RX_FILTER | FIL_INDIVIDUAL | FIL_BRDCST |
	 FIL_MULTICAST |
	 ((ifp->if_flags & IFF_PROMISC) ? FIL_PROMISC : 0 ));
}               

static void            
vxgetlink(sc)
    struct vx_softc *sc;
{
    int n, k;

    GO_WINDOW(3);
    sc->vx_connectors = inw(BASE + VX_W3_RESET_OPT) & 0x7f;
    for (n = 0, k = 0; k < VX_CONNECTORS; k++) {
      if (sc->vx_connectors & conn_tab[k].bit) {
	if (n > 0) {
	  printf("/");
	}
	printf(conn_tab[k].name);
	n++;
      }
    }
    if (sc->vx_connectors == 0) {
	printf("no connectors!");
	return;
    }
    GO_WINDOW(3);
    sc->vx_connector = (inl(BASE + VX_W3_INTERNAL_CFG) 
			& INTERNAL_CONNECTOR_MASK) 
			>> INTERNAL_CONNECTOR_BITS;
    if (sc->vx_connector & 0x10) {
	sc->vx_connector &= 0x0f;
	printf("[*%s*]", conn_tab[sc->vx_connector].name);
	printf(": disable 'auto select' with DOS util!");
    } else {
	printf("[*%s*]", conn_tab[sc->vx_connector].name);
    }
}

static void            
vxsetlink(sc)
    struct vx_softc *sc;
{       
    register struct ifnet *ifp = &sc->arpcom.ac_if;  
    int i, j, k;
    char *reason, *warning;
    static short prev_flags;
    static char prev_conn = -1;

    if (prev_conn == -1) {
	prev_conn = sc->vx_connector;
    }

    /*
     * S.B.
     *
     * Now behavior was slightly changed:
     *
     * if any of flags link[0-2] is used and its connector is
     * physically present the following connectors are used:
     *
     *   link0 - AUI * highest precedence
     *   link1 - BNC
     *   link2 - UTP * lowest precedence
     *
     * If none of them is specified then
     * connector specified in the EEPROM is used
     * (if present on card or UTP if not).
     */

    i = sc->vx_connector;	/* default in EEPROM */
    reason = "default";
    warning = 0;

    if (ifp->if_flags & IFF_LINK0) {
	if (sc->vx_connectors & conn_tab[CONNECTOR_AUI].bit) {
	    i = CONNECTOR_AUI;
	    reason = "link0";
	} else {
	    warning = "aui not present! (link0)";
	}
    } else if (ifp->if_flags & IFF_LINK1) {
	if (sc->vx_connectors & conn_tab[CONNECTOR_BNC].bit) {
	    i = CONNECTOR_BNC;
	    reason = "link1";
	} else {
	    warning = "bnc not present! (link1)";
	}
    } else if (ifp->if_flags & IFF_LINK2) {
	if (sc->vx_connectors & conn_tab[CONNECTOR_UTP].bit) {
	    i = CONNECTOR_UTP;
	    reason = "link2";
	} else {
	    warning = "utp not present! (link2)";
	}
    } else if ((sc->vx_connectors & conn_tab[sc->vx_connector].bit) == 0) {
	warning = "strange connector type in EEPROM.";
	reason = "forced";
	i = CONNECTOR_UTP;
    }

    /* Avoid unnecessary message. */
    k = (prev_flags ^ ifp->if_flags) & (IFF_LINK0 | IFF_LINK1 | IFF_LINK2);
    if ((k != 0) || (prev_conn != i)) {
	if (warning != 0) {
	    printf("vx%d: warning: %s\n", sc->unit, warning);
	}
	printf("vx%d: selected %s. (%s)\n",
	       sc->unit, conn_tab[i].name, reason);
    }

    /* Set the selected connector. */
    GO_WINDOW(3);
    j = inl(BASE + VX_W3_INTERNAL_CFG) & ~INTERNAL_CONNECTOR_MASK;
    outl(BASE + VX_W3_INTERNAL_CFG, j | (i <<INTERNAL_CONNECTOR_BITS));

    /* First, disable all. */
    outw(BASE + VX_COMMAND, STOP_TRANSCEIVER);
    DELAY(800);
    GO_WINDOW(4);
    outw(BASE + VX_W4_MEDIA_TYPE, 0);

    /* Second, enable the selected one. */
    switch(i) {
      case CONNECTOR_UTP:
	GO_WINDOW(4);
	outw(BASE + VX_W4_MEDIA_TYPE, ENABLE_UTP);
	break;
      case CONNECTOR_BNC:
	outw(BASE + VX_COMMAND, START_TRANSCEIVER);
	DELAY(800);
	break;
      case CONNECTOR_TX:
      case CONNECTOR_FX:
	GO_WINDOW(4);
	outw(BASE + VX_W4_MEDIA_TYPE, LINKBEAT_ENABLE);
	break;
      default:	/* AUI and MII fall here */
	break;
    }
    GO_WINDOW(1); 

    prev_flags = ifp->if_flags;
    prev_conn = i;
}

static void
vxstart(ifp)
    struct ifnet *ifp;
{
    register struct vx_softc *sc = vx_softc[ifp->if_unit];
    register struct mbuf *m, *m0;
    int sh, len, pad;

    /* Don't transmit if interface is busy or not running */
    if ((sc->arpcom.ac_if.if_flags & (IFF_RUNNING|IFF_OACTIVE)) != IFF_RUNNING)
	return;

startagain:
    /* Sneak a peek at the next packet */
    m0 = ifp->if_snd.ifq_head;
    if (m0 == 0) {
	return;
    }
    /* We need to use m->m_pkthdr.len, so require the header */
     if ((m0->m_flags & M_PKTHDR) == 0)
	panic("vxstart: no header mbuf");
     len = m0->m_pkthdr.len;

     pad = (4 - len) & 3;

    /*
     * The 3c509 automatically pads short packets to minimum ethernet length,
     * but we drop packets that are too large. Perhaps we should truncate
     * them instead?
     */
    if (len + pad > ETHER_MAX_LEN) {
	/* packet is obviously too large: toss it */
	++ifp->if_oerrors;
	IF_DEQUEUE(&ifp->if_snd, m0);
	m_freem(m0);
	goto readcheck;
    }
    VX_BUSY_WAIT;
    if (inw(BASE + VX_W1_FREE_TX) < len + pad + 4) {
	outw(BASE + VX_COMMAND, SET_TX_AVAIL_THRESH | ((len + pad + 4) >> 2));
	/* not enough room in FIFO */
	if (inw(BASE + VX_W1_FREE_TX) < len + pad + 4) { /* make sure */
	    ifp->if_flags |= IFF_OACTIVE;
	    ifp->if_timer = 1;
	    return;
	}
    }
    outw(BASE + VX_COMMAND, SET_TX_AVAIL_THRESH | (8188 >> 2));
    IF_DEQUEUE(&ifp->if_snd, m0);
    if (m0 == 0) {		/* not really needed */
	return;
    }

    VX_BUSY_WAIT;
    outw(BASE + VX_COMMAND, SET_TX_START_THRESH |
	((len / 4 + sc->tx_start_thresh) >> 2));

#if NBPFILTER > 0
    if (sc->arpcom.ac_if.if_bpf) {
	bpf_mtap(&sc->arpcom.ac_if, m0);
    }
#endif

    /*
     * Do the output at splhigh() so that an interrupt from another device
     * won't cause a FIFO underrun.
     */
    sh = splhigh();

    outl(BASE + VX_W1_TX_PIO_WR_1, len | TX_INDICATE);

    for (m = m0; m != 0;) {
        if (m->m_len > 3)
	    outsl(BASE + VX_W1_TX_PIO_WR_1, mtod(m, caddr_t), m->m_len / 4);
        if (m->m_len & 3)
	    outsb(BASE + VX_W1_TX_PIO_WR_1,
	      mtod(m, caddr_t) + (m->m_len & ~3) , m->m_len & 3);
        MFREE(m, m0);
        m = m0;
    }
    while (pad--)
	outb(BASE + VX_W1_TX_PIO_WR_1, 0);	/* Padding */

    splx(sh);

    ++ifp->if_opackets;
    ifp->if_timer = 1;

readcheck:
    if ((inw(BASE + VX_W1_RX_STATUS) & ERR_INCOMPLETE) == 0) {
	/* We received a complete packet. */
	
	if ((inw(BASE + VX_STATUS) & S_INTR_LATCH) == 0) {
	    /*
	     * No interrupt, read the packet and continue
	     * Is  this supposed to happen? Is my motherboard
	     * completely busted?
	     */
	    vxread(sc);
	} else
	    /* Got an interrupt, return so that it gets serviced. */
	    return;
    } else {
	/* Check if we are stuck and reset [see XXX comment] */