// SPDX-License-Identifier: GPL-2.0+ /* * (C) Copyright 2000 * Wolfgang Denk, DENX Software Engineering, wd@denx.de. */ #include #include #include #include #include #include #include #include #include #include #include #include DECLARE_GLOBAL_DATA_PTR; /* define WANT_MII when MII support is required */ #if defined(CONFIG_SYS_DISCOVER_PHY) || defined(CONFIG_FEC1_PHY) || defined(CONFIG_FEC2_PHY) #define WANT_MII #else #undef WANT_MII #endif #if defined(WANT_MII) #include #if !(defined(CONFIG_MII) || defined(CONFIG_CMD_MII)) #error "CONFIG_MII has to be defined!" #endif #endif #if defined(CONFIG_RMII) && !defined(WANT_MII) #error RMII support is unusable without a working PHY. #endif #ifdef CONFIG_SYS_DISCOVER_PHY static int mii_discover_phy(struct eth_device *dev); #endif int fec8xx_miiphy_read(struct mii_dev *bus, int addr, int devad, int reg); int fec8xx_miiphy_write(struct mii_dev *bus, int addr, int devad, int reg, u16 value); static struct ether_fcc_info_s { int ether_index; int fecp_offset; int phy_addr; int actual_phy_addr; int initialized; } ether_fcc_info[] = { #if defined(CONFIG_ETHER_ON_FEC1) { 0, offsetof(immap_t, im_cpm.cp_fec1), CONFIG_FEC1_PHY, -1, 0, }, #endif #if defined(CONFIG_ETHER_ON_FEC2) { 1, offsetof(immap_t, im_cpm.cp_fec2), CONFIG_FEC2_PHY, -1, 0, }, #endif }; /* Ethernet Transmit and Receive Buffers */ #define DBUF_LENGTH 1520 #define TX_BUF_CNT 2 #define TOUT_LOOP 100 #define PKT_MAXBUF_SIZE 1518 #define PKT_MINBUF_SIZE 64 #define PKT_MAXBLR_SIZE 1520 #ifdef __GNUC__ static char txbuf[DBUF_LENGTH] __aligned(8); #else #error txbuf must be aligned. #endif static uint rxIdx; /* index of the current RX buffer */ static uint txIdx; /* index of the current TX buffer */ /* * FEC Ethernet Tx and Rx buffer descriptors allocated at the * immr->udata_bd address on Dual-Port RAM * Provide for Double Buffering */ struct common_buf_desc { cbd_t rxbd[PKTBUFSRX]; /* Rx BD */ cbd_t txbd[TX_BUF_CNT]; /* Tx BD */ }; static struct common_buf_desc __iomem *rtx; static int fec_send(struct eth_device *dev, void *packet, int length); static int fec_recv(struct eth_device *dev); static int fec_init(struct eth_device *dev, struct bd_info *bd); static void fec_halt(struct eth_device *dev); #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) static void __mii_init(void); #endif int fec_initialize(struct bd_info *bis) { struct eth_device *dev; struct ether_fcc_info_s *efis; int i; for (i = 0; i < ARRAY_SIZE(ether_fcc_info); i++) { dev = malloc(sizeof(*dev)); if (dev == NULL) hang(); memset(dev, 0, sizeof(*dev)); /* for FEC1 make sure that the name of the interface is the same as the old one for compatibility reasons */ if (i == 0) strcpy(dev->name, "FEC"); else sprintf(dev->name, "FEC%d", ether_fcc_info[i].ether_index + 1); efis = ðer_fcc_info[i]; /* * reset actual phy addr */ efis->actual_phy_addr = -1; dev->priv = efis; dev->init = fec_init; dev->halt = fec_halt; dev->send = fec_send; dev->recv = fec_recv; eth_register(dev); #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) int retval; struct mii_dev *mdiodev = mdio_alloc(); if (!mdiodev) return -ENOMEM; strncpy(mdiodev->name, dev->name, MDIO_NAME_LEN); mdiodev->read = fec8xx_miiphy_read; mdiodev->write = fec8xx_miiphy_write; retval = mdio_register(mdiodev); if (retval < 0) return retval; #endif } return 1; } static int fec_send(struct eth_device *dev, void *packet, int length) { int j, rc; struct ether_fcc_info_s *efis = dev->priv; fec_t __iomem *fecp = (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset); /* section 16.9.23.3 * Wait for ready */ j = 0; while ((in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_READY) && (j < TOUT_LOOP)) { udelay(1); j++; } if (j >= TOUT_LOOP) printf("TX not ready\n"); out_be32(&rtx->txbd[txIdx].cbd_bufaddr, (uint)packet); out_be16(&rtx->txbd[txIdx].cbd_datlen, length); setbits_be16(&rtx->txbd[txIdx].cbd_sc, BD_ENET_TX_READY | BD_ENET_TX_LAST); /* Activate transmit Buffer Descriptor polling */ /* Descriptor polling active */ out_be32(&fecp->fec_x_des_active, 0x01000000); j = 0; while ((in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_READY) && (j < TOUT_LOOP)) { udelay(1); j++; } if (j >= TOUT_LOOP) printf("TX timeout\n"); /* return only status bits */; rc = in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_STATS; txIdx = (txIdx + 1) % TX_BUF_CNT; return rc; } static int fec_recv(struct eth_device *dev) { struct ether_fcc_info_s *efis = dev->priv; fec_t __iomem *fecp = (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset); int length; for (;;) { /* section 16.9.23.2 */ if (in_be16(&rtx->rxbd[rxIdx].cbd_sc) & BD_ENET_RX_EMPTY) { length = -1; break; /* nothing received - leave for() loop */ } length = in_be16(&rtx->rxbd[rxIdx].cbd_datlen); if (!(in_be16(&rtx->rxbd[rxIdx].cbd_sc) & 0x003f)) { uchar *rx = net_rx_packets[rxIdx]; length -= 4; #if defined(CONFIG_CMD_CDP) if ((rx[0] & 1) != 0 && memcmp((uchar *)rx, net_bcast_ethaddr, 6) != 0 && !is_cdp_packet((uchar *)rx)) rx = NULL; #endif /* * Pass the packet up to the protocol layers. */ if (rx != NULL) net_process_received_packet(rx, length); } /* Give the buffer back to the FEC. */ out_be16(&rtx->rxbd[rxIdx].cbd_datlen, 0); /* wrap around buffer index when necessary */ if ((rxIdx + 1) >= PKTBUFSRX) { out_be16(&rtx->rxbd[PKTBUFSRX - 1].cbd_sc, BD_ENET_RX_WRAP | BD_ENET_RX_EMPTY); rxIdx = 0; } else { out_be16(&rtx->rxbd[rxIdx].cbd_sc, BD_ENET_RX_EMPTY); rxIdx++; } /* Try to fill Buffer Descriptors */ /* Descriptor polling active */ out_be32(&fecp->fec_r_des_active, 0x01000000); } return length; } /************************************************************** * * FEC Ethernet Initialization Routine * *************************************************************/ #define FEC_ECNTRL_PINMUX 0x00000004 #define FEC_ECNTRL_ETHER_EN 0x00000002 #define FEC_ECNTRL_RESET 0x00000001 #define FEC_RCNTRL_BC_REJ 0x00000010 #define FEC_RCNTRL_PROM 0x00000008 #define FEC_RCNTRL_MII_MODE 0x00000004 #define FEC_RCNTRL_DRT 0x00000002 #define FEC_RCNTRL_LOOP 0x00000001 #define FEC_TCNTRL_FDEN 0x00000004 #define FEC_TCNTRL_HBC 0x00000002 #define FEC_TCNTRL_GTS 0x00000001 #define FEC_RESET_DELAY 50 #if defined(CONFIG_RMII) static inline void fec_10Mbps(struct eth_device *dev) { struct ether_fcc_info_s *efis = dev->priv; int fecidx = efis->ether_index; uint mask = (fecidx == 0) ? 0x0000010 : 0x0000008; immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR; if ((unsigned int)fecidx >= 2) hang(); setbits_be32(&immr->im_cpm.cp_cptr, mask); } static inline void fec_100Mbps(struct eth_device *dev) { struct ether_fcc_info_s *efis = dev->priv; int fecidx = efis->ether_index; uint mask = (fecidx == 0) ? 0x0000010 : 0x0000008; immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR; if ((unsigned int)fecidx >= 2) hang(); clrbits_be32(&immr->im_cpm.cp_cptr, mask); } #endif static inline void fec_full_duplex(struct eth_device *dev) { struct ether_fcc_info_s *efis = dev->priv; fec_t __iomem *fecp = (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset); clrbits_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_DRT); setbits_be32(&fecp->fec_x_cntrl, FEC_TCNTRL_FDEN); /* FD enable */ } static inline void fec_half_duplex(struct eth_device *dev) { struct ether_fcc_info_s *efis = dev->priv; fec_t __iomem *fecp = (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset); setbits_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_DRT); clrbits_be32(&fecp->fec_x_cntrl, FEC_TCNTRL_FDEN); /* FD disable */ } static void fec_pin_init(int fecidx) { struct bd_info *bd = gd->bd; immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR; /* * Set MII speed to 2.5 MHz or slightly below. * * According to the MPC860T (Rev. D) Fast ethernet controller user * manual (6.2.14), * the MII management interface clock must be less than or equal * to 2.5 MHz. * This MDC frequency is equal to system clock / (2 * MII_SPEED). * Then MII_SPEED = system_clock / 2 * 2,5 MHz. * * All MII configuration is done via FEC1 registers: */ out_be32(&immr->im_cpm.cp_fec1.fec_mii_speed, ((bd->bi_intfreq + 4999999) / 5000000) << 1); #if defined(CONFIG_MPC885) && defined(WANT_MII) /* use MDC for MII */ setbits_be16(&immr->im_ioport.iop_pdpar, 0x0080); clrbits_be16(&immr->im_ioport.iop_pddir, 0x0080); #endif if (fecidx == 0) { #if defined(CONFIG_ETHER_ON_FEC1) #if defined(CONFIG_MPC885) /* MPC87x/88x have got 2 FECs and different pinout */ #if !defined(CONFIG_RMII) setbits_be16(&immr->im_ioport.iop_papar, 0xf830); setbits_be16(&immr->im_ioport.iop_padir, 0x0830); clrbits_be16(&immr->im_ioport.iop_padir, 0xf000); setbits_be32(&immr->im_cpm.cp_pbpar, 0x00001001); clrbits_be32(&immr->im_cpm.cp_pbdir, 0x00001001); setbits_be16(&immr->im_ioport.iop_pcpar, 0x000c); clrbits_be16(&immr->im_ioport.iop_pcdir, 0x000c); setbits_be32(&immr->im_cpm.cp_pepar, 0x00000003); setbits_be32(&immr->im_cpm.cp_pedir, 0x00000003); clrbits_be32(&immr->im_cpm.cp_peso, 0x00000003); clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000100); #else #if !defined(CONFIG_FEC1_PHY_NORXERR) setbits_be16(&immr->im_ioport.iop_papar, 0x1000); clrbits_be16(&immr->im_ioport.iop_padir, 0x1000); #endif setbits_be16(&immr->im_ioport.iop_papar, 0xe810); setbits_be16(&immr->im_ioport.iop_padir, 0x0810); clrbits_be16(&immr->im_ioport.iop_padir, 0xe000); setbits_be32(&immr->im_cpm.cp_pbpar, 0x00000001); clrbits_be32(&immr->im_cpm.cp_pbdir, 0x00000001); setbits_be32(&immr->im_cpm.cp_cptr, 0x00000100); clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000050); #endif /* !CONFIG_RMII */ #else /* * Configure all of port D for MII. */ out_be16(&immr->im_ioport.iop_pdpar, 0x1fff); out_be16(&immr->im_ioport.iop_pddir, 0x1fff); #if defined(CONFIG_TARGET_MCR3000) out_be16(&immr->im_ioport.iop_papar, 0xBBFF); out_be16(&immr->im_ioport.iop_padir, 0x04F0); out_be16(&immr->im_ioport.iop_paodr, 0x0000); out_be32(&immr->im_cpm.cp_pbpar, 0x000133FF); out_be32(&immr->im_cpm.cp_pbdir, 0x0003BF0F); out_be16(&immr->im_cpm.cp_pbodr, 0x0000); out_be16(&immr->im_ioport.iop_pcpar, 0x0400); out_be16(&immr->im_ioport.iop_pcdir, 0x0080); out_be16(&immr->im_ioport.iop_pcso , 0x0D53); out_be16(&immr->im_ioport.iop_pcint, 0x0000); out_be16(&immr->im_ioport.iop_pdpar, 0x03FE); out_be16(&immr->im_ioport.iop_pddir, 0x1C09); setbits_be32(&immr->im_ioport.utmode, 0x80); #endif #endif #endif /* CONFIG_ETHER_ON_FEC1 */ } else if (fecidx == 1) { #if defined(CONFIG_ETHER_ON_FEC2) #if defined(CONFIG_MPC885) /* MPC87x/88x have got 2 FECs and different pinout */ #if !defined(CONFIG_RMII) setbits_be32(&immr->im_cpm.cp_pepar, 0x0003fffc); setbits_be32(&immr->im_cpm.cp_pedir, 0x0003fffc); clrbits_be32(&immr->im_cpm.cp_peso, 0x000087fc); setbits_be32(&immr->im_cpm.cp_peso, 0x00037800); clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000080); #else #if !defined(CONFIG_FEC2_PHY_NORXERR) setbits_be32(&immr->im_cpm.cp_pepar, 0x00000010); setbits_be32(&immr->im_cpm.cp_pedir, 0x00000010); clrbits_be32(&immr->im_cpm.cp_peso, 0x00000010); #endif setbits_be32(&immr->im_cpm.cp_pepar, 0x00039620); setbits_be32(&immr->im_cpm.cp_pedir, 0x00039620); setbits_be32(&immr->im_cpm.cp_peso, 0x00031000); clrbits_be32(&immr->im_cpm.cp_peso, 0x00008620); setbits_be32(&immr->im_cpm.cp_cptr, 0x00000080); clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000028); #endif /* CONFIG_RMII */ #endif /* CONFIG_MPC885 */ #endif /* CONFIG_ETHER_ON_FEC2 */ } } static int fec_reset(fec_t __iomem *fecp) { int i; /* Whack a reset. * A delay is required between a reset of the FEC block and * initialization of other FEC registers because the reset takes * some time to complete. If you don't delay, subsequent writes * to FEC registers might get killed by the reset routine which is * still in progress. */ out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_RESET); for (i = 0; (in_be32(&fecp->fec_ecntrl) & FEC_ECNTRL_RESET) && (i < FEC_RESET_DELAY); ++i) udelay(1); if (i == FEC_RESET_DELAY) return -1; return 0; } static int fec_init(struct eth_device *dev, struct bd_info *bd) { struct ether_fcc_info_s *efis = dev->priv; immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR; fec_t __iomem *fecp = (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset); int i; #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) /* the MII interface is connected to FEC1 * so for the miiphy_xxx function to work we must * call mii_init since fec_halt messes the thing up */ if (efis->ether_index != 0) __mii_init(); #endif if (fec_reset(fecp) < 0) printf("FEC_RESET_DELAY timeout\n"); /* We use strictly polling mode only */ out_be32(&fecp->fec_imask, 0); /* Clear any pending interrupt */ out_be32(&fecp->fec_ievent, 0xffc0); /* No need to set the IVEC register */ /* Set station address */ #define ea dev->enetaddr out_be32(&fecp->fec_addr_low, (ea[0] << 24) | (ea[1] << 16) | (ea[2] << 8) | ea[3]); out_be16(&fecp->fec_addr_high, (ea[4] << 8) | ea[5]); #undef ea #if defined(CONFIG_CMD_CDP) /* * Turn on multicast address hash table */ out_be32(&fecp->fec_hash_table_high, 0xffffffff); out_be32(&fecp->fec_hash_table_low, 0xffffffff); #else /* Clear multicast address hash table */ out_be32(&fecp->fec_hash_table_high, 0); out_be32(&fecp->fec_hash_table_low, 0); #endif /* Set maximum receive buffer size. */ out_be32(&fecp->fec_r_buff_size, PKT_MAXBLR_SIZE); /* Set maximum frame length */ out_be32(&fecp->fec_r_hash, PKT_MAXBUF_SIZE); /* * Setup Buffers and Buffer Descriptors */ rxIdx = 0; txIdx = 0; if (!rtx) rtx = (struct common_buf_desc __iomem *) (immr->im_cpm.cp_dpmem + CPM_FEC_BASE); /* * Setup Receiver Buffer Descriptors (13.14.24.18) * Settings: * Empty, Wrap */ for (i = 0; i < PKTBUFSRX; i++) { out_be16(&rtx->rxbd[i].cbd_sc, BD_ENET_RX_EMPTY); out_be16(&rtx->rxbd[i].cbd_datlen, 0); /* Reset */ out_be32(&rtx->rxbd[i].cbd_bufaddr, (uint)net_rx_packets[i]); } setbits_be16(&rtx->rxbd[PKTBUFSRX - 1].cbd_sc, BD_ENET_RX_WRAP); /* * Setup Ethernet Transmitter Buffer Descriptors (13.14.24.19) * Settings: * Last, Tx CRC */ for (i = 0; i < TX_BUF_CNT; i++) { out_be16(&rtx->txbd[i].cbd_sc, BD_ENET_TX_LAST | BD_ENET_TX_TC); out_be16(&rtx->txbd[i].cbd_datlen, 0); /* Reset */ out_be32(&rtx->txbd[i].cbd_bufaddr, (uint)txbuf); } setbits_be16(&rtx->txbd[TX_BUF_CNT - 1].cbd_sc, BD_ENET_TX_WRAP); /* Set receive and transmit descriptor base */ out_be32(&fecp->fec_r_des_start, (__force unsigned int)rtx->rxbd); out_be32(&fecp->fec_x_des_start, (__force unsigned int)rtx->txbd); /* Enable MII mode */ /* Half duplex mode */ out_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_MII_MODE | FEC_RCNTRL_DRT); out_be32(&fecp->fec_x_cntrl, 0); /* Enable big endian and don't care about SDMA FC. */ out_be32(&fecp->fec_fun_code, 0x78000000); /* * Setup the pin configuration of the FEC */ fec_pin_init(efis->ether_index); rxIdx = 0; txIdx = 0; /* * Now enable the transmit and receive processing */ out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_ETHER_EN); if (efis->phy_addr == -1) { #ifdef CONFIG_SYS_DISCOVER_PHY /* * wait for the PHY to wake up after reset */ efis->actual_phy_addr = mii_discover_phy(dev); if (efis->actual_phy_addr == -1) { printf("Unable to discover phy!\n"); return -1; } #else efis->actual_phy_addr = -1; #endif } else { efis->actual_phy_addr = efis->phy_addr; } #if defined(CONFIG_MII) && defined(CONFIG_RMII) /* * adapt the RMII speed to the speed of the phy */ if (miiphy_speed(dev->name, efis->actual_phy_addr) == _100BASET) fec_100Mbps(dev); else fec_10Mbps(dev); #endif #if defined(CONFIG_MII) /* * adapt to the half/full speed settings */ if (miiphy_duplex(dev->name, efis->actual_phy_addr) == FULL) fec_full_duplex(dev); else fec_half_duplex(dev); #endif /* And last, try to fill Rx Buffer Descriptors */ /* Descriptor polling active */ out_be32(&fecp->fec_r_des_active, 0x01000000); efis->initialized = 1; return 0; } static void fec_halt(struct eth_device *dev) { struct ether_fcc_info_s *efis = dev->priv; fec_t __iomem *fecp = (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset); int i; /* avoid halt if initialized; mii gets stuck otherwise */ if (!efis->initialized) return; /* Whack a reset. * A delay is required between a reset of the FEC block and * initialization of other FEC registers because the reset takes * some time to complete. If you don't delay, subsequent writes * to FEC registers might get killed by the reset routine which is * still in progress. */ out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_RESET); for (i = 0; (in_be32(&fecp->fec_ecntrl) & FEC_ECNTRL_RESET) && (i < FEC_RESET_DELAY); ++i) udelay(1); if (i == FEC_RESET_DELAY) { printf("FEC_RESET_DELAY timeout\n"); return; } efis->initialized = 0; } #if defined(CONFIG_SYS_DISCOVER_PHY) || defined(CONFIG_MII) || defined(CONFIG_CMD_MII) /* Make MII read/write commands for the FEC. */ #define mk_mii_read(ADDR, REG) (0x60020000 | ((ADDR << 23) | \ (REG & 0x1f) << 18)) #define mk_mii_write(ADDR, REG, VAL) (0x50020000 | ((ADDR << 23) | \ (REG & 0x1f) << 18) | \ (VAL & 0xffff)) /* Interrupt events/masks. */ #define FEC_ENET_HBERR ((uint)0x80000000) /* Heartbeat error */ #define FEC_ENET_BABR ((uint)0x40000000) /* Babbling receiver */ #define FEC_ENET_BABT ((uint)0x20000000) /* Babbling transmitter */ #define FEC_ENET_GRA ((uint)0x10000000) /* Graceful stop complete */ #define FEC_ENET_TXF ((uint)0x08000000) /* Full frame transmitted */ #define FEC_ENET_TXB ((uint)0x04000000) /* A buffer was transmitted */ #define FEC_ENET_RXF ((uint)0x02000000) /* Full frame received */ #define FEC_ENET_RXB ((uint)0x01000000) /* A buffer was received */ #define FEC_ENET_MII ((uint)0x00800000) /* MII interrupt */ #define FEC_ENET_EBERR ((uint)0x00400000) /* SDMA bus error */ /* send command to phy using mii, wait for result */ static uint mii_send(uint mii_cmd) { uint mii_reply; fec_t __iomem *ep; int cnt; immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR; ep = &immr->im_cpm.cp_fec; out_be32(&ep->fec_mii_data, mii_cmd); /* command to phy */ /* wait for mii complete */ cnt = 0; while (!(in_be32(&ep->fec_ievent) & FEC_ENET_MII)) { if (++cnt > 1000) { printf("mii_send STUCK!\n"); break; } } mii_reply = in_be32(&ep->fec_mii_data); /* result from phy */ out_be32(&ep->fec_ievent, FEC_ENET_MII); /* clear MII complete */ return mii_reply & 0xffff; /* data read from phy */ } #endif #if defined(CONFIG_SYS_DISCOVER_PHY) static int mii_discover_phy(struct eth_device *dev) { #define MAX_PHY_PASSES 11 uint phyno; int pass; uint phytype; int phyaddr; phyaddr = -1; /* didn't find a PHY yet */ for (pass = 1; pass <= MAX_PHY_PASSES && phyaddr < 0; ++pass) { if (pass > 1) { /* PHY may need more time to recover from reset. * The LXT970 needs 50ms typical, no maximum is * specified, so wait 10ms before try again. * With 11 passes this gives it 100ms to wake up. */ udelay(10000); /* wait 10ms */ } for (phyno = 0; phyno < 32 && phyaddr < 0; ++phyno) { phytype = mii_send(mk_mii_read(phyno, MII_PHYSID2)); if (phytype != 0xffff) { phyaddr = phyno; phytype |= mii_send(mk_mii_read(phyno, MII_PHYSID1)) << 16; } } } if (phyaddr < 0) printf("No PHY device found.\n"); return phyaddr; } #endif /* CONFIG_SYS_DISCOVER_PHY */ #if (defined(CONFIG_MII) || defined(CONFIG_CMD_MII)) && !defined(CONFIG_BITBANGMII) /**************************************************************************** * mii_init -- Initialize the MII via FEC 1 for MII command without ethernet * This function is a subset of eth_init **************************************************************************** */ static void __mii_init(void) { immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR; fec_t __iomem *fecp = &immr->im_cpm.cp_fec; if (fec_reset(fecp) < 0) printf("FEC_RESET_DELAY timeout\n"); /* We use strictly polling mode only */ out_be32(&fecp->fec_imask, 0); /* Clear any pending interrupt */ out_be32(&fecp->fec_ievent, 0xffc0); /* Now enable the transmit and receive processing */ out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_ETHER_EN); } void mii_init(void) { int i; __mii_init(); /* Setup the pin configuration of the FEC(s) */ for (i = 0; i < ARRAY_SIZE(ether_fcc_info); i++) fec_pin_init(ether_fcc_info[i].ether_index); } /***************************************************************************** * Read and write a MII PHY register, routines used by MII Utilities * * FIXME: These routines are expected to return 0 on success, but mii_send * does _not_ return an error code. Maybe 0xFFFF means error, i.e. * no PHY connected... * For now always return 0. * FIXME: These routines only work after calling eth_init() at least once! * Otherwise they hang in mii_send() !!! Sorry! *****************************************************************************/ int fec8xx_miiphy_read(struct mii_dev *bus, int addr, int devad, int reg) { unsigned short value = 0; short rdreg; /* register working value */ rdreg = mii_send(mk_mii_read(addr, reg)); value = rdreg; return value; } int fec8xx_miiphy_write(struct mii_dev *bus, int addr, int devad, int reg, u16 value) { (void)mii_send(mk_mii_write(addr, reg, value)); return 0; } #endif