Home | History | Annotate | Line # | Download | only in altboot
rge.c revision 1.1
      1  1.1  nisimura /* $NetBSD: rge.c,v 1.1 2011/01/23 01:05:30 nisimura 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.1  nisimura #define CSR_WRITE_1(l, r, v)	*(volatile uint8_t *)((l)->csr+(r)) = (v)
     48  1.1  nisimura #define CSR_READ_1(l, r)	*(volatile uint8_t *)((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		0x80000000	/* loaded for HW to send */
     64  1.1  nisimura #define T0_EOR		0x40000000	/* end of ring */
     65  1.1  nisimura #define T0_FS		0x20000000	/* first descriptor */
     66  1.1  nisimura #define T0_LS		0x10000000	/* last descriptor */
     67  1.1  nisimura #define T0_FRMASK	0x0000ffff
     68  1.1  nisimura 
     69  1.1  nisimura #define R0_OWN		0x80000000	/* empty for HW to load anew */
     70  1.1  nisimura #define R0_EOR		0x40000000	/* end mark to form a ring */
     71  1.1  nisimura #define R0_BUFLEN	0x00003ff8	/* max frag. size to receive */
     72  1.1  nisimura #define R0_FS		0x20000000	/* start of frame */
     73  1.1  nisimura #define R0_LS		0x10000000	/* end of frame */
     74  1.1  nisimura #define R0_RES		0x00200000	/* Rx error summary */
     75  1.1  nisimura #define R0_RUNT		0x00100000	/* runt frame received */
     76  1.1  nisimura #define R0_CRC		0x00080000	/* CRC error found */
     77  1.1  nisimura #define R0_FRMASK	0x00003fff	/* 13:0 frame length */
     78  1.1  nisimura 
     79  1.1  nisimura #define RGE_IDR0	0x00		/* MAC address [0] */
     80  1.1  nisimura #define RGE_IDR1	0x01		/* MAC address [1] */
     81  1.1  nisimura #define RGE_IDR2	0x02		/* MAC address [2] */
     82  1.1  nisimura #define RGE_IDR3	0x03		/* MAC address [3] */
     83  1.1  nisimura #define RGE_IDR4	0x04		/* MAC address [4] */
     84  1.1  nisimura #define RGE_IDR5	0x05		/* MAC address [5] */
     85  1.1  nisimura #define RGE_TNPDS	0x20		/* Tx descriptor base paddr */
     86  1.1  nisimura #define RGE_THPDS	0x28		/* high pro. Tx des. base paddr */
     87  1.1  nisimura #define RGE_CR		0x37		/* command */
     88  1.1  nisimura #define	 CR_RESET	(1U << 4)	/* reset S1C */
     89  1.1  nisimura #define	 CR_RXEN	(1U << 3)	/* Rx enable */
     90  1.1  nisimura #define	 CR_TXEN	(1U << 2)	/* Tx enable */
     91  1.1  nisimura #define RGE_TPPOLL	0x38		/* activate desc polling */
     92  1.1  nisimura #define RGE_IMR		0x3c		/* interrupt mask */
     93  1.1  nisimura #define RGE_ISR		0x3e		/* interrupt status */
     94  1.1  nisimura #define RGE_TCR		0x40		/* Tx control */
     95  1.1  nisimura #define	 TCR_MAXDMA	0x0700		/* 10:8 Tx DMA burst size */
     96  1.1  nisimura #define RGE_RCR		0x44		/* Rx control */
     97  1.1  nisimura #define	 RCR_RXTFH	0xe000		/* 15:13 Rx FIFO threshold */
     98  1.1  nisimura #define	 RCR_MAXDMA	0x0700		/* 10:8 Rx DMA burst size */
     99  1.1  nisimura #define	 RCR_AE		(1U << 5)	/* accept error frame */
    100  1.1  nisimura #define	 RCR_RE		(1U << 4)	/* accept runt frame */
    101  1.1  nisimura #define	 RCR_AB		(1U << 3)	/* accept broadcast frame */
    102  1.1  nisimura #define	 RCR_AM		(1U << 2)	/* accept multicast frame */
    103  1.1  nisimura #define	 RCR_APM	(1U << 1)	/* accept unicast frame */
    104  1.1  nisimura #define	 RCR_AAP	(1U << 0)	/* promiscuous */
    105  1.1  nisimura #define RGE_PHYAR	0x60		/* PHY access */
    106  1.1  nisimura #define RGE_PHYSR	0x6c		/* PHY status */
    107  1.1  nisimura #define RGE_RMS		0xda		/* Rx maximum frame size */
    108  1.1  nisimura #define RGE_RDSAR	0xe4		/* Rx descriptor base paddr */
    109  1.1  nisimura #define RGE_ETTHR	0xec		/* Tx threshold */
    110  1.1  nisimura 
    111  1.1  nisimura #define FRAMESIZE	1536
    112  1.1  nisimura 
    113  1.1  nisimura struct local {
    114  1.1  nisimura 	struct desc txd[2]; /* 256B align */
    115  1.1  nisimura 	  uint8_t _hole0[256 - 2 * sizeof(struct desc)];
    116  1.1  nisimura 	struct desc rxd[2]; /* 256B align */
    117  1.1  nisimura 	  uint8_t _hole1[256 - 2 * sizeof(struct desc)];
    118  1.1  nisimura 	uint8_t rxstore[2][FRAMESIZE];
    119  1.1  nisimura 	unsigned csr, tx, rx;
    120  1.1  nisimura 	unsigned phy, bmsr, anlpar;
    121  1.1  nisimura 	unsigned tcr, rcr;
    122  1.1  nisimura };
    123  1.1  nisimura 
    124  1.1  nisimura static int mii_read(struct local *, int, int);
    125  1.1  nisimura static void mii_write(struct local *, int, int, int);
    126  1.1  nisimura static void mii_initphy(struct local *);
    127  1.1  nisimura static void mii_dealan(struct local *, unsigned);
    128  1.1  nisimura 
    129  1.1  nisimura int
    130  1.1  nisimura rge_match(unsigned tag, void *data)
    131  1.1  nisimura {
    132  1.1  nisimura 	unsigned v;
    133  1.1  nisimura 
    134  1.1  nisimura 	v = pcicfgread(tag, PCI_ID_REG);
    135  1.1  nisimura 	switch (v) {
    136  1.1  nisimura 	case PCI_DEVICE(0x10ec, 0x8169):
    137  1.1  nisimura 		return 1;
    138  1.1  nisimura 	}
    139  1.1  nisimura 	return 0;
    140  1.1  nisimura }
    141  1.1  nisimura 
    142  1.1  nisimura void *
    143  1.1  nisimura rge_init(unsigned tag, void *data)
    144  1.1  nisimura {
    145  1.1  nisimura 	unsigned val;
    146  1.1  nisimura 	struct local *l;
    147  1.1  nisimura 	struct desc *txd, *rxd;
    148  1.1  nisimura 	uint8_t *en = data;
    149  1.1  nisimura 
    150  1.1  nisimura 	l = ALLOC(struct local, 256);	/* desc alignment */
    151  1.1  nisimura 	memset(l, 0, sizeof(struct local));
    152  1.1  nisimura 	l->csr = DEVTOV(pcicfgread(tag, 0x14)); /* use mem space */
    153  1.1  nisimura 
    154  1.1  nisimura 	CSR_WRITE_1(l, RGE_CR, CR_RESET);
    155  1.1  nisimura 	do {
    156  1.1  nisimura 		val = CSR_READ_1(l, RGE_CR);
    157  1.1  nisimura 	} while (val & CR_RESET);
    158  1.1  nisimura 
    159  1.1  nisimura 	mii_initphy(l);
    160  1.1  nisimura 
    161  1.1  nisimura 	en = data;
    162  1.1  nisimura 	en[0] = CSR_READ_1(l, RGE_IDR0);
    163  1.1  nisimura 	en[1] = CSR_READ_1(l, RGE_IDR1);
    164  1.1  nisimura 	en[2] = CSR_READ_1(l, RGE_IDR2);
    165  1.1  nisimura 	en[3] = CSR_READ_1(l, RGE_IDR3);
    166  1.1  nisimura 	en[4] = CSR_READ_1(l, RGE_IDR4);
    167  1.1  nisimura 	en[5] = CSR_READ_1(l, RGE_IDR5);
    168  1.1  nisimura 
    169  1.1  nisimura 	printf("MAC address %02x:%02x:%02x:%02x:%02x:%02x\n",
    170  1.1  nisimura 	    en[0], en[1], en[2], en[3], en[4], en[5]);
    171  1.1  nisimura 	printf("PHY %d (%04x.%04x)\n", l->phy,
    172  1.1  nisimura 	    mii_read(l, l->phy, 2), mii_read(l, l->phy, 3));
    173  1.1  nisimura 
    174  1.1  nisimura 	mii_dealan(l, 5);
    175  1.1  nisimura 
    176  1.1  nisimura 	/* speed and duplexity can be seen in PHYSR */
    177  1.1  nisimura 	val = CSR_READ_1(l, RGE_PHYSR);
    178  1.1  nisimura 	if (val & (1U << 4))
    179  1.1  nisimura 		printf("1000Mbps");
    180  1.1  nisimura 	if (val & (1U << 3))
    181  1.1  nisimura 		printf("100Mbps");
    182  1.1  nisimura 	if (val & (1U << 2))
    183  1.1  nisimura 		printf("10Mbps");
    184  1.1  nisimura 	if (val & (1U << 0))
    185  1.1  nisimura 		printf("-FDX");
    186  1.1  nisimura 	printf("\n");
    187  1.1  nisimura 
    188  1.1  nisimura 	txd = &l->txd[0];
    189  1.1  nisimura 	txd[1].xd0 = htole32(T0_EOR);
    190  1.1  nisimura 	rxd = &l->rxd[0];
    191  1.1  nisimura 	rxd[0].xd0 = htole32(R0_OWN | FRAMESIZE);
    192  1.1  nisimura 	rxd[0].xd2 = htole32(VTOPHYS(l->rxstore[0]));
    193  1.1  nisimura 	rxd[1].xd0 = htole32(R0_OWN | R0_EOR | FRAMESIZE);
    194  1.1  nisimura 	rxd[1].xd2 = htole32(VTOPHYS(l->rxstore[1]));
    195  1.1  nisimura 	wbinv(l, sizeof(struct local));
    196  1.1  nisimura 	l->tx = l->rx = 0;
    197  1.1  nisimura 
    198  1.1  nisimura 	l->tcr = (03 << 24) | (07 << 8);
    199  1.1  nisimura 	l->rcr = (07 << 13) | (07 << 8) | RCR_APM;
    200  1.1  nisimura 	CSR_WRITE_1(l, RGE_CR, CR_TXEN | CR_RXEN);
    201  1.1  nisimura 	CSR_WRITE_1(l, RGE_ETTHR, 0x3f);
    202  1.1  nisimura 	CSR_WRITE_2(l, RGE_RMS, FRAMELEN);
    203  1.1  nisimura 	CSR_WRITE_4(l, RGE_TCR, l->tcr);
    204  1.1  nisimura 	CSR_WRITE_4(l, RGE_RCR, l->rcr);
    205  1.1  nisimura 	CSR_WRITE_4(l, RGE_TNPDS, VTOPHYS(txd));
    206  1.1  nisimura 	CSR_WRITE_4(l, RGE_RDSAR, VTOPHYS(rxd));
    207  1.1  nisimura 	CSR_WRITE_4(l, RGE_TNPDS + 4, 0);
    208  1.1  nisimura 	CSR_WRITE_4(l, RGE_RDSAR + 4, 0);
    209  1.1  nisimura 	CSR_WRITE_2(l, RGE_ISR, ~0);
    210  1.1  nisimura 	CSR_WRITE_2(l, RGE_IMR, 0);
    211  1.1  nisimura 
    212  1.1  nisimura 	return l;
    213  1.1  nisimura }
    214  1.1  nisimura 
    215  1.1  nisimura int
    216  1.1  nisimura rge_send(void *dev, char *buf, unsigned len)
    217  1.1  nisimura {
    218  1.1  nisimura 	struct local *l = dev;
    219  1.1  nisimura 	volatile struct desc *txd;
    220  1.1  nisimura 	unsigned loop;
    221  1.1  nisimura 
    222  1.1  nisimura 	wbinv(buf, len);
    223  1.1  nisimura 	txd = &l->txd[l->tx];
    224  1.1  nisimura 	txd->xd2 = htole32(VTOPHYS(buf));
    225  1.1  nisimura 	txd->xd0 &= htole32(T0_EOR);
    226  1.1  nisimura 	txd->xd0 |= htole32(T0_OWN | T0_FS | T0_LS | (len & T0_FRMASK));
    227  1.1  nisimura 	wbinv(txd, sizeof(struct desc));
    228  1.1  nisimura 	CSR_WRITE_1(l, RGE_TPPOLL, 0x40);
    229  1.1  nisimura 	loop = 100;
    230  1.1  nisimura 	do {
    231  1.1  nisimura 		if ((le32toh(txd->xd0) & T0_OWN) == 0)
    232  1.1  nisimura 			goto done;
    233  1.1  nisimura 		DELAY(10);
    234  1.1  nisimura 		inv(txd, sizeof(struct desc));
    235  1.1  nisimura 	} while (--loop > 0);
    236  1.1  nisimura 	printf("xmit failed\n");
    237  1.1  nisimura 	return -1;
    238  1.1  nisimura   done:
    239  1.1  nisimura 	l->tx ^= 1;
    240  1.1  nisimura 	return len;
    241  1.1  nisimura }
    242  1.1  nisimura 
    243  1.1  nisimura int
    244  1.1  nisimura rge_recv(void *dev, char *buf, unsigned maxlen, unsigned timo)
    245  1.1  nisimura {
    246  1.1  nisimura 	struct local *l = dev;
    247  1.1  nisimura 	volatile struct desc *rxd;
    248  1.1  nisimura 	unsigned bound, rxstat, len;
    249  1.1  nisimura 	uint8_t *ptr;
    250  1.1  nisimura 
    251  1.1  nisimura 	bound = 1000 * timo;
    252  1.1  nisimura #if 0
    253  1.1  nisimura printf("recving with %u sec. timeout\n", timo);
    254  1.1  nisimura #endif
    255  1.1  nisimura   again:
    256  1.1  nisimura 	rxd = &l->rxd[l->rx];
    257  1.1  nisimura 	do {
    258  1.1  nisimura 		inv(rxd, sizeof(struct desc));
    259  1.1  nisimura 		rxstat = le32toh(rxd->xd0);
    260  1.1  nisimura 		if ((rxstat & R0_OWN) == 0)
    261  1.1  nisimura 			goto gotone;
    262  1.1  nisimura 		DELAY(1000);	/* 1 milli second */
    263  1.1  nisimura 	} while (--bound > 0);
    264  1.1  nisimura 	errno = 0;
    265  1.1  nisimura 	return -1;
    266  1.1  nisimura   gotone:
    267  1.1  nisimura 	if (rxstat & R0_RES) {
    268  1.1  nisimura 		rxd->xd0 &= htole32(R0_EOR);
    269  1.1  nisimura 		rxd->xd0 |= htole32(R0_OWN | FRAMESIZE);
    270  1.1  nisimura 		wbinv(rxd, sizeof(struct desc));
    271  1.1  nisimura 		l->rx ^= 1;
    272  1.1  nisimura 		goto again;
    273  1.1  nisimura 	}
    274  1.1  nisimura 	len = rxstat & R0_FRMASK;
    275  1.1  nisimura 	if (len > maxlen)
    276  1.1  nisimura 		len = maxlen;
    277  1.1  nisimura 	ptr = l->rxstore[l->rx];
    278  1.1  nisimura 	inv(ptr, len);
    279  1.1  nisimura 	memcpy(buf, ptr, len);
    280  1.1  nisimura 	rxd->xd0 &= htole32(R0_EOR);
    281  1.1  nisimura 	rxd->xd0 |= htole32(R0_OWN | FRAMESIZE);
    282  1.1  nisimura 	wbinv(rxd, sizeof(struct desc));
    283  1.1  nisimura 	l->rx ^= 1;
    284  1.1  nisimura 	return len;
    285  1.1  nisimura }
    286  1.1  nisimura 
    287  1.1  nisimura static int
    288  1.1  nisimura mii_read(struct local *l, int phy, int reg)
    289  1.1  nisimura {
    290  1.1  nisimura 	unsigned v, loop;
    291  1.1  nisimura 
    292  1.1  nisimura 	v = reg << 16;
    293  1.1  nisimura 	CSR_WRITE_4(l, RGE_PHYAR, v);
    294  1.1  nisimura 	loop = 100;
    295  1.1  nisimura 	do {
    296  1.1  nisimura 		v = CSR_READ_4(l, RGE_PHYAR);
    297  1.1  nisimura 	} while ((v & (1U << 31)) == 0); /* wait for 0 -> 1 */
    298  1.1  nisimura 	return v;
    299  1.1  nisimura }
    300  1.1  nisimura 
    301  1.1  nisimura static void
    302  1.1  nisimura mii_write(struct local *l, int phy, int reg, int data)
    303  1.1  nisimura {
    304  1.1  nisimura 	unsigned v;
    305  1.1  nisimura 
    306  1.1  nisimura 	v = (reg << 16) | (data & 0xffff) | (1U << 31);
    307  1.1  nisimura 	CSR_WRITE_4(l, RGE_PHYAR, v);
    308  1.1  nisimura 	do {
    309  1.1  nisimura 		v = CSR_READ_4(l, RGE_PHYAR);
    310  1.1  nisimura 	} while (v & (1U << 31)); /* wait for 1 -> 0 */
    311  1.1  nisimura }
    312  1.1  nisimura 
    313  1.1  nisimura #define MII_BMCR	0x00	/* Basic mode control register (rw) */
    314  1.1  nisimura #define  BMCR_RESET	0x8000	/* reset */
    315  1.1  nisimura #define  BMCR_AUTOEN	0x1000	/* autonegotiation enable */
    316  1.1  nisimura #define  BMCR_ISO	0x0400	/* isolate */
    317  1.1  nisimura #define  BMCR_STARTNEG	0x0200	/* restart autonegotiation */
    318  1.1  nisimura #define MII_BMSR	0x01	/* Basic mode status register (ro) */
    319  1.1  nisimura #define  BMSR_ACOMP	0x0020	/* Autonegotiation complete */
    320  1.1  nisimura #define  BMSR_LINK	0x0004	/* Link status */
    321  1.1  nisimura #define MII_ANAR	0x04	/* Autonegotiation advertisement (rw) */
    322  1.1  nisimura #define  ANAR_FC	0x0400	/* local device supports PAUSE */
    323  1.1  nisimura #define  ANAR_TX_FD	0x0100	/* local device supports 100bTx FD */
    324  1.1  nisimura #define  ANAR_TX	0x0080	/* local device supports 100bTx */
    325  1.1  nisimura #define  ANAR_10_FD	0x0040	/* local device supports 10bT FD */
    326  1.1  nisimura #define  ANAR_10	0x0020	/* local device supports 10bT */
    327  1.1  nisimura #define  ANAR_CSMA	0x0001	/* protocol selector CSMA/CD */
    328  1.1  nisimura #define MII_ANLPAR	0x05	/* Autonegotiation lnk partner abilities (rw) */
    329  1.1  nisimura #define MII_GTCR	0x09	/* 1000baseT control */
    330  1.1  nisimura #define  GANA_1000TFDX	0x0200	/* advertise 1000baseT FDX */
    331  1.1  nisimura #define  GANA_1000THDX	0x0100	/* advertise 1000baseT HDX */
    332  1.1  nisimura #define MII_GTSR	0x0a	/* 1000baseT status */
    333  1.1  nisimura #define  GLPA_1000TFDX	0x0800	/* link partner 1000baseT FDX capable */
    334  1.1  nisimura #define  GLPA_1000THDX	0x0400	/* link partner 1000baseT HDX capable */
    335  1.1  nisimura #define  GLPA_ASM_DIR	0x0200	/* link partner asym. pause dir. capable */
    336  1.1  nisimura 
    337  1.1  nisimura static void
    338  1.1  nisimura mii_initphy(struct local *l)
    339  1.1  nisimura {
    340  1.1  nisimura 	int phy, ctl, sts, bound;
    341  1.1  nisimura 
    342  1.1  nisimura 	for (phy = 0; phy < 32; phy++) {
    343  1.1  nisimura 		ctl = mii_read(l, phy, MII_BMCR);
    344  1.1  nisimura 		sts = mii_read(l, phy, MII_BMSR);
    345  1.1  nisimura 		if (ctl != 0xffff && sts != 0xffff)
    346  1.1  nisimura 			goto found;
    347  1.1  nisimura 	}
    348  1.1  nisimura 	printf("MII: no PHY found\n");
    349  1.1  nisimura 	return;
    350  1.1  nisimura   found:
    351  1.1  nisimura 	ctl = mii_read(l, phy, MII_BMCR);
    352  1.1  nisimura 	mii_write(l, phy, MII_BMCR, ctl | BMCR_RESET);
    353  1.1  nisimura 	bound = 100;
    354  1.1  nisimura 	do {
    355  1.1  nisimura 		DELAY(10);
    356  1.1  nisimura 		ctl = mii_read(l, phy, MII_BMCR);
    357  1.1  nisimura 		if (ctl == 0xffff) {
    358  1.1  nisimura 			printf("MII: PHY %d has died after reset\n", phy);
    359  1.1  nisimura 			return;
    360  1.1  nisimura 		}
    361  1.1  nisimura 	} while (bound-- > 0 && (ctl & BMCR_RESET));
    362  1.1  nisimura 	if (bound == 0) {
    363  1.1  nisimura 		printf("PHY %d reset failed\n", phy);
    364  1.1  nisimura 	}
    365  1.1  nisimura 	ctl &= ~BMCR_ISO;
    366  1.1  nisimura 	mii_write(l, phy, MII_BMCR, ctl);
    367  1.1  nisimura 	sts = mii_read(l, phy, MII_BMSR) |
    368  1.1  nisimura 	    mii_read(l, phy, MII_BMSR); /* read twice */
    369  1.1  nisimura 	l->phy = phy;
    370  1.1  nisimura 	l->bmsr = sts;
    371  1.1  nisimura }
    372  1.1  nisimura 
    373  1.1  nisimura void
    374  1.1  nisimura mii_dealan(struct local *l, unsigned timo)
    375  1.1  nisimura {
    376  1.1  nisimura 	unsigned anar, gtcr, bound;
    377  1.1  nisimura 
    378  1.1  nisimura 	anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10 | ANAR_CSMA;
    379  1.1  nisimura 	anar |= ANAR_FC;
    380  1.1  nisimura 	gtcr = GANA_1000TFDX | GANA_1000THDX;
    381  1.1  nisimura 	mii_write(l, l->phy, MII_ANAR, anar);
    382  1.1  nisimura 	mii_write(l, l->phy, MII_GTCR, gtcr);
    383  1.1  nisimura 	mii_write(l, l->phy, MII_BMCR, BMCR_AUTOEN | BMCR_STARTNEG);
    384  1.1  nisimura 	l->anlpar = 0;
    385  1.1  nisimura 	bound = getsecs() + timo;
    386  1.1  nisimura 	do {
    387  1.1  nisimura 		l->bmsr = mii_read(l, l->phy, MII_BMSR) |
    388  1.1  nisimura 		   mii_read(l, l->phy, MII_BMSR); /* read twice */
    389  1.1  nisimura 		if ((l->bmsr & BMSR_LINK) && (l->bmsr & BMSR_ACOMP)) {
    390  1.1  nisimura 			l->anlpar = mii_read(l, l->phy, MII_ANLPAR);
    391  1.1  nisimura 			break;
    392  1.1  nisimura 		}
    393  1.1  nisimura 		DELAY(10 * 1000);
    394  1.1  nisimura 	} while (getsecs() < bound);
    395  1.1  nisimura 	return;
    396  1.1  nisimura }
    397