1 1.2 phx /* $NetBSD: sip.c,v 1.2 2011/01/27 17:38:04 phx 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.2 phx DPRINTF(("PHY %d (%04x.%04x)\n", l->phy, 182 1.2 phx 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