uboot/drivers/net/tsec.c
<<
>>
Prefs
   1/*
   2 * Freescale Three Speed Ethernet Controller driver
   3 *
   4 * This software may be used and distributed according to the
   5 * terms of the GNU Public License, Version 2, incorporated
   6 * herein by reference.
   7 *
   8 * Copyright 2004-2011 Freescale Semiconductor, Inc.
   9 * (C) Copyright 2003, Motorola, Inc.
  10 * author Andy Fleming
  11 *
  12 */
  13
  14#include <config.h>
  15#include <common.h>
  16#include <malloc.h>
  17#include <net.h>
  18#include <command.h>
  19#include <tsec.h>
  20#include <fsl_mdio.h>
  21#include <asm/errno.h>
  22#include <asm/processor.h>
  23
  24DECLARE_GLOBAL_DATA_PTR;
  25
  26#define TX_BUF_CNT              2
  27
  28static uint rxIdx;              /* index of the current RX buffer */
  29static uint txIdx;              /* index of the current TX buffer */
  30
  31typedef volatile struct rtxbd {
  32        txbd8_t txbd[TX_BUF_CNT];
  33        rxbd8_t rxbd[PKTBUFSRX];
  34} RTXBD;
  35
  36#define MAXCONTROLLERS  (8)
  37
  38static struct tsec_private *privlist[MAXCONTROLLERS];
  39static int num_tsecs = 0;
  40
  41#ifdef __GNUC__
  42static RTXBD rtx __attribute__ ((aligned(8)));
  43#else
  44#error "rtx must be 64-bit aligned"
  45#endif
  46
  47static int tsec_send(struct eth_device *dev,
  48        volatile void *packet, int length);
  49
  50/* Default initializations for TSEC controllers. */
  51
  52static struct tsec_info_struct tsec_info[] = {
  53#ifdef CONFIG_TSEC1
  54        STD_TSEC_INFO(1),       /* TSEC1 */
  55#endif
  56#ifdef CONFIG_TSEC2
  57        STD_TSEC_INFO(2),       /* TSEC2 */
  58#endif
  59#ifdef CONFIG_MPC85XX_FEC
  60        {
  61                .regs = (tsec_t *)(TSEC_BASE_ADDR + 0x2000),
  62                .devname = CONFIG_MPC85XX_FEC_NAME,
  63                .phyaddr = FEC_PHY_ADDR,
  64                .flags = FEC_FLAGS,
  65                .mii_devname = DEFAULT_MII_NAME
  66        },                      /* FEC */
  67#endif
  68#ifdef CONFIG_TSEC3
  69        STD_TSEC_INFO(3),       /* TSEC3 */
  70#endif
  71#ifdef CONFIG_TSEC4
  72        STD_TSEC_INFO(4),       /* TSEC4 */
  73#endif
  74};
  75
  76#define TBIANA_SETTINGS ( \
  77                TBIANA_ASYMMETRIC_PAUSE \
  78                | TBIANA_SYMMETRIC_PAUSE \
  79                | TBIANA_FULL_DUPLEX \
  80                )
  81
  82/* By default force the TBI PHY into 1000Mbps full duplex when in SGMII mode */
  83#ifndef CONFIG_TSEC_TBICR_SETTINGS
  84#define CONFIG_TSEC_TBICR_SETTINGS ( \
  85                TBICR_PHY_RESET \
  86                | TBICR_ANEG_ENABLE \
  87                | TBICR_FULL_DUPLEX \
  88                | TBICR_SPEED1_SET \
  89                )
  90#endif /* CONFIG_TSEC_TBICR_SETTINGS */
  91
  92/* Configure the TBI for SGMII operation */
  93static void tsec_configure_serdes(struct tsec_private *priv)
  94{
  95        /* Access TBI PHY registers at given TSEC register offset as opposed
  96         * to the register offset used for external PHY accesses */
  97        tsec_local_mdio_write(priv->phyregs_sgmii, in_be32(&priv->regs->tbipa),
  98                        0, TBI_ANA, TBIANA_SETTINGS);
  99        tsec_local_mdio_write(priv->phyregs_sgmii, in_be32(&priv->regs->tbipa),
 100                        0, TBI_TBICON, TBICON_CLK_SELECT);
 101        tsec_local_mdio_write(priv->phyregs_sgmii, in_be32(&priv->regs->tbipa),
 102                        0, TBI_CR, CONFIG_TSEC_TBICR_SETTINGS);
 103}
 104
 105#ifdef CONFIG_MCAST_TFTP
 106
 107/* CREDITS: linux gianfar driver, slightly adjusted... thanx. */
 108
 109/* Set the appropriate hash bit for the given addr */
 110
 111/* The algorithm works like so:
 112 * 1) Take the Destination Address (ie the multicast address), and
 113 * do a CRC on it (little endian), and reverse the bits of the
 114 * result.
 115 * 2) Use the 8 most significant bits as a hash into a 256-entry
 116 * table.  The table is controlled through 8 32-bit registers:
 117 * gaddr0-7.  gaddr0's MSB is entry 0, and gaddr7's LSB is
 118 * gaddr7.  This means that the 3 most significant bits in the
 119 * hash index which gaddr register to use, and the 5 other bits
 120 * indicate which bit (assuming an IBM numbering scheme, which
 121 * for PowerPC (tm) is usually the case) in the tregister holds
 122 * the entry. */
 123static int
 124tsec_mcast_addr (struct eth_device *dev, u8 mcast_mac, u8 set)
 125{
 126        struct tsec_private *priv = privlist[1];
 127        volatile tsec_t *regs = priv->regs;
 128        volatile u32  *reg_array, value;
 129        u8 result, whichbit, whichreg;
 130
 131        result = (u8)((ether_crc(MAC_ADDR_LEN,mcast_mac) >> 24) & 0xff);
 132        whichbit = result & 0x1f;       /* the 5 LSB = which bit to set */
 133        whichreg = result >> 5;         /* the 3 MSB = which reg to set it in */
 134        value = (1 << (31-whichbit));
 135
 136        reg_array = &(regs->hash.gaddr0);
 137
 138        if (set) {
 139                reg_array[whichreg] |= value;
 140        } else {
 141                reg_array[whichreg] &= ~value;
 142        }
 143        return 0;
 144}
 145#endif /* Multicast TFTP ? */
 146
 147/* Initialized required registers to appropriate values, zeroing
 148 * those we don't care about (unless zero is bad, in which case,
 149 * choose a more appropriate value)
 150 */
 151static void init_registers(tsec_t *regs)
 152{
 153        /* Clear IEVENT */
 154        out_be32(&regs->ievent, IEVENT_INIT_CLEAR);
 155
 156        out_be32(&regs->imask, IMASK_INIT_CLEAR);
 157
 158        out_be32(&regs->hash.iaddr0, 0);
 159        out_be32(&regs->hash.iaddr1, 0);
 160        out_be32(&regs->hash.iaddr2, 0);
 161        out_be32(&regs->hash.iaddr3, 0);
 162        out_be32(&regs->hash.iaddr4, 0);
 163        out_be32(&regs->hash.iaddr5, 0);
 164        out_be32(&regs->hash.iaddr6, 0);
 165        out_be32(&regs->hash.iaddr7, 0);
 166
 167        out_be32(&regs->hash.gaddr0, 0);
 168        out_be32(&regs->hash.gaddr1, 0);
 169        out_be32(&regs->hash.gaddr2, 0);
 170        out_be32(&regs->hash.gaddr3, 0);
 171        out_be32(&regs->hash.gaddr4, 0);
 172        out_be32(&regs->hash.gaddr5, 0);
 173        out_be32(&regs->hash.gaddr6, 0);
 174        out_be32(&regs->hash.gaddr7, 0);
 175
 176        out_be32(&regs->rctrl, 0x00000000);
 177
 178        /* Init RMON mib registers */
 179        memset((void *)&(regs->rmon), 0, sizeof(rmon_mib_t));
 180
 181        out_be32(&regs->rmon.cam1, 0xffffffff);
 182        out_be32(&regs->rmon.cam2, 0xffffffff);
 183
 184        out_be32(&regs->mrblr, MRBLR_INIT_SETTINGS);
 185
 186        out_be32(&regs->minflr, MINFLR_INIT_SETTINGS);
 187
 188        out_be32(&regs->attr, ATTR_INIT_SETTINGS);
 189        out_be32(&regs->attreli, ATTRELI_INIT_SETTINGS);
 190
 191}
 192
 193/* Configure maccfg2 based on negotiated speed and duplex
 194 * reported by PHY handling code
 195 */
 196static void adjust_link(struct tsec_private *priv, struct phy_device *phydev)
 197{
 198        tsec_t *regs = priv->regs;
 199        u32 ecntrl, maccfg2;
 200
 201        if (!phydev->link) {
 202                printf("%s: No link.\n", phydev->dev->name);
 203                return;
 204        }
 205
 206        /* clear all bits relative with interface mode */
 207        ecntrl = in_be32(&regs->ecntrl);
 208        ecntrl &= ~ECNTRL_R100;
 209
 210        maccfg2 = in_be32(&regs->maccfg2);
 211        maccfg2 &= ~(MACCFG2_IF | MACCFG2_FULL_DUPLEX);
 212
 213        if (phydev->duplex)
 214                maccfg2 |= MACCFG2_FULL_DUPLEX;
 215
 216        switch (phydev->speed) {
 217        case 1000:
 218                maccfg2 |= MACCFG2_GMII;
 219                break;
 220        case 100:
 221        case 10:
 222                maccfg2 |= MACCFG2_MII;
 223
 224                /* Set R100 bit in all modes although
 225                 * it is only used in RGMII mode
 226                 */
 227                if (phydev->speed == 100)
 228                        ecntrl |= ECNTRL_R100;
 229                break;
 230        default:
 231                printf("%s: Speed was bad\n", phydev->dev->name);
 232                break;
 233        }
 234
 235        out_be32(&regs->ecntrl, ecntrl);
 236        out_be32(&regs->maccfg2, maccfg2);
 237
 238        printf("Speed: %d, %s duplex%s\n", phydev->speed,
 239                        (phydev->duplex) ? "full" : "half",
 240                        (phydev->port == PORT_FIBRE) ? ", fiber mode" : "");
 241}
 242
 243#ifdef CONFIG_SYS_FSL_ERRATUM_NMG_ETSEC129
 244/*
 245 * When MACCFG1[Rx_EN] is enabled during system boot as part
 246 * of the eTSEC port initialization sequence,
 247 * the eTSEC Rx logic may not be properly initialized.
 248 */
 249void redundant_init(struct eth_device *dev)
 250{
 251        struct tsec_private *priv = dev->priv;
 252        tsec_t *regs = priv->regs;
 253        uint t, count = 0;
 254        int fail = 1;
 255        static const u8 pkt[] = {
 256                0x00, 0x1e, 0x4f, 0x12, 0xcb, 0x2c, 0x00, 0x25,
 257                0x64, 0xbb, 0xd1, 0xab, 0x08, 0x00, 0x45, 0x00,
 258                0x00, 0x5c, 0xdd, 0x22, 0x00, 0x00, 0x80, 0x01,
 259                0x1f, 0x71, 0x0a, 0xc1, 0x14, 0x22, 0x0a, 0xc1,
 260                0x14, 0x6a, 0x08, 0x00, 0xef, 0x7e, 0x02, 0x00,
 261                0x94, 0x05, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66,
 262                0x67, 0x68, 0x69, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e,
 263                0x6f, 0x70, 0x71, 0x72, 0x73, 0x74, 0x75, 0x76,
 264                0x77, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67,
 265                0x68, 0x69, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e, 0x6f,
 266                0x70, 0x71, 0x72, 0x73, 0x74, 0x75, 0x76, 0x77,
 267                0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68,
 268                0x69, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e, 0x6f, 0x70,
 269                0x71, 0x72};
 270
 271        /* Enable promiscuous mode */
 272        setbits_be32(&regs->rctrl, 0x8);
 273        /* Enable loopback mode */
 274        setbits_be32(&regs->maccfg1, MACCFG1_LOOPBACK);
 275        /* Enable transmit and receive */
 276        setbits_be32(&regs->maccfg1, MACCFG1_RX_EN | MACCFG1_TX_EN);
 277
 278        /* Tell the DMA it is clear to go */
 279        setbits_be32(&regs->dmactrl, DMACTRL_INIT_SETTINGS);
 280        out_be32(&regs->tstat, TSTAT_CLEAR_THALT);
 281        out_be32(&regs->rstat, RSTAT_CLEAR_RHALT);
 282        clrbits_be32(&regs->dmactrl, DMACTRL_GRS | DMACTRL_GTS);
 283
 284        do {
 285                tsec_send(dev, (void *)pkt, sizeof(pkt));
 286
 287                /* Wait for buffer to be received */
 288                for (t = 0; rtx.rxbd[rxIdx].status & RXBD_EMPTY; t++) {
 289                        if (t >= 10 * TOUT_LOOP) {
 290                                printf("%s: tsec: rx error\n", dev->name);
 291                                break;
 292                        }
 293                }
 294
 295                if (!memcmp(pkt, (void *)NetRxPackets[rxIdx], sizeof(pkt)))
 296                        fail = 0;
 297
 298                rtx.rxbd[rxIdx].length = 0;
 299                rtx.rxbd[rxIdx].status =
 300                    RXBD_EMPTY | (((rxIdx + 1) == PKTBUFSRX) ? RXBD_WRAP : 0);
 301                rxIdx = (rxIdx + 1) % PKTBUFSRX;
 302
 303                if (in_be32(&regs->ievent) & IEVENT_BSY) {
 304                        out_be32(&regs->ievent, IEVENT_BSY);
 305                        out_be32(&regs->rstat, RSTAT_CLEAR_RHALT);
 306                }
 307                if (fail) {
 308                        printf("loopback recv packet error!\n");
 309                        clrbits_be32(&regs->maccfg1, MACCFG1_RX_EN);
 310                        udelay(1000);
 311                        setbits_be32(&regs->maccfg1, MACCFG1_RX_EN);
 312                }
 313        } while ((count++ < 4) && (fail == 1));
 314
 315        if (fail)
 316                panic("eTSEC init fail!\n");
 317        /* Disable promiscuous mode */
 318        clrbits_be32(&regs->rctrl, 0x8);
 319        /* Disable loopback mode */
 320        clrbits_be32(&regs->maccfg1, MACCFG1_LOOPBACK);
 321}
 322#endif
 323
 324/* Set up the buffers and their descriptors, and bring up the
 325 * interface
 326 */
 327static void startup_tsec(struct eth_device *dev)
 328{
 329        int i;
 330        struct tsec_private *priv = (struct tsec_private *)dev->priv;
 331        tsec_t *regs = priv->regs;
 332
 333        /* reset the indices to zero */
 334        rxIdx = 0;
 335        txIdx = 0;
 336#ifdef CONFIG_SYS_FSL_ERRATUM_NMG_ETSEC129
 337        uint svr;
 338#endif
 339
 340        /* Point to the buffer descriptors */
 341        out_be32(&regs->tbase, (unsigned int)(&rtx.txbd[txIdx]));
 342        out_be32(&regs->rbase, (unsigned int)(&rtx.rxbd[rxIdx]));
 343
 344        /* Initialize the Rx Buffer descriptors */
 345        for (i = 0; i < PKTBUFSRX; i++) {
 346                rtx.rxbd[i].status = RXBD_EMPTY;
 347                rtx.rxbd[i].length = 0;
 348                rtx.rxbd[i].bufPtr = (uint) NetRxPackets[i];
 349        }
 350        rtx.rxbd[PKTBUFSRX - 1].status |= RXBD_WRAP;
 351
 352        /* Initialize the TX Buffer Descriptors */
 353        for (i = 0; i < TX_BUF_CNT; i++) {
 354                rtx.txbd[i].status = 0;
 355                rtx.txbd[i].length = 0;
 356                rtx.txbd[i].bufPtr = 0;
 357        }
 358        rtx.txbd[TX_BUF_CNT - 1].status |= TXBD_WRAP;
 359
 360#ifdef CONFIG_SYS_FSL_ERRATUM_NMG_ETSEC129
 361        svr = get_svr();
 362        if ((SVR_MAJ(svr) == 1) || IS_SVR_REV(svr, 2, 0))
 363                redundant_init(dev);
 364#endif
 365        /* Enable Transmit and Receive */
 366        setbits_be32(&regs->maccfg1, MACCFG1_RX_EN | MACCFG1_TX_EN);
 367
 368        /* Tell the DMA it is clear to go */
 369        setbits_be32(&regs->dmactrl, DMACTRL_INIT_SETTINGS);
 370        out_be32(&regs->tstat, TSTAT_CLEAR_THALT);
 371        out_be32(&regs->rstat, RSTAT_CLEAR_RHALT);
 372        clrbits_be32(&regs->dmactrl, DMACTRL_GRS | DMACTRL_GTS);
 373}
 374
 375/* This returns the status bits of the device.  The return value
 376 * is never checked, and this is what the 8260 driver did, so we
 377 * do the same.  Presumably, this would be zero if there were no
 378 * errors
 379 */
 380static int tsec_send(struct eth_device *dev, volatile void *packet, int length)
 381{
 382        int i;
 383        int result = 0;
 384        struct tsec_private *priv = (struct tsec_private *)dev->priv;
 385        tsec_t *regs = priv->regs;
 386
 387        /* Find an empty buffer descriptor */
 388        for (i = 0; rtx.txbd[txIdx].status & TXBD_READY; i++) {
 389                if (i >= TOUT_LOOP) {
 390                        debug("%s: tsec: tx buffers full\n", dev->name);
 391                        return result;
 392                }
 393        }
 394
 395        rtx.txbd[txIdx].bufPtr = (uint) packet;
 396        rtx.txbd[txIdx].length = length;
 397        rtx.txbd[txIdx].status |=
 398            (TXBD_READY | TXBD_LAST | TXBD_CRC | TXBD_INTERRUPT);
 399
 400        /* Tell the DMA to go */
 401        out_be32(&regs->tstat, TSTAT_CLEAR_THALT);
 402
 403        /* Wait for buffer to be transmitted */
 404        for (i = 0; rtx.txbd[txIdx].status & TXBD_READY; i++) {
 405                if (i >= TOUT_LOOP) {
 406                        debug("%s: tsec: tx error\n", dev->name);
 407                        return result;
 408                }
 409        }
 410
 411        txIdx = (txIdx + 1) % TX_BUF_CNT;
 412        result = rtx.txbd[txIdx].status & TXBD_STATS;
 413
 414        return result;
 415}
 416
 417static int tsec_recv(struct eth_device *dev)
 418{
 419        int length;
 420        struct tsec_private *priv = (struct tsec_private *)dev->priv;
 421        tsec_t *regs = priv->regs;
 422
 423        while (!(rtx.rxbd[rxIdx].status & RXBD_EMPTY)) {
 424
 425                length = rtx.rxbd[rxIdx].length;
 426
 427                /* Send the packet up if there were no errors */
 428                if (!(rtx.rxbd[rxIdx].status & RXBD_STATS)) {
 429                        NetReceive(NetRxPackets[rxIdx], length - 4);
 430                } else {
 431                        printf("Got error %x\n",
 432                               (rtx.rxbd[rxIdx].status & RXBD_STATS));
 433                }
 434
 435                rtx.rxbd[rxIdx].length = 0;
 436
 437                /* Set the wrap bit if this is the last element in the list */
 438                rtx.rxbd[rxIdx].status =
 439                    RXBD_EMPTY | (((rxIdx + 1) == PKTBUFSRX) ? RXBD_WRAP : 0);
 440
 441                rxIdx = (rxIdx + 1) % PKTBUFSRX;
 442        }
 443
 444        if (in_be32(&regs->ievent) & IEVENT_BSY) {
 445                out_be32(&regs->ievent, IEVENT_BSY);
 446                out_be32(&regs->rstat, RSTAT_CLEAR_RHALT);
 447        }
 448
 449        return -1;
 450
 451}
 452
 453/* Stop the interface */
 454static void tsec_halt(struct eth_device *dev)
 455{
 456        struct tsec_private *priv = (struct tsec_private *)dev->priv;
 457        tsec_t *regs = priv->regs;
 458
 459        clrbits_be32(&regs->dmactrl, DMACTRL_GRS | DMACTRL_GTS);
 460        setbits_be32(&regs->dmactrl, DMACTRL_GRS | DMACTRL_GTS);
 461
 462        while ((in_be32(&regs->ievent) & (IEVENT_GRSC | IEVENT_GTSC))
 463                        != (IEVENT_GRSC | IEVENT_GTSC))
 464                ;
 465
 466        clrbits_be32(&regs->maccfg1, MACCFG1_TX_EN | MACCFG1_RX_EN);
 467
 468        /* Shut down the PHY, as needed */
 469        phy_shutdown(priv->phydev);
 470}
 471
 472/* Initializes data structures and registers for the controller,
 473 * and brings the interface up.  Returns the link status, meaning
 474 * that it returns success if the link is up, failure otherwise.
 475 * This allows u-boot to find the first active controller.
 476 */
 477static int tsec_init(struct eth_device *dev, bd_t * bd)
 478{
 479        uint tempval;
 480        char tmpbuf[MAC_ADDR_LEN];
 481        int i;
 482        struct tsec_private *priv = (struct tsec_private *)dev->priv;
 483        tsec_t *regs = priv->regs;
 484
 485        /* Make sure the controller is stopped */
 486        tsec_halt(dev);
 487
 488        /* Init MACCFG2.  Defaults to GMII */
 489        out_be32(&regs->maccfg2, MACCFG2_INIT_SETTINGS);
 490
 491        /* Init ECNTRL */
 492        out_be32(&regs->ecntrl, ECNTRL_INIT_SETTINGS);
 493
 494        /* Copy the station address into the address registers.
 495         * Backwards, because little endian MACS are dumb */
 496        for (i = 0; i < MAC_ADDR_LEN; i++)
 497                tmpbuf[MAC_ADDR_LEN - 1 - i] = dev->enetaddr[i];
 498
 499        tempval = (tmpbuf[0] << 24) | (tmpbuf[1] << 16) | (tmpbuf[2] << 8) |
 500                  tmpbuf[3];
 501
 502        out_be32(&regs->macstnaddr1, tempval);
 503
 504        tempval = *((uint *) (tmpbuf + 4));
 505
 506        out_be32(&regs->macstnaddr2, tempval);
 507
 508        /* Clear out (for the most part) the other registers */
 509        init_registers(regs);
 510
 511        /* Ready the device for tx/rx */
 512        startup_tsec(dev);
 513
 514        /* Start up the PHY */
 515        phy_startup(priv->phydev);
 516
 517        adjust_link(priv, priv->phydev);
 518
 519        /* If there's no link, fail */
 520        return priv->phydev->link ? 0 : -1;
 521}
 522
 523static phy_interface_t tsec_get_interface(struct tsec_private *priv)
 524{
 525        tsec_t *regs = priv->regs;
 526        u32 ecntrl;
 527
 528        ecntrl = in_be32(&regs->ecntrl);
 529
 530        if (ecntrl & ECNTRL_SGMII_MODE)
 531                return PHY_INTERFACE_MODE_SGMII;
 532
 533        if (ecntrl & ECNTRL_TBI_MODE) {
 534                if (ecntrl & ECNTRL_REDUCED_MODE)
 535                        return PHY_INTERFACE_MODE_RTBI;
 536                else
 537                        return PHY_INTERFACE_MODE_TBI;
 538        }
 539
 540        if (ecntrl & ECNTRL_REDUCED_MODE) {
 541                if (ecntrl & ECNTRL_REDUCED_MII_MODE)
 542                        return PHY_INTERFACE_MODE_RMII;
 543                else {
 544                        phy_interface_t interface = priv->interface;
 545
 546                        /*
 547                         * This isn't autodetected, so it must
 548                         * be set by the platform code.
 549                         */
 550                        if ((interface == PHY_INTERFACE_MODE_RGMII_ID) ||
 551                                 (interface == PHY_INTERFACE_MODE_RGMII_TXID) ||
 552                                 (interface == PHY_INTERFACE_MODE_RGMII_RXID))
 553                                return interface;
 554
 555                        return PHY_INTERFACE_MODE_RGMII;
 556                }
 557        }
 558
 559        if (priv->flags & TSEC_GIGABIT)
 560                return PHY_INTERFACE_MODE_GMII;
 561
 562        return PHY_INTERFACE_MODE_MII;
 563}
 564
 565
 566/* Discover which PHY is attached to the device, and configure it
 567 * properly.  If the PHY is not recognized, then return 0
 568 * (failure).  Otherwise, return 1
 569 */
 570static int init_phy(struct eth_device *dev)
 571{
 572        struct tsec_private *priv = (struct tsec_private *)dev->priv;
 573        struct phy_device *phydev;
 574        tsec_t *regs = priv->regs;
 575        u32 supported = (SUPPORTED_10baseT_Half |
 576                        SUPPORTED_10baseT_Full |
 577                        SUPPORTED_100baseT_Half |
 578                        SUPPORTED_100baseT_Full);
 579
 580        if (priv->flags & TSEC_GIGABIT)
 581                supported |= SUPPORTED_1000baseT_Full;
 582
 583        /* Assign a Physical address to the TBI */
 584        out_be32(&regs->tbipa, CONFIG_SYS_TBIPA_VALUE);
 585
 586        priv->interface = tsec_get_interface(priv);
 587
 588        if (priv->interface == PHY_INTERFACE_MODE_SGMII)
 589                tsec_configure_serdes(priv);
 590
 591        phydev = phy_connect(priv->bus, priv->phyaddr, dev, priv->interface);
 592
 593        phydev->supported &= supported;
 594        phydev->advertising = phydev->supported;
 595
 596        priv->phydev = phydev;
 597
 598        phy_config(phydev);
 599
 600        return 1;
 601}
 602
 603/* Initialize device structure. Returns success if PHY
 604 * initialization succeeded (i.e. if it recognizes the PHY)
 605 */
 606static int tsec_initialize(bd_t *bis, struct tsec_info_struct *tsec_info)
 607{
 608        struct eth_device *dev;
 609        int i;
 610        struct tsec_private *priv;
 611
 612        dev = (struct eth_device *)malloc(sizeof *dev);
 613
 614        if (NULL == dev)
 615                return 0;
 616
 617        memset(dev, 0, sizeof *dev);
 618
 619        priv = (struct tsec_private *)malloc(sizeof(*priv));
 620
 621        if (NULL == priv)
 622                return 0;
 623
 624        privlist[num_tsecs++] = priv;
 625        priv->regs = tsec_info->regs;
 626        priv->phyregs_sgmii = tsec_info->miiregs_sgmii;
 627
 628        priv->phyaddr = tsec_info->phyaddr;
 629        priv->flags = tsec_info->flags;
 630
 631        sprintf(dev->name, tsec_info->devname);
 632        priv->interface = tsec_info->interface;
 633        priv->bus = miiphy_get_dev_by_name(tsec_info->mii_devname);
 634        dev->iobase = 0;
 635        dev->priv = priv;
 636        dev->init = tsec_init;
 637        dev->halt = tsec_halt;
 638        dev->send = tsec_send;
 639        dev->recv = tsec_recv;
 640#ifdef CONFIG_MCAST_TFTP
 641        dev->mcast = tsec_mcast_addr;
 642#endif
 643
 644        /* Tell u-boot to get the addr from the env */
 645        for (i = 0; i < 6; i++)
 646                dev->enetaddr[i] = 0;
 647
 648        eth_register(dev);
 649
 650        /* Reset the MAC */
 651        setbits_be32(&priv->regs->maccfg1, MACCFG1_SOFT_RESET);
 652        udelay(2);  /* Soft Reset must be asserted for 3 TX clocks */
 653        clrbits_be32(&priv->regs->maccfg1, MACCFG1_SOFT_RESET);
 654
 655        /* Try to initialize PHY here, and return */
 656        return init_phy(dev);
 657}
 658
 659/*
 660 * Initialize all the TSEC devices
 661 *
 662 * Returns the number of TSEC devices that were initialized
 663 */
 664int tsec_eth_init(bd_t *bis, struct tsec_info_struct *tsecs, int num)
 665{
 666        int i;
 667        int ret, count = 0;
 668
 669        for (i = 0; i < num; i++) {
 670                ret = tsec_initialize(bis, &tsecs[i]);
 671                if (ret > 0)
 672                        count += ret;
 673        }
 674
 675        return count;
 676}
 677
 678int tsec_standard_init(bd_t *bis)
 679{
 680        struct fsl_pq_mdio_info info;
 681
 682        info.regs = (struct tsec_mii_mng *)CONFIG_SYS_MDIO_BASE_ADDR;
 683        info.name = DEFAULT_MII_NAME;
 684
 685        fsl_pq_mdio_init(bis, &info);
 686
 687        return tsec_eth_init(bis, tsec_info, ARRAY_SIZE(tsec_info));
 688}
 689