1 1.4 andvar /* $NetBSD: dm9000.c,v 1.4 2021/12/12 13:05:13 andvar Exp $ */ 2 1.1 nisimura 3 1.1 nisimura /*- 4 1.1 nisimura * Copyright (c) 2012 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 #include <netinet/in.h> 34 1.1 nisimura #include <netinet/in_systm.h> 35 1.1 nisimura 36 1.1 nisimura #include <lib/libsa/stand.h> 37 1.1 nisimura #include <lib/libsa/net.h> 38 1.1 nisimura 39 1.1 nisimura /* 40 1.1 nisimura * This DM9000 is wired as a 16bit device and manages Tx/Rx SRAM buffer 41 1.1 nisimura * in 16bit quantity. MRCMD/MWCMD access increments buffer pointer 42 1.1 nisimura * by two regardless of r/w size. Mixing 16/8bit access is not possible. 43 1.1 nisimura * Byte read would end up with loosing every odd indexed datum. 44 1.1 nisimura * 45 1.1 nisimura * The DM9000 CMD pin is tied with SoC LADDR2 address line. SA9-SA4 46 1.1 nisimura * pins are hardwired to fixed decoding 0x300. Thus address [26:3] in 47 1.1 nisimura * CS4 range 0x2000'0000 are don't-care bits to manipulate the chip. 48 1.1 nisimura * The DM9000 INDEX port is accessed at the address b'000 while the 49 1.1 nisimura * DATA port at the address b'100. 50 1.1 nisimura * 51 1.1 nisimura * This code assumes Little endian CPU. 52 1.1 nisimura */ 53 1.1 nisimura 54 1.1 nisimura #define NCR 0x00 /* control */ 55 1.1 nisimura #define NCR_FDX (1<<3) /* FDX link detection report */ 56 1.1 nisimura #define NCR_RST (1<<0) /* instruct reset, goes 0 at done */ 57 1.1 nisimura #define NSR 0x01 /* status */ 58 1.1 nisimura #define NSR_SPEED (1<<7) /* 1->100M, 0->10M, when link is up */ 59 1.1 nisimura #define NSR_LINKST (1<<6) /* 1->linkup, 0->linkdown */ 60 1.1 nisimura #define NSR_TX2END (1<<3) /* Tx frame #2 completed */ 61 1.1 nisimura #define NSR_TX1END (1<<2) /* Tx frame #1 completed */ 62 1.1 nisimura #define NSR_RXOV (1<<1) /* Rx FIFO overflow detected */ 63 1.1 nisimura #define TCR 0x02 /* Tx control */ 64 1.1 nisimura #define TCR_TXREQ 0x01 /* request to start transmit, goes 0 at done */ 65 1.1 nisimura #define TCR2 0x2d /* Tx control #2 */ 66 1.1 nisimura #define TCR2_ONEPM 0x10 /* send single Tx frame at a time */ 67 1.1 nisimura #define RCR 0x05 /* Rx control */ 68 1.1 nisimura #define RCR_WTDIS 0x40 /* disable frame receipt watchdog timer */ 69 1.1 nisimura #define RCR_DIS_LONG 0x20 /* discard too-long Rx frame */ 70 1.1 nisimura #define RCR_DIS_CRC 0x10 /* discard CRC error Rx frame */ 71 1.1 nisimura #define RCR_ALL 0x08 /* accept MCAST frames */ 72 1.1 nisimura #define RCR_RUNT 0x04 /* accept runt Rx frame */ 73 1.4 andvar #define RCR_PRMSC 0x02 /* promiscuous */ 74 1.1 nisimura #define RCR_RXEN 0x01 /* enable frame reception */ 75 1.1 nisimura #define RSR 0x06 /* RX status */ 76 1.1 nisimura #define RSR_MF (1<<6) /* bcast/mcast frame found */ 77 1.1 nisimura #define FCR 0x0a /* flow control */ 78 1.1 nisimura #define FCR_FLCE 0x01 /* enable Tx/Rx flow control */ 79 1.1 nisimura #define EPCR 0x0b /* EEPROM and PHY control */ 80 1.1 nisimura #define EP_EPOS (1<<3) /* 1 for PHY op, 0 for EEPROM op */ 81 1.1 nisimura #define EP_ERPRR (1<<2) /* instruct to start read op */ 82 1.1 nisimura #define EP_ERPRW (1<<1) /* instruct to start write op */ 83 1.1 nisimura #define EP_ERRE (1<<0) /* 1 while operation is in progress */ 84 1.1 nisimura #define EPAR 0x0c /* [7:6] for PHY#, [5:0] for addr */ 85 1.1 nisimura #define EPDRL 0x0d /* EEPROM/PHY data low byte */ 86 1.1 nisimura #define EPDRH 0x0e /* EEPROM/PHY data high byte */ 87 1.1 nisimura #define PAR 0x10 /* station address */ 88 1.1 nisimura #define MAR 0x16 /* multicast filter hash value */ 89 1.1 nisimura #define GPR 0x1f /* gpio control */ 90 1.1 nisimura #define GPR_PHYPWROFF 0x01 /* powerdown internal PHY */ 91 1.1 nisimura #define VID0 0x28 /* vendor ID low byte */ 92 1.1 nisimura #define VID1 0x29 /* vendor ID high byte */ 93 1.1 nisimura #define PID0 0x2a /* product ID low byte */ 94 1.1 nisimura #define PID1 0x2b /* product ID high byte */ 95 1.1 nisimura #define CHIPR 0x2c /* chip revision */ 96 1.1 nisimura #define MRCMDX 0xf0 /* read data w/o pointer incr */ 97 1.1 nisimura #define MRCMD 0xf2 /* read data with pointer auto incr */ 98 1.1 nisimura #define MWCMD 0xf8 /* write data with pointer auto incr */ 99 1.1 nisimura #define TXPLL 0xfc /* Tx frame length low byte */ 100 1.1 nisimura #define TXPLH 0xfd /* Tx frame length high byte */ 101 1.1 nisimura #define ISR 0xfe /* interrupt status report */ 102 1.1 nisimura #define ISR_LNKCHG 0x20 /* link status change detected */ 103 1.1 nisimura #define ISR_UDRUN 0x10 /* transmit underrun detected */ 104 1.1 nisimura #define ISR_PTM (1<<1) /* frame Tx completed */ 105 1.1 nisimura #define ISR_PRS (1<<0) /* frame Rx completed */ 106 1.1 nisimura #define IMR 0xff /* interrupt mask */ 107 1.1 nisimura #define IMR_PAR (1<<7) /* use 3/13K SRAM partitioning with autowrap */ 108 1.1 nisimura #define IMR_PRM (1<<0) /* post interrupt when Rx completed */ 109 1.1 nisimura 110 1.1 nisimura #ifndef DM9000MAC 111 1.1 nisimura #define DM9000MAC 0x08,0x08,0x11,0x18,0x12,0x27 112 1.1 nisimura #endif 113 1.1 nisimura 114 1.1 nisimura struct local { 115 1.1 nisimura unsigned int csr; 116 1.1 nisimura unsigned int phy, bmsr, anlpar; 117 1.1 nisimura uint8_t en[6]; 118 1.1 nisimura }; 119 1.1 nisimura 120 1.1 nisimura static struct local dm9000local; 121 1.1 nisimura 122 1.1 nisimura int dm9k_match(unsigned int, void *); 123 1.1 nisimura void *dm9k_init(unsigned int, void *); 124 1.1 nisimura int dm9k_send(void *, char *, unsigned int); 125 1.1 nisimura int dm9k_recv(void *, char *, unsigned int, unsigned int); 126 1.1 nisimura 127 1.1 nisimura static unsigned 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_dealan(struct local *, unsigned int); 130 1.1 nisimura 131 1.1 nisimura extern void usleep(int); 132 1.1 nisimura 133 1.1 nisimura static inline int 134 1.1 nisimura CSR_READ_1(struct local *l, int reg) 135 1.1 nisimura { 136 1.1 nisimura *(volatile uint8_t *)(l->csr) = reg; 137 1.1 nisimura return *(volatile uint8_t*)(l->csr + 4); 138 1.1 nisimura } 139 1.1 nisimura 140 1.1 nisimura static inline int 141 1.1 nisimura CSR_READ_2(struct local *l, int reg) 142 1.1 nisimura { 143 1.1 nisimura *(volatile uint8_t *)(l->csr) = reg; 144 1.1 nisimura return *(volatile uint16_t *)(l->csr + 4); 145 1.1 nisimura } 146 1.1 nisimura 147 1.1 nisimura static inline void 148 1.1 nisimura CSR_WRITE_1(struct local *l, int reg, int data) 149 1.1 nisimura { 150 1.1 nisimura *(volatile uint8_t *)(l->csr) = reg; 151 1.1 nisimura *(volatile uint8_t *)(l->csr + 4) = data; 152 1.1 nisimura } 153 1.1 nisimura 154 1.1 nisimura static inline void 155 1.1 nisimura CSR_WRITE_2(struct local *l, int reg, int data) 156 1.1 nisimura { 157 1.1 nisimura *(volatile uint8_t *)(l->csr) = reg; 158 1.1 nisimura *(volatile uint16_t *)(l->csr + 4) = data; 159 1.1 nisimura } 160 1.1 nisimura 161 1.1 nisimura int 162 1.1 nisimura dm9k_match(unsigned int tag, void *aux) 163 1.1 nisimura { 164 1.1 nisimura struct local *l = &dm9000local; 165 1.1 nisimura uint8_t *en = aux; 166 1.1 nisimura uint8_t std[6] = { DM9000MAC }; 167 1.1 nisimura int val; 168 1.1 nisimura 169 1.1 nisimura l->csr = 0x20000000; 170 1.1 nisimura val = CSR_READ_1(l, PID0); 171 1.1 nisimura val |= CSR_READ_1(l, PID1) << 8; 172 1.1 nisimura val |= CSR_READ_1(l, VID0) << 16; 173 1.1 nisimura val |= CSR_READ_1(l, VID1) << 24; 174 1.1 nisimura if (val != 0x0a469000) { 175 1.1 nisimura printf("DM9000 not found at 0x%x\n", l->csr); 176 1.1 nisimura return 0; 177 1.1 nisimura } 178 1.1 nisimura if (en != NULL 179 1.1 nisimura && en[0] && en[1] && en[2] && en[3] && en[4] && en[5]) 180 1.1 nisimura memcpy(l->en, en, 6); 181 1.1 nisimura else if (en != NULL) { 182 1.1 nisimura memcpy(en, std, 6); 183 1.1 nisimura memcpy(l->en, std, 6); 184 1.1 nisimura } 185 1.1 nisimura return 1; 186 1.1 nisimura } 187 1.1 nisimura 188 1.1 nisimura void * 189 1.1 nisimura dm9k_init(unsigned int tag, void *aux) 190 1.1 nisimura { 191 1.1 nisimura struct local *l = &dm9000local; 192 1.1 nisimura uint8_t *en = l->en; 193 1.1 nisimura unsigned int val, fdx; 194 1.1 nisimura 195 1.1 nisimura val = CSR_READ_1(l, CHIPR); 196 1.3 msaitoh printf("DM9000 rev. %#x", val); 197 1.1 nisimura val = CSR_READ_1(l, ISR); 198 1.1 nisimura printf(", %d bit mode\n", (val & 1<<7) ? 8 : 16); 199 1.1 nisimura 200 1.1 nisimura CSR_WRITE_1(l, NCR, 0); /* use internal PHY */ 201 1.1 nisimura l->phy = 1; 202 1.1 nisimura 203 1.1 nisimura /* force PHY poweroff */ 204 1.1 nisimura CSR_WRITE_1(l, GPR, GPR_PHYPWROFF); 205 1.1 nisimura 206 1.1 nisimura CSR_WRITE_1(l, IMR, 0); 207 1.1 nisimura CSR_WRITE_1(l, TCR, 0); 208 1.1 nisimura CSR_WRITE_1(l, RCR, 0); 209 1.1 nisimura 210 1.1 nisimura /* SW reset */ 211 1.1 nisimura CSR_WRITE_1(l, NCR, NCR_RST); 212 1.1 nisimura do { 213 1.1 nisimura usleep(1); 214 1.1 nisimura } while (NCR_RST & CSR_READ_1(l, NCR)); 215 1.1 nisimura 216 1.1 nisimura /* negate PHY poweroff condition */ 217 1.1 nisimura CSR_WRITE_1(l, GPR, 0); 218 1.1 nisimura 219 1.1 nisimura /* SW reset, again */ 220 1.1 nisimura CSR_WRITE_1(l, NCR, NCR_RST); 221 1.1 nisimura do { 222 1.1 nisimura usleep(1); 223 1.1 nisimura } while (NCR_RST & CSR_READ_1(l, NCR)); 224 1.1 nisimura 225 1.1 nisimura /* clear NSR bits */ 226 1.1 nisimura (void) CSR_READ_1(l, NSR); 227 1.1 nisimura 228 1.1 nisimura printf("MAC address %02x:%02x:%02x:%02x:%02x:%02x\n", 229 1.1 nisimura en[0], en[1], en[2], en[3], en[4], en[5]); 230 1.1 nisimura CSR_WRITE_1(l, PAR + 0, en[0]); 231 1.1 nisimura CSR_WRITE_1(l, PAR + 1, en[1]); 232 1.1 nisimura CSR_WRITE_1(l, PAR + 2, en[2]); 233 1.1 nisimura CSR_WRITE_1(l, PAR + 3, en[3]); 234 1.1 nisimura CSR_WRITE_1(l, PAR + 4, en[4]); 235 1.1 nisimura CSR_WRITE_1(l, PAR + 5, en[5]); 236 1.1 nisimura 237 1.1 nisimura /* make sure not to receive bcast/mcast frames */ 238 1.1 nisimura CSR_WRITE_1(l, MAR + 0, 0); 239 1.1 nisimura CSR_WRITE_1(l, MAR + 1, 0); 240 1.1 nisimura CSR_WRITE_1(l, MAR + 2, 0); 241 1.1 nisimura CSR_WRITE_1(l, MAR + 3, 0); 242 1.1 nisimura CSR_WRITE_1(l, MAR + 4, 0); 243 1.1 nisimura CSR_WRITE_1(l, MAR + 5, 0); 244 1.1 nisimura CSR_WRITE_1(l, MAR + 6, 0); 245 1.1 nisimura CSR_WRITE_1(l, MAR + 7, 0); 246 1.1 nisimura 247 1.1 nisimura /* perform link auto-negotiation */ 248 1.1 nisimura printf("waiting for linkup ... "); 249 1.1 nisimura mii_dealan(l, 5); 250 1.1 nisimura 251 1.1 nisimura val = CSR_READ_1(l, NSR); 252 1.1 nisimura if ((val & NSR_LINKST) == 0) { 253 1.1 nisimura printf("failed; cable problem?\n"); 254 1.1 nisimura return NULL; 255 1.1 nisimura } 256 1.1 nisimura 257 1.1 nisimura /* 258 1.1 nisimura * speed and duplexity can be seen in MII 17. 259 1.1 nisimura * bit15 100Mbps-FDX 260 1.1 nisimura * bit14 100Mbps 261 1.1 nisimura * bit13 10Mbps-FDX 262 1.1 nisimura * bit12 10Mbps 263 1.1 nisimura * also available in NSR[SPEED] and NCR[FDX] respectively. 264 1.1 nisimura */ 265 1.1 nisimura val = mii_read(l, l->phy, 17); 266 1.1 nisimura if (val & (03 << 14)) 267 1.1 nisimura printf("100Mbps"); 268 1.1 nisimura if (val & (03 << 12)) 269 1.1 nisimura printf("10Mbps"); 270 1.1 nisimura fdx = !!(val & (05 << 13)); 271 1.1 nisimura if (fdx) { 272 1.1 nisimura printf("-FDX"); 273 1.1 nisimura val = CSR_READ_1(l, FCR); 274 1.1 nisimura CSR_WRITE_1(l, FCR, val | FCR_FLCE); 275 1.1 nisimura } 276 1.1 nisimura printf("\n"); 277 1.1 nisimura 278 1.1 nisimura CSR_WRITE_1(l, NSR, ~0); 279 1.1 nisimura CSR_WRITE_1(l, ISR, ~0); 280 1.1 nisimura 281 1.1 nisimura /* 282 1.1 nisimura * - send one frame at a time. 283 1.1 nisimura * - disable Rx watchdog timer, discard too-long/CRC error frames. 284 1.1 nisimura * - 3/13K SRAM partitioning, r/w pointer autowrap. 285 1.1 nisimura */ 286 1.1 nisimura CSR_WRITE_1(l, TCR2, TCR2_ONEPM); 287 1.1 nisimura CSR_WRITE_1(l, RCR, RCR_RXEN | RCR_WTDIS | RCR_DIS_LONG | RCR_DIS_CRC); 288 1.1 nisimura CSR_WRITE_1(l, IMR, IMR_PAR); 289 1.1 nisimura 290 1.1 nisimura memcpy(aux, l->en, 6); 291 1.1 nisimura return l; 292 1.1 nisimura } 293 1.1 nisimura 294 1.1 nisimura int 295 1.1 nisimura dm9k_send(void *dev, char *buf, unsigned int len) 296 1.1 nisimura { 297 1.1 nisimura struct local *l = dev; 298 1.1 nisimura unsigned int val, cnt, bound; 299 1.1 nisimura 300 1.1 nisimura if (len > 1520) { 301 1.1 nisimura printf("dm9k_send: len > 1520 (%u)\n", len); 302 1.1 nisimura len = 1520; 303 1.1 nisimura } 304 1.1 nisimura 305 1.1 nisimura CSR_WRITE_1(l, ISR, ISR_PTM); /* clear ISR Tx complete bit */ 306 1.1 nisimura for (cnt = 0; cnt < len; cnt += 2) { 307 1.1 nisimura val = (buf[1] << 8) | buf[0]; 308 1.1 nisimura CSR_WRITE_2(l, MWCMD, val); 309 1.1 nisimura buf += 2; 310 1.1 nisimura } 311 1.1 nisimura CSR_WRITE_1(l, TXPLL, len); 312 1.1 nisimura CSR_WRITE_1(l, TXPLH, len >> 8); 313 1.1 nisimura CSR_WRITE_1(l, TCR, TCR_TXREQ); /* request to transmit */ 314 1.1 nisimura 315 1.1 nisimura bound = getsecs() + 1; 316 1.1 nisimura do { 317 1.1 nisimura val = CSR_READ_1(l, TCR); 318 1.1 nisimura if ((val & TCR_TXREQ) == 0) 319 1.1 nisimura goto done; 320 1.1 nisimura } while (getsecs() < bound); 321 1.1 nisimura printf("xmit failed\n"); 322 1.1 nisimura return -1; 323 1.1 nisimura done: 324 1.1 nisimura return len; 325 1.1 nisimura } 326 1.1 nisimura 327 1.1 nisimura int 328 1.1 nisimura dm9k_recv(void *dev, char *buf, unsigned int maxlen, unsigned int timo) 329 1.1 nisimura { 330 1.1 nisimura struct local *l = dev; 331 1.1 nisimura unsigned int bound, val, mark, stat, len, upto, cnt; 332 1.1 nisimura char *ptr; 333 1.1 nisimura 334 1.1 nisimura bound = getsecs() + timo; /* second */ 335 1.1 nisimura again: 336 1.1 nisimura do { 337 1.1 nisimura /* wait for Rx completion */ 338 1.1 nisimura val = CSR_READ_1(l, ISR); 339 1.1 nisimura if (val & ISR_PRS) 340 1.1 nisimura goto gotone; 341 1.1 nisimura /* usleep(10); this makes a stuck in mid transfer */ 342 1.1 nisimura } while (getsecs() < bound); 343 1.1 nisimura printf("receive timeout (%d seconds wait)\n", timo); 344 1.1 nisimura errno = 0; 345 1.1 nisimura return -1; 346 1.1 nisimura gotone: 347 1.1 nisimura CSR_WRITE_1(l, ISR, ISR_PRS); /* clear ISR Rx complete bit */ 348 1.1 nisimura (void) CSR_READ_2(l, MRCMDX); /* dummy read */ 349 1.2 nisimura mark = CSR_READ_2(l, MRCMDX); /* mark in [7:0] */ 350 1.1 nisimura if ((mark & 03) != 01) { 351 1.1 nisimura stat = CSR_READ_1(l, RSR); 352 1.1 nisimura printf("dm9k_recv: mark %x, RSR %x\n", mark, stat); 353 1.1 nisimura /* XXX got hosed, need full scale reinitialise XXX */ 354 1.1 nisimura goto again; 355 1.1 nisimura } 356 1.1 nisimura 357 1.2 nisimura stat = CSR_READ_2(l, MRCMD); /* stat in [15:8] */ 358 1.1 nisimura len = CSR_READ_2(l, MRCMD); 359 1.1 nisimura 360 1.1 nisimura /* should not happen, make sure to discard bcast/mcast frames */ 361 1.1 nisimura if (stat & (RSR_MF<<8)) { 362 1.1 nisimura for (cnt = 0; cnt < len; cnt += 2) 363 1.1 nisimura (void) CSR_READ_2(l, MRCMD); 364 1.1 nisimura printf("bcast/mcast frame, len = %d\n", len); 365 1.1 nisimura goto again; 366 1.1 nisimura } 367 1.1 nisimura 368 1.1 nisimura upto = len - 4; /* HASFCS */ 369 1.1 nisimura if (upto > maxlen) 370 1.1 nisimura upto = maxlen; 371 1.1 nisimura ptr = buf; 372 1.1 nisimura for (cnt = 0; cnt < upto; cnt += 2) { 373 1.1 nisimura val = CSR_READ_2(l, MRCMD); 374 1.1 nisimura ptr[0] = val; 375 1.1 nisimura ptr[1] = val >> 8; 376 1.1 nisimura ptr += 2; 377 1.1 nisimura } 378 1.1 nisimura /* discard trailing bytes */ 379 1.1 nisimura for (; cnt < len; cnt += 2) 380 1.1 nisimura (void) CSR_READ_2(l, MRCMD); 381 1.1 nisimura 382 1.1 nisimura return upto; 383 1.1 nisimura } 384 1.1 nisimura 385 1.1 nisimura static unsigned int 386 1.1 nisimura mii_read(struct local *l, int phy, int reg) 387 1.1 nisimura { 388 1.1 nisimura int v; 389 1.1 nisimura 390 1.1 nisimura CSR_WRITE_1(l, EPAR, phy << 6 | reg); 391 1.1 nisimura CSR_WRITE_1(l, EPCR, EP_EPOS | EP_ERPRR); 392 1.1 nisimura do { 393 1.1 nisimura v = CSR_READ_1(l, EPCR); 394 1.1 nisimura } while (v & EP_ERRE); 395 1.1 nisimura CSR_WRITE_1(l, EPCR, 0); 396 1.1 nisimura v = (CSR_READ_1(l, EPDRH) << 8) | CSR_READ_1(l, EPDRL); 397 1.1 nisimura return v; 398 1.1 nisimura } 399 1.1 nisimura 400 1.1 nisimura static void 401 1.1 nisimura mii_write(struct local *l, int phy, int reg, int data) 402 1.1 nisimura { 403 1.1 nisimura int v; 404 1.1 nisimura 405 1.1 nisimura CSR_WRITE_1(l, EPAR, phy << 6 | reg); 406 1.1 nisimura CSR_WRITE_1(l, EPDRL, data); 407 1.1 nisimura CSR_WRITE_1(l, EPDRH, data >> 8); 408 1.1 nisimura CSR_WRITE_1(l, EPCR, EP_EPOS | EP_ERPRW); 409 1.1 nisimura do { 410 1.1 nisimura v = CSR_READ_1(l, EPCR); 411 1.1 nisimura } while (v & EP_ERRE); 412 1.1 nisimura CSR_WRITE_1(l, EPCR, 0); 413 1.1 nisimura } 414 1.1 nisimura 415 1.1 nisimura #define MII_BMCR 0x00 /* Basic mode control register (rw) */ 416 1.1 nisimura #define BMCR_RESET 0x8000 /* reset */ 417 1.1 nisimura #define BMCR_AUTOEN 0x1000 /* autonegotiation enable */ 418 1.1 nisimura #define BMCR_ISO 0x0400 /* isolate */ 419 1.1 nisimura #define BMCR_STARTNEG 0x0200 /* restart autonegotiation */ 420 1.1 nisimura #define MII_BMSR 0x01 /* Basic mode status register (ro) */ 421 1.1 nisimura #define BMSR_ACOMP 0x0020 /* Autonegotiation complete */ 422 1.1 nisimura #define BMSR_LINK 0x0004 /* Link status */ 423 1.1 nisimura #define MII_ANAR 0x04 /* Autonegotiation advertisement (rw) */ 424 1.1 nisimura #define ANAR_FC 0x0400 /* local device supports PAUSE */ 425 1.1 nisimura #define ANAR_TX_FD 0x0100 /* local device supports 100bTx FD */ 426 1.1 nisimura #define ANAR_TX 0x0080 /* local device supports 100bTx */ 427 1.1 nisimura #define ANAR_10_FD 0x0040 /* local device supports 10bT FD */ 428 1.1 nisimura #define ANAR_10 0x0020 /* local device supports 10bT */ 429 1.1 nisimura #define ANAR_CSMA 0x0001 /* protocol selector CSMA/CD */ 430 1.1 nisimura #define MII_ANLPAR 0x05 /* Autonegotiation lnk partner abilities (rw) */ 431 1.1 nisimura 432 1.1 nisimura static void 433 1.1 nisimura mii_dealan(struct local *l, unsigned int timo) 434 1.1 nisimura { 435 1.1 nisimura unsigned int bound; 436 1.1 nisimura 437 1.1 nisimura mii_write(l, l->phy, MII_ANAR, ANAR_TX_FD | ANAR_TX | ANAR_10_FD | 438 1.1 nisimura ANAR_10 | ANAR_CSMA | ANAR_FC); 439 1.1 nisimura mii_write(l, l->phy, MII_BMCR, BMCR_AUTOEN | BMCR_STARTNEG); 440 1.1 nisimura l->anlpar = 0; 441 1.1 nisimura bound = getsecs() + timo; 442 1.1 nisimura do { 443 1.1 nisimura l->bmsr = mii_read(l, l->phy, MII_BMSR) | 444 1.1 nisimura mii_read(l, l->phy, MII_BMSR); /* read twice */ 445 1.1 nisimura if ((l->bmsr & BMSR_LINK) && (l->bmsr & BMSR_ACOMP)) { 446 1.1 nisimura l->anlpar = mii_read(l, l->phy, MII_ANLPAR); 447 1.1 nisimura break; 448 1.1 nisimura } 449 1.1 nisimura usleep(10 * 1000); 450 1.1 nisimura } while (getsecs() < bound); 451 1.1 nisimura return; 452 1.1 nisimura } 453