xref: /netbsd-src/sys/arch/sandpoint/stand/altboot/sme.c (revision f752ef7556f18906c663af5a2ef08524ffbd4965)
1 /* $NetBSD: sme.c,v 1.2 2011/01/27 17:38:04 phx Exp $ */
2 
3 /*-
4  * Copyright (c) 2008 The NetBSD Foundation, Inc.
5  * All rights reserved.
6  *
7  * This code is derived from software contributed to The NetBSD Foundation
8  * by Tohru Nishimura.
9  *
10  * Redistribution and use in source and binary forms, with or without
11  * modification, are permitted provided that the following conditions
12  * are met:
13  * 1. Redistributions of source code must retain the above copyright
14  *    notice, this list of conditions and the following disclaimer.
15  * 2. Redistributions in binary form must reproduce the above copyright
16  *    notice, this list of conditions and the following disclaimer in the
17  *    documentation and/or other materials provided with the distribution.
18  *
19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29  * POSSIBILITY OF SUCH DAMAGE.
30  */
31 
32 #include <sys/param.h>
33 
34 #include <netinet/in.h>
35 #include <netinet/in_systm.h>
36 
37 #include <lib/libsa/stand.h>
38 #include <lib/libsa/net.h>
39 
40 #include "globals.h"
41 
42 /*
43  * - reverse endian access every CSR.
44  * - no VTOPHYS() translation, vaddr_t == paddr_t.
45  * - PIPT writeback cache aware.
46  */
47 #define CSR_READ(l, r)		in32rb((l)->csr+(r))
48 #define CSR_WRITE(l, r, v) 	out32rb((l)->csr+(r), (v))
49 #define VTOPHYS(va) 		(uint32_t)(va)
50 #define DEVTOV(pa) 		(uint32_t)(pa)
51 #define wbinv(adr, siz)		_wbinv(VTOPHYS(adr), (uint32_t)(siz))
52 #define inv(adr, siz)		_inv(VTOPHYS(adr), (uint32_t)(siz))
53 #define DELAY(n)		delay(n)
54 #define ALLOC(T,A)		(T *)allocaligned(sizeof(T),(A))
55 
56 struct desc {
57 	uint32_t xd0, xd1, xd2, xd3;
58 };
59 #define T0_OWN		(1U<<31)	/* */
60 #define T0_ES		(1U<<15)	/* error summary */
61 #define	T0_FL		0x7fff0000	/* frame length */
62 #define T1_LS		(1U<<30)	/* last descriptor of Tx frame */
63 #define T1_FS		(1U<<29)	/* first descriptor of Tx frame */
64 #define T1_TER		(1U<<25)	/* wrap mark to form a ring */
65 #define T1_TCH		(1U<<24)	/* TDES3 points the next desc */
66 #define T1_FL		0x00007ff	/* Tx frame/segment length */
67 #define R0_OWN		(1U<<31)	/* */
68 #define R0_FL		0x3fff0000	/* frame length */
69 #define R0_ES		(1U<<15)	/* error summary */
70 #define R1_RER		(1U<<25)	/* wrap mark to form a ring */
71 #define	R1_RCH		(1U<<24)	/* RDES3 points the next desc */
72 /* RDES1 will be never changed while operation */
73 
74 #define	BUSMODE		0x00
75 #define	TXPOLLD		0x04		/* start transmission */
76 #define RXPOLLD		0x08		/* start receiving */
77 #define RXDBASE		0x0c		/* Rx descriptor list base */
78 #define	TXDBASE		0x10		/* Tx descriptor list base */
79 #define DMACCTL		0x18		/* DMAC control */
80 #define  DMACCTL_ST	(1U<<13)	/* start/stop Tx DMA */
81 #define  DMACCTL_SR	(1U<< 1)	/* start/stop Rx DMA */
82 #define MAC_CR		0x80		/* MAC control */
83 #define  MACCR_FDPX     (1U<<20)	/* full duplex operation */
84 #define  MACCR_TXEN     (1U<< 3)	/* enable xmit */
85 #define  MACCR_RXEN     (1U<< 2)	/* enable recv */
86 #define ADDRH		0x84		/* ea 5:4 */
87 #define ADDRL		0x88		/* ea 3:0 */
88 #define MIIADDR		0x94		/* MII control */
89 #define MIIDATA		0x98		/* MII data */
90 
91 #define FRAMESIZE	1536
92 
93 struct local {
94 	struct desc txd[2];
95 	struct desc rxd[2];
96 	uint8_t rxstore[2][FRAMESIZE];
97 	unsigned csr, tx, rx;
98 	unsigned phy, bmsr, anlpar;
99 };
100 
101 static int mii_read(struct local *, int, int);
102 static void mii_write(struct local *, int, int, int);
103 static void mii_dealan(struct local *, unsigned);
104 
105 int
sme_match(unsigned tag,void * data)106 sme_match(unsigned tag, void *data)
107 {
108 	unsigned v;
109 
110 	v = pcicfgread(tag, PCI_ID_REG);
111 	switch (v) {
112 	case PCI_DEVICE(0x1055, 0xe940):
113 		return 1;
114 	}
115 	return 0;
116 }
117 
118 void *
sme_init(unsigned tag,void * data)119 sme_init(unsigned tag, void *data)
120 {
121 	struct local *l;
122 	struct desc *txd, *rxd;
123 	unsigned mac32, mac16, val, fdx;
124 	uint8_t *en;
125 
126 	l = ALLOC(struct local, 32); /* desc alignment */
127 	memset(l, 0, sizeof(struct local));
128 	l->csr = DEVTOV(pcicfgread(tag, 0x1c)); /* BAR3 mem space, LE */
129 	l->phy = 1; /* 9420 internal PHY */
130 
131 	en = data;
132 	mac32 = CSR_READ(l, ADDRL);
133 	mac16 = CSR_READ(l, ADDRH);
134 	en[0] = mac32;
135 	en[1] = mac32 >> 8;
136 	en[2] = mac32 >> 16;
137 	en[3] = mac32 >> 24;
138 	en[4] = mac16;
139 	en[5] = mac16 >> 8;
140 
141 	printf("MAC address %02x:%02x:%02x:%02x:%02x:%02x\n",
142 		en[0], en[1], en[2], en[3], en[4], en[5]);
143 	DPRINTF(("PHY %d (%04x.%04x)\n", l->phy,
144 	    mii_read(l, l->phy, 2), mii_read(l, l->phy, 3)));
145 
146 	mii_dealan(l, 5);
147 
148 	/* speed and duplexity can be seen in MII 31 */
149 	val = mii_read(l, l->phy, 31);
150 	fdx = !!(val & (1U << 4));
151 	printf("%s", (val & (1U << 3)) ? "100Mbps" : "10Mbps");
152 	if (fdx)
153 		printf("-FDX");
154 	printf("\n");
155 
156 	txd = &l->txd[0];
157 	rxd = &l->rxd[0];
158 	rxd[0].xd0 = htole32(R0_OWN);
159 	rxd[0].xd1 = htole32(R1_RCH | FRAMESIZE);
160 	rxd[0].xd2 = htole32(VTOPHYS(l->rxstore[0]));
161 	rxd[0].xd3 = htole32(VTOPHYS(&rxd[1]));
162 	rxd[1].xd0 = htole32(R0_OWN);
163 	rxd[1].xd1 = htole32(R1_RER | FRAMESIZE);
164 	rxd[1].xd2 = htole32(VTOPHYS(l->rxstore[1]));
165 	/* R1_RER neglects xd3 */
166 	l->tx = l->rx = 0;
167 
168 	wbinv(l, sizeof(struct local));
169 
170 	CSR_WRITE(l, TXDBASE, VTOPHYS(txd));
171 	CSR_WRITE(l, RXDBASE, VTOPHYS(rxd));
172 	val = MACCR_TXEN | MACCR_RXEN;
173 	if (fdx)
174 		val |= MACCR_FDPX;
175 	CSR_WRITE(l, BUSMODE, 0);
176 	CSR_WRITE(l, DMACCTL, DMACCTL_ST | DMACCTL_SR);
177 	CSR_WRITE(l, MAC_CR, val); /* (FDX), Tx/Rx enable */
178 	CSR_WRITE(l, RXPOLLD, 01); /* start receiving */
179 
180 	return l;
181 }
182 
183 int
sme_send(void * dev,char * buf,unsigned len)184 sme_send(void *dev, char *buf, unsigned len)
185 {
186 	struct local *l = dev;
187 	volatile struct desc *txd;
188 	unsigned txstat, loop;
189 
190 	/* send a single frame with no T1_TER|T1_TCH designation */
191 	wbinv(buf, len);
192 	txd = &l->txd[l->tx];
193 	txd->xd2 = htole32(VTOPHYS(buf));
194 	txd->xd1 = htole32(T1_FS | T1_LS | (len & T1_FL));
195 	txd->xd0 = htole32(T0_OWN | (len & T0_FL) << 16);
196 	wbinv(txd, sizeof(struct desc));
197 	CSR_WRITE(l, TXPOLLD, 01); /* start transmission */
198 	loop = 100;
199 	do {
200 		txstat = le32toh(txd->xd0);
201 		if (txstat & T0_ES)
202 			break;
203 		if ((txstat & T0_OWN) == 0)
204 			goto done;
205 		DELAY(10);
206 		inv(txd, sizeof(struct desc));
207 	} while (--loop != 0);
208 	printf("xmit failed\n");
209 	return -1;
210   done:
211 	l->tx ^= 1;
212 	return len;
213 }
214 
215 int
sme_recv(void * dev,char * buf,unsigned maxlen,unsigned timo)216 sme_recv(void *dev, char *buf, unsigned maxlen, unsigned timo)
217 {
218 	struct local *l = dev;
219 	volatile struct desc *rxd;
220 	unsigned bound, rxstat, len;
221 	uint8_t *ptr;
222 
223 	bound = 1000 * timo;
224 printf("recving with %u sec. timeout\n", timo);
225   again:
226 	rxd = &l->rxd[l->rx];
227 	do {
228 		inv(rxd, sizeof(struct desc));
229 		rxstat = le32toh(rxd->xd0);
230 		if ((rxstat & R0_OWN) == 0)
231 			goto gotone;
232 		DELAY(1000); /* 1 milli second */
233 	} while (--bound > 0);
234 	errno = 0;
235 	return -1;
236   gotone:
237 	if (rxstat & R0_ES) {
238 		rxd->xd0 = htole32(R0_OWN);
239 		wbinv(rxd, sizeof(struct desc));
240 		l->rx ^= 1;
241 		CSR_WRITE(l, RXPOLLD, 01); /* restart receiving */
242 		goto again;
243 	}
244 	/* good frame */
245 	len = (rxstat & R0_FL) >> 16 /* no FCS included */;
246         if (len > maxlen)
247                 len = maxlen;
248 	ptr = l->rxstore[l->rx];
249         inv(ptr, len);
250         memcpy(buf, ptr, len);
251 	rxd->xd0 = htole32(R0_OWN);
252 	wbinv(rxd, sizeof(struct desc));
253 	l->rx ^= 1;
254 	CSR_WRITE(l, RXPOLLD, 01); /* necessary? */
255 	return len;
256 }
257 
258 #define MII_BMCR	0x00 	/* Basic mode control register (rw) */
259 #define  BMCR_RESET	0x8000	/* reset */
260 #define  BMCR_AUTOEN	0x1000	/* autonegotiation enable */
261 #define  BMCR_ISO	0x0400	/* isolate */
262 #define  BMCR_STARTNEG	0x0200	/* restart autonegotiation */
263 #define MII_BMSR	0x01	/* Basic mode status register (ro) */
264 #define  BMSR_ACOMP	0x0020	/* Autonegotiation complete */
265 #define  BMSR_LINK	0x0004	/* Link status */
266 #define MII_ANAR	0x04	/* Autonegotiation advertisement (rw) */
267 #define  ANAR_FC	0x0400	/* local device supports PAUSE */
268 #define  ANAR_TX_FD	0x0100	/* local device supports 100bTx FD */
269 #define  ANAR_TX	0x0080	/* local device supports 100bTx */
270 #define  ANAR_10_FD	0x0040	/* local device supports 10bT FD */
271 #define  ANAR_10	0x0020	/* local device supports 10bT */
272 #define  ANAR_CSMA	0x0001	/* protocol selector CSMA/CD */
273 #define MII_ANLPAR	0x05	/* Autonegotiation lnk partner abilities (rw) */
274 
275 static int
mii_read(struct local * l,int phy,int reg)276 mii_read(struct local *l, int phy, int reg)
277 {
278 	uint32_t ctl;
279 
280 	do {
281 		ctl = CSR_READ(l, MIIADDR);
282 	} while (ctl & 01);
283 	ctl = (phy << 11) | (reg << 6) | (0 << 1); /* READ op */
284 	CSR_WRITE(l, MIIADDR, ctl);
285 	do {
286 		ctl = CSR_READ(l, MIIADDR);
287 	} while (ctl & 01);
288 	return CSR_READ(l, MIIDATA);
289 }
290 
291 void
mii_write(struct local * l,int phy,int reg,int val)292 mii_write(struct local *l, int phy, int reg, int val)
293 {
294 	uint32_t ctl;
295 
296 	do {
297 		ctl = CSR_READ(l, MIIADDR);
298 	} while (ctl & 01);
299 	ctl = (phy << 11) | (reg << 6) | (1 << 1); /* WRITE op */
300 	CSR_WRITE(l, MIIDATA, val);
301 }
302 
303 void
mii_dealan(struct local * l,unsigned timo)304 mii_dealan(struct local *l, unsigned timo)
305 {
306 	unsigned anar, bound;
307 
308 	anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10 | ANAR_CSMA;
309 	mii_write(l, l->phy, MII_ANAR, anar);
310 	mii_write(l, l->phy, MII_BMCR, BMCR_AUTOEN | BMCR_STARTNEG);
311 	l->anlpar = 0;
312 	bound = getsecs() + timo;
313 	do {
314 		l->bmsr = mii_read(l, l->phy, MII_BMSR) |
315 		   mii_read(l, l->phy, MII_BMSR); /* read twice */
316 		if ((l->bmsr & BMSR_LINK) && (l->bmsr & BMSR_ACOMP)) {
317 			l->anlpar = mii_read(l, l->phy, MII_ANLPAR);
318 			break;
319 		}
320 		DELAY(10 * 1000);
321 	} while (getsecs() < bound);
322 	return;
323 }
324