sip.c revision 1.1 1 1.1 nisimura /* $NetBSD: sip.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_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.1 nisimura printf("PHY %d (%04x.%04x)\n", l->phy,
182 1.1 nisimura 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