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