Home | History | Annotate | Line # | Download | only in altboot
      1  1.2       phx /* $NetBSD: sip.c,v 1.2 2011/01/27 17:38:04 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.1  nisimura #define CSR_READ(l, r)		in32rb((l)->csr+(r))
     48  1.1  nisimura #define CSR_WRITE(l, r, v) 	out32rb((l)->csr+(r), (v))
     49  1.1  nisimura #define VTOPHYS(va) 		(uint32_t)(va)
     50  1.1  nisimura #define DEVTOV(pa) 		(uint32_t)(pa)
     51  1.1  nisimura #define wbinv(adr, siz)		_wbinv(VTOPHYS(adr), (uint32_t)(siz))
     52  1.1  nisimura #define inv(adr, siz)		_inv(VTOPHYS(adr), (uint32_t)(siz))
     53  1.1  nisimura #define DELAY(n)		delay(n)
     54  1.1  nisimura #define ALLOC(T,A)		(T *)allocaligned(sizeof(T),(A))
     55  1.1  nisimura 
     56  1.1  nisimura struct desc {
     57  1.1  nisimura 	uint32_t xd0, xd1, xd2;
     58  1.1  nisimura 	uint32_t hole;
     59  1.1  nisimura };
     60  1.1  nisimura #define XD1_OWN		(1U << 31)
     61  1.1  nisimura #define XD1_OK		(1U << 27)
     62  1.1  nisimura 
     63  1.1  nisimura #define SIP_CR		0x00
     64  1.1  nisimura #define  CR_RST		(1U << 8)	/* software reset */
     65  1.1  nisimura #define  CR_RXR		(1U << 5)	/* Rx abort and reset */
     66  1.1  nisimura #define  CR_TXR		(1U << 4)	/* Tx abort and reset */
     67  1.1  nisimura #define  CR_RXD		(1U << 3)	/* graceful Rx stop */
     68  1.1  nisimura #define  CR_RXE		(1U << 2)	/* run and activate Rx */
     69  1.1  nisimura #define  CR_TXD		(1U << 1)	/* graceful Tx stop */
     70  1.1  nisimura #define  CR_TXE		(1U << 0)	/* run and activate Tx */
     71  1.1  nisimura #define SIP_CFG		0x04
     72  1.1  nisimura #define SIP_MEAR	0x08
     73  1.1  nisimura #define  MEAR_EESEL	(1U << 3)	/* SEEP chipselect */
     74  1.1  nisimura #define  MEAR_EECLK	(1U << 2)	/* clock */
     75  1.1  nisimura #define  MEAR_EEDO	(1U << 1)	/* bit retrieve */
     76  1.1  nisimura #define  MEAR_EEDI	(1U << 0)	/* bit feed */
     77  1.1  nisimura #define SIP_IMR		0x14
     78  1.1  nisimura #define SIP_IER		0x18
     79  1.1  nisimura #define SIP_TXDP	0x20
     80  1.1  nisimura #define SIP_TXCFG	0x24
     81  1.1  nisimura #define  TXCFG_CSI	(1U << 31)
     82  1.1  nisimura #define  TXCFG_HBI	(1U << 30)
     83  1.1  nisimura #define  TXCFG_ATP	(1U << 28)
     84  1.1  nisimura #define  TXCFG_DMA256	0x300000
     85  1.1  nisimura #define SIP_RXDP	0x30
     86  1.1  nisimura #define SIP_RXCFG	0x34
     87  1.1  nisimura #define  RXCFG_ATX	(1U << 28)
     88  1.1  nisimura #define  RXCFG_DMA256	0x300000
     89  1.1  nisimura #define SIP_RFCR	0x48
     90  1.1  nisimura #define  RFCR_RFEN	(1U << 31)	/* activate Rx filter */
     91  1.1  nisimura #define  RFCR_APM	(1U << 27)	/* accept perfect match */
     92  1.1  nisimura #define SIP_RFDR	0x4c
     93  1.1  nisimura #define SIP_MIBC	0x5c
     94  1.1  nisimura #define SIP_BMCR	0x80
     95  1.1  nisimura #define SIP_PHYSTS	0xc0
     96  1.1  nisimura #define SIP_PHYCR	0xe4
     97  1.1  nisimura 
     98  1.1  nisimura #define FRAMESIZE	1536
     99  1.1  nisimura 
    100  1.1  nisimura struct local {
    101  1.1  nisimura 	struct desc txd[2];
    102  1.1  nisimura 	struct desc rxd[2];
    103  1.1  nisimura 	uint8_t store[2][FRAMESIZE];
    104  1.1  nisimura 	unsigned csr, tx, rx;
    105  1.1  nisimura 	unsigned phy, bmsr, anlpar;
    106  1.1  nisimura 	unsigned cr;
    107  1.1  nisimura };
    108  1.1  nisimura 
    109  1.1  nisimura static int read_eeprom(struct local *, int);
    110  1.1  nisimura static unsigned mii_read(struct local *, int, int);
    111  1.1  nisimura static void mii_write(struct local *, int, int, int);
    112  1.1  nisimura static void mii_initphy(struct local *);
    113  1.1  nisimura static void mii_dealan(struct local *, unsigned);
    114  1.1  nisimura 
    115  1.1  nisimura /* Table and macro to bit-reverse an octet. */
    116  1.1  nisimura static const uint8_t bbr4[] = {0,8,4,12,2,10,6,14,1,9,5,13,3,11,7,15};
    117  1.1  nisimura #define bbr(v)	((bbr4[(v)&0xf] << 4) | bbr4[((v)>>4) & 0xf])
    118  1.1  nisimura 
    119  1.1  nisimura int
    120  1.1  nisimura sip_match(unsigned tag, void *data)
    121  1.1  nisimura {
    122  1.1  nisimura 	unsigned v;
    123  1.1  nisimura 
    124  1.1  nisimura 	v = pcicfgread(tag, PCI_ID_REG);
    125  1.1  nisimura 	switch (v) {
    126  1.1  nisimura 	case PCI_DEVICE(0x100b, 0x0020):
    127  1.1  nisimura 		return 1;
    128  1.1  nisimura 	}
    129  1.1  nisimura 	return 0;
    130  1.1  nisimura }
    131  1.1  nisimura 
    132  1.1  nisimura void *
    133  1.1  nisimura sip_init(unsigned tag, void *data)
    134  1.1  nisimura {
    135  1.1  nisimura 	unsigned val, i, fdx, txc, rxc;
    136  1.1  nisimura 	struct local *l;
    137  1.1  nisimura 	struct desc *txd, *rxd;
    138  1.1  nisimura 	uint16_t eedata[4], *ee;
    139  1.1  nisimura 	uint8_t *en;
    140  1.1  nisimura 
    141  1.1  nisimura 	val = pcicfgread(tag, PCI_ID_REG);
    142  1.1  nisimura 	if (PCI_DEVICE(0x100b, 0x0020) != val)
    143  1.1  nisimura 		return NULL;
    144  1.1  nisimura 
    145  1.1  nisimura 	l = ALLOC(struct local, 32); /* desc alignment */
    146  1.1  nisimura 	memset(l, 0, sizeof(struct local));
    147  1.1  nisimura 	l->csr = DEVTOV(pcicfgread(tag, 0x14)); /* use mem space */
    148  1.1  nisimura 
    149  1.1  nisimura 	CSR_WRITE(l, SIP_IER, 0);
    150  1.1  nisimura 	CSR_WRITE(l, SIP_IMR, 0);
    151  1.1  nisimura 	CSR_WRITE(l, SIP_RFCR, 0);
    152  1.1  nisimura 	CSR_WRITE(l, SIP_CR, CR_RST);
    153  1.1  nisimura 	do {
    154  1.1  nisimura 		val = CSR_READ(l, SIP_CR);
    155  1.1  nisimura 	} while (val & CR_RST); /* S1C */
    156  1.1  nisimura 
    157  1.1  nisimura 	mii_initphy(l);
    158  1.1  nisimura 
    159  1.1  nisimura 	ee = eedata; en = data;
    160  1.1  nisimura 	ee[0] = read_eeprom(l, 6);
    161  1.1  nisimura 	ee[1] = read_eeprom(l, 7);
    162  1.1  nisimura 	ee[2] = read_eeprom(l, 8);
    163  1.1  nisimura 	ee[3] = read_eeprom(l, 9);
    164  1.1  nisimura 	en[0] = ((*ee & 0x1) << 7);
    165  1.1  nisimura 	ee++;
    166  1.1  nisimura 	en[0] |= ((*ee & 0xFE00) >> 9);
    167  1.1  nisimura 	en[1] = ((*ee & 0x1FE) >> 1);
    168  1.1  nisimura 	en[2] = ((*ee & 0x1) << 7);
    169  1.1  nisimura 	ee++;
    170  1.1  nisimura 	en[2] |= ((*ee & 0xFE00) >> 9);
    171  1.1  nisimura 	en[3] = ((*ee & 0x1FE) >> 1);
    172  1.1  nisimura 	en[4] = ((*ee & 0x1) << 7);
    173  1.1  nisimura 	ee++;
    174  1.1  nisimura 	en[4] |= ((*ee & 0xFE00) >> 9);
    175  1.1  nisimura 	en[5] = ((*ee & 0x1FE) >> 1);
    176  1.1  nisimura 	for (i = 0; i < 6; i++)
    177  1.1  nisimura 		en[i] = bbr(en[i]);
    178  1.1  nisimura 
    179  1.1  nisimura 	printf("MAC address %02x:%02x:%02x:%02x:%02x:%02x, ",
    180  1.1  nisimura 	    en[0], en[1], en[2], en[3], en[4], en[5]);
    181  1.2       phx 	DPRINTF(("PHY %d (%04x.%04x)\n", l->phy,
    182  1.2       phx 	    mii_read(l, l->phy, 2), mii_read(l, l->phy, 3)));
    183  1.1  nisimura 
    184  1.1  nisimura 	mii_dealan(l, 5);
    185  1.1  nisimura 
    186  1.1  nisimura 	/* speed and duplexity are found in CFG */
    187  1.1  nisimura 	val = CSR_READ(l, SIP_CFG);
    188  1.1  nisimura 	fdx = !!(val & (1U << 29));
    189  1.1  nisimura 	printf("%s", (val & (1U << 30)) ? "100Mbps" : "10Mbps");
    190  1.1  nisimura 	if (fdx)
    191  1.1  nisimura 		printf("-FDX");
    192  1.1  nisimura 	printf("\n");
    193  1.1  nisimura 
    194  1.1  nisimura 	txd = &l->txd[0];
    195  1.1  nisimura 	txd->xd0 = htole32(VTOPHYS(txd));
    196  1.1  nisimura 	rxd = l->rxd;
    197  1.1  nisimura 	rxd[0].xd0 = htole32(VTOPHYS(&rxd[1]));
    198  1.1  nisimura 	rxd[0].xd1 = htole32(XD1_OWN | FRAMESIZE);
    199  1.1  nisimura 	rxd[0].xd2 = htole32(VTOPHYS(l->store[0]));
    200  1.1  nisimura 	rxd[1].xd0 = htole32(VTOPHYS(&rxd[0]));
    201  1.1  nisimura 	rxd[1].xd1 = htole32(XD1_OWN | FRAMESIZE);
    202  1.1  nisimura 	rxd[1].xd2 = htole32(VTOPHYS(l->store[1]));
    203  1.1  nisimura 	wbinv(l, sizeof(struct local));
    204  1.1  nisimura 	l->tx = l->rx = 0;
    205  1.1  nisimura 
    206  1.1  nisimura 	CSR_WRITE(l, SIP_RFCR, 0);
    207  1.1  nisimura 	CSR_WRITE(l, SIP_RFDR, (en[1] << 8) | en[0]);
    208  1.1  nisimura 	CSR_WRITE(l, SIP_RFCR, 2);
    209  1.1  nisimura 	CSR_WRITE(l, SIP_RFDR, (en[3] << 8) | en[2]);
    210  1.1  nisimura 	CSR_WRITE(l, SIP_RFCR, 4);
    211  1.1  nisimura 	CSR_WRITE(l, SIP_RFDR, (en[5] << 8) | en[4]);
    212  1.1  nisimura 	CSR_WRITE(l, SIP_RFCR, RFCR_RFEN | RFCR_APM);
    213  1.1  nisimura 
    214  1.1  nisimura 	txc = TXCFG_ATP | TXCFG_DMA256 | 0x1002;
    215  1.1  nisimura 	rxc = RXCFG_DMA256 | 0x20;
    216  1.1  nisimura 	if (fdx) {
    217  1.1  nisimura 		txc |= TXCFG_CSI | TXCFG_HBI;
    218  1.1  nisimura 		rxc |= RXCFG_ATX;
    219  1.1  nisimura 	}
    220  1.1  nisimura 	l->cr = CR_RXE;
    221  1.1  nisimura 	CSR_WRITE(l, SIP_TXDP, VTOPHYS(txd));
    222  1.1  nisimura 	CSR_WRITE(l, SIP_RXDP, VTOPHYS(rxd));
    223  1.1  nisimura 	CSR_WRITE(l, SIP_TXCFG, txc);
    224  1.1  nisimura 	CSR_WRITE(l, SIP_RXCFG, rxc);
    225  1.1  nisimura 	CSR_WRITE(l, SIP_CR, l->cr);
    226  1.1  nisimura 
    227  1.1  nisimura 	return l;
    228  1.1  nisimura }
    229  1.1  nisimura 
    230  1.1  nisimura int
    231  1.1  nisimura sip_send(void *dev, char *buf, unsigned len)
    232  1.1  nisimura {
    233  1.1  nisimura 	struct local *l = dev;
    234  1.1  nisimura 	volatile struct desc *txd;
    235  1.1  nisimura 	unsigned loop;
    236  1.1  nisimura 
    237  1.1  nisimura 	wbinv(buf, len);
    238  1.1  nisimura 	txd = &l->txd[l->tx];
    239  1.1  nisimura 	txd->xd2 = htole32(VTOPHYS(buf));
    240  1.1  nisimura 	txd->xd1 = htole32(XD1_OWN | (len & 0xfff));
    241  1.1  nisimura 	wbinv(txd, sizeof(struct desc));
    242  1.1  nisimura 	CSR_WRITE(l, SIP_CR, l->cr | CR_TXE);
    243  1.1  nisimura 	loop = 100;
    244  1.1  nisimura 	do {
    245  1.1  nisimura 		if ((le32toh(txd->xd1) & XD1_OWN) == 0)
    246  1.1  nisimura 			goto done;
    247  1.1  nisimura 		DELAY(10);
    248  1.1  nisimura 		inv(txd, sizeof(struct desc));
    249  1.1  nisimura 	} while (--loop != 0);
    250  1.1  nisimura 	printf("xmit failed\n");
    251  1.1  nisimura 	return -1;
    252  1.1  nisimura   done:
    253  1.1  nisimura 	l->tx ^= 1;
    254  1.1  nisimura 	return len;
    255  1.1  nisimura }
    256  1.1  nisimura 
    257  1.1  nisimura int
    258  1.1  nisimura sip_recv(void *dev, char *buf, unsigned maxlen, unsigned timo)
    259  1.1  nisimura {
    260  1.1  nisimura 	struct local *l = dev;
    261  1.1  nisimura 	volatile struct desc *rxd;
    262  1.1  nisimura 	unsigned bound, rxstat, len;
    263  1.1  nisimura 	uint8_t *ptr;
    264  1.1  nisimura 
    265  1.1  nisimura 	bound = 1000 * timo;
    266  1.1  nisimura printf("recving with %u sec. timeout\n", timo);
    267  1.1  nisimura   again:
    268  1.1  nisimura 	rxd = &l->rxd[l->rx];
    269  1.1  nisimura 	do {
    270  1.1  nisimura 		inv(rxd, sizeof(struct desc));
    271  1.1  nisimura 		rxstat = le32toh(rxd->xd1);
    272  1.1  nisimura 		if ((rxstat & XD1_OWN) == 0)
    273  1.1  nisimura 			goto gotone;
    274  1.1  nisimura 		DELAY(1000);	/* 1 milli second */
    275  1.1  nisimura 	} while (--bound > 0);
    276  1.1  nisimura 	errno = 0;
    277  1.1  nisimura 	return -1;
    278  1.1  nisimura   gotone:
    279  1.1  nisimura 	if ((rxstat & XD1_OK) == 0) {
    280  1.1  nisimura 		rxd->xd1 = htole32(XD1_OWN | FRAMESIZE);
    281  1.1  nisimura 		wbinv(rxd, sizeof(struct desc));
    282  1.1  nisimura 		l->rx ^= 1;
    283  1.1  nisimura 		goto again;
    284  1.1  nisimura 	}
    285  1.1  nisimura 	/* good frame */
    286  1.1  nisimura 	len = (rxstat & 0xfff) - 4 /* HASFCS */;
    287  1.1  nisimura 	if (len > maxlen)
    288  1.1  nisimura 		len = maxlen;
    289  1.1  nisimura 	ptr = l->store[l->rx];
    290  1.1  nisimura 	inv(ptr, len);
    291  1.1  nisimura 	memcpy(buf, ptr, len);
    292  1.1  nisimura 	rxd->xd1 = htole32(XD1_OWN | FRAMESIZE);
    293  1.1  nisimura 	wbinv(rxd, sizeof(struct desc));
    294  1.1  nisimura 	l->rx ^= 1;
    295  1.1  nisimura 	CSR_WRITE(l, SIP_CR, l->cr);
    296  1.1  nisimura 	return len;
    297  1.1  nisimura }
    298  1.1  nisimura 
    299  1.1  nisimura static int
    300  1.1  nisimura read_eeprom(struct local *l, int loc)
    301  1.1  nisimura {
    302  1.1  nisimura #define R110 06 /* SEEPROM READ op. */
    303  1.1  nisimura 	unsigned data, v, i;
    304  1.1  nisimura 
    305  1.1  nisimura 	/* hold chip select */
    306  1.1  nisimura 	v = MEAR_EESEL;
    307  1.1  nisimura 	CSR_WRITE(l, SIP_MEAR, v);
    308  1.1  nisimura 
    309  1.1  nisimura 	data = (R110 << 6) | (loc & 0x3f); /* 6 bit addressing */
    310  1.1  nisimura 	/* instruct R110 op. at loc in MSB first order */
    311  1.1  nisimura 	for (i = (1 << 8); i != 0; i >>= 1) {
    312  1.1  nisimura 		if (data & i)
    313  1.1  nisimura 			v |= MEAR_EEDI;
    314  1.1  nisimura 		else
    315  1.1  nisimura 			v &= ~MEAR_EEDI;
    316  1.1  nisimura 		CSR_WRITE(l, SIP_MEAR, v);
    317  1.1  nisimura 		CSR_WRITE(l, SIP_MEAR, v | MEAR_EECLK);
    318  1.1  nisimura 		DELAY(4);
    319  1.1  nisimura 		CSR_WRITE(l, SIP_MEAR, v);
    320  1.1  nisimura 		DELAY(4);
    321  1.1  nisimura 	}
    322  1.1  nisimura 	v = MEAR_EESEL;
    323  1.1  nisimura 	/* read 16bit quantity in MSB first order */
    324  1.1  nisimura 	data = 0;
    325  1.1  nisimura 	for (i = 0; i < 16; i++) {
    326  1.1  nisimura 		CSR_WRITE(l, SIP_MEAR, v | MEAR_EECLK);
    327  1.1  nisimura 		DELAY(4);
    328  1.1  nisimura 		data = (data << 1) | !!(CSR_READ(l, SIP_MEAR) & MEAR_EEDO);
    329  1.1  nisimura 		CSR_WRITE(l, SIP_MEAR, v);
    330  1.1  nisimura 		DELAY(4);
    331  1.1  nisimura 	}
    332  1.1  nisimura 	/* turn off chip select */
    333  1.1  nisimura 	CSR_WRITE(l, SIP_MEAR, 0);
    334  1.1  nisimura 	DELAY(4);
    335  1.1  nisimura 	return data;
    336  1.1  nisimura }
    337  1.1  nisimura 
    338  1.1  nisimura #define MII_BMCR	0x00 	/* Basic mode control register (rw) */
    339  1.1  nisimura #define  BMCR_RESET	0x8000	/* reset */
    340  1.1  nisimura #define  BMCR_AUTOEN	0x1000	/* autonegotiation enable */
    341  1.1  nisimura #define  BMCR_ISO	0x0400	/* isolate */
    342  1.1  nisimura #define  BMCR_STARTNEG	0x0200	/* restart autonegotiation */
    343  1.1  nisimura #define MII_BMSR	0x01	/* Basic mode status register (ro) */
    344  1.1  nisimura #define  BMSR_ACOMP	0x0020	/* Autonegotiation complete */
    345  1.1  nisimura #define  BMSR_LINK	0x0004	/* Link status */
    346  1.1  nisimura #define MII_ANAR	0x04	/* Autonegotiation advertisement (rw) */
    347  1.1  nisimura #define  ANAR_FC	0x0400	/* local device supports PAUSE */
    348  1.1  nisimura #define  ANAR_TX_FD	0x0100	/* local device supports 100bTx FD */
    349  1.1  nisimura #define  ANAR_TX	0x0080	/* local device supports 100bTx */
    350  1.1  nisimura #define  ANAR_10_FD	0x0040	/* local device supports 10bT FD */
    351  1.1  nisimura #define  ANAR_10	0x0020	/* local device supports 10bT */
    352  1.1  nisimura #define  ANAR_CSMA	0x0001	/* protocol selector CSMA/CD */
    353  1.1  nisimura #define MII_ANLPAR	0x05	/* Autonegotiation lnk partner abilities (rw) */
    354  1.1  nisimura 
    355  1.1  nisimura unsigned
    356  1.1  nisimura mii_read(struct local *l, int phy, int reg)
    357  1.1  nisimura {
    358  1.1  nisimura 	unsigned val;
    359  1.1  nisimura 
    360  1.1  nisimura 	do {
    361  1.1  nisimura 		val = CSR_READ(l, SIP_BMCR + (reg << 2));
    362  1.1  nisimura 	} while (reg == MII_BMSR && val == 0);
    363  1.1  nisimura 	return val & 0xffff;
    364  1.1  nisimura }
    365  1.1  nisimura 
    366  1.1  nisimura void
    367  1.1  nisimura mii_write(struct local *l, int phy, int reg, int val)
    368  1.1  nisimura {
    369  1.1  nisimura 
    370  1.1  nisimura 	CSR_WRITE(l, SIP_BMCR + (reg << 2), val);
    371  1.1  nisimura }
    372  1.1  nisimura 
    373  1.1  nisimura void
    374  1.1  nisimura mii_initphy(struct local *l)
    375  1.1  nisimura {
    376  1.1  nisimura 	int phy, ctl, sts, bound;
    377  1.1  nisimura 
    378  1.1  nisimura 	for (phy = 0; phy < 32; phy++) {
    379  1.1  nisimura 		ctl = mii_read(l, phy, MII_BMCR);
    380  1.1  nisimura 		sts = mii_read(l, phy, MII_BMSR);
    381  1.1  nisimura 		if (ctl != 0xffff && sts != 0xffff)
    382  1.1  nisimura 			goto found;
    383  1.1  nisimura 	}
    384  1.1  nisimura 	printf("MII: no PHY found\n");
    385  1.1  nisimura 	return;
    386  1.1  nisimura   found:
    387  1.1  nisimura 	ctl = mii_read(l, phy, MII_BMCR);
    388  1.1  nisimura 	mii_write(l, phy, MII_BMCR, ctl | BMCR_RESET);
    389  1.1  nisimura 	bound = 100;
    390  1.1  nisimura 	do {
    391  1.1  nisimura 		DELAY(10);
    392  1.1  nisimura 		ctl = mii_read(l, phy, MII_BMCR);
    393  1.1  nisimura 		if (ctl == 0xffff) {
    394  1.1  nisimura 			printf("MII: PHY %d has died after reset\n", phy);
    395  1.1  nisimura 			return;
    396  1.1  nisimura 		}
    397  1.1  nisimura 	} while (bound-- > 0 && (ctl & BMCR_RESET));
    398  1.1  nisimura 	if (bound == 0) {
    399  1.1  nisimura 		printf("PHY %d reset failed\n", phy);
    400  1.1  nisimura 	}
    401  1.1  nisimura 	ctl &= ~BMCR_ISO;
    402  1.1  nisimura 	mii_write(l, phy, MII_BMCR, ctl);
    403  1.1  nisimura 	sts = mii_read(l, phy, MII_BMSR) |
    404  1.1  nisimura 	    mii_read(l, phy, MII_BMSR); /* read twice */
    405  1.1  nisimura 	l->phy = phy; /* should be 0 */
    406  1.1  nisimura 	l->bmsr = sts;
    407  1.1  nisimura }
    408  1.1  nisimura 
    409  1.1  nisimura void
    410  1.1  nisimura mii_dealan(struct local *l, unsigned timo)
    411  1.1  nisimura {
    412  1.1  nisimura 	unsigned anar, bound;
    413  1.1  nisimura 
    414  1.1  nisimura 	anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10 | ANAR_CSMA;
    415  1.1  nisimura 	mii_write(l, l->phy, MII_ANAR, anar);
    416  1.1  nisimura 	mii_write(l, l->phy, MII_BMCR, BMCR_AUTOEN | BMCR_STARTNEG);
    417  1.1  nisimura 	l->anlpar = 0;
    418  1.1  nisimura 	bound = getsecs() + timo;
    419  1.1  nisimura 	do {
    420  1.1  nisimura 		l->bmsr = mii_read(l, l->phy, MII_BMSR) |
    421  1.1  nisimura 		   mii_read(l, l->phy, MII_BMSR); /* read twice */
    422  1.1  nisimura 		if ((l->bmsr & BMSR_LINK) && (l->bmsr & BMSR_ACOMP)) {
    423  1.1  nisimura 			l->anlpar = mii_read(l, l->phy, MII_ANLPAR);
    424  1.1  nisimura 			break;
    425  1.1  nisimura 		}
    426  1.1  nisimura 		DELAY(10 * 1000);
    427  1.1  nisimura 	} while (getsecs() < bound);
    428  1.1  nisimura 	return;
    429  1.1  nisimura }
    430