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