Home | History | Annotate | Line # | Download | only in dev
if_gm.c revision 1.1
      1  1.1  tsubai /*	$NetBSD: if_gm.c,v 1.1 2000/02/27 18:00:55 tsubai Exp $	*/
      2  1.1  tsubai 
      3  1.1  tsubai /*-
      4  1.1  tsubai  * Copyright (c) 2000 Tsubai Masanari.  All rights reserved.
      5  1.1  tsubai  *
      6  1.1  tsubai  * Redistribution and use in source and binary forms, with or without
      7  1.1  tsubai  * modification, are permitted provided that the following conditions
      8  1.1  tsubai  * are met:
      9  1.1  tsubai  * 1. Redistributions of source code must retain the above copyright
     10  1.1  tsubai  *    notice, this list of conditions and the following disclaimer.
     11  1.1  tsubai  * 2. Redistributions in binary form must reproduce the above copyright
     12  1.1  tsubai  *    notice, this list of conditions and the following disclaimer in the
     13  1.1  tsubai  *    documentation and/or other materials provided with the distribution.
     14  1.1  tsubai  * 3. The name of the author may not be used to endorse or promote products
     15  1.1  tsubai  *    derived from this software without specific prior written permission.
     16  1.1  tsubai  *
     17  1.1  tsubai  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     18  1.1  tsubai  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     19  1.1  tsubai  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     20  1.1  tsubai  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     21  1.1  tsubai  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     22  1.1  tsubai  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     23  1.1  tsubai  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     24  1.1  tsubai  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     25  1.1  tsubai  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
     26  1.1  tsubai  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     27  1.1  tsubai  */
     28  1.1  tsubai 
     29  1.1  tsubai #include "opt_inet.h"
     30  1.1  tsubai #include "opt_ns.h"
     31  1.1  tsubai #include "bpfilter.h"
     32  1.1  tsubai 
     33  1.1  tsubai #include <sys/param.h>
     34  1.1  tsubai #include <sys/device.h>
     35  1.1  tsubai #include <sys/ioctl.h>
     36  1.1  tsubai #include <sys/kernel.h>
     37  1.1  tsubai #include <sys/mbuf.h>
     38  1.1  tsubai #include <sys/socket.h>
     39  1.1  tsubai #include <sys/systm.h>
     40  1.1  tsubai 
     41  1.1  tsubai #include <vm/vm.h>
     42  1.1  tsubai 
     43  1.1  tsubai #include <net/if.h>
     44  1.1  tsubai #include <net/if_ether.h>
     45  1.1  tsubai #include <net/if_media.h>
     46  1.1  tsubai 
     47  1.1  tsubai #if NBPFILTER > 0
     48  1.1  tsubai #include <net/bpf.h>
     49  1.1  tsubai #endif
     50  1.1  tsubai 
     51  1.1  tsubai #ifdef INET
     52  1.1  tsubai #include <netinet/in.h>
     53  1.1  tsubai #include <netinet/if_inarp.h>
     54  1.1  tsubai #endif
     55  1.1  tsubai 
     56  1.1  tsubai #include <dev/mii/mii.h>
     57  1.1  tsubai #include <dev/mii/miivar.h>
     58  1.1  tsubai 
     59  1.1  tsubai #include <dev/pci/pcivar.h>
     60  1.1  tsubai #include <dev/pci/pcireg.h>
     61  1.1  tsubai #include <dev/pci/pcidevs.h>
     62  1.1  tsubai 
     63  1.1  tsubai #include <dev/ofw/openfirm.h>
     64  1.1  tsubai #include <macppc/dev/if_gmreg.h>
     65  1.1  tsubai #include <machine/pio.h>
     66  1.1  tsubai 
     67  1.1  tsubai #define NTXBUF 4
     68  1.1  tsubai #define NRXBUF 32
     69  1.1  tsubai 
     70  1.1  tsubai struct gmac_softc {
     71  1.1  tsubai 	struct device sc_dev;
     72  1.1  tsubai 	struct ethercom sc_ethercom;
     73  1.1  tsubai 	vaddr_t sc_reg;
     74  1.1  tsubai 	struct gmac_dma *sc_txlist;
     75  1.1  tsubai 	struct gmac_dma *sc_rxlist;
     76  1.1  tsubai 	int sc_txnext;
     77  1.1  tsubai 	int sc_rxlast;
     78  1.1  tsubai 	caddr_t sc_txbuf[NTXBUF];
     79  1.1  tsubai 	caddr_t sc_rxbuf[NRXBUF];
     80  1.1  tsubai 	struct mii_data sc_mii;
     81  1.1  tsubai 	char sc_laddr[6];
     82  1.1  tsubai };
     83  1.1  tsubai 
     84  1.1  tsubai #define sc_if sc_ethercom.ec_if
     85  1.1  tsubai 
     86  1.1  tsubai int gmac_match __P((struct device *, struct cfdata *, void *));
     87  1.1  tsubai void gmac_attach __P((struct device *, struct device *, void *));
     88  1.1  tsubai 
     89  1.1  tsubai static __inline u_int gmac_read_reg __P((struct gmac_softc *, int));
     90  1.1  tsubai static __inline void gmac_write_reg __P((struct gmac_softc *, int, u_int));
     91  1.1  tsubai 
     92  1.1  tsubai static __inline void gmac_start_txdma __P((struct gmac_softc *));
     93  1.1  tsubai static __inline void gmac_start_rxdma __P((struct gmac_softc *));
     94  1.1  tsubai static __inline void gmac_stop_txdma __P((struct gmac_softc *));
     95  1.1  tsubai static __inline void gmac_stop_rxdma __P((struct gmac_softc *));
     96  1.1  tsubai 
     97  1.1  tsubai int gmac_intr __P((void *));
     98  1.1  tsubai void gmac_tint __P((struct gmac_softc *));
     99  1.1  tsubai void gmac_rint __P((struct gmac_softc *));
    100  1.1  tsubai struct mbuf * gmac_get __P((struct gmac_softc *, caddr_t, int));
    101  1.1  tsubai void gmac_start __P((struct ifnet *));
    102  1.1  tsubai int gmac_put __P((struct gmac_softc *, caddr_t, struct mbuf *));
    103  1.1  tsubai 
    104  1.1  tsubai void gmac_stop __P((struct gmac_softc *));
    105  1.1  tsubai void gmac_reset __P((struct gmac_softc *));
    106  1.1  tsubai void gmac_init __P((struct gmac_softc *));
    107  1.1  tsubai void gmac_init_mac __P((struct gmac_softc *));
    108  1.1  tsubai 
    109  1.1  tsubai int gmac_ioctl __P((struct ifnet *, u_long, caddr_t));
    110  1.1  tsubai void gmac_watchdog __P((struct ifnet *));
    111  1.1  tsubai 
    112  1.1  tsubai int gmac_mediachange __P((struct ifnet *));
    113  1.1  tsubai void gmac_mediastatus __P((struct ifnet *, struct ifmediareq *));
    114  1.1  tsubai int gmac_mii_readreg __P((struct device *, int, int));
    115  1.1  tsubai void gmac_mii_writereg __P((struct device *, int, int, int));
    116  1.1  tsubai void gmac_mii_statchg __P((struct device *));
    117  1.1  tsubai void gmac_mii_tick __P((void *));
    118  1.1  tsubai 
    119  1.1  tsubai struct cfattach gm_ca = {
    120  1.1  tsubai 	sizeof(struct gmac_softc), gmac_match, gmac_attach
    121  1.1  tsubai };
    122  1.1  tsubai 
    123  1.1  tsubai int
    124  1.1  tsubai gmac_match(parent, match, aux)
    125  1.1  tsubai 	struct device *parent;
    126  1.1  tsubai 	struct cfdata *match;
    127  1.1  tsubai 	void *aux;
    128  1.1  tsubai {
    129  1.1  tsubai 	struct pci_attach_args *pa = aux;
    130  1.1  tsubai 
    131  1.1  tsubai 	if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_APPLE &&
    132  1.1  tsubai 	    PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_APPLE_GMAC)
    133  1.1  tsubai 		return 1;
    134  1.1  tsubai 
    135  1.1  tsubai 	return 0;
    136  1.1  tsubai }
    137  1.1  tsubai 
    138  1.1  tsubai void
    139  1.1  tsubai gmac_attach(parent, self, aux)
    140  1.1  tsubai 	struct device *parent, *self;
    141  1.1  tsubai 	void *aux;
    142  1.1  tsubai {
    143  1.1  tsubai 	struct gmac_softc *sc = (void *)self;
    144  1.1  tsubai 	struct pci_attach_args *pa = aux;
    145  1.1  tsubai 	struct ifnet *ifp = &sc->sc_if;
    146  1.1  tsubai 	struct mii_data *mii = &sc->sc_mii;
    147  1.1  tsubai 	pci_intr_handle_t ih;
    148  1.1  tsubai 	const char *intrstr = NULL;
    149  1.1  tsubai 	int node, i;
    150  1.1  tsubai 	char *p;
    151  1.1  tsubai 	struct gmac_dma *dp;
    152  1.1  tsubai 	u_int32_t reg[10];
    153  1.1  tsubai 	u_char laddr[6];
    154  1.1  tsubai 
    155  1.1  tsubai 	node = pcidev_to_ofdev(pa->pa_pc, pa->pa_tag);
    156  1.1  tsubai 	if (node == 0) {
    157  1.1  tsubai 		printf(": cannot find gmac node\n");
    158  1.1  tsubai 		return;
    159  1.1  tsubai 	}
    160  1.1  tsubai 
    161  1.1  tsubai 	OF_getprop(node, "local-mac-address", laddr, sizeof laddr);
    162  1.1  tsubai 	OF_getprop(node, "assigned-addresses", reg, sizeof reg);
    163  1.1  tsubai 
    164  1.1  tsubai 	bcopy(laddr, sc->sc_laddr, sizeof laddr);
    165  1.1  tsubai 	sc->sc_reg = reg[2];
    166  1.1  tsubai 
    167  1.1  tsubai 	if (pci_intr_map(pa->pa_pc, pa->pa_intrtag, pa->pa_intrpin,
    168  1.1  tsubai 	    pa->pa_intrline, &ih)) {
    169  1.1  tsubai 		printf(": unable to map interrupt\n");
    170  1.1  tsubai 		return;
    171  1.1  tsubai 	}
    172  1.1  tsubai 	intrstr = pci_intr_string(pa->pa_pc, ih);
    173  1.1  tsubai 
    174  1.1  tsubai 	if (pci_intr_establish(pa->pa_pc, ih, IPL_NET, gmac_intr, sc) == NULL) {
    175  1.1  tsubai 		printf(": unable to establish interrupt");
    176  1.1  tsubai 		if (intrstr)
    177  1.1  tsubai 			printf(" at %s", intrstr);
    178  1.1  tsubai 		printf("\n");
    179  1.1  tsubai 		return;
    180  1.1  tsubai 	}
    181  1.1  tsubai 
    182  1.1  tsubai 	/* Setup packet buffers and dma descriptors. */
    183  1.1  tsubai 	p = malloc((NRXBUF + NTXBUF) * 2048 + 3 * 0x800, M_DEVBUF, M_NOWAIT);
    184  1.1  tsubai 	if (p == NULL) {
    185  1.1  tsubai 		printf(": cannot malloc buffers\n");
    186  1.1  tsubai 		return;
    187  1.1  tsubai 	}
    188  1.1  tsubai 	p = (void *)roundup((vaddr_t)p, 0x800);
    189  1.1  tsubai 	bzero(p, 2048 * (NRXBUF + NTXBUF) + 2 * 0x800);
    190  1.1  tsubai 	sc->sc_rxlist = (void *)(p + 2048 * (NRXBUF + NTXBUF));
    191  1.1  tsubai 	sc->sc_txlist = (void *)(p + 2048 * (NRXBUF + NTXBUF) + 0x800);
    192  1.1  tsubai 
    193  1.1  tsubai 	dp = sc->sc_rxlist;
    194  1.1  tsubai 	for (i = 0; i < NRXBUF; i++) {
    195  1.1  tsubai 		sc->sc_rxbuf[i] = p;
    196  1.1  tsubai 		dp->address = htole32(vtophys(p));
    197  1.1  tsubai 		dp->cmd = htole32(GMAC_OWN);
    198  1.1  tsubai 		dp++;
    199  1.1  tsubai 		p += 2048;
    200  1.1  tsubai 	}
    201  1.1  tsubai 
    202  1.1  tsubai 	dp = sc->sc_txlist;
    203  1.1  tsubai 	for (i = 0; i < NTXBUF; i++) {
    204  1.1  tsubai 		sc->sc_txbuf[i] = p;
    205  1.1  tsubai 		dp->address = htole32(vtophys(p));
    206  1.1  tsubai 		dp++;
    207  1.1  tsubai 		p += 2048;
    208  1.1  tsubai 	}
    209  1.1  tsubai 
    210  1.1  tsubai 	gmac_reset(sc);
    211  1.1  tsubai 
    212  1.1  tsubai 	printf(": Ethernet address %s\n", ether_sprintf(laddr));
    213  1.1  tsubai 	printf("%s: interrupting at %s\n", sc->sc_dev.dv_xname, intrstr);
    214  1.1  tsubai 
    215  1.1  tsubai 	bcopy(sc->sc_dev.dv_xname, ifp->if_xname, IFNAMSIZ);
    216  1.1  tsubai 	ifp->if_softc = sc;
    217  1.1  tsubai 	ifp->if_ioctl = gmac_ioctl;
    218  1.1  tsubai 	ifp->if_start = gmac_start;
    219  1.1  tsubai 	ifp->if_watchdog = gmac_watchdog;
    220  1.1  tsubai 	ifp->if_flags =
    221  1.1  tsubai 		IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS | IFF_MULTICAST;
    222  1.1  tsubai 	ifp->if_flags |= IFF_ALLMULTI;
    223  1.1  tsubai 
    224  1.1  tsubai 	mii->mii_ifp = ifp;
    225  1.1  tsubai 	mii->mii_readreg = gmac_mii_readreg;
    226  1.1  tsubai 	mii->mii_writereg = gmac_mii_writereg;
    227  1.1  tsubai 	mii->mii_statchg = gmac_mii_statchg;
    228  1.1  tsubai 
    229  1.1  tsubai 	ifmedia_init(&mii->mii_media, 0, gmac_mediachange, gmac_mediastatus);
    230  1.1  tsubai 	mii_attach(self, mii, 0xffffffff, MII_PHY_ANY, MII_OFFSET_ANY, 0);
    231  1.1  tsubai 
    232  1.1  tsubai 	/* Choose a default media. */
    233  1.1  tsubai 	if (LIST_FIRST(&mii->mii_phys) == NULL) {
    234  1.1  tsubai 		ifmedia_add(&mii->mii_media, IFM_ETHER|IFM_NONE, 0, NULL);
    235  1.1  tsubai 		ifmedia_set(&mii->mii_media, IFM_ETHER|IFM_NONE);
    236  1.1  tsubai 	} else
    237  1.1  tsubai 		ifmedia_set(&mii->mii_media, IFM_ETHER|IFM_AUTO);
    238  1.1  tsubai 
    239  1.1  tsubai 	if_attach(ifp);
    240  1.1  tsubai 	ether_ifattach(ifp, laddr);
    241  1.1  tsubai 
    242  1.1  tsubai #if NBPFILTER > 0
    243  1.1  tsubai 	bpfattach(&ifp->if_bpf, ifp, DLT_EN10MB, sizeof(struct ether_header));
    244  1.1  tsubai #endif
    245  1.1  tsubai }
    246  1.1  tsubai 
    247  1.1  tsubai u_int
    248  1.1  tsubai gmac_read_reg(sc, reg)
    249  1.1  tsubai 	struct gmac_softc *sc;
    250  1.1  tsubai 	int reg;
    251  1.1  tsubai {
    252  1.1  tsubai 	return in32rb(sc->sc_reg + reg);
    253  1.1  tsubai }
    254  1.1  tsubai 
    255  1.1  tsubai void
    256  1.1  tsubai gmac_write_reg(sc, reg, val)
    257  1.1  tsubai 	struct gmac_softc *sc;
    258  1.1  tsubai 	int reg;
    259  1.1  tsubai 	u_int val;
    260  1.1  tsubai {
    261  1.1  tsubai 	out32rb(sc->sc_reg + reg, val);
    262  1.1  tsubai }
    263  1.1  tsubai 
    264  1.1  tsubai void
    265  1.1  tsubai gmac_start_txdma(sc)
    266  1.1  tsubai 	struct gmac_softc *sc;
    267  1.1  tsubai {
    268  1.1  tsubai 	u_int x;
    269  1.1  tsubai 
    270  1.1  tsubai 	x = gmac_read_reg(sc, GMAC_TXDMACONFIG);
    271  1.1  tsubai 	x |= 1;
    272  1.1  tsubai 	gmac_write_reg(sc, GMAC_TXDMACONFIG, x);
    273  1.1  tsubai 	x = gmac_read_reg(sc, GMAC_TXMACCONFIG);
    274  1.1  tsubai 	x |= 1;
    275  1.1  tsubai 	gmac_write_reg(sc, GMAC_TXMACCONFIG, x);
    276  1.1  tsubai }
    277  1.1  tsubai 
    278  1.1  tsubai void
    279  1.1  tsubai gmac_start_rxdma(sc)
    280  1.1  tsubai 	struct gmac_softc *sc;
    281  1.1  tsubai {
    282  1.1  tsubai 	u_int x;
    283  1.1  tsubai 
    284  1.1  tsubai 	x = gmac_read_reg(sc, GMAC_RXDMACONFIG);
    285  1.1  tsubai 	x |= 1;
    286  1.1  tsubai 	gmac_write_reg(sc, GMAC_RXDMACONFIG, x);
    287  1.1  tsubai 	x = gmac_read_reg(sc, GMAC_RXMACCONFIG);
    288  1.1  tsubai 	x |= 1;
    289  1.1  tsubai 	gmac_write_reg(sc, GMAC_RXMACCONFIG, x);
    290  1.1  tsubai }
    291  1.1  tsubai 
    292  1.1  tsubai void
    293  1.1  tsubai gmac_stop_txdma(sc)
    294  1.1  tsubai 	struct gmac_softc *sc;
    295  1.1  tsubai {
    296  1.1  tsubai 	u_int x;
    297  1.1  tsubai 
    298  1.1  tsubai 	x = gmac_read_reg(sc, GMAC_TXDMACONFIG);
    299  1.1  tsubai 	x &= ~1;
    300  1.1  tsubai 	gmac_write_reg(sc, GMAC_TXDMACONFIG, x);
    301  1.1  tsubai 	x = gmac_read_reg(sc, GMAC_TXMACCONFIG);
    302  1.1  tsubai 	x &= ~1;
    303  1.1  tsubai 	gmac_write_reg(sc, GMAC_TXMACCONFIG, x);
    304  1.1  tsubai }
    305  1.1  tsubai 
    306  1.1  tsubai void
    307  1.1  tsubai gmac_stop_rxdma(sc)
    308  1.1  tsubai 	struct gmac_softc *sc;
    309  1.1  tsubai {
    310  1.1  tsubai 	u_int x;
    311  1.1  tsubai 
    312  1.1  tsubai 	x = gmac_read_reg(sc, GMAC_RXDMACONFIG);
    313  1.1  tsubai 	x &= ~1;
    314  1.1  tsubai 	gmac_write_reg(sc, GMAC_RXDMACONFIG, x);
    315  1.1  tsubai 	x = gmac_read_reg(sc, GMAC_RXMACCONFIG);
    316  1.1  tsubai 	x &= ~1;
    317  1.1  tsubai 	gmac_write_reg(sc, GMAC_RXMACCONFIG, x);
    318  1.1  tsubai }
    319  1.1  tsubai 
    320  1.1  tsubai int
    321  1.1  tsubai gmac_intr(v)
    322  1.1  tsubai 	void *v;
    323  1.1  tsubai {
    324  1.1  tsubai 	struct gmac_softc *sc = v;
    325  1.1  tsubai 	u_int status;
    326  1.1  tsubai 
    327  1.1  tsubai 	status = gmac_read_reg(sc, GMAC_STATUS) & 0xff;
    328  1.1  tsubai 	if (status == 0)
    329  1.1  tsubai 		return 0;
    330  1.1  tsubai 
    331  1.1  tsubai 	if (status & GMAC_INT_RXDONE)
    332  1.1  tsubai 		gmac_rint(sc);
    333  1.1  tsubai 
    334  1.1  tsubai 	if (status & GMAC_INT_TXDONE)
    335  1.1  tsubai 		gmac_tint(sc);
    336  1.1  tsubai 
    337  1.1  tsubai 	return 1;
    338  1.1  tsubai }
    339  1.1  tsubai 
    340  1.1  tsubai void
    341  1.1  tsubai gmac_tint(sc)
    342  1.1  tsubai 	struct gmac_softc *sc;
    343  1.1  tsubai {
    344  1.1  tsubai 	struct ifnet *ifp = &sc->sc_if;
    345  1.1  tsubai 	volatile struct gmac_dma *dp;
    346  1.1  tsubai 	int i;
    347  1.1  tsubai 
    348  1.1  tsubai 	i = sc->sc_txlast;
    349  1.1  tsubai 	dp = &sc->sc_txlist[i];
    350  1.1  tsubai 	__asm __volatile ("sync");
    351  1.1  tsubai 
    352  1.1  tsubai 	ifp->if_flags &= ~IFF_OACTIVE;
    353  1.1  tsubai 	ifp->if_timer = 0;
    354  1.1  tsubai 	ifp->if_opackets++;
    355  1.1  tsubai 	gmac_start(ifp);
    356  1.1  tsubai }
    357  1.1  tsubai 
    358  1.1  tsubai void
    359  1.1  tsubai gmac_rint(sc)
    360  1.1  tsubai 	struct gmac_softc *sc;
    361  1.1  tsubai {
    362  1.1  tsubai 	struct ifnet *ifp = &sc->sc_if;
    363  1.1  tsubai 	volatile struct gmac_dma *dp;
    364  1.1  tsubai 	struct mbuf *m;
    365  1.1  tsubai 	int i, len;
    366  1.1  tsubai 	u_int cmd;
    367  1.1  tsubai 
    368  1.1  tsubai 	for (i = sc->sc_rxlast;; i++) {
    369  1.1  tsubai 		if (i == NRXBUF)
    370  1.1  tsubai 			i = 0;
    371  1.1  tsubai 
    372  1.1  tsubai 		dp = &sc->sc_rxlist[i];
    373  1.1  tsubai 		cmd = le32toh(dp->cmd);
    374  1.1  tsubai 		if (cmd & GMAC_OWN)
    375  1.1  tsubai 			break;
    376  1.1  tsubai 		len = (cmd >> 16) & GMAC_LEN_MASK;
    377  1.1  tsubai 		len -= 4;	/* CRC */
    378  1.1  tsubai 
    379  1.1  tsubai 		if (le32toh(dp->cmd_hi) & 0x40000000) {
    380  1.1  tsubai 			ifp->if_ierrors++;
    381  1.1  tsubai 			goto next;
    382  1.1  tsubai 		}
    383  1.1  tsubai 
    384  1.1  tsubai 		m = gmac_get(sc, sc->sc_rxbuf[i], len);
    385  1.1  tsubai 		if (m == NULL) {
    386  1.1  tsubai 			ifp->if_ierrors++;
    387  1.1  tsubai 			goto next;
    388  1.1  tsubai 		}
    389  1.1  tsubai 
    390  1.1  tsubai #if NBPFILTER > 0
    391  1.1  tsubai 		/*
    392  1.1  tsubai 		 * Check if there's a BPF listener on this interface.
    393  1.1  tsubai 		 * If so, hand off the raw packet to BPF.
    394  1.1  tsubai 		 */
    395  1.1  tsubai 		if (ifp->if_bpf)
    396  1.1  tsubai 			bpf_tap(ifp->if_bpf, sc->sc_rxbuf[i], len);
    397  1.1  tsubai #endif
    398  1.1  tsubai 		(*ifp->if_input)(ifp, m);
    399  1.1  tsubai 		ifp->if_ipackets++;
    400  1.1  tsubai 
    401  1.1  tsubai next:
    402  1.1  tsubai 		dp->cmd_hi = 0;
    403  1.1  tsubai 		__asm __volatile ("sync");
    404  1.1  tsubai 		dp->cmd = htole32(GMAC_OWN);
    405  1.1  tsubai 	}
    406  1.1  tsubai 	sc->sc_rxlast = i;
    407  1.1  tsubai }
    408  1.1  tsubai 
    409  1.1  tsubai struct mbuf *
    410  1.1  tsubai gmac_get(sc, pkt, totlen)
    411  1.1  tsubai 	struct gmac_softc *sc;
    412  1.1  tsubai 	caddr_t pkt;
    413  1.1  tsubai 	int totlen;
    414  1.1  tsubai {
    415  1.1  tsubai 	struct mbuf *m;
    416  1.1  tsubai 	struct mbuf *top, **mp;
    417  1.1  tsubai 	int len;
    418  1.1  tsubai 
    419  1.1  tsubai 	MGETHDR(m, M_DONTWAIT, MT_DATA);
    420  1.1  tsubai 	if (m == 0)
    421  1.1  tsubai 		return 0;
    422  1.1  tsubai 	m->m_pkthdr.rcvif = &sc->sc_if;
    423  1.1  tsubai 	m->m_pkthdr.len = totlen;
    424  1.1  tsubai 	len = MHLEN;
    425  1.1  tsubai 	top = 0;
    426  1.1  tsubai 	mp = &top;
    427  1.1  tsubai 
    428  1.1  tsubai 	while (totlen > 0) {
    429  1.1  tsubai 		if (top) {
    430  1.1  tsubai 			MGET(m, M_DONTWAIT, MT_DATA);
    431  1.1  tsubai 			if (m == 0) {
    432  1.1  tsubai 				m_freem(top);
    433  1.1  tsubai 				return 0;
    434  1.1  tsubai 			}
    435  1.1  tsubai 			len = MLEN;
    436  1.1  tsubai 		}
    437  1.1  tsubai 		if (totlen >= MINCLSIZE) {
    438  1.1  tsubai 			MCLGET(m, M_DONTWAIT);
    439  1.1  tsubai 			if ((m->m_flags & M_EXT) == 0) {
    440  1.1  tsubai 				m_free(m);
    441  1.1  tsubai 				m_freem(top);
    442  1.1  tsubai 				return 0;
    443  1.1  tsubai 			}
    444  1.1  tsubai 			len = MCLBYTES;
    445  1.1  tsubai 		}
    446  1.1  tsubai 		m->m_len = len = min(totlen, len);
    447  1.1  tsubai 		bcopy(pkt, mtod(m, caddr_t), len);
    448  1.1  tsubai 		pkt += len;
    449  1.1  tsubai 		totlen -= len;
    450  1.1  tsubai 		*mp = m;
    451  1.1  tsubai 		mp = &m->m_next;
    452  1.1  tsubai 	}
    453  1.1  tsubai 
    454  1.1  tsubai 	return top;
    455  1.1  tsubai }
    456  1.1  tsubai 
    457  1.1  tsubai void
    458  1.1  tsubai gmac_start(ifp)
    459  1.1  tsubai 	struct ifnet *ifp;
    460  1.1  tsubai {
    461  1.1  tsubai 	struct gmac_softc *sc = ifp->if_softc;
    462  1.1  tsubai 	struct mbuf *m;
    463  1.1  tsubai 	caddr_t buff;
    464  1.1  tsubai 	int i, tlen;
    465  1.1  tsubai 	volatile struct gmac_dma *dp;
    466  1.1  tsubai 
    467  1.1  tsubai 	if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
    468  1.1  tsubai 		return;
    469  1.1  tsubai 
    470  1.1  tsubai 	for (;;) {
    471  1.1  tsubai 		if (ifp->if_flags & IFF_OACTIVE)
    472  1.1  tsubai 			break;
    473  1.1  tsubai 
    474  1.1  tsubai 		IF_DEQUEUE(&ifp->if_snd, m);
    475  1.1  tsubai 		if (m == 0)
    476  1.1  tsubai 			break;
    477  1.1  tsubai 
    478  1.1  tsubai 		ifp->if_flags |= IFF_OACTIVE;
    479  1.1  tsubai 
    480  1.1  tsubai 		/* 5 seconds to watch for failing to transmit */
    481  1.1  tsubai 		ifp->if_timer = 5;
    482  1.1  tsubai 		ifp->if_opackets++;		/* # of pkts */
    483  1.1  tsubai 
    484  1.1  tsubai #if 0
    485  1.1  tsubai 		i = sc->sc_txnext;
    486  1.1  tsubai #else
    487  1.1  tsubai 		i = 0;
    488  1.1  tsubai #endif
    489  1.1  tsubai 		buff = sc->sc_txbuf[i];
    490  1.1  tsubai 		tlen = gmac_put(sc, buff, m);
    491  1.1  tsubai 
    492  1.1  tsubai 		dp = &sc->sc_txlist[i];
    493  1.1  tsubai 		dp->cmd_hi = 0;
    494  1.1  tsubai 		dp->address_hi = 0;
    495  1.1  tsubai 		dp->cmd = htole32(tlen | GMAC_OWN | GMAC_SOP);
    496  1.1  tsubai 
    497  1.1  tsubai 		i++;
    498  1.1  tsubai 		if (i == NTXBUF)
    499  1.1  tsubai 			i = 0;
    500  1.1  tsubai 		__asm __volatile ("sync");
    501  1.1  tsubai 
    502  1.1  tsubai 		gmac_write_reg(sc, GMAC_TXDMAKICK, i);
    503  1.1  tsubai 		sc->sc_txnext = i;
    504  1.1  tsubai 
    505  1.1  tsubai #if NBPFILTER > 0
    506  1.1  tsubai 		/*
    507  1.1  tsubai 		 * If BPF is listening on this interface, let it see the
    508  1.1  tsubai 		 * packet before we commit it to the wire.
    509  1.1  tsubai 		 */
    510  1.1  tsubai 		if (ifp->if_bpf)
    511  1.1  tsubai 			bpf_tap(ifp->if_bpf, buff, tlen);
    512  1.1  tsubai #endif
    513  1.1  tsubai 	}
    514  1.1  tsubai }
    515  1.1  tsubai 
    516  1.1  tsubai int
    517  1.1  tsubai gmac_put(sc, buff, m)
    518  1.1  tsubai 	struct gmac_softc *sc;
    519  1.1  tsubai 	caddr_t buff;
    520  1.1  tsubai 	struct mbuf *m;
    521  1.1  tsubai {
    522  1.1  tsubai 	struct mbuf *n;
    523  1.1  tsubai 	int len, tlen = 0;
    524  1.1  tsubai 
    525  1.1  tsubai 	for (; m; m = n) {
    526  1.1  tsubai 		len = m->m_len;
    527  1.1  tsubai 		if (len == 0) {
    528  1.1  tsubai 			MFREE(m, n);
    529  1.1  tsubai 			continue;
    530  1.1  tsubai 		}
    531  1.1  tsubai 		bcopy(mtod(m, caddr_t), buff, len);
    532  1.1  tsubai 		buff += len;
    533  1.1  tsubai 		tlen += len;
    534  1.1  tsubai 		MFREE(m, n);
    535  1.1  tsubai 	}
    536  1.1  tsubai 	if (tlen > 2048)
    537  1.1  tsubai 		panic("%s: gmac_put packet overflow", sc->sc_dev.dv_xname);
    538  1.1  tsubai 
    539  1.1  tsubai 	return tlen;
    540  1.1  tsubai }
    541  1.1  tsubai 
    542  1.1  tsubai void
    543  1.1  tsubai gmac_reset(sc)
    544  1.1  tsubai 	struct gmac_softc *sc;
    545  1.1  tsubai {
    546  1.1  tsubai 	int i, s;
    547  1.1  tsubai 
    548  1.1  tsubai 	s = splnet();
    549  1.1  tsubai 
    550  1.1  tsubai 	gmac_stop_txdma(sc);
    551  1.1  tsubai 	gmac_stop_rxdma(sc);
    552  1.1  tsubai 
    553  1.1  tsubai 	gmac_write_reg(sc, GMAC_SOFTWARERESET, 3);
    554  1.1  tsubai 	for (i = 10; i > 0; i--) {
    555  1.1  tsubai 		delay(300000);				/* XXX long delay */
    556  1.1  tsubai 		if (gmac_read_reg(sc, GMAC_SOFTWARERESET) == 0)
    557  1.1  tsubai 			break;
    558  1.1  tsubai 	}
    559  1.1  tsubai 	splx(s);
    560  1.1  tsubai 
    561  1.1  tsubai 	if (i == 0)
    562  1.1  tsubai 		printf("%s: reset timeout\n", sc->sc_dev.dv_xname);
    563  1.1  tsubai }
    564  1.1  tsubai 
    565  1.1  tsubai void
    566  1.1  tsubai gmac_stop(sc)
    567  1.1  tsubai 	struct gmac_softc *sc;
    568  1.1  tsubai {
    569  1.1  tsubai 	struct ifnet *ifp = &sc->sc_if;
    570  1.1  tsubai 	int s;
    571  1.1  tsubai 
    572  1.1  tsubai 	s = splnet();
    573  1.1  tsubai 
    574  1.1  tsubai 	untimeout(gmac_mii_tick, sc);
    575  1.1  tsubai 	mii_down(&sc->sc_mii);
    576  1.1  tsubai 
    577  1.1  tsubai 	gmac_stop_txdma(sc);
    578  1.1  tsubai 	gmac_stop_rxdma(sc);
    579  1.1  tsubai 
    580  1.1  tsubai 	gmac_write_reg(sc, GMAC_INTMASK, 0xffffffff);
    581  1.1  tsubai 
    582  1.1  tsubai 	ifp->if_flags &= ~(IFF_UP | IFF_RUNNING);
    583  1.1  tsubai 	ifp->if_timer = 0;
    584  1.1  tsubai 
    585  1.1  tsubai 	splx(s);
    586  1.1  tsubai }
    587  1.1  tsubai 
    588  1.1  tsubai void
    589  1.1  tsubai gmac_init_mac(sc)
    590  1.1  tsubai 	struct gmac_softc *sc;
    591  1.1  tsubai {
    592  1.1  tsubai 	int i, tb;
    593  1.1  tsubai 	char *laddr = sc->sc_laddr;
    594  1.1  tsubai 
    595  1.1  tsubai 	__asm ("mftb %0" : "=r"(tb));
    596  1.1  tsubai 	gmac_write_reg(sc, GMAC_RANDOMSEED, tb);
    597  1.1  tsubai 
    598  1.1  tsubai 	/* init-mii */
    599  1.1  tsubai 	gmac_write_reg(sc, GMAC_DATAPATHMODE, 4);
    600  1.1  tsubai 	gmac_mii_writereg(&sc->sc_dev, 0, 0, 0x1000);
    601  1.1  tsubai 
    602  1.1  tsubai 	gmac_write_reg(sc, GMAC_TXDMACONFIG, 0xffc00);
    603  1.1  tsubai 	gmac_write_reg(sc, GMAC_RXDMACONFIG, 0);
    604  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACPAUSE, 0x1bf0);
    605  1.1  tsubai 	gmac_write_reg(sc, GMAC_INTERPACKETGAP0, 0);
    606  1.1  tsubai 	gmac_write_reg(sc, GMAC_INTERPACKETGAP1, 8);
    607  1.1  tsubai 	gmac_write_reg(sc, GMAC_INTERPACKETGAP2, 4);
    608  1.1  tsubai 	gmac_write_reg(sc, GMAC_MINFRAMESIZE, ETHER_MIN_LEN);
    609  1.1  tsubai 	gmac_write_reg(sc, GMAC_MAXFRAMESIZE, ETHER_MAX_LEN);
    610  1.1  tsubai 	gmac_write_reg(sc, GMAC_PASIZE, 7);
    611  1.1  tsubai 	gmac_write_reg(sc, GMAC_JAMSIZE, 4);
    612  1.1  tsubai 	gmac_write_reg(sc, GMAC_ATTEMPTLIMIT,0x10);
    613  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACCNTLTYPE, 0x8808);
    614  1.1  tsubai 
    615  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRESS0, (laddr[4] << 8) | laddr[5]);
    616  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRESS1, (laddr[2] << 8) | laddr[3]);
    617  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRESS2, (laddr[0] << 8) | laddr[1]);
    618  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRESS3, 0);
    619  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRESS4, 0);
    620  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRESS5, 0);
    621  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRESS6, 1);
    622  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRESS7, 0xc200);
    623  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRESS8, 0x0180);
    624  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRFILT0, 0);
    625  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRFILT1, 0);
    626  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRFILT2, 0);
    627  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRFILT2_1MASK, 0);
    628  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACADDRFILT0MASK, 0);
    629  1.1  tsubai 
    630  1.1  tsubai 	for (i = 0; i < 0x6c; i+= 4)
    631  1.1  tsubai 		gmac_write_reg(sc, GMAC_HASHTABLE0 + i, 0);
    632  1.1  tsubai 
    633  1.1  tsubai 	gmac_write_reg(sc, GMAC_SLOTTIME, 0x40);
    634  1.1  tsubai 
    635  1.1  tsubai 	/* XXX */
    636  1.1  tsubai 	gmac_write_reg(sc, GMAC_TXMACCONFIG, 0);
    637  1.1  tsubai 	gmac_write_reg(sc, GMAC_XIFCONFIG, 5);
    638  1.1  tsubai 	gmac_write_reg(sc, GMAC_MACCTRLCONFIG, 0);
    639  1.1  tsubai }
    640  1.1  tsubai 
    641  1.1  tsubai void
    642  1.1  tsubai gmac_init(sc)
    643  1.1  tsubai 	struct gmac_softc *sc;
    644  1.1  tsubai {
    645  1.1  tsubai 	struct ifnet *ifp = &sc->sc_if;
    646  1.1  tsubai 	u_int x;
    647  1.1  tsubai 
    648  1.1  tsubai 	gmac_stop_txdma(sc);
    649  1.1  tsubai 	gmac_stop_rxdma(sc);
    650  1.1  tsubai 
    651  1.1  tsubai 	gmac_init_mac(sc);
    652  1.1  tsubai 
    653  1.1  tsubai 	x = gmac_read_reg(sc, GMAC_RXMACCONFIG);
    654  1.1  tsubai 	if (ifp->if_flags & IFF_PROMISC)
    655  1.1  tsubai 		x |= GMAC_RXMAC_PR;
    656  1.1  tsubai 	else
    657  1.1  tsubai 		x &= ~GMAC_RXMAC_PR;
    658  1.1  tsubai 	gmac_write_reg(sc, GMAC_RXMACCONFIG, x);
    659  1.1  tsubai 
    660  1.1  tsubai 	gmac_write_reg(sc, GMAC_TXDMADESCBASEHI, 0);
    661  1.1  tsubai 	gmac_write_reg(sc, GMAC_TXDMADESCBASELO, vtophys(sc->sc_txlist));
    662  1.1  tsubai 	gmac_write_reg(sc, GMAC_RXDMADESCBASEHI, 0);
    663  1.1  tsubai 	gmac_write_reg(sc, GMAC_RXDMADESCBASELO, vtophys(sc->sc_rxlist));
    664  1.1  tsubai 
    665  1.1  tsubai 	gmac_start_txdma(sc);
    666  1.1  tsubai 	gmac_start_rxdma(sc);
    667  1.1  tsubai 	gmac_write_reg(sc, GMAC_RXDMAKICK, NRXBUF);
    668  1.1  tsubai 
    669  1.1  tsubai 	gmac_write_reg(sc, GMAC_INTMASK, ~(GMAC_INT_TXDONE | GMAC_INT_RXDONE));
    670  1.1  tsubai 
    671  1.1  tsubai 	ifp->if_flags |= IFF_RUNNING;
    672  1.1  tsubai 	ifp->if_flags &= ~IFF_OACTIVE;
    673  1.1  tsubai 	ifp->if_timer = 0;
    674  1.1  tsubai 
    675  1.1  tsubai 	untimeout(gmac_mii_tick, sc);
    676  1.1  tsubai 	timeout(gmac_mii_tick, sc, 1);
    677  1.1  tsubai 
    678  1.1  tsubai 	gmac_start(ifp);
    679  1.1  tsubai }
    680  1.1  tsubai 
    681  1.1  tsubai int
    682  1.1  tsubai gmac_ioctl(ifp, cmd, data)
    683  1.1  tsubai 	struct ifnet *ifp;
    684  1.1  tsubai 	u_long cmd;
    685  1.1  tsubai 	caddr_t data;
    686  1.1  tsubai {
    687  1.1  tsubai 	struct gmac_softc *sc = ifp->if_softc;
    688  1.1  tsubai 	struct ifaddr *ifa = (struct ifaddr *)data;
    689  1.1  tsubai 	struct ifreq *ifr = (struct ifreq *)data;
    690  1.1  tsubai 	int s, error = 0;
    691  1.1  tsubai 
    692  1.1  tsubai 	s = splnet();
    693  1.1  tsubai 
    694  1.1  tsubai 	switch (cmd) {
    695  1.1  tsubai 
    696  1.1  tsubai 	case SIOCSIFADDR:
    697  1.1  tsubai 		ifp->if_flags |= IFF_UP;
    698  1.1  tsubai 
    699  1.1  tsubai 		switch (ifa->ifa_addr->sa_family) {
    700  1.1  tsubai #ifdef INET
    701  1.1  tsubai 		case AF_INET:
    702  1.1  tsubai 			gmac_init(sc);
    703  1.1  tsubai 			arp_ifinit(ifp, ifa);
    704  1.1  tsubai 			break;
    705  1.1  tsubai #endif
    706  1.1  tsubai #ifdef NS
    707  1.1  tsubai 		case AF_NS:
    708  1.1  tsubai 		    {
    709  1.1  tsubai 			struct ns_addr *ina = &IA_SNS(ifa)->sns_addr;
    710  1.1  tsubai 
    711  1.1  tsubai 			if (ns_nullhost(*ina))
    712  1.1  tsubai 				ina->x_host =
    713  1.1  tsubai 				    *(union ns_host *)LLADDR(ifp->if_sadl);
    714  1.1  tsubai 			else {
    715  1.1  tsubai 				bcopy(ina->x_host.c_host,
    716  1.1  tsubai 				    LLADDR(ifp->if_sadl),
    717  1.1  tsubai 				    sizeof(sc->sc_enaddr));
    718  1.1  tsubai 			}
    719  1.1  tsubai 			/* Set new address. */
    720  1.1  tsubai 			gmac_init(sc);
    721  1.1  tsubai 			break;
    722  1.1  tsubai 		    }
    723  1.1  tsubai #endif
    724  1.1  tsubai 		default:
    725  1.1  tsubai 			gmac_init(sc);
    726  1.1  tsubai 			break;
    727  1.1  tsubai 		}
    728  1.1  tsubai 		break;
    729  1.1  tsubai 
    730  1.1  tsubai 	case SIOCSIFFLAGS:
    731  1.1  tsubai 		if ((ifp->if_flags & IFF_UP) == 0 &&
    732  1.1  tsubai 		    (ifp->if_flags & IFF_RUNNING) != 0) {
    733  1.1  tsubai 			/*
    734  1.1  tsubai 			 * If interface is marked down and it is running, then
    735  1.1  tsubai 			 * stop it.
    736  1.1  tsubai 			 */
    737  1.1  tsubai 			gmac_stop(sc);
    738  1.1  tsubai 			ifp->if_flags &= ~IFF_RUNNING;
    739  1.1  tsubai 		} else if ((ifp->if_flags & IFF_UP) != 0 &&
    740  1.1  tsubai 		    (ifp->if_flags & IFF_RUNNING) == 0) {
    741  1.1  tsubai 			/*
    742  1.1  tsubai 			 * If interface is marked up and it is stopped, then
    743  1.1  tsubai 			 * start it.
    744  1.1  tsubai 			 */
    745  1.1  tsubai 			gmac_init(sc);
    746  1.1  tsubai 		} else {
    747  1.1  tsubai 			/*
    748  1.1  tsubai 			 * Reset the interface to pick up changes in any other
    749  1.1  tsubai 			 * flags that affect hardware registers.
    750  1.1  tsubai 			 */
    751  1.1  tsubai 			/* gmac_reset(sc); */
    752  1.1  tsubai 			gmac_init(sc);
    753  1.1  tsubai 		}
    754  1.1  tsubai #ifdef GMAC_DEBUG
    755  1.1  tsubai 		if (ifp->if_flags & IFF_DEBUG)
    756  1.1  tsubai 			sc->sc_flags |= GMAC_DEBUGFLAG;
    757  1.1  tsubai #endif
    758  1.1  tsubai 		break;
    759  1.1  tsubai 
    760  1.1  tsubai 	case SIOCADDMULTI:
    761  1.1  tsubai 	case SIOCDELMULTI:
    762  1.1  tsubai 		error = (cmd == SIOCADDMULTI) ?
    763  1.1  tsubai 		    ether_addmulti(ifr, &sc->sc_ethercom) :
    764  1.1  tsubai 		    ether_delmulti(ifr, &sc->sc_ethercom);
    765  1.1  tsubai 
    766  1.1  tsubai 		if (error == ENETRESET) {
    767  1.1  tsubai 			/*
    768  1.1  tsubai 			 * Multicast list has changed; set the hardware filter
    769  1.1  tsubai 			 * accordingly.
    770  1.1  tsubai 			 */
    771  1.1  tsubai 			gmac_init(sc);
    772  1.1  tsubai 			/* gmac_setladrf(sc); */
    773  1.1  tsubai 			error = 0;
    774  1.1  tsubai 		}
    775  1.1  tsubai 		break;
    776  1.1  tsubai 
    777  1.1  tsubai 	case SIOCGIFMEDIA:
    778  1.1  tsubai 	case SIOCSIFMEDIA:
    779  1.1  tsubai 		error = ifmedia_ioctl(ifp, ifr, &sc->sc_mii.mii_media, cmd);
    780  1.1  tsubai 		break;
    781  1.1  tsubai 
    782  1.1  tsubai 	default:
    783  1.1  tsubai 		error = EINVAL;
    784  1.1  tsubai 	}
    785  1.1  tsubai 
    786  1.1  tsubai 	splx(s);
    787  1.1  tsubai 	return error;
    788  1.1  tsubai }
    789  1.1  tsubai 
    790  1.1  tsubai void
    791  1.1  tsubai gmac_watchdog(ifp)
    792  1.1  tsubai 	struct ifnet *ifp;
    793  1.1  tsubai {
    794  1.1  tsubai 	struct gmac_softc *sc = ifp->if_softc;
    795  1.1  tsubai 
    796  1.1  tsubai 	printf("%s: device timeout\n", ifp->if_xname);
    797  1.1  tsubai 	ifp->if_oerrors++;
    798  1.1  tsubai 
    799  1.1  tsubai 	gmac_reset(sc);
    800  1.1  tsubai 	gmac_init(sc);
    801  1.1  tsubai }
    802  1.1  tsubai 
    803  1.1  tsubai int
    804  1.1  tsubai gmac_mediachange(ifp)
    805  1.1  tsubai 	struct ifnet *ifp;
    806  1.1  tsubai {
    807  1.1  tsubai 	struct gmac_softc *sc = ifp->if_softc;
    808  1.1  tsubai 
    809  1.1  tsubai 	return mii_mediachg(&sc->sc_mii);
    810  1.1  tsubai }
    811  1.1  tsubai 
    812  1.1  tsubai void
    813  1.1  tsubai gmac_mediastatus(ifp, ifmr)
    814  1.1  tsubai 	struct ifnet *ifp;
    815  1.1  tsubai 	struct ifmediareq *ifmr;
    816  1.1  tsubai {
    817  1.1  tsubai 	struct gmac_softc *sc = ifp->if_softc;
    818  1.1  tsubai 
    819  1.1  tsubai 	mii_pollstat(&sc->sc_mii);
    820  1.1  tsubai 
    821  1.1  tsubai 	ifmr->ifm_status = sc->sc_mii.mii_media_status;
    822  1.1  tsubai 	ifmr->ifm_active = sc->sc_mii.mii_media_active;
    823  1.1  tsubai }
    824  1.1  tsubai 
    825  1.1  tsubai int
    826  1.1  tsubai gmac_mii_readreg(dev, phy, reg)
    827  1.1  tsubai 	struct device *dev;
    828  1.1  tsubai 	int phy, reg;
    829  1.1  tsubai {
    830  1.1  tsubai 	struct gmac_softc *sc = (void *)dev;
    831  1.1  tsubai 	int i;
    832  1.1  tsubai 
    833  1.1  tsubai 	gmac_write_reg(sc, GMAC_MIFFRAMEOUTPUT,
    834  1.1  tsubai 		0x60020000 | (phy << 23) | (reg << 18));
    835  1.1  tsubai 
    836  1.1  tsubai 	for (i = 1000; i >= 0; i -= 10) {
    837  1.1  tsubai 		if (gmac_read_reg(sc, GMAC_MIFFRAMEOUTPUT) & 0x10000)
    838  1.1  tsubai 			break;
    839  1.1  tsubai 		delay(10);
    840  1.1  tsubai 	}
    841  1.1  tsubai 	if (i < 0) {
    842  1.1  tsubai 		printf("%s: gmac_mii_readreg: timeout\n", sc->sc_dev.dv_xname);
    843  1.1  tsubai 		return 0;
    844  1.1  tsubai 	}
    845  1.1  tsubai 
    846  1.1  tsubai 	return gmac_read_reg(sc, GMAC_MIFFRAMEOUTPUT) & 0xffff;
    847  1.1  tsubai }
    848  1.1  tsubai 
    849  1.1  tsubai void
    850  1.1  tsubai gmac_mii_writereg(dev, phy, reg, val)
    851  1.1  tsubai 	struct device *dev;
    852  1.1  tsubai 	int phy, reg, val;
    853  1.1  tsubai {
    854  1.1  tsubai 	struct gmac_softc *sc = (void *)dev;
    855  1.1  tsubai 	int i;
    856  1.1  tsubai 
    857  1.1  tsubai 	gmac_write_reg(sc, GMAC_MIFFRAMEOUTPUT,
    858  1.1  tsubai 		0x50020000 | (phy << 23) | (reg << 18) | (val & 0xffff));
    859  1.1  tsubai 
    860  1.1  tsubai 	for (i = 1000; i >= 0; i -= 10) {
    861  1.1  tsubai 		if (gmac_read_reg(sc, GMAC_MIFFRAMEOUTPUT) & 0x10000)
    862  1.1  tsubai 			break;
    863  1.1  tsubai 		delay(10);
    864  1.1  tsubai 	}
    865  1.1  tsubai 	if (i < 0)
    866  1.1  tsubai 		printf("%s: gmac_mii_writereg: timeout\n", sc->sc_dev.dv_xname);
    867  1.1  tsubai }
    868  1.1  tsubai 
    869  1.1  tsubai void
    870  1.1  tsubai gmac_mii_statchg(dev)
    871  1.1  tsubai 	struct device *dev;
    872  1.1  tsubai {
    873  1.1  tsubai 	struct gmac_softc *sc = (void *)dev;
    874  1.1  tsubai 
    875  1.1  tsubai 	gmac_stop_txdma(sc);
    876  1.1  tsubai 	gmac_stop_rxdma(sc);
    877  1.1  tsubai 
    878  1.1  tsubai 	if (IFM_OPTIONS(sc->sc_mii.mii_media_active) & IFM_FDX) {
    879  1.1  tsubai 		gmac_write_reg(sc, GMAC_TXMACCONFIG, 6);
    880  1.1  tsubai 		gmac_write_reg(sc, GMAC_XIFCONFIG, 1);
    881  1.1  tsubai 	} else {
    882  1.1  tsubai 		gmac_write_reg(sc, GMAC_TXMACCONFIG, 0);
    883  1.1  tsubai 		gmac_write_reg(sc, GMAC_XIFCONFIG, 5);
    884  1.1  tsubai 	}
    885  1.1  tsubai 
    886  1.1  tsubai 	if (0)	/* g-bit? */
    887  1.1  tsubai 		gmac_write_reg(sc, GMAC_MACCTRLCONFIG, 3);
    888  1.1  tsubai 	else
    889  1.1  tsubai 		gmac_write_reg(sc, GMAC_MACCTRLCONFIG, 0);
    890  1.1  tsubai 
    891  1.1  tsubai 	gmac_start_txdma(sc);
    892  1.1  tsubai 	gmac_start_rxdma(sc);
    893  1.1  tsubai }
    894  1.1  tsubai 
    895  1.1  tsubai void
    896  1.1  tsubai gmac_mii_tick(v)
    897  1.1  tsubai 	void *v;
    898  1.1  tsubai {
    899  1.1  tsubai 	struct gmac_softc *sc = v;
    900  1.1  tsubai 	int s;
    901  1.1  tsubai 
    902  1.1  tsubai 	s = splnet();
    903  1.1  tsubai 	mii_tick(&sc->sc_mii);
    904  1.1  tsubai 	splx(s);
    905  1.1  tsubai 
    906  1.1  tsubai 	timeout(gmac_mii_tick, sc, hz);
    907  1.1  tsubai }
    908