rge.c revision 1.8 1 1.8 rin /* $NetBSD: rge.c,v 1.8 2021/03/25 03:44:25 rin 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.6 phx #define CSR_WRITE_1(l, r, v) out8((l)->csr+(r), (v))
48 1.6 phx #define CSR_READ_1(l, r) in8((l)->csr+(r))
49 1.1 nisimura #define CSR_WRITE_2(l, r, v) out16rb((l)->csr+(r), (v))
50 1.1 nisimura #define CSR_READ_2(l, r) in16rb((l)->csr+(r))
51 1.1 nisimura #define CSR_WRITE_4(l, r, v) out32rb((l)->csr+(r), (v))
52 1.1 nisimura #define CSR_READ_4(l, r) in32rb((l)->csr+(r))
53 1.1 nisimura #define VTOPHYS(va) (uint32_t)(va)
54 1.1 nisimura #define DEVTOV(pa) (uint32_t)(pa)
55 1.1 nisimura #define wbinv(adr, siz) _wbinv(VTOPHYS(adr), (uint32_t)(siz))
56 1.1 nisimura #define inv(adr, siz) _inv(VTOPHYS(adr), (uint32_t)(siz))
57 1.1 nisimura #define DELAY(n) delay(n)
58 1.1 nisimura #define ALLOC(T,A) (T *)allocaligned(sizeof(T),(A))
59 1.1 nisimura
60 1.1 nisimura struct desc {
61 1.1 nisimura uint32_t xd0, xd1, xd2, xd3;
62 1.1 nisimura };
63 1.1 nisimura #define T0_OWN 0x80000000 /* loaded for HW to send */
64 1.1 nisimura #define T0_EOR 0x40000000 /* end of ring */
65 1.1 nisimura #define T0_FS 0x20000000 /* first descriptor */
66 1.1 nisimura #define T0_LS 0x10000000 /* last descriptor */
67 1.1 nisimura #define T0_FRMASK 0x0000ffff
68 1.1 nisimura
69 1.1 nisimura #define R0_OWN 0x80000000 /* empty for HW to load anew */
70 1.1 nisimura #define R0_EOR 0x40000000 /* end mark to form a ring */
71 1.1 nisimura #define R0_BUFLEN 0x00003ff8 /* max frag. size to receive */
72 1.1 nisimura #define R0_FS 0x20000000 /* start of frame */
73 1.1 nisimura #define R0_LS 0x10000000 /* end of frame */
74 1.1 nisimura #define R0_RES 0x00200000 /* Rx error summary */
75 1.1 nisimura #define R0_RUNT 0x00100000 /* runt frame received */
76 1.1 nisimura #define R0_CRC 0x00080000 /* CRC error found */
77 1.1 nisimura #define R0_FRMASK 0x00003fff /* 13:0 frame length */
78 1.1 nisimura
79 1.1 nisimura #define RGE_IDR0 0x00 /* MAC address [0] */
80 1.1 nisimura #define RGE_IDR1 0x01 /* MAC address [1] */
81 1.1 nisimura #define RGE_IDR2 0x02 /* MAC address [2] */
82 1.1 nisimura #define RGE_IDR3 0x03 /* MAC address [3] */
83 1.1 nisimura #define RGE_IDR4 0x04 /* MAC address [4] */
84 1.1 nisimura #define RGE_IDR5 0x05 /* MAC address [5] */
85 1.1 nisimura #define RGE_TNPDS 0x20 /* Tx descriptor base paddr */
86 1.1 nisimura #define RGE_THPDS 0x28 /* high pro. Tx des. base paddr */
87 1.1 nisimura #define RGE_CR 0x37 /* command */
88 1.1 nisimura #define CR_RESET (1U << 4) /* reset S1C */
89 1.1 nisimura #define CR_RXEN (1U << 3) /* Rx enable */
90 1.1 nisimura #define CR_TXEN (1U << 2) /* Tx enable */
91 1.1 nisimura #define RGE_TPPOLL 0x38 /* activate desc polling */
92 1.1 nisimura #define RGE_IMR 0x3c /* interrupt mask */
93 1.1 nisimura #define RGE_ISR 0x3e /* interrupt status */
94 1.1 nisimura #define RGE_TCR 0x40 /* Tx control */
95 1.1 nisimura #define TCR_MAXDMA 0x0700 /* 10:8 Tx DMA burst size */
96 1.1 nisimura #define RGE_RCR 0x44 /* Rx control */
97 1.1 nisimura #define RCR_RXTFH 0xe000 /* 15:13 Rx FIFO threshold */
98 1.1 nisimura #define RCR_MAXDMA 0x0700 /* 10:8 Rx DMA burst size */
99 1.1 nisimura #define RCR_AE (1U << 5) /* accept error frame */
100 1.1 nisimura #define RCR_RE (1U << 4) /* accept runt frame */
101 1.1 nisimura #define RCR_AB (1U << 3) /* accept broadcast frame */
102 1.1 nisimura #define RCR_AM (1U << 2) /* accept multicast frame */
103 1.1 nisimura #define RCR_APM (1U << 1) /* accept unicast frame */
104 1.1 nisimura #define RCR_AAP (1U << 0) /* promiscuous */
105 1.7 phx #define RGE_EECMD 0x50 /* EEPROM command register */
106 1.7 phx #define EECMD_LOCK 0x00
107 1.7 phx #define EECMD_UNLOCK 0xc0
108 1.1 nisimura #define RGE_PHYAR 0x60 /* PHY access */
109 1.1 nisimura #define RGE_PHYSR 0x6c /* PHY status */
110 1.1 nisimura #define RGE_RMS 0xda /* Rx maximum frame size */
111 1.1 nisimura #define RGE_RDSAR 0xe4 /* Rx descriptor base paddr */
112 1.1 nisimura #define RGE_ETTHR 0xec /* Tx threshold */
113 1.1 nisimura
114 1.1 nisimura #define FRAMESIZE 1536
115 1.1 nisimura
116 1.1 nisimura struct local {
117 1.1 nisimura struct desc txd[2]; /* 256B align */
118 1.1 nisimura uint8_t _hole0[256 - 2 * sizeof(struct desc)];
119 1.1 nisimura struct desc rxd[2]; /* 256B align */
120 1.1 nisimura uint8_t _hole1[256 - 2 * sizeof(struct desc)];
121 1.1 nisimura uint8_t rxstore[2][FRAMESIZE];
122 1.1 nisimura unsigned csr, tx, rx;
123 1.1 nisimura unsigned phy, bmsr, anlpar;
124 1.1 nisimura unsigned tcr, rcr;
125 1.1 nisimura };
126 1.1 nisimura
127 1.1 nisimura static int mii_read(struct local *, int, int);
128 1.1 nisimura static void mii_write(struct local *, int, int, int);
129 1.1 nisimura static void mii_initphy(struct local *);
130 1.1 nisimura static void mii_dealan(struct local *, unsigned);
131 1.1 nisimura
132 1.1 nisimura int
133 1.1 nisimura rge_match(unsigned tag, void *data)
134 1.1 nisimura {
135 1.1 nisimura unsigned v;
136 1.1 nisimura
137 1.1 nisimura v = pcicfgread(tag, PCI_ID_REG);
138 1.1 nisimura switch (v) {
139 1.3 phx case PCI_DEVICE(0x10ec, 0x8167):
140 1.1 nisimura case PCI_DEVICE(0x10ec, 0x8169):
141 1.1 nisimura return 1;
142 1.1 nisimura }
143 1.1 nisimura return 0;
144 1.1 nisimura }
145 1.1 nisimura
146 1.1 nisimura void *
147 1.1 nisimura rge_init(unsigned tag, void *data)
148 1.1 nisimura {
149 1.1 nisimura unsigned val;
150 1.1 nisimura struct local *l;
151 1.1 nisimura struct desc *txd, *rxd;
152 1.7 phx uint32_t reg;
153 1.7 phx uint8_t *en;
154 1.1 nisimura
155 1.1 nisimura l = ALLOC(struct local, 256); /* desc alignment */
156 1.1 nisimura memset(l, 0, sizeof(struct local));
157 1.1 nisimura l->csr = DEVTOV(pcicfgread(tag, 0x14)); /* use mem space */
158 1.1 nisimura
159 1.1 nisimura CSR_WRITE_1(l, RGE_CR, CR_RESET);
160 1.1 nisimura do {
161 1.1 nisimura val = CSR_READ_1(l, RGE_CR);
162 1.1 nisimura } while (val & CR_RESET);
163 1.1 nisimura
164 1.1 nisimura mii_initphy(l);
165 1.7 phx en = data;
166 1.1 nisimura
167 1.7 phx if (brdtype == BRD_QNAPTS) {
168 1.7 phx /* read the MAC from flash and write it into the ID-Regs */
169 1.7 phx read_mac_from_flash(en);
170 1.7 phx
171 1.7 phx CSR_WRITE_1(l, RGE_EECMD, EECMD_UNLOCK);
172 1.7 phx reg = en[0] | (en[1] << 8) | (en[2] << 16) | (en[3] << 24);
173 1.7 phx CSR_WRITE_4(l, RGE_IDR0, reg);
174 1.7 phx reg = en[4] | (en[5] << 8);
175 1.7 phx CSR_WRITE_4(l, RGE_IDR4, reg);
176 1.7 phx CSR_WRITE_1(l, RGE_EECMD, EECMD_LOCK);
177 1.7 phx } else {
178 1.7 phx /* pretent the ID-Regs have the correct address */
179 1.7 phx en[0] = CSR_READ_1(l, RGE_IDR0);
180 1.7 phx en[1] = CSR_READ_1(l, RGE_IDR1);
181 1.7 phx en[2] = CSR_READ_1(l, RGE_IDR2);
182 1.7 phx en[3] = CSR_READ_1(l, RGE_IDR3);
183 1.7 phx en[4] = CSR_READ_1(l, RGE_IDR4);
184 1.7 phx en[5] = CSR_READ_1(l, RGE_IDR5);
185 1.7 phx }
186 1.1 nisimura
187 1.1 nisimura printf("MAC address %02x:%02x:%02x:%02x:%02x:%02x\n",
188 1.1 nisimura en[0], en[1], en[2], en[3], en[4], en[5]);
189 1.2 phx DPRINTF(("PHY %d (%04x.%04x)\n", l->phy,
190 1.2 phx mii_read(l, l->phy, 2), mii_read(l, l->phy, 3)));
191 1.1 nisimura
192 1.1 nisimura mii_dealan(l, 5);
193 1.1 nisimura
194 1.1 nisimura /* speed and duplexity can be seen in PHYSR */
195 1.1 nisimura val = CSR_READ_1(l, RGE_PHYSR);
196 1.1 nisimura if (val & (1U << 4))
197 1.1 nisimura printf("1000Mbps");
198 1.1 nisimura if (val & (1U << 3))
199 1.1 nisimura printf("100Mbps");
200 1.1 nisimura if (val & (1U << 2))
201 1.1 nisimura printf("10Mbps");
202 1.1 nisimura if (val & (1U << 0))
203 1.1 nisimura printf("-FDX");
204 1.1 nisimura printf("\n");
205 1.1 nisimura
206 1.1 nisimura txd = &l->txd[0];
207 1.1 nisimura txd[1].xd0 = htole32(T0_EOR);
208 1.1 nisimura rxd = &l->rxd[0];
209 1.1 nisimura rxd[0].xd0 = htole32(R0_OWN | FRAMESIZE);
210 1.1 nisimura rxd[0].xd2 = htole32(VTOPHYS(l->rxstore[0]));
211 1.1 nisimura rxd[1].xd0 = htole32(R0_OWN | R0_EOR | FRAMESIZE);
212 1.1 nisimura rxd[1].xd2 = htole32(VTOPHYS(l->rxstore[1]));
213 1.1 nisimura wbinv(l, sizeof(struct local));
214 1.1 nisimura l->tx = l->rx = 0;
215 1.1 nisimura
216 1.1 nisimura l->tcr = (03 << 24) | (07 << 8);
217 1.1 nisimura l->rcr = (07 << 13) | (07 << 8) | RCR_APM;
218 1.1 nisimura CSR_WRITE_1(l, RGE_CR, CR_TXEN | CR_RXEN);
219 1.1 nisimura CSR_WRITE_1(l, RGE_ETTHR, 0x3f);
220 1.3 phx CSR_WRITE_2(l, RGE_RMS, FRAMESIZE);
221 1.1 nisimura CSR_WRITE_4(l, RGE_TCR, l->tcr);
222 1.1 nisimura CSR_WRITE_4(l, RGE_RCR, l->rcr);
223 1.1 nisimura CSR_WRITE_4(l, RGE_TNPDS, VTOPHYS(txd));
224 1.1 nisimura CSR_WRITE_4(l, RGE_RDSAR, VTOPHYS(rxd));
225 1.1 nisimura CSR_WRITE_4(l, RGE_TNPDS + 4, 0);
226 1.1 nisimura CSR_WRITE_4(l, RGE_RDSAR + 4, 0);
227 1.1 nisimura CSR_WRITE_2(l, RGE_ISR, ~0);
228 1.1 nisimura CSR_WRITE_2(l, RGE_IMR, 0);
229 1.1 nisimura return l;
230 1.1 nisimura }
231 1.1 nisimura
232 1.1 nisimura int
233 1.1 nisimura rge_send(void *dev, char *buf, unsigned len)
234 1.1 nisimura {
235 1.1 nisimura struct local *l = dev;
236 1.1 nisimura volatile struct desc *txd;
237 1.5 phx unsigned loop, ret;
238 1.8 rin char tmp[60];
239 1.1 nisimura
240 1.5 phx ret = len;
241 1.8 rin /* RTL does not stretch <60 Tx frame */
242 1.4 phx if (len < 60) {
243 1.8 rin memcpy(tmp, buf, len);
244 1.8 rin buf = tmp;
245 1.4 phx memset(buf + len, 0, 60 - len);
246 1.8 rin len = 60;
247 1.4 phx }
248 1.1 nisimura wbinv(buf, len);
249 1.1 nisimura txd = &l->txd[l->tx];
250 1.1 nisimura txd->xd2 = htole32(VTOPHYS(buf));
251 1.1 nisimura txd->xd0 &= htole32(T0_EOR);
252 1.1 nisimura txd->xd0 |= htole32(T0_OWN | T0_FS | T0_LS | (len & T0_FRMASK));
253 1.1 nisimura wbinv(txd, sizeof(struct desc));
254 1.1 nisimura CSR_WRITE_1(l, RGE_TPPOLL, 0x40);
255 1.1 nisimura loop = 100;
256 1.1 nisimura do {
257 1.1 nisimura if ((le32toh(txd->xd0) & T0_OWN) == 0)
258 1.1 nisimura goto done;
259 1.1 nisimura DELAY(10);
260 1.1 nisimura inv(txd, sizeof(struct desc));
261 1.1 nisimura } while (--loop > 0);
262 1.1 nisimura printf("xmit failed\n");
263 1.1 nisimura return -1;
264 1.1 nisimura done:
265 1.1 nisimura l->tx ^= 1;
266 1.5 phx return ret;
267 1.1 nisimura }
268 1.1 nisimura
269 1.1 nisimura int
270 1.1 nisimura rge_recv(void *dev, char *buf, unsigned maxlen, unsigned timo)
271 1.1 nisimura {
272 1.1 nisimura struct local *l = dev;
273 1.1 nisimura volatile struct desc *rxd;
274 1.1 nisimura unsigned bound, rxstat, len;
275 1.1 nisimura uint8_t *ptr;
276 1.1 nisimura
277 1.1 nisimura bound = 1000 * timo;
278 1.1 nisimura #if 0
279 1.1 nisimura printf("recving with %u sec. timeout\n", timo);
280 1.1 nisimura #endif
281 1.1 nisimura again:
282 1.1 nisimura rxd = &l->rxd[l->rx];
283 1.1 nisimura do {
284 1.1 nisimura inv(rxd, sizeof(struct desc));
285 1.1 nisimura rxstat = le32toh(rxd->xd0);
286 1.1 nisimura if ((rxstat & R0_OWN) == 0)
287 1.1 nisimura goto gotone;
288 1.1 nisimura DELAY(1000); /* 1 milli second */
289 1.1 nisimura } while (--bound > 0);
290 1.1 nisimura errno = 0;
291 1.1 nisimura return -1;
292 1.1 nisimura gotone:
293 1.1 nisimura if (rxstat & R0_RES) {
294 1.1 nisimura rxd->xd0 &= htole32(R0_EOR);
295 1.1 nisimura rxd->xd0 |= htole32(R0_OWN | FRAMESIZE);
296 1.1 nisimura wbinv(rxd, sizeof(struct desc));
297 1.1 nisimura l->rx ^= 1;
298 1.1 nisimura goto again;
299 1.1 nisimura }
300 1.1 nisimura len = rxstat & R0_FRMASK;
301 1.1 nisimura if (len > maxlen)
302 1.1 nisimura len = maxlen;
303 1.1 nisimura ptr = l->rxstore[l->rx];
304 1.1 nisimura inv(ptr, len);
305 1.1 nisimura memcpy(buf, ptr, len);
306 1.1 nisimura rxd->xd0 &= htole32(R0_EOR);
307 1.1 nisimura rxd->xd0 |= htole32(R0_OWN | FRAMESIZE);
308 1.1 nisimura wbinv(rxd, sizeof(struct desc));
309 1.1 nisimura l->rx ^= 1;
310 1.1 nisimura return len;
311 1.1 nisimura }
312 1.1 nisimura
313 1.1 nisimura static int
314 1.1 nisimura mii_read(struct local *l, int phy, int reg)
315 1.1 nisimura {
316 1.3 phx unsigned v;
317 1.1 nisimura
318 1.1 nisimura v = reg << 16;
319 1.1 nisimura CSR_WRITE_4(l, RGE_PHYAR, v);
320 1.3 phx DELAY(1000);
321 1.1 nisimura do {
322 1.3 phx DELAY(100);
323 1.1 nisimura v = CSR_READ_4(l, RGE_PHYAR);
324 1.1 nisimura } while ((v & (1U << 31)) == 0); /* wait for 0 -> 1 */
325 1.3 phx return v & 0xffff;
326 1.1 nisimura }
327 1.1 nisimura
328 1.1 nisimura static void
329 1.1 nisimura mii_write(struct local *l, int phy, int reg, int data)
330 1.1 nisimura {
331 1.1 nisimura unsigned v;
332 1.1 nisimura
333 1.1 nisimura v = (reg << 16) | (data & 0xffff) | (1U << 31);
334 1.1 nisimura CSR_WRITE_4(l, RGE_PHYAR, v);
335 1.3 phx DELAY(1000);
336 1.1 nisimura do {
337 1.3 phx DELAY(100);
338 1.1 nisimura v = CSR_READ_4(l, RGE_PHYAR);
339 1.1 nisimura } while (v & (1U << 31)); /* wait for 1 -> 0 */
340 1.1 nisimura }
341 1.1 nisimura
342 1.1 nisimura #define MII_BMCR 0x00 /* Basic mode control register (rw) */
343 1.1 nisimura #define BMCR_RESET 0x8000 /* reset */
344 1.1 nisimura #define BMCR_AUTOEN 0x1000 /* autonegotiation enable */
345 1.1 nisimura #define BMCR_ISO 0x0400 /* isolate */
346 1.1 nisimura #define BMCR_STARTNEG 0x0200 /* restart autonegotiation */
347 1.1 nisimura #define MII_BMSR 0x01 /* Basic mode status register (ro) */
348 1.1 nisimura #define BMSR_ACOMP 0x0020 /* Autonegotiation complete */
349 1.1 nisimura #define BMSR_LINK 0x0004 /* Link status */
350 1.1 nisimura #define MII_ANAR 0x04 /* Autonegotiation advertisement (rw) */
351 1.1 nisimura #define ANAR_FC 0x0400 /* local device supports PAUSE */
352 1.1 nisimura #define ANAR_TX_FD 0x0100 /* local device supports 100bTx FD */
353 1.1 nisimura #define ANAR_TX 0x0080 /* local device supports 100bTx */
354 1.1 nisimura #define ANAR_10_FD 0x0040 /* local device supports 10bT FD */
355 1.1 nisimura #define ANAR_10 0x0020 /* local device supports 10bT */
356 1.1 nisimura #define ANAR_CSMA 0x0001 /* protocol selector CSMA/CD */
357 1.1 nisimura #define MII_ANLPAR 0x05 /* Autonegotiation lnk partner abilities (rw) */
358 1.1 nisimura #define MII_GTCR 0x09 /* 1000baseT control */
359 1.1 nisimura #define GANA_1000TFDX 0x0200 /* advertise 1000baseT FDX */
360 1.1 nisimura #define GANA_1000THDX 0x0100 /* advertise 1000baseT HDX */
361 1.1 nisimura #define MII_GTSR 0x0a /* 1000baseT status */
362 1.1 nisimura #define GLPA_1000TFDX 0x0800 /* link partner 1000baseT FDX capable */
363 1.1 nisimura #define GLPA_1000THDX 0x0400 /* link partner 1000baseT HDX capable */
364 1.1 nisimura #define GLPA_ASM_DIR 0x0200 /* link partner asym. pause dir. capable */
365 1.1 nisimura
366 1.1 nisimura static void
367 1.1 nisimura mii_initphy(struct local *l)
368 1.1 nisimura {
369 1.3 phx int bound, ctl, phy, sts;
370 1.1 nisimura
371 1.3 phx phy = 7; /* internal rgephy, always at 7 */
372 1.1 nisimura ctl = mii_read(l, phy, MII_BMCR);
373 1.1 nisimura mii_write(l, phy, MII_BMCR, ctl | BMCR_RESET);
374 1.1 nisimura bound = 100;
375 1.1 nisimura do {
376 1.1 nisimura DELAY(10);
377 1.1 nisimura ctl = mii_read(l, phy, MII_BMCR);
378 1.1 nisimura if (ctl == 0xffff) {
379 1.1 nisimura printf("MII: PHY %d has died after reset\n", phy);
380 1.1 nisimura return;
381 1.1 nisimura }
382 1.1 nisimura } while (bound-- > 0 && (ctl & BMCR_RESET));
383 1.1 nisimura if (bound == 0) {
384 1.1 nisimura printf("PHY %d reset failed\n", phy);
385 1.1 nisimura }
386 1.1 nisimura ctl &= ~BMCR_ISO;
387 1.1 nisimura mii_write(l, phy, MII_BMCR, ctl);
388 1.1 nisimura sts = mii_read(l, phy, MII_BMSR) |
389 1.1 nisimura mii_read(l, phy, MII_BMSR); /* read twice */
390 1.1 nisimura l->phy = phy;
391 1.1 nisimura l->bmsr = sts;
392 1.1 nisimura }
393 1.1 nisimura
394 1.1 nisimura void
395 1.1 nisimura mii_dealan(struct local *l, unsigned timo)
396 1.1 nisimura {
397 1.1 nisimura unsigned anar, gtcr, bound;
398 1.1 nisimura
399 1.1 nisimura anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10 | ANAR_CSMA;
400 1.1 nisimura anar |= ANAR_FC;
401 1.1 nisimura gtcr = GANA_1000TFDX | GANA_1000THDX;
402 1.1 nisimura mii_write(l, l->phy, MII_ANAR, anar);
403 1.1 nisimura mii_write(l, l->phy, MII_GTCR, gtcr);
404 1.1 nisimura mii_write(l, l->phy, MII_BMCR, BMCR_AUTOEN | BMCR_STARTNEG);
405 1.1 nisimura l->anlpar = 0;
406 1.1 nisimura bound = getsecs() + timo;
407 1.1 nisimura do {
408 1.1 nisimura l->bmsr = mii_read(l, l->phy, MII_BMSR) |
409 1.1 nisimura mii_read(l, l->phy, MII_BMSR); /* read twice */
410 1.1 nisimura if ((l->bmsr & BMSR_LINK) && (l->bmsr & BMSR_ACOMP)) {
411 1.1 nisimura l->anlpar = mii_read(l, l->phy, MII_ANLPAR);
412 1.1 nisimura break;
413 1.1 nisimura }
414 1.1 nisimura DELAY(10 * 1000);
415 1.1 nisimura } while (getsecs() < bound);
416 1.1 nisimura return;
417 1.1 nisimura }
418