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