drivers/net/mpc8xx_fec.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2000
   4  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   5  */
   6
   7 #include <common.h>
   8 #include <command.h>
   9 #include <malloc.h>
  10 #include <net.h>
  11 #include <netdev.h>
  12 #include <asm/cpm_8xx.h>
  13 #include <asm/io.h>
  14
  15 #include <phy.h>
  16
  17 DECLARE_GLOBAL_DATA_PTR;
  18
  19 /* define WANT_MII when MII support is required */
  20 #if defined(CONFIG_SYS_DISCOVER_PHY) || defined(CONFIG_FEC1_PHY) || defined(CONFIG_FEC2_PHY)
  21 #define WANT_MII
  22 #else
  23 #undef WANT_MII
  24 #endif
  25
  26 #if defined(WANT_MII)
  27 #include <miiphy.h>
  28
  29 #if !(defined(CONFIG_MII) || defined(CONFIG_CMD_MII))
  30 #error "CONFIG_MII has to be defined!"
  31 #endif
  32
  33 #endif
  34
  35 #if defined(CONFIG_RMII) && !defined(WANT_MII)
  36 #error RMII support is unusable without a working PHY.
  37 #endif
  38
  39 #ifdef CONFIG_SYS_DISCOVER_PHY
  40 static int mii_discover_phy(struct eth_device *dev);
  41 #endif
  42
  43 int fec8xx_miiphy_read(struct mii_dev *bus, int addr, int devad, int reg);
  44 int fec8xx_miiphy_write(struct mii_dev *bus, int addr, int devad, int reg,
  45                         u16 value);
  46
  47 static struct ether_fcc_info_s
  48 {
  49         int ether_index;
  50         int fecp_offset;
  51         int phy_addr;
  52         int actual_phy_addr;
  53         int initialized;
  54 }
  55         ether_fcc_info[] = {
  56 #if defined(CONFIG_ETHER_ON_FEC1)
  57         {
  58                 0,
  59                 offsetof(immap_t, im_cpm.cp_fec1),
  60                 CONFIG_FEC1_PHY,
  61                 -1,
  62                 0,
  63
  64         },
  65 #endif
  66 #if defined(CONFIG_ETHER_ON_FEC2)
  67         {
  68                 1,
  69                 offsetof(immap_t, im_cpm.cp_fec2),
  70                 CONFIG_FEC2_PHY,
  71                 -1,
  72                 0,
  73         },
  74 #endif
  75 };
  76
  77 /* Ethernet Transmit and Receive Buffers */
  78 #define DBUF_LENGTH  1520
  79
  80 #define TX_BUF_CNT 2
  81
  82 #define TOUT_LOOP 100
  83
  84 #define PKT_MAXBUF_SIZE         1518
  85 #define PKT_MINBUF_SIZE         64
  86 #define PKT_MAXBLR_SIZE         1520
  87
  88 #ifdef __GNUC__
  89 static char txbuf[DBUF_LENGTH] __aligned(8);
  90 #else
  91 #error txbuf must be aligned.
  92 #endif
  93
  94 static uint rxIdx;      /* index of the current RX buffer */
  95 static uint txIdx;      /* index of the current TX buffer */
  96
  97 /*
  98   * FEC Ethernet Tx and Rx buffer descriptors allocated at the
  99   *  immr->udata_bd address on Dual-Port RAM
 100   * Provide for Double Buffering
 101   */
 102
 103 struct common_buf_desc {
 104         cbd_t rxbd[PKTBUFSRX];          /* Rx BD */
 105         cbd_t txbd[TX_BUF_CNT];         /* Tx BD */
 106 };
 107
 108 static struct common_buf_desc __iomem *rtx;
 109
 110 static int fec_send(struct eth_device *dev, void *packet, int length);
 111 static int fec_recv(struct eth_device *dev);
 112 static int fec_init(struct eth_device *dev, bd_t *bd);
 113 static void fec_halt(struct eth_device *dev);
 114 #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
 115 static void __mii_init(void);
 116 #endif
 117
 118 int fec_initialize(bd_t *bis)
 119 {
 120         struct eth_device *dev;
 121         struct ether_fcc_info_s *efis;
 122         int             i;
 123
 124         for (i = 0; i < ARRAY_SIZE(ether_fcc_info); i++) {
 125                 dev = malloc(sizeof(*dev));
 126                 if (dev == NULL)
 127                         hang();
 128
 129                 memset(dev, 0, sizeof(*dev));
 130
 131                 /* for FEC1 make sure that the name of the interface is the same
 132                    as the old one for compatibility reasons */
 133                 if (i == 0)
 134                         strcpy(dev->name, "FEC");
 135                 else
 136                         sprintf(dev->name, "FEC%d",
 137                                 ether_fcc_info[i].ether_index + 1);
 138
 139                 efis = &ether_fcc_info[i];
 140
 141                 /*
 142                  * reset actual phy addr
 143                  */
 144                 efis->actual_phy_addr = -1;
 145
 146                 dev->priv = efis;
 147                 dev->init = fec_init;
 148                 dev->halt = fec_halt;
 149                 dev->send = fec_send;
 150                 dev->recv = fec_recv;
 151
 152                 eth_register(dev);
 153
 154 #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
 155                 int retval;
 156                 struct mii_dev *mdiodev = mdio_alloc();
 157                 if (!mdiodev)
 158                         return -ENOMEM;
 159                 strncpy(mdiodev->name, dev->name, MDIO_NAME_LEN);
 160                 mdiodev->read = fec8xx_miiphy_read;
 161                 mdiodev->write = fec8xx_miiphy_write;
 162
 163                 retval = mdio_register(mdiodev);
 164                 if (retval < 0)
 165                         return retval;
 166 #endif
 167         }
 168         return 1;
 169 }
 170
 171 static int fec_send(struct eth_device *dev, void *packet, int length)
 172 {
 173         int j, rc;
 174         struct ether_fcc_info_s *efis = dev->priv;
 175         fec_t __iomem *fecp =
 176                         (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
 177
 178         /* section 16.9.23.3
 179          * Wait for ready
 180          */
 181         j = 0;
 182         while ((in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_READY) &&
 183                (j < TOUT_LOOP)) {
 184                 udelay(1);
 185                 j++;
 186         }
 187         if (j >= TOUT_LOOP)
 188                 printf("TX not ready\n");
 189
 190         out_be32(&rtx->txbd[txIdx].cbd_bufaddr, (uint)packet);
 191         out_be16(&rtx->txbd[txIdx].cbd_datlen, length);
 192         setbits_be16(&rtx->txbd[txIdx].cbd_sc,
 193                      BD_ENET_TX_READY | BD_ENET_TX_LAST);
 194
 195         /* Activate transmit Buffer Descriptor polling */
 196         /* Descriptor polling active    */
 197         out_be32(&fecp->fec_x_des_active, 0x01000000);
 198
 199         j = 0;
 200         while ((in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_READY) &&
 201                (j < TOUT_LOOP)) {
 202                 udelay(1);
 203                 j++;
 204         }
 205         if (j >= TOUT_LOOP)
 206                 printf("TX timeout\n");
 207
 208         /* return only status bits */;
 209         rc = in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_STATS;
 210
 211         txIdx = (txIdx + 1) % TX_BUF_CNT;
 212
 213         return rc;
 214 }
 215
 216 static int fec_recv(struct eth_device *dev)
 217 {
 218         struct ether_fcc_info_s *efis = dev->priv;
 219         fec_t __iomem *fecp =
 220                         (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
 221         int length;
 222
 223         for (;;) {
 224                 /* section 16.9.23.2 */
 225                 if (in_be16(&rtx->rxbd[rxIdx].cbd_sc) & BD_ENET_RX_EMPTY) {
 226                         length = -1;
 227                         break;  /* nothing received - leave for() loop */
 228                 }
 229
 230                 length = in_be16(&rtx->rxbd[rxIdx].cbd_datlen);
 231
 232                 if (!(in_be16(&rtx->rxbd[rxIdx].cbd_sc) & 0x003f)) {
 233                         uchar *rx = net_rx_packets[rxIdx];
 234
 235                         length -= 4;
 236
 237 #if defined(CONFIG_CMD_CDP)
 238                         if ((rx[0] & 1) != 0 &&
 239                             memcmp((uchar *)rx, net_bcast_ethaddr, 6) != 0 &&
 240                             !is_cdp_packet((uchar *)rx))
 241                                 rx = NULL;
 242 #endif
 243                         /*
 244                          * Pass the packet up to the protocol layers.
 245                          */
 246                         if (rx != NULL)
 247                                 net_process_received_packet(rx, length);
 248                 }
 249
 250                 /* Give the buffer back to the FEC. */
 251                 out_be16(&rtx->rxbd[rxIdx].cbd_datlen, 0);
 252
 253                 /* wrap around buffer index when necessary */
 254                 if ((rxIdx + 1) >= PKTBUFSRX) {
 255                         out_be16(&rtx->rxbd[PKTBUFSRX - 1].cbd_sc,
 256                                  BD_ENET_RX_WRAP | BD_ENET_RX_EMPTY);
 257                         rxIdx = 0;
 258                 } else {
 259                         out_be16(&rtx->rxbd[rxIdx].cbd_sc, BD_ENET_RX_EMPTY);
 260                         rxIdx++;
 261                 }
 262
 263                 /* Try to fill Buffer Descriptors */
 264                 /* Descriptor polling active    */
 265                 out_be32(&fecp->fec_r_des_active, 0x01000000);
 266         }
 267
 268         return length;
 269 }
 270
 271 /**************************************************************
 272  *
 273  * FEC Ethernet Initialization Routine
 274  *
 275  *************************************************************/
 276
 277 #define FEC_ECNTRL_PINMUX       0x00000004
 278 #define FEC_ECNTRL_ETHER_EN     0x00000002
 279 #define FEC_ECNTRL_RESET        0x00000001
 280
 281 #define FEC_RCNTRL_BC_REJ       0x00000010
 282 #define FEC_RCNTRL_PROM         0x00000008
 283 #define FEC_RCNTRL_MII_MODE     0x00000004
 284 #define FEC_RCNTRL_DRT          0x00000002
 285 #define FEC_RCNTRL_LOOP         0x00000001
 286
 287 #define FEC_TCNTRL_FDEN         0x00000004
 288 #define FEC_TCNTRL_HBC          0x00000002
 289 #define FEC_TCNTRL_GTS          0x00000001
 290
 291 #define FEC_RESET_DELAY         50
 292
 293 #if defined(CONFIG_RMII)
 294
 295 static inline void fec_10Mbps(struct eth_device *dev)
 296 {
 297         struct ether_fcc_info_s *efis = dev->priv;
 298         int fecidx = efis->ether_index;
 299         uint mask = (fecidx == 0) ? 0x0000010 : 0x0000008;
 300         immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
 301
 302         if ((unsigned int)fecidx >= 2)
 303                 hang();
 304
 305         setbits_be32(&immr->im_cpm.cp_cptr, mask);
 306 }
 307
 308 static inline void fec_100Mbps(struct eth_device *dev)
 309 {
 310         struct ether_fcc_info_s *efis = dev->priv;
 311         int fecidx = efis->ether_index;
 312         uint mask = (fecidx == 0) ? 0x0000010 : 0x0000008;
 313         immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
 314
 315         if ((unsigned int)fecidx >= 2)
 316                 hang();
 317
 318         clrbits_be32(&immr->im_cpm.cp_cptr, mask);
 319 }
 320
 321 #endif
 322
 323 static inline void fec_full_duplex(struct eth_device *dev)
 324 {
 325         struct ether_fcc_info_s *efis = dev->priv;
 326         fec_t __iomem *fecp =
 327                         (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
 328
 329         clrbits_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_DRT);
 330         setbits_be32(&fecp->fec_x_cntrl,  FEC_TCNTRL_FDEN);     /* FD enable */
 331 }
 332
 333 static inline void fec_half_duplex(struct eth_device *dev)
 334 {
 335         struct ether_fcc_info_s *efis = dev->priv;
 336         fec_t __iomem *fecp =
 337                         (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
 338
 339         setbits_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_DRT);
 340         clrbits_be32(&fecp->fec_x_cntrl,  FEC_TCNTRL_FDEN);     /* FD disable */
 341 }
 342
 343 static void fec_pin_init(int fecidx)
 344 {
 345         bd_t           *bd = gd->bd;
 346         immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
 347
 348         /*
 349          * Set MII speed to 2.5 MHz or slightly below.
 350          *
 351          * According to the MPC860T (Rev. D) Fast ethernet controller user
 352          * manual (6.2.14),
 353          * the MII management interface clock must be less than or equal
 354          * to 2.5 MHz.
 355          * This MDC frequency is equal to system clock / (2 * MII_SPEED).
 356          * Then MII_SPEED = system_clock / 2 * 2,5 MHz.
 357          *
 358          * All MII configuration is done via FEC1 registers:
 359          */
 360         out_be32(&immr->im_cpm.cp_fec1.fec_mii_speed,
 361                  ((bd->bi_intfreq + 4999999) / 5000000) << 1);
 362
 363 #if defined(CONFIG_MPC885) && defined(WANT_MII)
 364         /* use MDC for MII */
 365         setbits_be16(&immr->im_ioport.iop_pdpar, 0x0080);
 366         clrbits_be16(&immr->im_ioport.iop_pddir, 0x0080);
 367 #endif
 368
 369         if (fecidx == 0) {
 370 #if defined(CONFIG_ETHER_ON_FEC1)
 371
 372 #if defined(CONFIG_MPC885) /* MPC87x/88x have got 2 FECs and different pinout */
 373
 374 #if !defined(CONFIG_RMII)
 375
 376                 setbits_be16(&immr->im_ioport.iop_papar, 0xf830);
 377                 setbits_be16(&immr->im_ioport.iop_padir, 0x0830);
 378                 clrbits_be16(&immr->im_ioport.iop_padir, 0xf000);
 379
 380                 setbits_be32(&immr->im_cpm.cp_pbpar, 0x00001001);
 381                 clrbits_be32(&immr->im_cpm.cp_pbdir, 0x00001001);
 382
 383                 setbits_be16(&immr->im_ioport.iop_pcpar, 0x000c);
 384                 clrbits_be16(&immr->im_ioport.iop_pcdir, 0x000c);
 385
 386                 setbits_be32(&immr->im_cpm.cp_pepar, 0x00000003);
 387                 setbits_be32(&immr->im_cpm.cp_pedir, 0x00000003);
 388                 clrbits_be32(&immr->im_cpm.cp_peso, 0x00000003);
 389
 390                 clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000100);
 391
 392 #else
 393
 394 #if !defined(CONFIG_FEC1_PHY_NORXERR)
 395                 setbits_be16(&immr->im_ioport.iop_papar, 0x1000);
 396                 clrbits_be16(&immr->im_ioport.iop_padir, 0x1000);
 397 #endif
 398                 setbits_be16(&immr->im_ioport.iop_papar, 0xe810);
 399                 setbits_be16(&immr->im_ioport.iop_padir, 0x0810);
 400                 clrbits_be16(&immr->im_ioport.iop_padir, 0xe000);
 401
 402                 setbits_be32(&immr->im_cpm.cp_pbpar, 0x00000001);
 403                 clrbits_be32(&immr->im_cpm.cp_pbdir, 0x00000001);
 404
 405                 setbits_be32(&immr->im_cpm.cp_cptr, 0x00000100);
 406                 clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000050);
 407
 408 #endif /* !CONFIG_RMII */
 409
 410 #else
 411                 /*
 412                  * Configure all of port D for MII.
 413                  */
 414                 out_be16(&immr->im_ioport.iop_pdpar, 0x1fff);
 415                 out_be16(&immr->im_ioport.iop_pddir, 0x1fff);
 416
 417 #if defined(CONFIG_TARGET_MCR3000)
 418                 out_be16(&immr->im_ioport.iop_papar, 0xBBFF);
 419                 out_be16(&immr->im_ioport.iop_padir, 0x04F0);
 420                 out_be16(&immr->im_ioport.iop_paodr, 0x0000);
 421
 422                 out_be32(&immr->im_cpm.cp_pbpar, 0x000133FF);
 423                 out_be32(&immr->im_cpm.cp_pbdir, 0x0003BF0F);
 424                 out_be16(&immr->im_cpm.cp_pbodr, 0x0000);
 425
 426                 out_be16(&immr->im_ioport.iop_pcpar, 0x0400);
 427                 out_be16(&immr->im_ioport.iop_pcdir, 0x0080);
 428                 out_be16(&immr->im_ioport.iop_pcso , 0x0D53);
 429                 out_be16(&immr->im_ioport.iop_pcint, 0x0000);
 430
 431                 out_be16(&immr->im_ioport.iop_pdpar, 0x03FE);
 432                 out_be16(&immr->im_ioport.iop_pddir, 0x1C09);
 433
 434                 setbits_be32(&immr->im_ioport.utmode, 0x80);
 435 #endif
 436 #endif
 437
 438 #endif  /* CONFIG_ETHER_ON_FEC1 */
 439         } else if (fecidx == 1) {
 440 #if defined(CONFIG_ETHER_ON_FEC2)
 441
 442 #if defined(CONFIG_MPC885) /* MPC87x/88x have got 2 FECs and different pinout */
 443
 444 #if !defined(CONFIG_RMII)
 445                 setbits_be32(&immr->im_cpm.cp_pepar, 0x0003fffc);
 446                 setbits_be32(&immr->im_cpm.cp_pedir, 0x0003fffc);
 447                 clrbits_be32(&immr->im_cpm.cp_peso, 0x000087fc);
 448                 setbits_be32(&immr->im_cpm.cp_peso, 0x00037800);
 449
 450                 clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000080);
 451 #else
 452
 453 #if !defined(CONFIG_FEC2_PHY_NORXERR)
 454                 setbits_be32(&immr->im_cpm.cp_pepar, 0x00000010);
 455                 setbits_be32(&immr->im_cpm.cp_pedir, 0x00000010);
 456                 clrbits_be32(&immr->im_cpm.cp_peso, 0x00000010);
 457 #endif
 458                 setbits_be32(&immr->im_cpm.cp_pepar, 0x00039620);
 459                 setbits_be32(&immr->im_cpm.cp_pedir, 0x00039620);
 460                 setbits_be32(&immr->im_cpm.cp_peso, 0x00031000);
 461                 clrbits_be32(&immr->im_cpm.cp_peso, 0x00008620);
 462
 463                 setbits_be32(&immr->im_cpm.cp_cptr, 0x00000080);
 464                 clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000028);
 465 #endif /* CONFIG_RMII */
 466
 467 #endif /* CONFIG_MPC885 */
 468
 469 #endif /* CONFIG_ETHER_ON_FEC2 */
 470         }
 471 }
 472
 473 static int fec_reset(fec_t __iomem *fecp)
 474 {
 475         int i;
 476
 477         /* Whack a reset.
 478          * A delay is required between a reset of the FEC block and
 479          * initialization of other FEC registers because the reset takes
 480          * some time to complete. If you don't delay, subsequent writes
 481          * to FEC registers might get killed by the reset routine which is
 482          * still in progress.
 483          */
 484
 485         out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_RESET);
 486         for (i = 0; (in_be32(&fecp->fec_ecntrl) & FEC_ECNTRL_RESET) &&
 487              (i < FEC_RESET_DELAY); ++i)
 488                 udelay(1);
 489
 490         if (i == FEC_RESET_DELAY)
 491                 return -1;
 492
 493         return 0;
 494 }
 495
 496 static int fec_init(struct eth_device *dev, bd_t *bd)
 497 {
 498         struct ether_fcc_info_s *efis = dev->priv;
 499         immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
 500         fec_t __iomem *fecp =
 501                         (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
 502         int i;
 503
 504 #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
 505         /* the MII interface is connected to FEC1
 506          * so for the miiphy_xxx function to work we must
 507          * call mii_init since fec_halt messes the thing up
 508          */
 509         if (efis->ether_index != 0)
 510                 __mii_init();
 511 #endif
 512
 513         if (fec_reset(fecp) < 0)
 514                 printf("FEC_RESET_DELAY timeout\n");
 515
 516         /* We use strictly polling mode only
 517          */
 518         out_be32(&fecp->fec_imask, 0);
 519
 520         /* Clear any pending interrupt
 521          */
 522         out_be32(&fecp->fec_ievent, 0xffc0);
 523
 524         /* No need to set the IVEC register */
 525
 526         /* Set station address
 527          */
 528 #define ea dev->enetaddr
 529         out_be32(&fecp->fec_addr_low, (ea[0] << 24) | (ea[1] << 16) |
 530                                       (ea[2] << 8) | ea[3]);
 531         out_be16(&fecp->fec_addr_high, (ea[4] << 8) | ea[5]);
 532 #undef ea
 533
 534 #if defined(CONFIG_CMD_CDP)
 535         /*
 536          * Turn on multicast address hash table
 537          */
 538         out_be32(&fecp->fec_hash_table_high, 0xffffffff);
 539         out_be32(&fecp->fec_hash_table_low, 0xffffffff);
 540 #else
 541         /* Clear multicast address hash table
 542          */
 543         out_be32(&fecp->fec_hash_table_high, 0);
 544         out_be32(&fecp->fec_hash_table_low, 0);
 545 #endif
 546
 547         /* Set maximum receive buffer size.
 548          */
 549         out_be32(&fecp->fec_r_buff_size, PKT_MAXBLR_SIZE);
 550
 551         /* Set maximum frame length
 552          */
 553         out_be32(&fecp->fec_r_hash, PKT_MAXBUF_SIZE);
 554
 555         /*
 556          * Setup Buffers and Buffer Descriptors
 557          */
 558         rxIdx = 0;
 559         txIdx = 0;
 560
 561         if (!rtx)
 562                 rtx = (struct common_buf_desc __iomem *)
 563                       (immr->im_cpm.cp_dpmem + CPM_FEC_BASE);
 564         /*
 565          * Setup Receiver Buffer Descriptors (13.14.24.18)
 566          * Settings:
 567          *     Empty, Wrap
 568          */
 569         for (i = 0; i < PKTBUFSRX; i++) {
 570                 out_be16(&rtx->rxbd[i].cbd_sc, BD_ENET_RX_EMPTY);
 571                 out_be16(&rtx->rxbd[i].cbd_datlen, 0);  /* Reset */
 572                 out_be32(&rtx->rxbd[i].cbd_bufaddr, (uint)net_rx_packets[i]);
 573         }
 574         setbits_be16(&rtx->rxbd[PKTBUFSRX - 1].cbd_sc, BD_ENET_RX_WRAP);
 575
 576         /*
 577          * Setup Ethernet Transmitter Buffer Descriptors (13.14.24.19)
 578          * Settings:
 579          *    Last, Tx CRC
 580          */
 581         for (i = 0; i < TX_BUF_CNT; i++) {
 582                 out_be16(&rtx->txbd[i].cbd_sc, BD_ENET_TX_LAST | BD_ENET_TX_TC);
 583                 out_be16(&rtx->txbd[i].cbd_datlen, 0);  /* Reset */
 584                 out_be32(&rtx->txbd[i].cbd_bufaddr, (uint)txbuf);
 585         }
 586         setbits_be16(&rtx->txbd[TX_BUF_CNT - 1].cbd_sc, BD_ENET_TX_WRAP);
 587
 588         /* Set receive and transmit descriptor base
 589          */
 590         out_be32(&fecp->fec_r_des_start, (__force unsigned int)rtx->rxbd);
 591         out_be32(&fecp->fec_x_des_start, (__force unsigned int)rtx->txbd);
 592
 593         /* Enable MII mode
 594          */
 595         /* Half duplex mode */
 596         out_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_MII_MODE | FEC_RCNTRL_DRT);
 597         out_be32(&fecp->fec_x_cntrl, 0);
 598
 599         /* Enable big endian and don't care about SDMA FC.
 600          */
 601         out_be32(&fecp->fec_fun_code, 0x78000000);
 602
 603         /*
 604          * Setup the pin configuration of the FEC
 605          */
 606         fec_pin_init(efis->ether_index);
 607
 608         rxIdx = 0;
 609         txIdx = 0;
 610
 611         /*
 612          * Now enable the transmit and receive processing
 613          */
 614         out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_ETHER_EN);
 615
 616         if (efis->phy_addr == -1) {
 617 #ifdef CONFIG_SYS_DISCOVER_PHY
 618                 /*
 619                  * wait for the PHY to wake up after reset
 620                  */
 621                 efis->actual_phy_addr = mii_discover_phy(dev);
 622
 623                 if (efis->actual_phy_addr == -1) {
 624                         printf("Unable to discover phy!\n");
 625                         return -1;
 626                 }
 627 #else
 628                 efis->actual_phy_addr = -1;
 629 #endif
 630         } else {
 631                 efis->actual_phy_addr = efis->phy_addr;
 632         }
 633
 634 #if defined(CONFIG_MII) && defined(CONFIG_RMII)
 635         /*
 636          * adapt the RMII speed to the speed of the phy
 637          */
 638         if (miiphy_speed(dev->name, efis->actual_phy_addr) == _100BASET)
 639                 fec_100Mbps(dev);
 640         else
 641                 fec_10Mbps(dev);
 642 #endif
 643
 644 #if defined(CONFIG_MII)
 645         /*
 646          * adapt to the half/full speed settings
 647          */
 648         if (miiphy_duplex(dev->name, efis->actual_phy_addr) == FULL)
 649                 fec_full_duplex(dev);
 650         else
 651                 fec_half_duplex(dev);
 652 #endif
 653
 654         /* And last, try to fill Rx Buffer Descriptors */
 655         /* Descriptor polling active    */
 656         out_be32(&fecp->fec_r_des_active, 0x01000000);
 657
 658         efis->initialized = 1;
 659
 660         return 0;
 661 }
 662
 663
 664 static void fec_halt(struct eth_device *dev)
 665 {
 666         struct ether_fcc_info_s *efis = dev->priv;
 667         fec_t __iomem *fecp =
 668                         (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
 669         int i;
 670
 671         /* avoid halt if initialized; mii gets stuck otherwise */
 672         if (!efis->initialized)
 673                 return;
 674
 675         /* Whack a reset.
 676          * A delay is required between a reset of the FEC block and
 677          * initialization of other FEC registers because the reset takes
 678          * some time to complete. If you don't delay, subsequent writes
 679          * to FEC registers might get killed by the reset routine which is
 680          * still in progress.
 681          */
 682
 683         out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_RESET);
 684         for (i = 0; (in_be32(&fecp->fec_ecntrl) & FEC_ECNTRL_RESET) &&
 685              (i < FEC_RESET_DELAY); ++i)
 686                 udelay(1);
 687
 688         if (i == FEC_RESET_DELAY) {
 689                 printf("FEC_RESET_DELAY timeout\n");
 690                 return;
 691         }
 692
 693         efis->initialized = 0;
 694 }
 695
 696 #if defined(CONFIG_SYS_DISCOVER_PHY) || defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
 697
 698 /* Make MII read/write commands for the FEC.
 699 */
 700
 701 #define mk_mii_read(ADDR, REG)  (0x60020000 | ((ADDR << 23) | \
 702                                                 (REG & 0x1f) << 18))
 703
 704 #define mk_mii_write(ADDR, REG, VAL)    (0x50020000 | ((ADDR << 23) | \
 705                                                 (REG & 0x1f) << 18) | \
 706                                                 (VAL & 0xffff))
 707
 708 /* Interrupt events/masks.
 709 */
 710 #define FEC_ENET_HBERR  ((uint)0x80000000)      /* Heartbeat error */
 711 #define FEC_ENET_BABR   ((uint)0x40000000)      /* Babbling receiver */
 712 #define FEC_ENET_BABT   ((uint)0x20000000)      /* Babbling transmitter */
 713 #define FEC_ENET_GRA    ((uint)0x10000000)      /* Graceful stop complete */
 714 #define FEC_ENET_TXF    ((uint)0x08000000)      /* Full frame transmitted */
 715 #define FEC_ENET_TXB    ((uint)0x04000000)      /* A buffer was transmitted */
 716 #define FEC_ENET_RXF    ((uint)0x02000000)      /* Full frame received */
 717 #define FEC_ENET_RXB    ((uint)0x01000000)      /* A buffer was received */
 718 #define FEC_ENET_MII    ((uint)0x00800000)      /* MII interrupt */
 719 #define FEC_ENET_EBERR  ((uint)0x00400000)      /* SDMA bus error */
 720
 721 /* send command to phy using mii, wait for result */
 722 static uint
 723 mii_send(uint mii_cmd)
 724 {
 725         uint mii_reply;
 726         fec_t __iomem *ep;
 727         int cnt;
 728         immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
 729
 730         ep = &immr->im_cpm.cp_fec;
 731
 732         out_be32(&ep->fec_mii_data, mii_cmd);   /* command to phy */
 733
 734         /* wait for mii complete */
 735         cnt = 0;
 736         while (!(in_be32(&ep->fec_ievent) & FEC_ENET_MII)) {
 737                 if (++cnt > 1000) {
 738                         printf("mii_send STUCK!\n");
 739                         break;
 740                 }
 741         }
 742         mii_reply = in_be32(&ep->fec_mii_data);         /* result from phy */
 743         out_be32(&ep->fec_ievent, FEC_ENET_MII);        /* clear MII complete */
 744         return mii_reply & 0xffff;              /* data read from phy */
 745 }
 746 #endif
 747
 748 #if defined(CONFIG_SYS_DISCOVER_PHY)
 749 static int mii_discover_phy(struct eth_device *dev)
 750 {
 751 #define MAX_PHY_PASSES 11
 752         uint phyno;
 753         int  pass;
 754         uint phytype;
 755         int phyaddr;
 756
 757         phyaddr = -1;   /* didn't find a PHY yet */
 758         for (pass = 1; pass <= MAX_PHY_PASSES && phyaddr < 0; ++pass) {
 759                 if (pass > 1) {
 760                         /* PHY may need more time to recover from reset.
 761                          * The LXT970 needs 50ms typical, no maximum is
 762                          * specified, so wait 10ms before try again.
 763                          * With 11 passes this gives it 100ms to wake up.
 764                          */
 765                         udelay(10000);  /* wait 10ms */
 766                 }
 767                 for (phyno = 0; phyno < 32 && phyaddr < 0; ++phyno) {
 768                         phytype = mii_send(mk_mii_read(phyno, MII_PHYSID2));
 769                         if (phytype != 0xffff) {
 770                                 phyaddr = phyno;
 771                                 phytype |= mii_send(mk_mii_read(phyno,
 772                                                                 MII_PHYSID1)) << 16;
 773                         }
 774                 }
 775         }
 776         if (phyaddr < 0)
 777                 printf("No PHY device found.\n");
 778
 779         return phyaddr;
 780 }
 781 #endif  /* CONFIG_SYS_DISCOVER_PHY */
 782
 783 #if (defined(CONFIG_MII) || defined(CONFIG_CMD_MII)) && !defined(CONFIG_BITBANGMII)
 784
 785 /****************************************************************************
 786  * mii_init -- Initialize the MII via FEC 1 for MII command without ethernet
 787  * This function is a subset of eth_init
 788  ****************************************************************************
 789  */
 790 static void __mii_init(void)
 791 {
 792         immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
 793         fec_t __iomem *fecp = &immr->im_cpm.cp_fec;
 794
 795         if (fec_reset(fecp) < 0)
 796                 printf("FEC_RESET_DELAY timeout\n");
 797
 798         /* We use strictly polling mode only
 799          */
 800         out_be32(&fecp->fec_imask, 0);
 801
 802         /* Clear any pending interrupt
 803          */
 804         out_be32(&fecp->fec_ievent, 0xffc0);
 805
 806         /* Now enable the transmit and receive processing
 807          */
 808         out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_ETHER_EN);
 809 }
 810
 811 void mii_init(void)
 812 {
 813         int i;
 814
 815         __mii_init();
 816
 817         /* Setup the pin configuration of the FEC(s)
 818         */
 819         for (i = 0; i < ARRAY_SIZE(ether_fcc_info); i++)
 820                 fec_pin_init(ether_fcc_info[i].ether_index);
 821 }
 822
 823 /*****************************************************************************
 824  * Read and write a MII PHY register, routines used by MII Utilities
 825  *
 826  * FIXME: These routines are expected to return 0 on success, but mii_send
 827  *        does _not_ return an error code. Maybe 0xFFFF means error, i.e.
 828  *        no PHY connected...
 829  *        For now always return 0.
 830  * FIXME: These routines only work after calling eth_init() at least once!
 831  *        Otherwise they hang in mii_send() !!! Sorry!
 832  *****************************************************************************/
 833
 834 int fec8xx_miiphy_read(struct mii_dev *bus, int addr, int devad, int reg)
 835 {
 836         unsigned short value = 0;
 837         short rdreg;    /* register working value */
 838
 839         rdreg = mii_send(mk_mii_read(addr, reg));
 840
 841         value = rdreg;
 842         return value;
 843 }
 844
 845 int fec8xx_miiphy_write(struct mii_dev *bus, int addr, int devad, int reg,
 846                         u16 value)
 847 {
 848         (void)mii_send(mk_mii_write(addr, reg, value));
 849
 850         return 0;
 851 }
 852 #endif