mirror of
				https://source.denx.de/u-boot/u-boot.git
				synced 2025-11-03 18:01:41 +01:00 
			
		
		
		
	Migrate mpc8xx_fec driver to DM_ETH. Signed-off-by: Christophe Leroy <christophe.leroy@csgroup.eu> Reviewed-by: Ramon Fried <rfried.dev@gmail.com>
		
			
				
	
	
		
			864 lines
		
	
	
		
			22 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			864 lines
		
	
	
		
			22 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
// SPDX-License-Identifier: GPL-2.0+
 | 
						|
/*
 | 
						|
 * (C) Copyright 2000
 | 
						|
 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 | 
						|
 */
 | 
						|
 | 
						|
#include <common.h>
 | 
						|
#include <command.h>
 | 
						|
#include <hang.h>
 | 
						|
#include <malloc.h>
 | 
						|
#include <net.h>
 | 
						|
#include <netdev.h>
 | 
						|
#include <asm/cpm_8xx.h>
 | 
						|
#include <asm/global_data.h>
 | 
						|
#include <asm/io.h>
 | 
						|
#include <linux/delay.h>
 | 
						|
 | 
						|
#include <phy.h>
 | 
						|
#include <linux/mii.h>
 | 
						|
 | 
						|
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 <miiphy.h>
 | 
						|
 | 
						|
#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 udevice *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;
 | 
						|
 | 
						|
#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
 | 
						|
static void __mii_init(void);
 | 
						|
#endif
 | 
						|
 | 
						|
static int fec_probe(struct udevice *dev)
 | 
						|
{
 | 
						|
	struct ether_fcc_info_s *efis = dev_get_priv(dev);
 | 
						|
	int index = dev_get_driver_data(dev);
 | 
						|
	int             i;
 | 
						|
 | 
						|
	for (i = 0; i < ARRAY_SIZE(ether_fcc_info); i++) {
 | 
						|
		if (ether_fcc_info[i].ether_index != index)
 | 
						|
			continue;
 | 
						|
 | 
						|
		memcpy(efis, ðer_fcc_info[i], sizeof(*efis));
 | 
						|
 | 
						|
		efis->actual_phy_addr = -1;
 | 
						|
 | 
						|
#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
 | 
						|
		int retval;
 | 
						|
		struct mii_dev *mdiodev = mdio_alloc();
 | 
						|
		if (!mdiodev)
 | 
						|
			return -ENOMEM;
 | 
						|
		strlcpy(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 0;
 | 
						|
}
 | 
						|
 | 
						|
static int fec_send(struct udevice *dev, void *packet, int length)
 | 
						|
{
 | 
						|
	int j, rc;
 | 
						|
	struct ether_fcc_info_s *efis = dev_get_priv(dev);
 | 
						|
	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 udevice *dev, int flags, uchar **packetp)
 | 
						|
{
 | 
						|
	int length;
 | 
						|
 | 
						|
	/* section 16.9.23.2 */
 | 
						|
	if (in_be16(&rtx->rxbd[rxIdx].cbd_sc) & BD_ENET_RX_EMPTY)
 | 
						|
		return -EAGAIN;
 | 
						|
 | 
						|
	length = in_be16(&rtx->rxbd[rxIdx].cbd_datlen);
 | 
						|
 | 
						|
	if (!(in_be16(&rtx->rxbd[rxIdx].cbd_sc) & 0x003f)) {
 | 
						|
		uchar *rx = net_rx_packets[rxIdx];
 | 
						|
 | 
						|
#if defined(CONFIG_CMD_CDP)
 | 
						|
		if ((rx[0] & 1) != 0 &&
 | 
						|
		    memcmp((uchar *)rx, net_bcast_ethaddr, 6) != 0 &&
 | 
						|
		    !is_cdp_packet((uchar *)rx))
 | 
						|
			return 0;
 | 
						|
#endif
 | 
						|
		*packetp = rx;
 | 
						|
 | 
						|
		return length - 4;
 | 
						|
	} else {
 | 
						|
		return 0;
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static int fec_free_pkt(struct udevice *dev, uchar *packet, int length)
 | 
						|
{
 | 
						|
	struct ether_fcc_info_s *efis = dev_get_priv(dev);
 | 
						|
	fec_t __iomem *fecp =
 | 
						|
			(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
 | 
						|
 | 
						|
	/* 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 0;
 | 
						|
}
 | 
						|
 | 
						|
/**************************************************************
 | 
						|
 *
 | 
						|
 * 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 udevice *dev)
 | 
						|
{
 | 
						|
	struct ether_fcc_info_s *efis = dev_get_priv(dev);
 | 
						|
	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 udevice *dev)
 | 
						|
{
 | 
						|
	struct ether_fcc_info_s *efis = dev_get_priv(dev);
 | 
						|
	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 udevice *dev)
 | 
						|
{
 | 
						|
	struct ether_fcc_info_s *efis = dev_get_priv(dev);
 | 
						|
	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 udevice *dev)
 | 
						|
{
 | 
						|
	struct ether_fcc_info_s *efis = dev_get_priv(dev);
 | 
						|
	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_start(struct udevice *dev)
 | 
						|
{
 | 
						|
	struct eth_pdata *plat = dev_get_plat(dev);
 | 
						|
	struct ether_fcc_info_s *efis = dev_get_priv(dev);
 | 
						|
	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 plat->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_stop(struct udevice *dev)
 | 
						|
{
 | 
						|
	struct ether_fcc_info_s *efis = dev_get_priv(dev);
 | 
						|
	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 udevice *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
 | 
						|
 | 
						|
static const struct eth_ops fec_ops = {
 | 
						|
	.start	= fec_start,
 | 
						|
	.send	= fec_send,
 | 
						|
	.recv	= fec_recv,
 | 
						|
	.stop	= fec_stop,
 | 
						|
	.free_pkt = fec_free_pkt,
 | 
						|
};
 | 
						|
 | 
						|
static const struct udevice_id fec_ids[] = {
 | 
						|
#ifdef CONFIG_ETHER_ON_FEC1
 | 
						|
	{
 | 
						|
		.compatible = "fsl,pq1-fec1",
 | 
						|
		.data = 0,
 | 
						|
	},
 | 
						|
#endif
 | 
						|
#ifdef CONFIG_ETHER_ON_FEC2
 | 
						|
	{
 | 
						|
		.compatible = "fsl,pq1-fec2",
 | 
						|
		.data = 1,
 | 
						|
	},
 | 
						|
#endif
 | 
						|
	{ }
 | 
						|
};
 | 
						|
 | 
						|
U_BOOT_DRIVER(fec) = {
 | 
						|
	.name	= "fec",
 | 
						|
	.id	= UCLASS_ETH,
 | 
						|
	.of_match = fec_ids,
 | 
						|
	.probe	= fec_probe,
 | 
						|
	.ops	= &fec_ops,
 | 
						|
	.priv_auto	= sizeof(struct ether_fcc_info_s),
 | 
						|
	.plat_auto	= sizeof(struct eth_pdata),
 | 
						|
};
 |