Home | History | Annotate | Line # | Download | only in altboot
      1  1.3       phx /* $NetBSD: nvt.c,v 1.3 2011/10/30 21:08:33 phx Exp $ */
      2  1.1  nisimura 
      3  1.1  nisimura /*-
      4  1.1  nisimura  * Copyright (c) 2007 The NetBSD Foundation, Inc.
      5  1.1  nisimura  * All rights reserved.
      6  1.1  nisimura  *
      7  1.1  nisimura  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1  nisimura  * by Tohru Nishimura.
      9  1.1  nisimura  *
     10  1.1  nisimura  * Redistribution and use in source and binary forms, with or without
     11  1.1  nisimura  * modification, are permitted provided that the following conditions
     12  1.1  nisimura  * are met:
     13  1.1  nisimura  * 1. Redistributions of source code must retain the above copyright
     14  1.1  nisimura  *    notice, this list of conditions and the following disclaimer.
     15  1.1  nisimura  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1  nisimura  *    notice, this list of conditions and the following disclaimer in the
     17  1.1  nisimura  *    documentation and/or other materials provided with the distribution.
     18  1.1  nisimura  *
     19  1.1  nisimura  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  1.1  nisimura  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  1.1  nisimura  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  1.1  nisimura  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  1.1  nisimura  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  1.1  nisimura  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  1.1  nisimura  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  1.1  nisimura  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  1.1  nisimura  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  1.1  nisimura  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  1.1  nisimura  * POSSIBILITY OF SUCH DAMAGE.
     30  1.1  nisimura  */
     31  1.1  nisimura 
     32  1.1  nisimura #include <sys/param.h>
     33  1.1  nisimura 
     34  1.1  nisimura #include <netinet/in.h>
     35  1.1  nisimura #include <netinet/in_systm.h>
     36  1.1  nisimura 
     37  1.1  nisimura #include <lib/libsa/stand.h>
     38  1.1  nisimura #include <lib/libsa/net.h>
     39  1.1  nisimura 
     40  1.1  nisimura #include "globals.h"
     41  1.1  nisimura 
     42  1.1  nisimura /*
     43  1.1  nisimura  * - reverse endian access every CSR.
     44  1.1  nisimura  * - no vtophys() translation, vaddr_t == paddr_t.
     45  1.1  nisimura  * - PIPT writeback cache aware.
     46  1.1  nisimura  */
     47  1.3       phx #define CSR_WRITE_1(l, r, v)	out8((l)->csr+(r), (v))
     48  1.3       phx #define CSR_READ_1(l, r)	in8((l)->csr+(r))
     49  1.1  nisimura #define CSR_WRITE_2(l, r, v)	out16rb((l)->csr+(r), (v))
     50  1.1  nisimura #define CSR_READ_2(l, r)	in16rb((l)->csr+(r))
     51  1.1  nisimura #define CSR_WRITE_4(l, r, v)	out32rb((l)->csr+(r), (v))
     52  1.1  nisimura #define CSR_READ_4(l, r)	in32rb((l)->csr+(r))
     53  1.1  nisimura #define VTOPHYS(va)		(uint32_t)(va)
     54  1.1  nisimura #define DEVTOV(pa)		(uint32_t)(pa)
     55  1.1  nisimura #define wbinv(adr, siz)		_wbinv(VTOPHYS(adr), (uint32_t)(siz))
     56  1.1  nisimura #define inv(adr, siz)		_inv(VTOPHYS(adr), (uint32_t)(siz))
     57  1.1  nisimura #define DELAY(n)		delay(n)
     58  1.1  nisimura #define ALLOC(T,A)		(T *)allocaligned(sizeof(T),(A))
     59  1.1  nisimura 
     60  1.1  nisimura struct desc {
     61  1.1  nisimura 	uint32_t xd0, xd1, xd2, xd3;
     62  1.1  nisimura };
     63  1.1  nisimura #define T0_OWN		(1U << 31)	/* 1: loaded for HW to send */
     64  1.1  nisimura #define T0_TERR		(1U << 15)	/* Tx error; ABT|CBH */
     65  1.1  nisimura #define T0_UDF		(1U << 11)	/* FIFO underflow */
     66  1.1  nisimura #define T0_CRS		(1U << 10)	/* found carrier sense lost */
     67  1.1  nisimura #define T0_OWC		(1U << 9)	/* found out of window collision */
     68  1.1  nisimura #define T0_ABT		(1U << 8)	/* excess collision Tx abort */
     69  1.1  nisimura #define T0_CBH		(1U << 7)	/* heartbeat check failure */
     70  1.1  nisimura #define T0_COLS		(1U << 4)	/* collision detected */
     71  1.1  nisimura #define T0_NCRMASK	0x3		/* number of collision retries */
     72  1.1  nisimura #define T1_IC		(1U << 23)	/* post Tx done interrupt */
     73  1.1  nisimura #define T1_STP		(1U << 22)	/* first frame segment */
     74  1.1  nisimura #define T1_EDP		(1U << 21)	/* last frame segment */
     75  1.1  nisimura #define T1_CRC		(1U << 16)	/* _disable_ CRC generation */
     76  1.1  nisimura #define T1_CHN		(1U << 15)	/* "more bit," not the last seg. */
     77  1.1  nisimura #define T_FLMASK	0x00007fff	/* Tx frame/segment length */
     78  1.1  nisimura 
     79  1.1  nisimura #define R0_OWN		(1U << 31)	/* 1: empty for HW to load anew */
     80  1.1  nisimura #define R0_FLMASK	0x7fff0000	/* frame length */
     81  1.1  nisimura #define R0_RXOK		(1U << 15)
     82  1.1  nisimura #define R0_MAR		(1U << 13)	/* multicast frame */
     83  1.1  nisimura #define R0_BAR		(1U << 12)	/* broadcast frame */
     84  1.1  nisimura #define R0_PHY		(1U << 11)	/* unicast frame */
     85  1.1  nisimura #define R0_CHN		(1U << 10)	/* "more bit," not the last seg. */
     86  1.1  nisimura #define R0_STP		(1U << 9)	/* first frame segment */
     87  1.1  nisimura #define R0_EDP		(1U << 8)	/* last frame segment */
     88  1.1  nisimura #define R0_BUFF		(1U << 7)	/* segment chain was broken */
     89  1.1  nisimura #define R0_RUNT		(1U << 5)	/* runt frame received */
     90  1.1  nisimura #define R0_LONG		(1U << 4)	/* frame too long */
     91  1.1  nisimura #define R0_FOV		(1U << 3)	/* Rx FIFO overflow */
     92  1.1  nisimura #define R0_FAE		(1U << 2)	/* frame alignment error */
     93  1.1  nisimura #define R0_CRCE		(1U << 1)	/* CRC error */
     94  1.1  nisimura #define R0_RERR		(1U << 0)	/* Rx error summary */
     95  1.1  nisimura #define R1_FLMASK	0x00007ffc	/* Rx segment buffer length */
     96  1.1  nisimura 
     97  1.1  nisimura #define VR_PAR0		0x00		/* SA [0] */
     98  1.1  nisimura #define VR_PAR1		0x01		/* SA [1] */
     99  1.1  nisimura #define VR_PAR2		0x02		/* SA [2] */
    100  1.1  nisimura #define VR_PAR3		0x03		/* SA [3] */
    101  1.1  nisimura #define VR_PAR4		0x04		/* SA [4] */
    102  1.1  nisimura #define VR_PAR5		0x05		/* SA [5] */
    103  1.1  nisimura #define VR_RCR		0x06		/* Rx control */
    104  1.1  nisimura #define  RCR_PROM	(1U << 4)	/* accept any frame */
    105  1.1  nisimura #define  RCR_AB		(1U << 3)	/* accept broadcast frame */
    106  1.1  nisimura #define  RCR_AM		(1U << 2)	/* use multicast filter */
    107  1.1  nisimura #define VR_TCR		0x07		/* Tx control */
    108  1.1  nisimura #define VR_CTL0		0x08		/* control #0 */
    109  1.1  nisimura #define  CTL0_RDMD	(1U << 6)	/* instruct Rx descriptor poll */
    110  1.1  nisimura #define  CTL0_TDMD	(1U << 5)	/* instruct Tx descriptor poll */
    111  1.1  nisimura #define  CTL0_TXON	(1U << 4)	/* enable Tx DMA */
    112  1.1  nisimura #define  CTL0_RXON	(1U << 3)	/* enable Rx DMA */
    113  1.1  nisimura #define  CTL0_STOP	(1U << 2)	/* activate stop processing */
    114  1.1  nisimura #define  CTL0_START	(1U << 1)	/* start and activate */
    115  1.1  nisimura #define VR_CTL1		0x09		/* control #1 */
    116  1.1  nisimura #define  CTL1_RESET	(1U << 7)	/* SW reset, self-clearing */
    117  1.1  nisimura #define  CTL1_DPOLL	(1U << 3)	/* _disable_ Tx auto polling */
    118  1.1  nisimura #define  CTL1_FDX	(1U << 2)	/* set full duplex */
    119  1.1  nisimura #define VR_ISR		0x0c		/* interrupt status */
    120  1.1  nisimura #define VR_IEN		0x0e		/* interrupt enable */
    121  1.1  nisimura #define VR_RDBA		0x18		/* Rx descriptor list base */
    122  1.1  nisimura #define VR_TDBA		0x1c		/* Tx descriptor list base */
    123  1.1  nisimura #define VR_MIICFG	0x6c		/* 4:0 PHY number */
    124  1.1  nisimura #define VR_MIISR	0x6d		/* MII status */
    125  1.1  nisimura #define VR_MIICR	0x70		/* MII control */
    126  1.1  nisimura #define  MIICR_MAUTO	(1U << 7)	/* activate autopoll mode */
    127  1.1  nisimura #define  MIICR_RCMD	(1U << 6)	/* MII read operation */
    128  1.1  nisimura #define  MIICR_WCMD	(1U << 5)	/* MII write operation */
    129  1.1  nisimura #define VR_MIIADR	0x71		/* MII indirect */
    130  1.1  nisimura #define  MIIADR_MIDLE	(1U << 7)	/* not in auto polling */
    131  1.1  nisimura #define VR_MIIDATA	0x72		/* MII read/write */
    132  1.1  nisimura #define VR_RXC		0x7e		/* Rx feature control */
    133  1.1  nisimura #define VR_TXC		0x7f		/* Tx feature control */
    134  1.1  nisimura #define VR_MCR0		0x80		/* misc control #0 */
    135  1.1  nisimura #define  MCR0_RFDXFLC	(1U << 3)	/* FCR1? */
    136  1.1  nisimura #define  MCR0_HDXFLC	(1U << 2)	/* FCR2? */
    137  1.1  nisimura #define VR_MCR1		0x81		/* misc control #1 */
    138  1.1  nisimura 
    139  1.1  nisimura #define FRAMESIZE	1536
    140  1.1  nisimura 
    141  1.1  nisimura struct local {
    142  1.1  nisimura 	struct desc txd[2];
    143  1.1  nisimura 	struct desc rxd[2];
    144  1.1  nisimura 	uint8_t rxstore[2][FRAMESIZE];
    145  1.1  nisimura 	unsigned csr, tx, rx;
    146  1.1  nisimura 	unsigned phy, bmsr, anlpar;
    147  1.1  nisimura 	unsigned ctl0;
    148  1.1  nisimura };
    149  1.1  nisimura 
    150  1.1  nisimura static void mii_autopoll(struct local *);
    151  1.1  nisimura static void mii_stoppoll(struct local *);
    152  1.1  nisimura static int mii_read(struct local *, int, int);
    153  1.1  nisimura static void mii_write(struct local *, int, int, int);
    154  1.1  nisimura static void mii_dealan(struct local *, unsigned);
    155  1.1  nisimura 
    156  1.1  nisimura int
    157  1.1  nisimura nvt_match(unsigned tag, void *data)
    158  1.1  nisimura {
    159  1.1  nisimura 	unsigned v;
    160  1.1  nisimura 
    161  1.1  nisimura 	v = pcicfgread(tag, PCI_ID_REG);
    162  1.1  nisimura 	switch (v) {
    163  1.1  nisimura 	case PCI_DEVICE(0x1106, 0x3053):
    164  1.1  nisimura 	case PCI_DEVICE(0x1106, 0x3065):
    165  1.1  nisimura 		return 1;
    166  1.1  nisimura 	}
    167  1.1  nisimura 	return 0;
    168  1.1  nisimura }
    169  1.1  nisimura 
    170  1.1  nisimura void *
    171  1.1  nisimura nvt_init(unsigned tag, void *data)
    172  1.1  nisimura {
    173  1.1  nisimura 	unsigned val, fdx;
    174  1.1  nisimura 	struct local *l;
    175  1.1  nisimura 	struct desc *txd, *rxd;
    176  1.1  nisimura 	uint8_t *en;
    177  1.1  nisimura 
    178  1.1  nisimura 	l = ALLOC(struct local, 32); /* desc alignment */
    179  1.1  nisimura 	memset(l, 0, sizeof(struct local));
    180  1.1  nisimura 	l->csr = ~01 & DEVTOV(pcicfgread(tag, 0x10)); /* use IO space */
    181  1.1  nisimura 
    182  1.1  nisimura 	val = CTL1_RESET;
    183  1.1  nisimura 	CSR_WRITE_1(l, VR_CTL1, val);
    184  1.1  nisimura 	do {
    185  1.1  nisimura 		val = CSR_READ_1(l, VR_CTL1);
    186  1.1  nisimura 	} while (val & CTL1_RESET);
    187  1.1  nisimura 	/* PHY number is loaded from EEPROM */
    188  1.1  nisimura 	l->phy = CSR_READ_1(l, VR_MIICFG) & 0x1f;
    189  1.1  nisimura 
    190  1.1  nisimura 	en = data;
    191  1.1  nisimura 	en[0] = CSR_READ_1(l, VR_PAR0);
    192  1.1  nisimura 	en[1] = CSR_READ_1(l, VR_PAR1);
    193  1.1  nisimura 	en[2] = CSR_READ_1(l, VR_PAR2);
    194  1.1  nisimura 	en[3] = CSR_READ_1(l, VR_PAR3);
    195  1.1  nisimura 	en[4] = CSR_READ_1(l, VR_PAR4);
    196  1.1  nisimura 	en[5] = CSR_READ_1(l, VR_PAR5);
    197  1.1  nisimura 
    198  1.1  nisimura 	printf("MAC address %02x:%02x:%02x:%02x:%02x:%02x\n",
    199  1.1  nisimura 	    en[0], en[1], en[2], en[3], en[4], en[5]);
    200  1.2       phx 	DPRINTF(("PHY %d (%04x.%04x)\n", l->phy,
    201  1.2       phx 	    mii_read(l, l->phy, 2), mii_read(l, l->phy, 3)));
    202  1.1  nisimura 
    203  1.1  nisimura 	mii_dealan(l, 5);
    204  1.1  nisimura 
    205  1.1  nisimura 	/* speed and duplexity can be seen in MII 20 */
    206  1.1  nisimura 	val = mii_read(l, l->phy, 20);
    207  1.1  nisimura 	fdx = !!(val & (1U << 0));
    208  1.1  nisimura 	printf("%s", (val & (1U << 1)) ? "100Mbps" : "10Mbps");
    209  1.1  nisimura 	if (fdx)
    210  1.1  nisimura 		printf("-FDX");
    211  1.1  nisimura 	printf("\n");
    212  1.1  nisimura 
    213  1.1  nisimura 	txd = &l->txd[0];
    214  1.1  nisimura 	rxd = &l->rxd[0];
    215  1.1  nisimura 	rxd[0].xd0 = htole32(R0_OWN);
    216  1.1  nisimura 	rxd[0].xd1 = htole32(FRAMESIZE << 16);
    217  1.1  nisimura 	rxd[0].xd2 = htole32(VTOPHYS(l->rxstore[0]));
    218  1.1  nisimura 	rxd[0].xd3 = htole32(VTOPHYS(&rxd[1]));
    219  1.1  nisimura 	rxd[1].xd0 = htole32(R0_OWN);
    220  1.1  nisimura 	rxd[1].xd1 = htole32(VTOPHYS(l->rxstore[1]));
    221  1.1  nisimura 	rxd[1].xd2 = htole32(FRAMESIZE << 16);
    222  1.1  nisimura 	rxd[1].xd3 = htole32(VTOPHYS(&rxd[0]));
    223  1.1  nisimura 	wbinv(l, sizeof(struct local));
    224  1.1  nisimura 	l->tx = l->rx = 0;
    225  1.1  nisimura 
    226  1.1  nisimura 	/* enable transmitter and receiver */
    227  1.1  nisimura 	l->ctl0 = CTL0_TXON | CTL0_RXON | CTL0_START;
    228  1.1  nisimura 	CSR_WRITE_4(l, VR_RDBA, VTOPHYS(rxd));
    229  1.1  nisimura 	CSR_WRITE_4(l, VR_TDBA, VTOPHYS(txd));
    230  1.1  nisimura 	CSR_WRITE_1(l, VR_RCR, 0);
    231  1.1  nisimura 	CSR_WRITE_1(l, VR_TCR, 0);
    232  1.1  nisimura 	CSR_WRITE_2(l, VR_ISR, ~0);
    233  1.1  nisimura 	CSR_WRITE_2(l, VR_IEN, 0);
    234  1.1  nisimura 	if (fdx)
    235  1.1  nisimura 		CSR_WRITE_1(l, VR_CTL1, CTL1_FDX);
    236  1.1  nisimura 	CSR_WRITE_1(l, VR_CTL0, CTL0_START);
    237  1.1  nisimura 	CSR_WRITE_1(l, VR_CTL0, l->ctl0);
    238  1.1  nisimura 
    239  1.1  nisimura 	return l;
    240  1.1  nisimura }
    241  1.1  nisimura 
    242  1.1  nisimura int
    243  1.1  nisimura nvt_send(void *dev, char *buf, unsigned len)
    244  1.1  nisimura {
    245  1.1  nisimura 	struct local *l = dev;
    246  1.1  nisimura 	volatile struct desc *txd;
    247  1.1  nisimura 	unsigned loop;
    248  1.1  nisimura 
    249  1.1  nisimura 	len = (len & T_FLMASK);
    250  1.1  nisimura 	if (len < 60)
    251  1.1  nisimura 		len = 60; /* needs to stretch to ETHER_MIN_LEN - 4 */
    252  1.1  nisimura 	wbinv(buf, len);
    253  1.1  nisimura 	txd = &l->txd[l->tx];
    254  1.1  nisimura 	txd->xd3 = htole32(txd);
    255  1.1  nisimura 	txd->xd2 = htole32(VTOPHYS(buf));
    256  1.1  nisimura 	txd->xd1 = htole32(T1_STP | T1_EDP | len);
    257  1.1  nisimura 	txd->xd0 = htole32(T0_OWN);
    258  1.1  nisimura 	wbinv(txd, sizeof(struct desc));
    259  1.1  nisimura 	CSR_WRITE_1(l, VR_CTL0, l->ctl0 | CTL0_TDMD);
    260  1.1  nisimura 	loop = 100;
    261  1.1  nisimura 	do {
    262  1.1  nisimura 		if ((le32toh(txd->xd0) & T0_OWN) == 0)
    263  1.1  nisimura 			goto done;
    264  1.1  nisimura 		DELAY(10);
    265  1.1  nisimura 		inv(txd, sizeof(struct desc));
    266  1.1  nisimura 	} while (--loop > 0);
    267  1.1  nisimura 	printf("xmit failed\n");
    268  1.1  nisimura 	return -1;
    269  1.1  nisimura   done:
    270  1.1  nisimura 	l->tx ^= 1;
    271  1.1  nisimura 	return len;
    272  1.1  nisimura }
    273  1.1  nisimura 
    274  1.1  nisimura int
    275  1.1  nisimura nvt_recv(void *dev, char *buf, unsigned maxlen, unsigned timo)
    276  1.1  nisimura {
    277  1.1  nisimura 	struct local *l = dev;
    278  1.1  nisimura 	volatile struct desc *rxd;
    279  1.1  nisimura 	unsigned bound, rxstat, len;
    280  1.1  nisimura 	uint8_t *ptr;
    281  1.1  nisimura 
    282  1.1  nisimura 	bound = 1000 * timo;
    283  1.1  nisimura printf("recving with %u sec. timeout\n", timo);
    284  1.1  nisimura   again:
    285  1.1  nisimura 	rxd = &l->rxd[l->rx];
    286  1.1  nisimura 	do {
    287  1.1  nisimura 		inv(rxd, sizeof(struct desc));
    288  1.1  nisimura 		rxstat = le32toh(rxd->xd0);
    289  1.1  nisimura 		if ((rxstat & R0_OWN) == 0)
    290  1.1  nisimura 			goto gotone;
    291  1.1  nisimura 		DELAY(1000);	/* 1 milli second */
    292  1.1  nisimura 	} while (--bound > 0);
    293  1.1  nisimura 	errno = 0;
    294  1.1  nisimura 	return -1;
    295  1.1  nisimura   gotone:
    296  1.1  nisimura 	if ((rxstat & R0_RXOK) == 0) {
    297  1.1  nisimura 		rxd->xd0 = htole32(R0_OWN);
    298  1.1  nisimura 		wbinv(rxd, sizeof(struct desc));
    299  1.1  nisimura 		l->rx ^= 1;
    300  1.1  nisimura 		goto again;
    301  1.1  nisimura 	}
    302  1.1  nisimura 	len = ((rxstat & R0_FLMASK) >> 16) - 4 /* HASFCS */;
    303  1.1  nisimura 	if (len > maxlen)
    304  1.1  nisimura 		len = maxlen;
    305  1.1  nisimura 	ptr = l->rxstore[l->rx];
    306  1.1  nisimura 	inv(ptr, len);
    307  1.1  nisimura 	memcpy(buf, ptr, len);
    308  1.1  nisimura 	rxd->xd0 = htole32(R0_OWN);
    309  1.1  nisimura 	wbinv(rxd, sizeof(struct desc));
    310  1.1  nisimura 	l->rx ^= 1;
    311  1.1  nisimura 	return len;
    312  1.1  nisimura }
    313  1.1  nisimura 
    314  1.1  nisimura static void
    315  1.1  nisimura mii_autopoll(struct local *l)
    316  1.1  nisimura {
    317  1.1  nisimura 	int v;
    318  1.1  nisimura 
    319  1.1  nisimura 	CSR_WRITE_1(l, VR_MIICR, 0);
    320  1.1  nisimura 	do {
    321  1.1  nisimura 		DELAY(1);
    322  1.1  nisimura 		v = CSR_READ_1(l, VR_MIISR);
    323  1.1  nisimura 	} while ((v & MIIADR_MIDLE) == 0);
    324  1.1  nisimura 	CSR_WRITE_1(l, VR_MIICR, MIICR_MAUTO);
    325  1.1  nisimura 	do {
    326  1.1  nisimura 		DELAY(1);
    327  1.1  nisimura 		v = CSR_READ_1(l, VR_MIISR);
    328  1.1  nisimura 	} while ((v & MIIADR_MIDLE) != 0);
    329  1.1  nisimura }
    330  1.1  nisimura 
    331  1.1  nisimura static void
    332  1.1  nisimura mii_stoppoll(struct local *l)
    333  1.1  nisimura {
    334  1.1  nisimura 	int v;
    335  1.1  nisimura 
    336  1.1  nisimura 	CSR_WRITE_1(l, VR_MIICR, 0);
    337  1.1  nisimura 	do {
    338  1.1  nisimura 		DELAY(1);
    339  1.1  nisimura 		v = CSR_READ_1(l, VR_MIISR);
    340  1.1  nisimura 	} while ((v & MIIADR_MIDLE) == 0);
    341  1.1  nisimura }
    342  1.1  nisimura 
    343  1.1  nisimura static int
    344  1.1  nisimura mii_read(struct local *l, int phy, int reg)
    345  1.1  nisimura {
    346  1.1  nisimura 	int v;
    347  1.1  nisimura 
    348  1.1  nisimura 	mii_stoppoll(l);
    349  1.1  nisimura 	CSR_WRITE_1(l, VR_MIICFG, phy);
    350  1.1  nisimura 	CSR_WRITE_1(l, VR_MIIADR, reg);
    351  1.1  nisimura 	CSR_WRITE_1(l, VR_MIICR, MIICR_RCMD);
    352  1.1  nisimura 	do {
    353  1.1  nisimura 		v = CSR_READ_1(l, VR_MIICR);
    354  1.1  nisimura 	} while (v & MIICR_RCMD);
    355  1.1  nisimura 	v = CSR_READ_2(l, VR_MIIDATA);
    356  1.1  nisimura 	mii_autopoll(l);
    357  1.1  nisimura 	return v;
    358  1.1  nisimura }
    359  1.1  nisimura 
    360  1.1  nisimura static void
    361  1.1  nisimura mii_write(struct local *l, int phy, int reg, int data)
    362  1.1  nisimura {
    363  1.1  nisimura 	int v;
    364  1.1  nisimura 
    365  1.1  nisimura 	mii_stoppoll(l);
    366  1.1  nisimura 	CSR_WRITE_2(l, VR_MIIDATA, data);
    367  1.1  nisimura 	CSR_WRITE_1(l, VR_MIICFG, phy);
    368  1.1  nisimura 	CSR_WRITE_1(l, VR_MIIADR, reg);
    369  1.1  nisimura 	CSR_WRITE_1(l, VR_MIICR, MIICR_WCMD);
    370  1.1  nisimura 	do {
    371  1.1  nisimura 		v = CSR_READ_1(l, VR_MIICR);
    372  1.1  nisimura 	} while (v & MIICR_WCMD);
    373  1.1  nisimura 	mii_autopoll(l);
    374  1.1  nisimura }
    375  1.1  nisimura 
    376  1.1  nisimura #define MII_BMCR	0x00	/* Basic mode control register (rw) */
    377  1.1  nisimura #define  BMCR_RESET	0x8000	/* reset */
    378  1.1  nisimura #define  BMCR_AUTOEN	0x1000	/* autonegotiation enable */
    379  1.1  nisimura #define  BMCR_ISO	0x0400	/* isolate */
    380  1.1  nisimura #define  BMCR_STARTNEG	0x0200	/* restart autonegotiation */
    381  1.1  nisimura #define MII_BMSR	0x01	/* Basic mode status register (ro) */
    382  1.1  nisimura #define  BMSR_ACOMP	0x0020	/* Autonegotiation complete */
    383  1.1  nisimura #define  BMSR_LINK	0x0004	/* Link status */
    384  1.1  nisimura #define MII_ANAR	0x04	/* Autonegotiation advertisement (rw) */
    385  1.1  nisimura #define  ANAR_FC	0x0400	/* local device supports PAUSE */
    386  1.1  nisimura #define  ANAR_TX_FD	0x0100	/* local device supports 100bTx FD */
    387  1.1  nisimura #define  ANAR_TX	0x0080	/* local device supports 100bTx */
    388  1.1  nisimura #define  ANAR_10_FD	0x0040	/* local device supports 10bT FD */
    389  1.1  nisimura #define  ANAR_10	0x0020	/* local device supports 10bT */
    390  1.1  nisimura #define  ANAR_CSMA	0x0001	/* protocol selector CSMA/CD */
    391  1.1  nisimura #define MII_ANLPAR	0x05	/* Autonegotiation lnk partner abilities (rw) */
    392  1.1  nisimura 
    393  1.1  nisimura void
    394  1.1  nisimura mii_dealan(struct local *l, unsigned timo)
    395  1.1  nisimura {
    396  1.1  nisimura 	unsigned anar, bound;
    397  1.1  nisimura 
    398  1.1  nisimura 	anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10 | ANAR_CSMA;
    399  1.1  nisimura 	mii_write(l, l->phy, MII_ANAR, anar);
    400  1.1  nisimura 	mii_write(l, l->phy, MII_BMCR, BMCR_AUTOEN | BMCR_STARTNEG);
    401  1.1  nisimura 	l->anlpar = 0;
    402  1.1  nisimura 	bound = getsecs() + timo;
    403  1.1  nisimura 	do {
    404  1.1  nisimura 		l->bmsr = mii_read(l, l->phy, MII_BMSR) |
    405  1.1  nisimura 		   mii_read(l, l->phy, MII_BMSR); /* read twice */
    406  1.1  nisimura 		if ((l->bmsr & BMSR_LINK) && (l->bmsr & BMSR_ACOMP)) {
    407  1.1  nisimura 			l->anlpar = mii_read(l, l->phy, MII_ANLPAR);
    408  1.1  nisimura 			break;
    409  1.1  nisimura 		}
    410  1.1  nisimura 		DELAY(10 * 1000);
    411  1.1  nisimura 	} while (getsecs() < bound);
    412  1.1  nisimura 	return;
    413  1.1  nisimura }
    414