drivers/net/at91_emac.c

   1 /*
   2  * Copyright (C) 2009 BuS Elektronik GmbH & Co. KG
   3  * Jens Scharsig (esw@bus-elektronik.de)
   4  *
   5  * (C) Copyright 2003
   6  * Author : Hamid Ikdoumi (Atmel)
   7
   8  * SPDX-License-Identifier:     GPL-2.0+
   9  */
  10
  11 #include <common.h>
  12 #include <asm/io.h>
  13 #include <asm/arch/hardware.h>
  14 #include <asm/arch/at91_emac.h>
  15 #include <asm/arch/clk.h>
  16 #include <asm/arch/at91_pio.h>
  17 #include <net.h>
  18 #include <netdev.h>
  19 #include <malloc.h>
  20 #include <miiphy.h>
  21 #include <linux/mii.h>
  22
  23 #undef MII_DEBUG
  24 #undef ET_DEBUG
  25
  26 #if (CONFIG_SYS_RX_ETH_BUFFER > 1024)
  27 #error AT91 EMAC supports max 1024 RX buffers. \
  28         Please decrease the CONFIG_SYS_RX_ETH_BUFFER value
  29 #endif
  30
  31 #ifndef CONFIG_DRIVER_AT91EMAC_PHYADDR
  32 #define CONFIG_DRIVER_AT91EMAC_PHYADDR  0
  33 #endif
  34
  35 /* MDIO clock must not exceed 2.5 MHz, so enable MCK divider */
  36 #if (AT91C_MASTER_CLOCK > 80000000)
  37         #define HCLK_DIV        AT91_EMAC_CFG_MCLK_64
  38 #elif (AT91C_MASTER_CLOCK > 40000000)
  39         #define HCLK_DIV        AT91_EMAC_CFG_MCLK_32
  40 #elif (AT91C_MASTER_CLOCK > 20000000)
  41         #define HCLK_DIV        AT91_EMAC_CFG_MCLK_16
  42 #else
  43         #define HCLK_DIV        AT91_EMAC_CFG_MCLK_8
  44 #endif
  45
  46 #ifdef ET_DEBUG
  47 #define DEBUG_AT91EMAC  1
  48 #else
  49 #define DEBUG_AT91EMAC  0
  50 #endif
  51
  52 #ifdef MII_DEBUG
  53 #define DEBUG_AT91PHY   1
  54 #else
  55 #define DEBUG_AT91PHY   0
  56 #endif
  57
  58 #ifndef CONFIG_DRIVER_AT91EMAC_QUIET
  59 #define VERBOSEP        1
  60 #else
  61 #define VERBOSEP        0
  62 #endif
  63
  64 #define RBF_ADDR      0xfffffffc
  65 #define RBF_OWNER     (1<<0)
  66 #define RBF_WRAP      (1<<1)
  67 #define RBF_BROADCAST (1<<31)
  68 #define RBF_MULTICAST (1<<30)
  69 #define RBF_UNICAST   (1<<29)
  70 #define RBF_EXTERNAL  (1<<28)
  71 #define RBF_UNKNOWN   (1<<27)
  72 #define RBF_SIZE      0x07ff
  73 #define RBF_LOCAL4    (1<<26)
  74 #define RBF_LOCAL3    (1<<25)
  75 #define RBF_LOCAL2    (1<<24)
  76 #define RBF_LOCAL1    (1<<23)
  77
  78 #define RBF_FRAMEMAX CONFIG_SYS_RX_ETH_BUFFER
  79 #define RBF_FRAMELEN 0x600
  80
  81 typedef struct {
  82         unsigned long addr, size;
  83 } rbf_t;
  84
  85 typedef struct {
  86         rbf_t           rbfdt[RBF_FRAMEMAX];
  87         unsigned long   rbindex;
  88 } emac_device;
  89
  90 void at91emac_EnableMDIO(at91_emac_t *at91mac)
  91 {
  92         /* Mac CTRL reg set for MDIO enable */
  93         writel(readl(&at91mac->ctl) | AT91_EMAC_CTL_MPE, &at91mac->ctl);
  94 }
  95
  96 void at91emac_DisableMDIO(at91_emac_t *at91mac)
  97 {
  98         /* Mac CTRL reg set for MDIO disable */
  99         writel(readl(&at91mac->ctl) & ~AT91_EMAC_CTL_MPE, &at91mac->ctl);
 100 }
 101
 102 int  at91emac_read(at91_emac_t *at91mac, unsigned char addr,
 103                 unsigned char reg, unsigned short *value)
 104 {
 105         unsigned long netstat;
 106         at91emac_EnableMDIO(at91mac);
 107
 108         writel(AT91_EMAC_MAN_HIGH | AT91_EMAC_MAN_RW_R |
 109                 AT91_EMAC_MAN_REGA(reg) | AT91_EMAC_MAN_CODE_802_3 |
 110                 AT91_EMAC_MAN_PHYA(addr),
 111                 &at91mac->man);
 112
 113         do {
 114                 netstat = readl(&at91mac->sr);
 115                 debug_cond(DEBUG_AT91PHY, "poll SR %08lx\n", netstat);
 116         } while (!(netstat & AT91_EMAC_SR_IDLE));
 117
 118         *value = readl(&at91mac->man) & AT91_EMAC_MAN_DATA_MASK;
 119
 120         at91emac_DisableMDIO(at91mac);
 121
 122         debug_cond(DEBUG_AT91PHY,
 123                 "AT91PHY read %p REG(%d)=%x\n", at91mac, reg, *value);
 124
 125         return 0;
 126 }
 127
 128 int  at91emac_write(at91_emac_t *at91mac, unsigned char addr,
 129                 unsigned char reg, unsigned short value)
 130 {
 131         unsigned long netstat;
 132         debug_cond(DEBUG_AT91PHY,
 133                 "AT91PHY write %p REG(%d)=%p\n", at91mac, reg, &value);
 134
 135         at91emac_EnableMDIO(at91mac);
 136
 137         writel(AT91_EMAC_MAN_HIGH | AT91_EMAC_MAN_RW_W |
 138                 AT91_EMAC_MAN_REGA(reg) | AT91_EMAC_MAN_CODE_802_3 |
 139                 AT91_EMAC_MAN_PHYA(addr) | (value & AT91_EMAC_MAN_DATA_MASK),
 140                 &at91mac->man);
 141
 142         do {
 143                 netstat = readl(&at91mac->sr);
 144                 debug_cond(DEBUG_AT91PHY, "poll SR %08lx\n", netstat);
 145         } while (!(netstat & AT91_EMAC_SR_IDLE));
 146
 147         at91emac_DisableMDIO(at91mac);
 148
 149         return 0;
 150 }
 151
 152 #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
 153
 154 at91_emac_t *get_emacbase_by_name(const char *devname)
 155 {
 156         struct eth_device *netdev;
 157
 158         netdev = eth_get_dev_by_name(devname);
 159         return (at91_emac_t *) netdev->iobase;
 160 }
 161
 162 int at91emac_mii_read(struct mii_dev *bus, int addr, int devad, int reg)
 163 {
 164         unsigned short value = 0;
 165         at91_emac_t *emac;
 166
 167         emac = get_emacbase_by_name(bus->name);
 168         at91emac_read(emac , addr, reg, &value);
 169         return value;
 170 }
 171
 172
 173 int at91emac_mii_write(struct mii_dev *bus, int addr, int devad, int reg,
 174                        u16 value)
 175 {
 176         at91_emac_t *emac;
 177
 178         emac = get_emacbase_by_name(bus->name);
 179         at91emac_write(emac, addr, reg, value);
 180         return 0;
 181 }
 182
 183 #endif
 184
 185 static int at91emac_phy_reset(struct eth_device *netdev)
 186 {
 187         int i;
 188         u16 status, adv;
 189         at91_emac_t *emac;
 190
 191         emac = (at91_emac_t *) netdev->iobase;
 192
 193         adv = ADVERTISE_CSMA | ADVERTISE_ALL;
 194         at91emac_write(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
 195                 MII_ADVERTISE, adv);
 196         debug_cond(VERBOSEP, "%s: Starting autonegotiation...\n", netdev->name);
 197         at91emac_write(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR, MII_BMCR,
 198                 (BMCR_ANENABLE | BMCR_ANRESTART));
 199
 200         for (i = 0; i < 30000; i++) {
 201                 at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
 202                         MII_BMSR, &status);
 203                 if (status & BMSR_ANEGCOMPLETE)
 204                         break;
 205                 udelay(100);
 206         }
 207
 208         if (status & BMSR_ANEGCOMPLETE) {
 209                 debug_cond(VERBOSEP,
 210                         "%s: Autonegotiation complete\n", netdev->name);
 211         } else {
 212                 printf("%s: Autonegotiation timed out (status=0x%04x)\n",
 213                        netdev->name, status);
 214                 return -1;
 215         }
 216         return 0;
 217 }
 218
 219 static int at91emac_phy_init(struct eth_device *netdev)
 220 {
 221         u16 phy_id, status, adv, lpa;
 222         int media, speed, duplex;
 223         int i;
 224         at91_emac_t *emac;
 225
 226         emac = (at91_emac_t *) netdev->iobase;
 227
 228         /* Check if the PHY is up to snuff... */
 229         at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
 230                 MII_PHYSID1, &phy_id);
 231         if (phy_id == 0xffff) {
 232                 printf("%s: No PHY present\n", netdev->name);
 233                 return -1;
 234         }
 235
 236         at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
 237                 MII_BMSR, &status);
 238
 239         if (!(status & BMSR_LSTATUS)) {
 240                 /* Try to re-negotiate if we don't have link already. */
 241                 if (at91emac_phy_reset(netdev))
 242                         return -2;
 243
 244                 for (i = 0; i < 100000 / 100; i++) {
 245                         at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
 246                                 MII_BMSR, &status);
 247                         if (status & BMSR_LSTATUS)
 248                                 break;
 249                         udelay(100);
 250                 }
 251         }
 252         if (!(status & BMSR_LSTATUS)) {
 253                 debug_cond(VERBOSEP, "%s: link down\n", netdev->name);
 254                 return -3;
 255         } else {
 256                 at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
 257                         MII_ADVERTISE, &adv);
 258                 at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR,
 259                         MII_LPA, &lpa);
 260                 media = mii_nway_result(lpa & adv);
 261                 speed = (media & (ADVERTISE_100FULL | ADVERTISE_100HALF)
 262                          ? 1 : 0);
 263                 duplex = (media & ADVERTISE_FULL) ? 1 : 0;
 264                 debug_cond(VERBOSEP, "%s: link up, %sMbps %s-duplex\n",
 265                        netdev->name,
 266                        speed ? "100" : "10",
 267                        duplex ? "full" : "half");
 268         }
 269         return 0;
 270 }
 271
 272 int at91emac_UpdateLinkSpeed(at91_emac_t *emac)
 273 {
 274         unsigned short stat1;
 275
 276         at91emac_read(emac, CONFIG_DRIVER_AT91EMAC_PHYADDR, MII_BMSR, &stat1);
 277
 278         if (!(stat1 & BMSR_LSTATUS))    /* link status up? */
 279                 return -1;
 280
 281         if (stat1 & BMSR_100FULL) {
 282                 /*set Emac for 100BaseTX and Full Duplex  */
 283                 writel(readl(&emac->cfg) |
 284                         AT91_EMAC_CFG_SPD | AT91_EMAC_CFG_FD,
 285                         &emac->cfg);
 286                 return 0;
 287         }
 288
 289         if (stat1 & BMSR_10FULL) {
 290                 /*set MII for 10BaseT and Full Duplex  */
 291                 writel((readl(&emac->cfg) &
 292                         ~(AT91_EMAC_CFG_SPD | AT91_EMAC_CFG_FD)
 293                         ) | AT91_EMAC_CFG_FD,
 294                         &emac->cfg);
 295                 return 0;
 296         }
 297
 298         if (stat1 & BMSR_100HALF) {
 299                 /*set MII for 100BaseTX and Half Duplex  */
 300                 writel((readl(&emac->cfg) &
 301                         ~(AT91_EMAC_CFG_SPD | AT91_EMAC_CFG_FD)
 302                         ) | AT91_EMAC_CFG_SPD,
 303                         &emac->cfg);
 304                 return 0;
 305         }
 306
 307         if (stat1 & BMSR_10HALF) {
 308                 /*set MII for 10BaseT and Half Duplex  */
 309                 writel((readl(&emac->cfg) &
 310                         ~(AT91_EMAC_CFG_SPD | AT91_EMAC_CFG_FD)),
 311                         &emac->cfg);
 312                 return 0;
 313         }
 314         return 0;
 315 }
 316
 317 static int at91emac_init(struct eth_device *netdev, bd_t *bd)
 318 {
 319         int i;
 320         u32 value;
 321         emac_device *dev;
 322         at91_emac_t *emac;
 323         at91_pio_t *pio = (at91_pio_t *) ATMEL_BASE_PIO;
 324
 325         emac = (at91_emac_t *) netdev->iobase;
 326         dev = (emac_device *) netdev->priv;
 327
 328         /* PIO Disable Register */
 329         value = ATMEL_PMX_AA_EMDIO |    ATMEL_PMX_AA_EMDC |
 330                 ATMEL_PMX_AA_ERXER |    ATMEL_PMX_AA_ERX1 |
 331                 ATMEL_PMX_AA_ERX0 |     ATMEL_PMX_AA_ECRS |
 332                 ATMEL_PMX_AA_ETX1 |     ATMEL_PMX_AA_ETX0 |
 333                 ATMEL_PMX_AA_ETXEN |    ATMEL_PMX_AA_EREFCK;
 334
 335         writel(value, &pio->pioa.pdr);
 336         writel(value, &pio->pioa.mux.pio2.asr);
 337
 338 #ifdef CONFIG_RMII
 339         value = ATMEL_PMX_BA_ERXCK;
 340 #else
 341         value = ATMEL_PMX_BA_ERXCK |    ATMEL_PMX_BA_ECOL |
 342                 ATMEL_PMX_BA_ERXDV |    ATMEL_PMX_BA_ERX3 |
 343                 ATMEL_PMX_BA_ERX2 |     ATMEL_PMX_BA_ETXER |
 344                 ATMEL_PMX_BA_ETX3 |     ATMEL_PMX_BA_ETX2;
 345 #endif
 346         writel(value, &pio->piob.pdr);
 347         writel(value, &pio->piob.mux.pio2.bsr);
 348
 349         at91_periph_clk_enable(ATMEL_ID_EMAC);
 350
 351         writel(readl(&emac->ctl) | AT91_EMAC_CTL_CSR, &emac->ctl);
 352
 353         /* Init Ethernet buffers */
 354         for (i = 0; i < RBF_FRAMEMAX; i++) {
 355                 dev->rbfdt[i].addr = (unsigned long) net_rx_packets[i];
 356                 dev->rbfdt[i].size = 0;
 357         }
 358         dev->rbfdt[RBF_FRAMEMAX - 1].addr |= RBF_WRAP;
 359         dev->rbindex = 0;
 360         writel((u32) &(dev->rbfdt[0]), &emac->rbqp);
 361
 362         writel(readl(&emac->rsr) &
 363                 ~(AT91_EMAC_RSR_OVR | AT91_EMAC_RSR_REC | AT91_EMAC_RSR_BNA),
 364                 &emac->rsr);
 365
 366         value = AT91_EMAC_CFG_CAF |     AT91_EMAC_CFG_NBC |
 367                 HCLK_DIV;
 368 #ifdef CONFIG_RMII
 369         value |= AT91_EMAC_CFG_RMII;
 370 #endif
 371         writel(value, &emac->cfg);
 372
 373         writel(readl(&emac->ctl) | AT91_EMAC_CTL_TE | AT91_EMAC_CTL_RE,
 374                 &emac->ctl);
 375
 376         if (!at91emac_phy_init(netdev)) {
 377                 at91emac_UpdateLinkSpeed(emac);
 378                 return 0;
 379         }
 380         return -1;
 381 }
 382
 383 static void at91emac_halt(struct eth_device *netdev)
 384 {
 385         at91_emac_t *emac;
 386
 387         emac = (at91_emac_t *) netdev->iobase;
 388         writel(readl(&emac->ctl) & ~(AT91_EMAC_CTL_TE | AT91_EMAC_CTL_RE),
 389                 &emac->ctl);
 390         debug_cond(DEBUG_AT91EMAC, "halt MAC\n");
 391 }
 392
 393 static int at91emac_send(struct eth_device *netdev, void *packet, int length)
 394 {
 395         at91_emac_t *emac;
 396
 397         emac = (at91_emac_t *) netdev->iobase;
 398
 399         while (!(readl(&emac->tsr) & AT91_EMAC_TSR_BNQ))
 400                 ;
 401         writel((u32) packet, &emac->tar);
 402         writel(AT91_EMAC_TCR_LEN(length), &emac->tcr);
 403         while (AT91_EMAC_TCR_LEN(readl(&emac->tcr)))
 404                 ;
 405         debug_cond(DEBUG_AT91EMAC, "Send %d\n", length);
 406         writel(readl(&emac->tsr) | AT91_EMAC_TSR_COMP, &emac->tsr);
 407         return 0;
 408 }
 409
 410 static int at91emac_recv(struct eth_device *netdev)
 411 {
 412         emac_device *dev;
 413         at91_emac_t *emac;
 414         rbf_t *rbfp;
 415         int size;
 416
 417         emac = (at91_emac_t *) netdev->iobase;
 418         dev = (emac_device *) netdev->priv;
 419
 420         rbfp = &dev->rbfdt[dev->rbindex];
 421         while (rbfp->addr & RBF_OWNER)  {
 422                 size = rbfp->size & RBF_SIZE;
 423                 net_process_received_packet(net_rx_packets[dev->rbindex], size);
 424
 425                 debug_cond(DEBUG_AT91EMAC, "Recv[%ld]: %d bytes @ %lx\n",
 426                         dev->rbindex, size, rbfp->addr);
 427
 428                 rbfp->addr &= ~RBF_OWNER;
 429                 rbfp->size = 0;
 430                 if (dev->rbindex < (RBF_FRAMEMAX-1))
 431                         dev->rbindex++;
 432                 else
 433                         dev->rbindex = 0;
 434
 435                 rbfp = &(dev->rbfdt[dev->rbindex]);
 436                 if (!(rbfp->addr & RBF_OWNER))
 437                         writel(readl(&emac->rsr) | AT91_EMAC_RSR_REC,
 438                                 &emac->rsr);
 439         }
 440
 441         if (readl(&emac->isr) & AT91_EMAC_IxR_RBNA) {
 442                 /* EMAC silicon bug 41.3.1 workaround 1 */
 443                 writel(readl(&emac->ctl) & ~AT91_EMAC_CTL_RE, &emac->ctl);
 444                 writel(readl(&emac->ctl) | AT91_EMAC_CTL_RE, &emac->ctl);
 445                 dev->rbindex = 0;
 446                 printf("%s: reset receiver (EMAC dead lock bug)\n",
 447                         netdev->name);
 448         }
 449         return 0;
 450 }
 451
 452 static int at91emac_write_hwaddr(struct eth_device *netdev)
 453 {
 454         at91_emac_t *emac;
 455         emac = (at91_emac_t *) netdev->iobase;
 456
 457         at91_periph_clk_enable(ATMEL_ID_EMAC);
 458
 459         debug_cond(DEBUG_AT91EMAC,
 460                 "init MAC-ADDR %02x:%02x:%02x:%02x:%02x:%02x\n",
 461                 netdev->enetaddr[5], netdev->enetaddr[4], netdev->enetaddr[3],
 462                 netdev->enetaddr[2], netdev->enetaddr[1], netdev->enetaddr[0]);
 463         writel( (netdev->enetaddr[0] | netdev->enetaddr[1] << 8 |
 464                         netdev->enetaddr[2] << 16 | netdev->enetaddr[3] << 24),
 465                         &emac->sa2l);
 466         writel((netdev->enetaddr[4] | netdev->enetaddr[5] << 8), &emac->sa2h);
 467         debug_cond(DEBUG_AT91EMAC, "init MAC-ADDR %x%x\n",
 468                 readl(&emac->sa2h), readl(&emac->sa2l));
 469         return 0;
 470 }
 471
 472 int at91emac_register(bd_t *bis, unsigned long iobase)
 473 {
 474         emac_device *emac;
 475         emac_device *emacfix;
 476         struct eth_device *dev;
 477
 478         if (iobase == 0)
 479                 iobase = ATMEL_BASE_EMAC;
 480         emac = malloc(sizeof(*emac)+512);
 481         if (emac == NULL)
 482                 return -1;
 483         dev = malloc(sizeof(*dev));
 484         if (dev == NULL) {
 485                 free(emac);
 486                 return -1;
 487         }
 488         /* alignment as per Errata (64 bytes) is insufficient! */
 489         emacfix = (emac_device *) (((unsigned long) emac + 0x1ff) & 0xFFFFFE00);
 490         memset(emacfix, 0, sizeof(emac_device));
 491
 492         memset(dev, 0, sizeof(*dev));
 493         strcpy(dev->name, "emac");
 494         dev->iobase = iobase;
 495         dev->priv = emacfix;
 496         dev->init = at91emac_init;
 497         dev->halt = at91emac_halt;
 498         dev->send = at91emac_send;
 499         dev->recv = at91emac_recv;
 500         dev->write_hwaddr = at91emac_write_hwaddr;
 501
 502         eth_register(dev);
 503
 504 #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
 505         int retval;
 506         struct mii_dev *mdiodev = mdio_alloc();
 507         if (!mdiodev)
 508                 return -ENOMEM;
 509         strncpy(mdiodev->name, dev->name, MDIO_NAME_LEN);
 510         mdiodev->read = at91emac_mii_read;
 511         mdiodev->write = at91emac_mii_write;
 512
 513         retval = mdio_register(mdiodev);
 514         if (retval < 0)
 515                 return retval;
 516 #endif
 517         return 1;
 518 }